| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 1 | /* Copyright (C) 2006, Red Hat, Inc. */ | 
|  | 2 |  | 
|  | 3 | #include <linux/bitops.h> | 
|  | 4 | #include <net/ieee80211.h> | 
| Dan Williams | 3cf2093 | 2007-05-25 17:28:30 -0400 | [diff] [blame] | 5 | #include <linux/etherdevice.h> | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 6 |  | 
|  | 7 | #include "assoc.h" | 
|  | 8 | #include "join.h" | 
|  | 9 | #include "decl.h" | 
|  | 10 | #include "hostcmd.h" | 
|  | 11 | #include "host.h" | 
| Dan Williams | 2dd4b26 | 2007-12-11 16:54:15 -0500 | [diff] [blame] | 12 | #include "cmd.h" | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 13 |  | 
|  | 14 |  | 
| Ihar Hrachyshka | 5a6e043 | 2008-01-25 14:15:00 +0100 | [diff] [blame] | 15 | static const u8 bssid_any[ETH_ALEN]  __attribute__ ((aligned (2))) = | 
|  | 16 | { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF }; | 
|  | 17 | static const u8 bssid_off[ETH_ALEN]  __attribute__ ((aligned (2))) = | 
|  | 18 | { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 19 |  | 
| Dan Williams | e76850d | 2007-05-25 17:09:41 -0400 | [diff] [blame] | 20 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 21 | static int assoc_helper_essid(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 22 | struct assoc_request * assoc_req) | 
|  | 23 | { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 24 | int ret = 0; | 
| Dan Williams | fcdb53d | 2007-05-25 16:15:56 -0400 | [diff] [blame] | 25 | struct bss_descriptor * bss; | 
| Dan Williams | aeea0ab | 2007-05-25 22:30:48 -0400 | [diff] [blame] | 26 | int channel = -1; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 27 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 28 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 29 |  | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 30 | /* FIXME: take channel into account when picking SSIDs if a channel | 
|  | 31 | * is set. | 
|  | 32 | */ | 
|  | 33 |  | 
| Dan Williams | aeea0ab | 2007-05-25 22:30:48 -0400 | [diff] [blame] | 34 | if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) | 
|  | 35 | channel = assoc_req->channel; | 
|  | 36 |  | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 37 | lbs_deb_assoc("SSID '%s' requested\n", | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 38 | escape_essid(assoc_req->ssid, assoc_req->ssid_len)); | 
| Dan Williams | 0dc5a29 | 2007-05-10 22:58:02 -0400 | [diff] [blame] | 39 | if (assoc_req->mode == IW_MODE_INFRA) { | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 40 | lbs_send_specific_ssid_scan(priv, assoc_req->ssid, | 
| Holger Schurig | 52933d8 | 2008-03-05 07:05:32 +0100 | [diff] [blame] | 41 | assoc_req->ssid_len); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 42 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 43 | bss = lbs_find_ssid_in_list(priv, assoc_req->ssid, | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 44 | assoc_req->ssid_len, NULL, IW_MODE_INFRA, channel); | 
| Dan Williams | fcdb53d | 2007-05-25 16:15:56 -0400 | [diff] [blame] | 45 | if (bss != NULL) { | 
| Dan Williams | e76850d | 2007-05-25 17:09:41 -0400 | [diff] [blame] | 46 | memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor)); | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 47 | ret = lbs_associate(priv, assoc_req); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 48 | } else { | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 49 | lbs_deb_assoc("SSID not found; cannot associate\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 50 | } | 
| Dan Williams | 0dc5a29 | 2007-05-10 22:58:02 -0400 | [diff] [blame] | 51 | } else if (assoc_req->mode == IW_MODE_ADHOC) { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 52 | /* Scan for the network, do not save previous results.  Stale | 
|  | 53 | *   scan data will cause us to join a non-existant adhoc network | 
|  | 54 | */ | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 55 | lbs_send_specific_ssid_scan(priv, assoc_req->ssid, | 
| Holger Schurig | 52933d8 | 2008-03-05 07:05:32 +0100 | [diff] [blame] | 56 | assoc_req->ssid_len); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 57 |  | 
|  | 58 | /* Search for the requested SSID in the scan table */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 59 | bss = lbs_find_ssid_in_list(priv, assoc_req->ssid, | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 60 | assoc_req->ssid_len, NULL, IW_MODE_ADHOC, channel); | 
| Dan Williams | fcdb53d | 2007-05-25 16:15:56 -0400 | [diff] [blame] | 61 | if (bss != NULL) { | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 62 | lbs_deb_assoc("SSID found, will join\n"); | 
| Dan Williams | e76850d | 2007-05-25 17:09:41 -0400 | [diff] [blame] | 63 | memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor)); | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 64 | lbs_join_adhoc_network(priv, assoc_req); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 65 | } else { | 
|  | 66 | /* else send START command */ | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 67 | lbs_deb_assoc("SSID not found, creating adhoc network\n"); | 
| Dan Williams | e76850d | 2007-05-25 17:09:41 -0400 | [diff] [blame] | 68 | memcpy(&assoc_req->bss.ssid, &assoc_req->ssid, | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 69 | IW_ESSID_MAX_SIZE); | 
|  | 70 | assoc_req->bss.ssid_len = assoc_req->ssid_len; | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 71 | lbs_start_adhoc_network(priv, assoc_req); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 72 | } | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 73 | } | 
|  | 74 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 75 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 76 | return ret; | 
|  | 77 | } | 
|  | 78 |  | 
|  | 79 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 80 | static int assoc_helper_bssid(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 81 | struct assoc_request * assoc_req) | 
|  | 82 | { | 
| Dan Williams | fcdb53d | 2007-05-25 16:15:56 -0400 | [diff] [blame] | 83 | int ret = 0; | 
|  | 84 | struct bss_descriptor * bss; | 
| Joe Perches | 0795af5 | 2007-10-03 17:59:30 -0700 | [diff] [blame] | 85 | DECLARE_MAC_BUF(mac); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 86 |  | 
| Joe Perches | 0795af5 | 2007-10-03 17:59:30 -0700 | [diff] [blame] | 87 | lbs_deb_enter_args(LBS_DEB_ASSOC, "BSSID %s", | 
|  | 88 | print_mac(mac, assoc_req->bssid)); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 89 |  | 
|  | 90 | /* Search for index position in list for requested MAC */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 91 | bss = lbs_find_bssid_in_list(priv, assoc_req->bssid, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 92 | assoc_req->mode); | 
| Dan Williams | fcdb53d | 2007-05-25 16:15:56 -0400 | [diff] [blame] | 93 | if (bss == NULL) { | 
| Joe Perches | 0795af5 | 2007-10-03 17:59:30 -0700 | [diff] [blame] | 94 | lbs_deb_assoc("ASSOC: WAP: BSSID %s not found, " | 
|  | 95 | "cannot associate.\n", print_mac(mac, assoc_req->bssid)); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 96 | goto out; | 
|  | 97 | } | 
|  | 98 |  | 
| Dan Williams | e76850d | 2007-05-25 17:09:41 -0400 | [diff] [blame] | 99 | memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor)); | 
| Dan Williams | 0dc5a29 | 2007-05-10 22:58:02 -0400 | [diff] [blame] | 100 | if (assoc_req->mode == IW_MODE_INFRA) { | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 101 | ret = lbs_associate(priv, assoc_req); | 
|  | 102 | lbs_deb_assoc("ASSOC: lbs_associate(bssid) returned %d\n", ret); | 
| Dan Williams | 0dc5a29 | 2007-05-10 22:58:02 -0400 | [diff] [blame] | 103 | } else if (assoc_req->mode == IW_MODE_ADHOC) { | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 104 | lbs_join_adhoc_network(priv, assoc_req); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 105 | } | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 106 |  | 
|  | 107 | out: | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 108 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 109 | return ret; | 
|  | 110 | } | 
|  | 111 |  | 
|  | 112 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 113 | static int assoc_helper_associate(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 114 | struct assoc_request * assoc_req) | 
|  | 115 | { | 
|  | 116 | int ret = 0, done = 0; | 
|  | 117 |  | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 118 | lbs_deb_enter(LBS_DEB_ASSOC); | 
|  | 119 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 120 | /* If we're given and 'any' BSSID, try associating based on SSID */ | 
|  | 121 |  | 
|  | 122 | if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) { | 
| Dan Williams | 3cf2093 | 2007-05-25 17:28:30 -0400 | [diff] [blame] | 123 | if (compare_ether_addr(bssid_any, assoc_req->bssid) | 
|  | 124 | && compare_ether_addr(bssid_off, assoc_req->bssid)) { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 125 | ret = assoc_helper_bssid(priv, assoc_req); | 
|  | 126 | done = 1; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 127 | } | 
|  | 128 | } | 
|  | 129 |  | 
|  | 130 | if (!done && test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) { | 
|  | 131 | ret = assoc_helper_essid(priv, assoc_req); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 132 | } | 
|  | 133 |  | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 134 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 135 | return ret; | 
|  | 136 | } | 
|  | 137 |  | 
|  | 138 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 139 | static int assoc_helper_mode(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 140 | struct assoc_request * assoc_req) | 
|  | 141 | { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 142 | int ret = 0; | 
|  | 143 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 144 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 145 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 146 | if (assoc_req->mode == priv->mode) | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 147 | goto done; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 148 |  | 
| Dan Williams | 0dc5a29 | 2007-05-10 22:58:02 -0400 | [diff] [blame] | 149 | if (assoc_req->mode == IW_MODE_INFRA) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 150 | if (priv->psstate != PS_STATE_FULL_POWER) | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 151 | lbs_ps_wakeup(priv, CMD_OPTION_WAITFORRSP); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 152 | priv->psmode = LBS802_11POWERMODECAM; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 153 | } | 
|  | 154 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 155 | priv->mode = assoc_req->mode; | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 156 | ret = lbs_prepare_and_send_command(priv, | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 157 | CMD_802_11_SNMP_MIB, | 
|  | 158 | 0, CMD_OPTION_WAITFORRSP, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 159 | OID_802_11_INFRASTRUCTURE_MODE, | 
| David Woodhouse | 981f187 | 2007-05-25 23:36:54 -0400 | [diff] [blame] | 160 | /* Shoot me now */  (void *) (size_t) assoc_req->mode); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 161 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 162 | done: | 
|  | 163 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 164 | return ret; | 
|  | 165 | } | 
|  | 166 |  | 
|  | 167 |  | 
| David Woodhouse | 9f46257 | 2007-12-12 22:50:21 -0500 | [diff] [blame] | 168 | int lbs_update_channel(struct lbs_private *priv) | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 169 | { | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 170 | int ret; | 
| Dan Williams | 2dd4b26 | 2007-12-11 16:54:15 -0500 | [diff] [blame] | 171 |  | 
| David Woodhouse | d1a469f | 2007-12-16 17:21:00 -0500 | [diff] [blame] | 172 | /* the channel in f/w could be out of sync; get the current channel */ | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 173 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| Dan Williams | 2dd4b26 | 2007-12-11 16:54:15 -0500 | [diff] [blame] | 174 |  | 
|  | 175 | ret = lbs_get_channel(priv); | 
| David Woodhouse | d1a469f | 2007-12-16 17:21:00 -0500 | [diff] [blame] | 176 | if (ret > 0) { | 
|  | 177 | priv->curbssparams.channel = ret; | 
|  | 178 | ret = 0; | 
|  | 179 | } | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 180 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
|  | 181 | return ret; | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 182 | } | 
|  | 183 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 184 | static int assoc_helper_channel(struct lbs_private *priv, | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 185 | struct assoc_request * assoc_req) | 
|  | 186 | { | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 187 | int ret = 0; | 
|  | 188 |  | 
|  | 189 | lbs_deb_enter(LBS_DEB_ASSOC); | 
|  | 190 |  | 
| David Woodhouse | 9f46257 | 2007-12-12 22:50:21 -0500 | [diff] [blame] | 191 | ret = lbs_update_channel(priv); | 
| David Woodhouse | d1a469f | 2007-12-16 17:21:00 -0500 | [diff] [blame] | 192 | if (ret) { | 
| David Woodhouse | 23d36ee | 2007-12-12 00:14:21 -0500 | [diff] [blame] | 193 | lbs_deb_assoc("ASSOC: channel: error getting channel.\n"); | 
| David Woodhouse | d1a469f | 2007-12-16 17:21:00 -0500 | [diff] [blame] | 194 | goto done; | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 195 | } | 
|  | 196 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 197 | if (assoc_req->channel == priv->curbssparams.channel) | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 198 | goto done; | 
|  | 199 |  | 
| David Woodhouse | 8642f1f | 2007-12-11 20:03:01 -0500 | [diff] [blame] | 200 | if (priv->mesh_dev) { | 
| David Woodhouse | 8606213 | 2007-12-13 00:32:36 -0500 | [diff] [blame] | 201 | /* Change mesh channel first; 21.p21 firmware won't let | 
|  | 202 | you change channel otherwise (even though it'll return | 
|  | 203 | an error to this */ | 
|  | 204 | lbs_mesh_config(priv, 0, assoc_req->channel); | 
| David Woodhouse | 8642f1f | 2007-12-11 20:03:01 -0500 | [diff] [blame] | 205 | } | 
|  | 206 |  | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 207 | lbs_deb_assoc("ASSOC: channel: %d -> %d\n", | 
| David Woodhouse | 8606213 | 2007-12-13 00:32:36 -0500 | [diff] [blame] | 208 | priv->curbssparams.channel, assoc_req->channel); | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 209 |  | 
| Dan Williams | 2dd4b26 | 2007-12-11 16:54:15 -0500 | [diff] [blame] | 210 | ret = lbs_set_channel(priv, assoc_req->channel); | 
|  | 211 | if (ret < 0) | 
| David Woodhouse | 23d36ee | 2007-12-12 00:14:21 -0500 | [diff] [blame] | 212 | lbs_deb_assoc("ASSOC: channel: error setting channel.\n"); | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 213 |  | 
| Dan Williams | 2dd4b26 | 2007-12-11 16:54:15 -0500 | [diff] [blame] | 214 | /* FIXME: shouldn't need to grab the channel _again_ after setting | 
|  | 215 | * it since the firmware is supposed to return the new channel, but | 
|  | 216 | * whatever... */ | 
| David Woodhouse | 9f46257 | 2007-12-12 22:50:21 -0500 | [diff] [blame] | 217 | ret = lbs_update_channel(priv); | 
| David Woodhouse | d1a469f | 2007-12-16 17:21:00 -0500 | [diff] [blame] | 218 | if (ret) { | 
| David Woodhouse | 23d36ee | 2007-12-12 00:14:21 -0500 | [diff] [blame] | 219 | lbs_deb_assoc("ASSOC: channel: error getting channel.\n"); | 
| David Woodhouse | d1a469f | 2007-12-16 17:21:00 -0500 | [diff] [blame] | 220 | goto done; | 
|  | 221 | } | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 222 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 223 | if (assoc_req->channel != priv->curbssparams.channel) { | 
| David Woodhouse | 88ae291 | 2007-12-11 19:57:05 -0500 | [diff] [blame] | 224 | lbs_deb_assoc("ASSOC: channel: failed to update channel to %d\n", | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 225 | assoc_req->channel); | 
| David Woodhouse | 8642f1f | 2007-12-11 20:03:01 -0500 | [diff] [blame] | 226 | goto restore_mesh; | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 227 | } | 
|  | 228 |  | 
|  | 229 | if (   assoc_req->secinfo.wep_enabled | 
|  | 230 | &&   (assoc_req->wep_keys[0].len | 
|  | 231 | || assoc_req->wep_keys[1].len | 
|  | 232 | || assoc_req->wep_keys[2].len | 
|  | 233 | || assoc_req->wep_keys[3].len)) { | 
|  | 234 | /* Make sure WEP keys are re-sent to firmware */ | 
|  | 235 | set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags); | 
|  | 236 | } | 
|  | 237 |  | 
|  | 238 | /* Must restart/rejoin adhoc networks after channel change */ | 
| David Woodhouse | 23d36ee | 2007-12-12 00:14:21 -0500 | [diff] [blame] | 239 | set_bit(ASSOC_FLAG_SSID, &assoc_req->flags); | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 240 |  | 
| David Woodhouse | 8642f1f | 2007-12-11 20:03:01 -0500 | [diff] [blame] | 241 | restore_mesh: | 
|  | 242 | if (priv->mesh_dev) | 
| David Woodhouse | 8606213 | 2007-12-13 00:32:36 -0500 | [diff] [blame] | 243 | lbs_mesh_config(priv, 1, priv->curbssparams.channel); | 
| David Woodhouse | 8642f1f | 2007-12-11 20:03:01 -0500 | [diff] [blame] | 244 |  | 
|  | 245 | done: | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 246 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
|  | 247 | return ret; | 
|  | 248 | } | 
|  | 249 |  | 
|  | 250 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 251 | static int assoc_helper_wep_keys(struct lbs_private *priv, | 
| David Woodhouse | f70dd45 | 2007-12-18 00:18:05 -0500 | [diff] [blame] | 252 | struct assoc_request *assoc_req) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 253 | { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 254 | int i; | 
|  | 255 | int ret = 0; | 
|  | 256 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 257 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 258 |  | 
|  | 259 | /* Set or remove WEP keys */ | 
| David Woodhouse | f70dd45 | 2007-12-18 00:18:05 -0500 | [diff] [blame] | 260 | if (assoc_req->wep_keys[0].len || assoc_req->wep_keys[1].len || | 
|  | 261 | assoc_req->wep_keys[2].len || assoc_req->wep_keys[3].len) | 
|  | 262 | ret = lbs_cmd_802_11_set_wep(priv, CMD_ACT_ADD, assoc_req); | 
|  | 263 | else | 
|  | 264 | ret = lbs_cmd_802_11_set_wep(priv, CMD_ACT_REMOVE, assoc_req); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 265 |  | 
|  | 266 | if (ret) | 
|  | 267 | goto out; | 
|  | 268 |  | 
|  | 269 | /* enable/disable the MAC's WEP packet filter */ | 
| Dan Williams | 889c05b | 2007-05-10 22:57:23 -0400 | [diff] [blame] | 270 | if (assoc_req->secinfo.wep_enabled) | 
| Holger Schurig | d9e9778 | 2008-03-12 16:06:43 +0100 | [diff] [blame] | 271 | priv->mac_control |= CMD_ACT_MAC_WEP_ENABLE; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 272 | else | 
| Holger Schurig | d9e9778 | 2008-03-12 16:06:43 +0100 | [diff] [blame] | 273 | priv->mac_control &= ~CMD_ACT_MAC_WEP_ENABLE; | 
| David Woodhouse | f70dd45 | 2007-12-18 00:18:05 -0500 | [diff] [blame] | 274 |  | 
| Holger Schurig | c97329e | 2008-03-18 11:20:21 +0100 | [diff] [blame] | 275 | lbs_set_mac_control(priv); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 276 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 277 | mutex_lock(&priv->lock); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 278 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 279 | /* Copy WEP keys into priv wep key fields */ | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 280 | for (i = 0; i < 4; i++) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 281 | memcpy(&priv->wep_keys[i], &assoc_req->wep_keys[i], | 
| David Woodhouse | f70dd45 | 2007-12-18 00:18:05 -0500 | [diff] [blame] | 282 | sizeof(struct enc_key)); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 283 | } | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 284 | priv->wep_tx_keyidx = assoc_req->wep_tx_keyidx; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 285 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 286 | mutex_unlock(&priv->lock); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 287 |  | 
|  | 288 | out: | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 289 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 290 | return ret; | 
|  | 291 | } | 
|  | 292 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 293 | static int assoc_helper_secinfo(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 294 | struct assoc_request * assoc_req) | 
|  | 295 | { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 296 | int ret = 0; | 
| David Woodhouse | 4f59abf | 2007-12-18 00:47:17 -0500 | [diff] [blame] | 297 | uint16_t do_wpa; | 
|  | 298 | uint16_t rsn = 0; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 299 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 300 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 301 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 302 | memcpy(&priv->secinfo, &assoc_req->secinfo, | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 303 | sizeof(struct lbs_802_11_security)); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 304 |  | 
| Holger Schurig | c97329e | 2008-03-18 11:20:21 +0100 | [diff] [blame] | 305 | lbs_set_mac_control(priv); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 306 |  | 
| Dan Williams | 18c96c34 | 2007-06-18 12:01:12 -0400 | [diff] [blame] | 307 | /* If RSN is already enabled, don't try to enable it again, since | 
|  | 308 | * ENABLE_RSN resets internal state machines and will clobber the | 
|  | 309 | * 4-way WPA handshake. | 
|  | 310 | */ | 
|  | 311 |  | 
|  | 312 | /* Get RSN enabled/disabled */ | 
| David Woodhouse | 4f59abf | 2007-12-18 00:47:17 -0500 | [diff] [blame] | 313 | ret = lbs_cmd_802_11_enable_rsn(priv, CMD_ACT_GET, &rsn); | 
| Dan Williams | 18c96c34 | 2007-06-18 12:01:12 -0400 | [diff] [blame] | 314 | if (ret) { | 
| David Woodhouse | 23d36ee | 2007-12-12 00:14:21 -0500 | [diff] [blame] | 315 | lbs_deb_assoc("Failed to get RSN status: %d\n", ret); | 
| Dan Williams | 18c96c34 | 2007-06-18 12:01:12 -0400 | [diff] [blame] | 316 | goto out; | 
|  | 317 | } | 
|  | 318 |  | 
|  | 319 | /* Don't re-enable RSN if it's already enabled */ | 
| David Woodhouse | 4f59abf | 2007-12-18 00:47:17 -0500 | [diff] [blame] | 320 | do_wpa = assoc_req->secinfo.WPAenabled || assoc_req->secinfo.WPA2enabled; | 
| Dan Williams | 18c96c34 | 2007-06-18 12:01:12 -0400 | [diff] [blame] | 321 | if (do_wpa == rsn) | 
|  | 322 | goto out; | 
|  | 323 |  | 
|  | 324 | /* Set RSN enabled/disabled */ | 
| David Woodhouse | 4f59abf | 2007-12-18 00:47:17 -0500 | [diff] [blame] | 325 | ret = lbs_cmd_802_11_enable_rsn(priv, CMD_ACT_SET, &do_wpa); | 
| Dan Williams | 90a4221 | 2007-05-25 23:01:24 -0400 | [diff] [blame] | 326 |  | 
|  | 327 | out: | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 328 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 329 | return ret; | 
|  | 330 | } | 
|  | 331 |  | 
|  | 332 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 333 | static int assoc_helper_wpa_keys(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 334 | struct assoc_request * assoc_req) | 
|  | 335 | { | 
|  | 336 | int ret = 0; | 
| Dan Williams | 2bcde51 | 2007-10-03 10:37:45 -0400 | [diff] [blame] | 337 | unsigned int flags = assoc_req->flags; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 338 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 339 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 340 |  | 
| Dan Williams | 2bcde51 | 2007-10-03 10:37:45 -0400 | [diff] [blame] | 341 | /* Work around older firmware bug where WPA unicast and multicast | 
|  | 342 | * keys must be set independently.  Seen in SDIO parts with firmware | 
|  | 343 | * version 5.0.11p0. | 
|  | 344 | */ | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 345 |  | 
| Dan Williams | 2bcde51 | 2007-10-03 10:37:45 -0400 | [diff] [blame] | 346 | if (test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) { | 
|  | 347 | clear_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags); | 
| David Woodhouse | 9e1228d | 2008-03-03 12:15:39 +0100 | [diff] [blame] | 348 | ret = lbs_cmd_802_11_key_material(priv, CMD_ACT_SET, assoc_req); | 
| Dan Williams | 2bcde51 | 2007-10-03 10:37:45 -0400 | [diff] [blame] | 349 | assoc_req->flags = flags; | 
|  | 350 | } | 
|  | 351 |  | 
|  | 352 | if (ret) | 
|  | 353 | goto out; | 
|  | 354 |  | 
|  | 355 | if (test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)) { | 
|  | 356 | clear_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags); | 
|  | 357 |  | 
| David Woodhouse | 9e1228d | 2008-03-03 12:15:39 +0100 | [diff] [blame] | 358 | ret = lbs_cmd_802_11_key_material(priv, CMD_ACT_SET, assoc_req); | 
| Dan Williams | 2bcde51 | 2007-10-03 10:37:45 -0400 | [diff] [blame] | 359 | assoc_req->flags = flags; | 
|  | 360 | } | 
|  | 361 |  | 
|  | 362 | out: | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 363 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 364 | return ret; | 
|  | 365 | } | 
|  | 366 |  | 
|  | 367 |  | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 368 | static int assoc_helper_wpa_ie(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 369 | struct assoc_request * assoc_req) | 
|  | 370 | { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 371 | int ret = 0; | 
|  | 372 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 373 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 374 |  | 
|  | 375 | if (assoc_req->secinfo.WPAenabled || assoc_req->secinfo.WPA2enabled) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 376 | memcpy(&priv->wpa_ie, &assoc_req->wpa_ie, assoc_req->wpa_ie_len); | 
|  | 377 | priv->wpa_ie_len = assoc_req->wpa_ie_len; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 378 | } else { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 379 | memset(&priv->wpa_ie, 0, MAX_WPA_IE_LEN); | 
|  | 380 | priv->wpa_ie_len = 0; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 381 | } | 
|  | 382 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 383 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 384 | return ret; | 
|  | 385 | } | 
|  | 386 |  | 
|  | 387 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 388 | static int should_deauth_infrastructure(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 389 | struct assoc_request * assoc_req) | 
|  | 390 | { | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 391 | int ret = 0; | 
|  | 392 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 393 | if (priv->connect_status != LBS_CONNECTED) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 394 | return 0; | 
|  | 395 |  | 
| Holger Schurig | 52507c2 | 2008-01-28 17:25:53 +0100 | [diff] [blame] | 396 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 397 | if (test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) { | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 398 | lbs_deb_assoc("Deauthenticating due to new SSID\n"); | 
|  | 399 | ret = 1; | 
|  | 400 | goto out; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 401 | } | 
|  | 402 |  | 
|  | 403 | if (test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 404 | if (priv->secinfo.auth_mode != assoc_req->secinfo.auth_mode) { | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 405 | lbs_deb_assoc("Deauthenticating due to new security\n"); | 
|  | 406 | ret = 1; | 
|  | 407 | goto out; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 408 | } | 
|  | 409 | } | 
|  | 410 |  | 
|  | 411 | if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) { | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 412 | lbs_deb_assoc("Deauthenticating due to new BSSID\n"); | 
|  | 413 | ret = 1; | 
|  | 414 | goto out; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 415 | } | 
|  | 416 |  | 
| Luis Carlos Cobo Rus | fff47f1 | 2007-05-30 12:16:13 -0400 | [diff] [blame] | 417 | if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) { | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 418 | lbs_deb_assoc("Deauthenticating due to channel switch\n"); | 
|  | 419 | ret = 1; | 
|  | 420 | goto out; | 
| Luis Carlos Cobo Rus | fff47f1 | 2007-05-30 12:16:13 -0400 | [diff] [blame] | 421 | } | 
|  | 422 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 423 | /* FIXME: deal with 'auto' mode somehow */ | 
|  | 424 | if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) { | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 425 | if (assoc_req->mode != IW_MODE_INFRA) { | 
|  | 426 | lbs_deb_assoc("Deauthenticating due to leaving " | 
|  | 427 | "infra mode\n"); | 
|  | 428 | ret = 1; | 
|  | 429 | goto out; | 
|  | 430 | } | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 431 | } | 
|  | 432 |  | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 433 | out: | 
|  | 434 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | 
| Holger Schurig | 52507c2 | 2008-01-28 17:25:53 +0100 | [diff] [blame] | 435 | return ret; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 436 | } | 
|  | 437 |  | 
|  | 438 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 439 | static int should_stop_adhoc(struct lbs_private *priv, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 440 | struct assoc_request * assoc_req) | 
|  | 441 | { | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 442 | lbs_deb_enter(LBS_DEB_ASSOC); | 
|  | 443 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 444 | if (priv->connect_status != LBS_CONNECTED) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 445 | return 0; | 
|  | 446 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 447 | if (lbs_ssid_cmp(priv->curbssparams.ssid, | 
|  | 448 | priv->curbssparams.ssid_len, | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 449 | assoc_req->ssid, assoc_req->ssid_len) != 0) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 450 | return 1; | 
|  | 451 |  | 
|  | 452 | /* FIXME: deal with 'auto' mode somehow */ | 
|  | 453 | if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) { | 
| Dan Williams | 0dc5a29 | 2007-05-10 22:58:02 -0400 | [diff] [blame] | 454 | if (assoc_req->mode != IW_MODE_ADHOC) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 455 | return 1; | 
|  | 456 | } | 
|  | 457 |  | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 458 | if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 459 | if (assoc_req->channel != priv->curbssparams.channel) | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 460 | return 1; | 
|  | 461 | } | 
|  | 462 |  | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 463 | lbs_deb_leave(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 464 | return 0; | 
|  | 465 | } | 
|  | 466 |  | 
|  | 467 |  | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 468 | void lbs_association_worker(struct work_struct *work) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 469 | { | 
| Holger Schurig | 69f9032 | 2007-11-23 15:43:44 +0100 | [diff] [blame] | 470 | struct lbs_private *priv = container_of(work, struct lbs_private, | 
|  | 471 | assoc_work.work); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 472 | struct assoc_request * assoc_req = NULL; | 
|  | 473 | int ret = 0; | 
|  | 474 | int find_any_ssid = 0; | 
| Joe Perches | 0795af5 | 2007-10-03 17:59:30 -0700 | [diff] [blame] | 475 | DECLARE_MAC_BUF(mac); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 476 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 477 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 478 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 479 | mutex_lock(&priv->lock); | 
|  | 480 | assoc_req = priv->pending_assoc_req; | 
|  | 481 | priv->pending_assoc_req = NULL; | 
|  | 482 | priv->in_progress_assoc_req = assoc_req; | 
|  | 483 | mutex_unlock(&priv->lock); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 484 |  | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 485 | if (!assoc_req) | 
|  | 486 | goto done; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 487 |  | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 488 | lbs_deb_assoc( | 
|  | 489 | "Association Request:\n" | 
|  | 490 | "    flags:     0x%08lx\n" | 
|  | 491 | "    SSID:      '%s'\n" | 
|  | 492 | "    chann:     %d\n" | 
|  | 493 | "    band:      %d\n" | 
|  | 494 | "    mode:      %d\n" | 
|  | 495 | "    BSSID:     %s\n" | 
|  | 496 | "    secinfo:  %s%s%s\n" | 
|  | 497 | "    auth_mode: %d\n", | 
|  | 498 | assoc_req->flags, | 
|  | 499 | escape_essid(assoc_req->ssid, assoc_req->ssid_len), | 
|  | 500 | assoc_req->channel, assoc_req->band, assoc_req->mode, | 
|  | 501 | print_mac(mac, assoc_req->bssid), | 
|  | 502 | assoc_req->secinfo.WPAenabled ? " WPA" : "", | 
|  | 503 | assoc_req->secinfo.WPA2enabled ? " WPA2" : "", | 
|  | 504 | assoc_req->secinfo.wep_enabled ? " WEP" : "", | 
|  | 505 | assoc_req->secinfo.auth_mode); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 506 |  | 
|  | 507 | /* If 'any' SSID was specified, find an SSID to associate with */ | 
|  | 508 | if (test_bit(ASSOC_FLAG_SSID, &assoc_req->flags) | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 509 | && !assoc_req->ssid_len) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 510 | find_any_ssid = 1; | 
|  | 511 |  | 
|  | 512 | /* But don't use 'any' SSID if there's a valid locked BSSID to use */ | 
|  | 513 | if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) { | 
| Dan Williams | 3cf2093 | 2007-05-25 17:28:30 -0400 | [diff] [blame] | 514 | if (compare_ether_addr(assoc_req->bssid, bssid_any) | 
|  | 515 | && compare_ether_addr(assoc_req->bssid, bssid_off)) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 516 | find_any_ssid = 0; | 
|  | 517 | } | 
|  | 518 |  | 
|  | 519 | if (find_any_ssid) { | 
| Dan Williams | 0dc5a29 | 2007-05-10 22:58:02 -0400 | [diff] [blame] | 520 | u8 new_mode; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 521 |  | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 522 | ret = lbs_find_best_network_ssid(priv, assoc_req->ssid, | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 523 | &assoc_req->ssid_len, assoc_req->mode, &new_mode); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 524 | if (ret) { | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 525 | lbs_deb_assoc("Could not find best network\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 526 | ret = -ENETUNREACH; | 
|  | 527 | goto out; | 
|  | 528 | } | 
|  | 529 |  | 
|  | 530 | /* Ensure we switch to the mode of the AP */ | 
| Dan Williams | 0dc5a29 | 2007-05-10 22:58:02 -0400 | [diff] [blame] | 531 | if (assoc_req->mode == IW_MODE_AUTO) { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 532 | set_bit(ASSOC_FLAG_MODE, &assoc_req->flags); | 
|  | 533 | assoc_req->mode = new_mode; | 
|  | 534 | } | 
|  | 535 | } | 
|  | 536 |  | 
|  | 537 | /* | 
|  | 538 | * Check if the attributes being changing require deauthentication | 
|  | 539 | * from the currently associated infrastructure access point. | 
|  | 540 | */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 541 | if (priv->mode == IW_MODE_INFRA) { | 
|  | 542 | if (should_deauth_infrastructure(priv, assoc_req)) { | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 543 | ret = lbs_send_deauthentication(priv); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 544 | if (ret) { | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 545 | lbs_deb_assoc("Deauthentication due to new " | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 546 | "configuration request failed: %d\n", | 
|  | 547 | ret); | 
|  | 548 | } | 
|  | 549 | } | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 550 | } else if (priv->mode == IW_MODE_ADHOC) { | 
|  | 551 | if (should_stop_adhoc(priv, assoc_req)) { | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 552 | ret = lbs_stop_adhoc_network(priv); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 553 | if (ret) { | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 554 | lbs_deb_assoc("Teardown of AdHoc network due to " | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 555 | "new configuration request failed: %d\n", | 
|  | 556 | ret); | 
|  | 557 | } | 
|  | 558 |  | 
|  | 559 | } | 
|  | 560 | } | 
|  | 561 |  | 
|  | 562 | /* Send the various configuration bits to the firmware */ | 
|  | 563 | if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) { | 
|  | 564 | ret = assoc_helper_mode(priv, assoc_req); | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 565 | if (ret) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 566 | goto out; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 567 | } | 
|  | 568 |  | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 569 | if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) { | 
|  | 570 | ret = assoc_helper_channel(priv, assoc_req); | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 571 | if (ret) | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 572 | goto out; | 
| Dan Williams | ef9a264 | 2007-05-25 16:46:33 -0400 | [diff] [blame] | 573 | } | 
|  | 574 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 575 | if (   test_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags) | 
|  | 576 | || test_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags)) { | 
|  | 577 | ret = assoc_helper_wep_keys(priv, assoc_req); | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 578 | if (ret) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 579 | goto out; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 580 | } | 
|  | 581 |  | 
|  | 582 | if (test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) { | 
|  | 583 | ret = assoc_helper_secinfo(priv, assoc_req); | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 584 | if (ret) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 585 | goto out; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 586 | } | 
|  | 587 |  | 
|  | 588 | if (test_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags)) { | 
|  | 589 | ret = assoc_helper_wpa_ie(priv, assoc_req); | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 590 | if (ret) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 591 | goto out; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 592 | } | 
|  | 593 |  | 
|  | 594 | if (test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags) | 
|  | 595 | || test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) { | 
|  | 596 | ret = assoc_helper_wpa_keys(priv, assoc_req); | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 597 | if (ret) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 598 | goto out; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 599 | } | 
|  | 600 |  | 
|  | 601 | /* SSID/BSSID should be the _last_ config option set, because they | 
|  | 602 | * trigger the association attempt. | 
|  | 603 | */ | 
|  | 604 | if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags) | 
|  | 605 | || test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) { | 
|  | 606 | int success = 1; | 
|  | 607 |  | 
|  | 608 | ret = assoc_helper_associate(priv, assoc_req); | 
|  | 609 | if (ret) { | 
| Holger Schurig | 9184346 | 2007-11-28 14:05:02 +0100 | [diff] [blame] | 610 | lbs_deb_assoc("ASSOC: association unsuccessful: %d\n", | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 611 | ret); | 
|  | 612 | success = 0; | 
|  | 613 | } | 
|  | 614 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 615 | if (priv->connect_status != LBS_CONNECTED) { | 
| Holger Schurig | 9184346 | 2007-11-28 14:05:02 +0100 | [diff] [blame] | 616 | lbs_deb_assoc("ASSOC: association unsuccessful, " | 
|  | 617 | "not connected\n"); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 618 | success = 0; | 
|  | 619 | } | 
|  | 620 |  | 
|  | 621 | if (success) { | 
| Holger Schurig | 52507c2 | 2008-01-28 17:25:53 +0100 | [diff] [blame] | 622 | lbs_deb_assoc("associated to %s\n", | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 623 | print_mac(mac, priv->curbssparams.bssid)); | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 624 | lbs_prepare_and_send_command(priv, | 
| Dan Williams | 0aef64d | 2007-08-02 11:31:18 -0400 | [diff] [blame] | 625 | CMD_802_11_RSSI, | 
|  | 626 | 0, CMD_OPTION_WAITFORRSP, 0, NULL); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 627 | } else { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 628 | ret = -1; | 
|  | 629 | } | 
|  | 630 | } | 
|  | 631 |  | 
|  | 632 | out: | 
|  | 633 | if (ret) { | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 634 | lbs_deb_assoc("ASSOC: reconfiguration attempt unsuccessful: %d\n", | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 635 | ret); | 
|  | 636 | } | 
| Dan Williams | e76850d | 2007-05-25 17:09:41 -0400 | [diff] [blame] | 637 |  | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 638 | mutex_lock(&priv->lock); | 
|  | 639 | priv->in_progress_assoc_req = NULL; | 
|  | 640 | mutex_unlock(&priv->lock); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 641 | kfree(assoc_req); | 
| Holger Schurig | 9012b28 | 2007-05-25 11:27:16 -0400 | [diff] [blame] | 642 |  | 
|  | 643 | done: | 
|  | 644 | lbs_deb_leave(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 645 | } | 
|  | 646 |  | 
|  | 647 |  | 
|  | 648 | /* | 
|  | 649 | * Caller MUST hold any necessary locks | 
|  | 650 | */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 651 | struct assoc_request *lbs_get_association_request(struct lbs_private *priv) | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 652 | { | 
|  | 653 | struct assoc_request * assoc_req; | 
|  | 654 |  | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 655 | lbs_deb_enter(LBS_DEB_ASSOC); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 656 | if (!priv->pending_assoc_req) { | 
|  | 657 | priv->pending_assoc_req = kzalloc(sizeof(struct assoc_request), | 
| Dan Williams | e76850d | 2007-05-25 17:09:41 -0400 | [diff] [blame] | 658 | GFP_KERNEL); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 659 | if (!priv->pending_assoc_req) { | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 660 | lbs_pr_info("Not enough memory to allocate association" | 
|  | 661 | " request!\n"); | 
|  | 662 | return NULL; | 
|  | 663 | } | 
|  | 664 | } | 
|  | 665 |  | 
|  | 666 | /* Copy current configuration attributes to the association request, | 
|  | 667 | * but don't overwrite any that are already set. | 
|  | 668 | */ | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 669 | assoc_req = priv->pending_assoc_req; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 670 | if (!test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 671 | memcpy(&assoc_req->ssid, &priv->curbssparams.ssid, | 
| Dan Williams | d8efea2 | 2007-05-28 23:54:55 -0400 | [diff] [blame] | 672 | IW_ESSID_MAX_SIZE); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 673 | assoc_req->ssid_len = priv->curbssparams.ssid_len; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 674 | } | 
|  | 675 |  | 
|  | 676 | if (!test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 677 | assoc_req->channel = priv->curbssparams.channel; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 678 |  | 
| Dan Williams | e76850d | 2007-05-25 17:09:41 -0400 | [diff] [blame] | 679 | if (!test_bit(ASSOC_FLAG_BAND, &assoc_req->flags)) | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 680 | assoc_req->band = priv->curbssparams.band; | 
| Dan Williams | e76850d | 2007-05-25 17:09:41 -0400 | [diff] [blame] | 681 |  | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 682 | if (!test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 683 | assoc_req->mode = priv->mode; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 684 |  | 
|  | 685 | if (!test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 686 | memcpy(&assoc_req->bssid, priv->curbssparams.bssid, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 687 | ETH_ALEN); | 
|  | 688 | } | 
|  | 689 |  | 
|  | 690 | if (!test_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags)) { | 
|  | 691 | int i; | 
|  | 692 | for (i = 0; i < 4; i++) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 693 | memcpy(&assoc_req->wep_keys[i], &priv->wep_keys[i], | 
| Dan Williams | 1443b65 | 2007-08-02 10:45:55 -0400 | [diff] [blame] | 694 | sizeof(struct enc_key)); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 695 | } | 
|  | 696 | } | 
|  | 697 |  | 
|  | 698 | if (!test_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags)) | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 699 | assoc_req->wep_tx_keyidx = priv->wep_tx_keyidx; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 700 |  | 
|  | 701 | if (!test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 702 | memcpy(&assoc_req->wpa_mcast_key, &priv->wpa_mcast_key, | 
| Dan Williams | 1443b65 | 2007-08-02 10:45:55 -0400 | [diff] [blame] | 703 | sizeof(struct enc_key)); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 704 | } | 
|  | 705 |  | 
|  | 706 | if (!test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 707 | memcpy(&assoc_req->wpa_unicast_key, &priv->wpa_unicast_key, | 
| Dan Williams | 1443b65 | 2007-08-02 10:45:55 -0400 | [diff] [blame] | 708 | sizeof(struct enc_key)); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 709 | } | 
|  | 710 |  | 
|  | 711 | if (!test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 712 | memcpy(&assoc_req->secinfo, &priv->secinfo, | 
| Holger Schurig | 1007832 | 2007-11-15 18:05:47 -0500 | [diff] [blame] | 713 | sizeof(struct lbs_802_11_security)); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 714 | } | 
|  | 715 |  | 
|  | 716 | if (!test_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags)) { | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 717 | memcpy(&assoc_req->wpa_ie, &priv->wpa_ie, | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 718 | MAX_WPA_IE_LEN); | 
| David Woodhouse | aa21c00 | 2007-12-08 20:04:36 +0000 | [diff] [blame] | 719 | assoc_req->wpa_ie_len = priv->wpa_ie_len; | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 720 | } | 
|  | 721 |  | 
| Holger Schurig | 0765af4 | 2007-10-15 12:55:56 +0200 | [diff] [blame] | 722 | lbs_deb_leave(LBS_DEB_ASSOC); | 
| Marcelo Tosatti | 876c9d3 | 2007-02-10 12:25:27 -0200 | [diff] [blame] | 723 | return assoc_req; | 
|  | 724 | } |