blob: a4b9756ebb7f6c7a8dfd75e95b64f5f7b8fba056 [file] [log] [blame]
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001/* Copyright (C) 2006, Red Hat, Inc. */
2
3#include <linux/bitops.h>
4#include <net/ieee80211.h>
Dan Williams3cf209312007-05-25 17:28:30 -04005#include <linux/etherdevice.h>
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02006
7#include "assoc.h"
8#include "join.h"
9#include "decl.h"
10#include "hostcmd.h"
11#include "host.h"
Dan Williams2dd4b262007-12-11 16:54:15 -050012#include "cmd.h"
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020013
14
15static const u8 bssid_any[ETH_ALEN] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
16static const u8 bssid_off[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
17
Dan Williamse76850d2007-05-25 17:09:41 -040018
Holger Schurig69f90322007-11-23 15:43:44 +010019static int assoc_helper_essid(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020020 struct assoc_request * assoc_req)
21{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020022 int ret = 0;
Dan Williamsfcdb53d2007-05-25 16:15:56 -040023 struct bss_descriptor * bss;
Dan Williamsaeea0ab2007-05-25 22:30:48 -040024 int channel = -1;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020025
Holger Schurig9012b282007-05-25 11:27:16 -040026 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020027
Dan Williamsef9a2642007-05-25 16:46:33 -040028 /* FIXME: take channel into account when picking SSIDs if a channel
29 * is set.
30 */
31
Dan Williamsaeea0ab2007-05-25 22:30:48 -040032 if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags))
33 channel = assoc_req->channel;
34
Holger Schurig0765af42007-10-15 12:55:56 +020035 lbs_deb_assoc("SSID '%s' requested\n",
Dan Williamsd8efea22007-05-28 23:54:55 -040036 escape_essid(assoc_req->ssid, assoc_req->ssid_len));
Dan Williams0dc5a292007-05-10 22:58:02 -040037 if (assoc_req->mode == IW_MODE_INFRA) {
Holger Schurig10078322007-11-15 18:05:47 -050038 lbs_send_specific_ssid_scan(priv, assoc_req->ssid,
Holger Schurig6e22a852007-08-02 13:05:32 -040039 assoc_req->ssid_len, 0);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020040
David Woodhouseaa21c002007-12-08 20:04:36 +000041 bss = lbs_find_ssid_in_list(priv, assoc_req->ssid,
Dan Williamsd8efea22007-05-28 23:54:55 -040042 assoc_req->ssid_len, NULL, IW_MODE_INFRA, channel);
Dan Williamsfcdb53d2007-05-25 16:15:56 -040043 if (bss != NULL) {
Dan Williamse76850d2007-05-25 17:09:41 -040044 memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor));
Holger Schurig10078322007-11-15 18:05:47 -050045 ret = lbs_associate(priv, assoc_req);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020046 } else {
Dan Williamsd8efea22007-05-28 23:54:55 -040047 lbs_deb_assoc("SSID not found; cannot associate\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020048 }
Dan Williams0dc5a292007-05-10 22:58:02 -040049 } else if (assoc_req->mode == IW_MODE_ADHOC) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020050 /* Scan for the network, do not save previous results. Stale
51 * scan data will cause us to join a non-existant adhoc network
52 */
Holger Schurig10078322007-11-15 18:05:47 -050053 lbs_send_specific_ssid_scan(priv, assoc_req->ssid,
Dan Williamsd8efea22007-05-28 23:54:55 -040054 assoc_req->ssid_len, 1);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020055
56 /* Search for the requested SSID in the scan table */
David Woodhouseaa21c002007-12-08 20:04:36 +000057 bss = lbs_find_ssid_in_list(priv, assoc_req->ssid,
Dan Williamsd8efea22007-05-28 23:54:55 -040058 assoc_req->ssid_len, NULL, IW_MODE_ADHOC, channel);
Dan Williamsfcdb53d2007-05-25 16:15:56 -040059 if (bss != NULL) {
Dan Williamsd8efea22007-05-28 23:54:55 -040060 lbs_deb_assoc("SSID found, will join\n");
Dan Williamse76850d2007-05-25 17:09:41 -040061 memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor));
Holger Schurig10078322007-11-15 18:05:47 -050062 lbs_join_adhoc_network(priv, assoc_req);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020063 } else {
64 /* else send START command */
Dan Williamsd8efea22007-05-28 23:54:55 -040065 lbs_deb_assoc("SSID not found, creating adhoc network\n");
Dan Williamse76850d2007-05-25 17:09:41 -040066 memcpy(&assoc_req->bss.ssid, &assoc_req->ssid,
Dan Williamsd8efea22007-05-28 23:54:55 -040067 IW_ESSID_MAX_SIZE);
68 assoc_req->bss.ssid_len = assoc_req->ssid_len;
Holger Schurig10078322007-11-15 18:05:47 -050069 lbs_start_adhoc_network(priv, assoc_req);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020070 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020071 }
72
Holger Schurig9012b282007-05-25 11:27:16 -040073 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020074 return ret;
75}
76
77
Holger Schurig69f90322007-11-23 15:43:44 +010078static int assoc_helper_bssid(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020079 struct assoc_request * assoc_req)
80{
Dan Williamsfcdb53d2007-05-25 16:15:56 -040081 int ret = 0;
82 struct bss_descriptor * bss;
Joe Perches0795af52007-10-03 17:59:30 -070083 DECLARE_MAC_BUF(mac);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020084
Joe Perches0795af52007-10-03 17:59:30 -070085 lbs_deb_enter_args(LBS_DEB_ASSOC, "BSSID %s",
86 print_mac(mac, assoc_req->bssid));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020087
88 /* Search for index position in list for requested MAC */
David Woodhouseaa21c002007-12-08 20:04:36 +000089 bss = lbs_find_bssid_in_list(priv, assoc_req->bssid,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020090 assoc_req->mode);
Dan Williamsfcdb53d2007-05-25 16:15:56 -040091 if (bss == NULL) {
Joe Perches0795af52007-10-03 17:59:30 -070092 lbs_deb_assoc("ASSOC: WAP: BSSID %s not found, "
93 "cannot associate.\n", print_mac(mac, assoc_req->bssid));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020094 goto out;
95 }
96
Dan Williamse76850d2007-05-25 17:09:41 -040097 memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor));
Dan Williams0dc5a292007-05-10 22:58:02 -040098 if (assoc_req->mode == IW_MODE_INFRA) {
Holger Schurig10078322007-11-15 18:05:47 -050099 ret = lbs_associate(priv, assoc_req);
100 lbs_deb_assoc("ASSOC: lbs_associate(bssid) returned %d\n", ret);
Dan Williams0dc5a292007-05-10 22:58:02 -0400101 } else if (assoc_req->mode == IW_MODE_ADHOC) {
Holger Schurig10078322007-11-15 18:05:47 -0500102 lbs_join_adhoc_network(priv, assoc_req);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200103 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200104
105out:
Holger Schurig9012b282007-05-25 11:27:16 -0400106 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200107 return ret;
108}
109
110
Holger Schurig69f90322007-11-23 15:43:44 +0100111static int assoc_helper_associate(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200112 struct assoc_request * assoc_req)
113{
114 int ret = 0, done = 0;
115
Holger Schurig0765af42007-10-15 12:55:56 +0200116 lbs_deb_enter(LBS_DEB_ASSOC);
117
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200118 /* If we're given and 'any' BSSID, try associating based on SSID */
119
120 if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
Dan Williams3cf209312007-05-25 17:28:30 -0400121 if (compare_ether_addr(bssid_any, assoc_req->bssid)
122 && compare_ether_addr(bssid_off, assoc_req->bssid)) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200123 ret = assoc_helper_bssid(priv, assoc_req);
124 done = 1;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200125 }
126 }
127
128 if (!done && test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
129 ret = assoc_helper_essid(priv, assoc_req);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200130 }
131
Holger Schurig0765af42007-10-15 12:55:56 +0200132 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200133 return ret;
134}
135
136
Holger Schurig69f90322007-11-23 15:43:44 +0100137static int assoc_helper_mode(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200138 struct assoc_request * assoc_req)
139{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200140 int ret = 0;
141
Holger Schurig9012b282007-05-25 11:27:16 -0400142 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200143
David Woodhouseaa21c002007-12-08 20:04:36 +0000144 if (assoc_req->mode == priv->mode)
Holger Schurig9012b282007-05-25 11:27:16 -0400145 goto done;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200146
Dan Williams0dc5a292007-05-10 22:58:02 -0400147 if (assoc_req->mode == IW_MODE_INFRA) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000148 if (priv->psstate != PS_STATE_FULL_POWER)
Holger Schurig10078322007-11-15 18:05:47 -0500149 lbs_ps_wakeup(priv, CMD_OPTION_WAITFORRSP);
David Woodhouseaa21c002007-12-08 20:04:36 +0000150 priv->psmode = LBS802_11POWERMODECAM;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200151 }
152
David Woodhouseaa21c002007-12-08 20:04:36 +0000153 priv->mode = assoc_req->mode;
Holger Schurig10078322007-11-15 18:05:47 -0500154 ret = lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400155 CMD_802_11_SNMP_MIB,
156 0, CMD_OPTION_WAITFORRSP,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200157 OID_802_11_INFRASTRUCTURE_MODE,
David Woodhouse981f1872007-05-25 23:36:54 -0400158 /* Shoot me now */ (void *) (size_t) assoc_req->mode);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200159
Holger Schurig9012b282007-05-25 11:27:16 -0400160done:
161 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200162 return ret;
163}
164
165
Holger Schurig69f90322007-11-23 15:43:44 +0100166static int update_channel(struct lbs_private *priv)
Dan Williamsef9a2642007-05-25 16:46:33 -0400167{
Holger Schurig0765af42007-10-15 12:55:56 +0200168 int ret;
Dan Williams2dd4b262007-12-11 16:54:15 -0500169
Dan Williamsef9a2642007-05-25 16:46:33 -0400170 /* the channel in f/w could be out of sync, get the current channel */
Holger Schurig0765af42007-10-15 12:55:56 +0200171 lbs_deb_enter(LBS_DEB_ASSOC);
Dan Williams2dd4b262007-12-11 16:54:15 -0500172
173 ret = lbs_get_channel(priv);
174 if (ret > 0)
175 priv->curbssparams.channel = (u8) ret;
176
Holger Schurig0765af42007-10-15 12:55:56 +0200177 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
178 return ret;
Dan Williamsef9a2642007-05-25 16:46:33 -0400179}
180
Holger Schurig10078322007-11-15 18:05:47 -0500181void lbs_sync_channel(struct work_struct *work)
Luis Carlos Cobo Rusb8bedef2007-05-30 12:14:34 -0400182{
Holger Schurig69f90322007-11-23 15:43:44 +0100183 struct lbs_private *priv = container_of(work, struct lbs_private,
184 sync_channel);
Luis Carlos Cobo Rusb8bedef2007-05-30 12:14:34 -0400185
Holger Schurig0765af42007-10-15 12:55:56 +0200186 lbs_deb_enter(LBS_DEB_ASSOC);
Luis Carlos Cobo Rusb8bedef2007-05-30 12:14:34 -0400187 if (update_channel(priv) != 0)
188 lbs_pr_info("Channel synchronization failed.");
Holger Schurig0765af42007-10-15 12:55:56 +0200189 lbs_deb_leave(LBS_DEB_ASSOC);
Luis Carlos Cobo Rusb8bedef2007-05-30 12:14:34 -0400190}
191
Holger Schurig69f90322007-11-23 15:43:44 +0100192static int assoc_helper_channel(struct lbs_private *priv,
Dan Williamsef9a2642007-05-25 16:46:33 -0400193 struct assoc_request * assoc_req)
194{
Dan Williamsef9a2642007-05-25 16:46:33 -0400195 int ret = 0;
196
197 lbs_deb_enter(LBS_DEB_ASSOC);
198
199 ret = update_channel(priv);
200 if (ret < 0) {
201 lbs_deb_assoc("ASSOC: channel: error getting channel.");
202 }
203
David Woodhouseaa21c002007-12-08 20:04:36 +0000204 if (assoc_req->channel == priv->curbssparams.channel)
Dan Williamsef9a2642007-05-25 16:46:33 -0400205 goto done;
206
207 lbs_deb_assoc("ASSOC: channel: %d -> %d\n",
David Woodhouseaa21c002007-12-08 20:04:36 +0000208 priv->curbssparams.channel, assoc_req->channel);
Dan Williamsef9a2642007-05-25 16:46:33 -0400209
Dan Williams2dd4b262007-12-11 16:54:15 -0500210 ret = lbs_set_channel(priv, assoc_req->channel);
211 if (ret < 0)
Dan Williamsef9a2642007-05-25 16:46:33 -0400212 lbs_deb_assoc("ASSOC: channel: error setting channel.");
Dan Williamsef9a2642007-05-25 16:46:33 -0400213
Dan Williams2dd4b262007-12-11 16:54:15 -0500214 /* 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... */
Dan Williamsef9a2642007-05-25 16:46:33 -0400217 ret = update_channel(priv);
Dan Williams2dd4b262007-12-11 16:54:15 -0500218 if (ret < 0)
Dan Williamsef9a2642007-05-25 16:46:33 -0400219 lbs_deb_assoc("ASSOC: channel: error getting channel.");
Dan Williamsef9a2642007-05-25 16:46:33 -0400220
David Woodhouseaa21c002007-12-08 20:04:36 +0000221 if (assoc_req->channel != priv->curbssparams.channel) {
David Woodhouse88ae2912007-12-11 19:57:05 -0500222 lbs_deb_assoc("ASSOC: channel: failed to update channel to %d\n",
Dan Williamsef9a2642007-05-25 16:46:33 -0400223 assoc_req->channel);
224 goto done;
225 }
226
227 if ( assoc_req->secinfo.wep_enabled
228 && (assoc_req->wep_keys[0].len
229 || assoc_req->wep_keys[1].len
230 || assoc_req->wep_keys[2].len
231 || assoc_req->wep_keys[3].len)) {
232 /* Make sure WEP keys are re-sent to firmware */
233 set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
234 }
235
236 /* Must restart/rejoin adhoc networks after channel change */
237 set_bit(ASSOC_FLAG_SSID, &assoc_req->flags);
238
239done:
240 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
241 return ret;
242}
243
244
Holger Schurig69f90322007-11-23 15:43:44 +0100245static int assoc_helper_wep_keys(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200246 struct assoc_request * assoc_req)
247{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200248 int i;
249 int ret = 0;
250
Holger Schurig9012b282007-05-25 11:27:16 -0400251 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200252
253 /* Set or remove WEP keys */
254 if ( assoc_req->wep_keys[0].len
255 || assoc_req->wep_keys[1].len
256 || assoc_req->wep_keys[2].len
257 || assoc_req->wep_keys[3].len) {
Holger Schurig10078322007-11-15 18:05:47 -0500258 ret = lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400259 CMD_802_11_SET_WEP,
260 CMD_ACT_ADD,
261 CMD_OPTION_WAITFORRSP,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200262 0, assoc_req);
263 } else {
Holger Schurig10078322007-11-15 18:05:47 -0500264 ret = lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400265 CMD_802_11_SET_WEP,
266 CMD_ACT_REMOVE,
267 CMD_OPTION_WAITFORRSP,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200268 0, NULL);
269 }
270
271 if (ret)
272 goto out;
273
274 /* enable/disable the MAC's WEP packet filter */
Dan Williams889c05b2007-05-10 22:57:23 -0400275 if (assoc_req->secinfo.wep_enabled)
David Woodhouseaa21c002007-12-08 20:04:36 +0000276 priv->currentpacketfilter |= CMD_ACT_MAC_WEP_ENABLE;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200277 else
David Woodhouseaa21c002007-12-08 20:04:36 +0000278 priv->currentpacketfilter &= ~CMD_ACT_MAC_WEP_ENABLE;
Holger Schurig10078322007-11-15 18:05:47 -0500279 ret = lbs_set_mac_packet_filter(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200280 if (ret)
281 goto out;
282
David Woodhouseaa21c002007-12-08 20:04:36 +0000283 mutex_lock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200284
David Woodhouseaa21c002007-12-08 20:04:36 +0000285 /* Copy WEP keys into priv wep key fields */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200286 for (i = 0; i < 4; i++) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000287 memcpy(&priv->wep_keys[i], &assoc_req->wep_keys[i],
Dan Williams1443b652007-08-02 10:45:55 -0400288 sizeof(struct enc_key));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200289 }
David Woodhouseaa21c002007-12-08 20:04:36 +0000290 priv->wep_tx_keyidx = assoc_req->wep_tx_keyidx;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200291
David Woodhouseaa21c002007-12-08 20:04:36 +0000292 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200293
294out:
Holger Schurig9012b282007-05-25 11:27:16 -0400295 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200296 return ret;
297}
298
Holger Schurig69f90322007-11-23 15:43:44 +0100299static int assoc_helper_secinfo(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200300 struct assoc_request * assoc_req)
301{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200302 int ret = 0;
Dan Williams18c96c342007-06-18 12:01:12 -0400303 u32 do_wpa;
304 u32 rsn = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200305
Holger Schurig9012b282007-05-25 11:27:16 -0400306 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200307
David Woodhouseaa21c002007-12-08 20:04:36 +0000308 memcpy(&priv->secinfo, &assoc_req->secinfo,
Holger Schurig10078322007-11-15 18:05:47 -0500309 sizeof(struct lbs_802_11_security));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200310
Holger Schurig10078322007-11-15 18:05:47 -0500311 ret = lbs_set_mac_packet_filter(priv);
Dan Williams90a42212007-05-25 23:01:24 -0400312 if (ret)
313 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200314
Dan Williams18c96c342007-06-18 12:01:12 -0400315 /* If RSN is already enabled, don't try to enable it again, since
316 * ENABLE_RSN resets internal state machines and will clobber the
317 * 4-way WPA handshake.
318 */
319
320 /* Get RSN enabled/disabled */
Holger Schurig10078322007-11-15 18:05:47 -0500321 ret = lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400322 CMD_802_11_ENABLE_RSN,
323 CMD_ACT_GET,
324 CMD_OPTION_WAITFORRSP,
Dan Williams18c96c342007-06-18 12:01:12 -0400325 0, &rsn);
326 if (ret) {
327 lbs_deb_assoc("Failed to get RSN status: %d", ret);
328 goto out;
329 }
330
331 /* Don't re-enable RSN if it's already enabled */
332 do_wpa = (assoc_req->secinfo.WPAenabled || assoc_req->secinfo.WPA2enabled);
333 if (do_wpa == rsn)
334 goto out;
335
336 /* Set RSN enabled/disabled */
337 rsn = do_wpa;
Holger Schurig10078322007-11-15 18:05:47 -0500338 ret = lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400339 CMD_802_11_ENABLE_RSN,
340 CMD_ACT_SET,
341 CMD_OPTION_WAITFORRSP,
Dan Williams18c96c342007-06-18 12:01:12 -0400342 0, &rsn);
Dan Williams90a42212007-05-25 23:01:24 -0400343
344out:
Holger Schurig9012b282007-05-25 11:27:16 -0400345 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200346 return ret;
347}
348
349
Holger Schurig69f90322007-11-23 15:43:44 +0100350static int assoc_helper_wpa_keys(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200351 struct assoc_request * assoc_req)
352{
353 int ret = 0;
Dan Williams2bcde512007-10-03 10:37:45 -0400354 unsigned int flags = assoc_req->flags;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200355
Holger Schurig9012b282007-05-25 11:27:16 -0400356 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200357
Dan Williams2bcde512007-10-03 10:37:45 -0400358 /* Work around older firmware bug where WPA unicast and multicast
359 * keys must be set independently. Seen in SDIO parts with firmware
360 * version 5.0.11p0.
361 */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200362
Dan Williams2bcde512007-10-03 10:37:45 -0400363 if (test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) {
364 clear_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);
Holger Schurig10078322007-11-15 18:05:47 -0500365 ret = lbs_prepare_and_send_command(priv,
Dan Williams2bcde512007-10-03 10:37:45 -0400366 CMD_802_11_KEY_MATERIAL,
367 CMD_ACT_SET,
368 CMD_OPTION_WAITFORRSP,
369 0, assoc_req);
370 assoc_req->flags = flags;
371 }
372
373 if (ret)
374 goto out;
375
376 if (test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)) {
377 clear_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags);
378
Holger Schurig10078322007-11-15 18:05:47 -0500379 ret = lbs_prepare_and_send_command(priv,
Dan Williams2bcde512007-10-03 10:37:45 -0400380 CMD_802_11_KEY_MATERIAL,
381 CMD_ACT_SET,
382 CMD_OPTION_WAITFORRSP,
383 0, assoc_req);
384 assoc_req->flags = flags;
385 }
386
387out:
Holger Schurig9012b282007-05-25 11:27:16 -0400388 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200389 return ret;
390}
391
392
Holger Schurig69f90322007-11-23 15:43:44 +0100393static int assoc_helper_wpa_ie(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200394 struct assoc_request * assoc_req)
395{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200396 int ret = 0;
397
Holger Schurig9012b282007-05-25 11:27:16 -0400398 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200399
400 if (assoc_req->secinfo.WPAenabled || assoc_req->secinfo.WPA2enabled) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000401 memcpy(&priv->wpa_ie, &assoc_req->wpa_ie, assoc_req->wpa_ie_len);
402 priv->wpa_ie_len = assoc_req->wpa_ie_len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200403 } else {
David Woodhouseaa21c002007-12-08 20:04:36 +0000404 memset(&priv->wpa_ie, 0, MAX_WPA_IE_LEN);
405 priv->wpa_ie_len = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200406 }
407
Holger Schurig9012b282007-05-25 11:27:16 -0400408 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200409 return ret;
410}
411
412
David Woodhouseaa21c002007-12-08 20:04:36 +0000413static int should_deauth_infrastructure(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200414 struct assoc_request * assoc_req)
415{
Holger Schurig0765af42007-10-15 12:55:56 +0200416 int ret = 0;
417
418 lbs_deb_enter(LBS_DEB_ASSOC);
419
David Woodhouseaa21c002007-12-08 20:04:36 +0000420 if (priv->connect_status != LBS_CONNECTED)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200421 return 0;
422
423 if (test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
Holger Schurig0765af42007-10-15 12:55:56 +0200424 lbs_deb_assoc("Deauthenticating due to new SSID\n");
425 ret = 1;
426 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200427 }
428
429 if (test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000430 if (priv->secinfo.auth_mode != assoc_req->secinfo.auth_mode) {
Holger Schurig0765af42007-10-15 12:55:56 +0200431 lbs_deb_assoc("Deauthenticating due to new security\n");
432 ret = 1;
433 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200434 }
435 }
436
437 if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
Holger Schurig0765af42007-10-15 12:55:56 +0200438 lbs_deb_assoc("Deauthenticating due to new BSSID\n");
439 ret = 1;
440 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200441 }
442
Luis Carlos Cobo Rusfff47f12007-05-30 12:16:13 -0400443 if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) {
Holger Schurig0765af42007-10-15 12:55:56 +0200444 lbs_deb_assoc("Deauthenticating due to channel switch\n");
445 ret = 1;
446 goto out;
Luis Carlos Cobo Rusfff47f12007-05-30 12:16:13 -0400447 }
448
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200449 /* FIXME: deal with 'auto' mode somehow */
450 if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) {
Holger Schurig0765af42007-10-15 12:55:56 +0200451 if (assoc_req->mode != IW_MODE_INFRA) {
452 lbs_deb_assoc("Deauthenticating due to leaving "
453 "infra mode\n");
454 ret = 1;
455 goto out;
456 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200457 }
458
Holger Schurig0765af42007-10-15 12:55:56 +0200459out:
460 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200461 return 0;
462}
463
464
David Woodhouseaa21c002007-12-08 20:04:36 +0000465static int should_stop_adhoc(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200466 struct assoc_request * assoc_req)
467{
Holger Schurig0765af42007-10-15 12:55:56 +0200468 lbs_deb_enter(LBS_DEB_ASSOC);
469
David Woodhouseaa21c002007-12-08 20:04:36 +0000470 if (priv->connect_status != LBS_CONNECTED)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200471 return 0;
472
David Woodhouseaa21c002007-12-08 20:04:36 +0000473 if (lbs_ssid_cmp(priv->curbssparams.ssid,
474 priv->curbssparams.ssid_len,
Dan Williamsd8efea22007-05-28 23:54:55 -0400475 assoc_req->ssid, assoc_req->ssid_len) != 0)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200476 return 1;
477
478 /* FIXME: deal with 'auto' mode somehow */
479 if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) {
Dan Williams0dc5a292007-05-10 22:58:02 -0400480 if (assoc_req->mode != IW_MODE_ADHOC)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200481 return 1;
482 }
483
Dan Williamsef9a2642007-05-25 16:46:33 -0400484 if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000485 if (assoc_req->channel != priv->curbssparams.channel)
Dan Williamsef9a2642007-05-25 16:46:33 -0400486 return 1;
487 }
488
Holger Schurig0765af42007-10-15 12:55:56 +0200489 lbs_deb_leave(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200490 return 0;
491}
492
493
Holger Schurig10078322007-11-15 18:05:47 -0500494void lbs_association_worker(struct work_struct *work)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200495{
Holger Schurig69f90322007-11-23 15:43:44 +0100496 struct lbs_private *priv = container_of(work, struct lbs_private,
497 assoc_work.work);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200498 struct assoc_request * assoc_req = NULL;
499 int ret = 0;
500 int find_any_ssid = 0;
Joe Perches0795af52007-10-03 17:59:30 -0700501 DECLARE_MAC_BUF(mac);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200502
Holger Schurig9012b282007-05-25 11:27:16 -0400503 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200504
David Woodhouseaa21c002007-12-08 20:04:36 +0000505 mutex_lock(&priv->lock);
506 assoc_req = priv->pending_assoc_req;
507 priv->pending_assoc_req = NULL;
508 priv->in_progress_assoc_req = assoc_req;
509 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200510
Holger Schurig9012b282007-05-25 11:27:16 -0400511 if (!assoc_req)
512 goto done;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200513
Holger Schurig0765af42007-10-15 12:55:56 +0200514 lbs_deb_assoc(
515 "Association Request:\n"
516 " flags: 0x%08lx\n"
517 " SSID: '%s'\n"
518 " chann: %d\n"
519 " band: %d\n"
520 " mode: %d\n"
521 " BSSID: %s\n"
522 " secinfo: %s%s%s\n"
523 " auth_mode: %d\n",
524 assoc_req->flags,
525 escape_essid(assoc_req->ssid, assoc_req->ssid_len),
526 assoc_req->channel, assoc_req->band, assoc_req->mode,
527 print_mac(mac, assoc_req->bssid),
528 assoc_req->secinfo.WPAenabled ? " WPA" : "",
529 assoc_req->secinfo.WPA2enabled ? " WPA2" : "",
530 assoc_req->secinfo.wep_enabled ? " WEP" : "",
531 assoc_req->secinfo.auth_mode);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200532
533 /* If 'any' SSID was specified, find an SSID to associate with */
534 if (test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)
Dan Williamsd8efea22007-05-28 23:54:55 -0400535 && !assoc_req->ssid_len)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200536 find_any_ssid = 1;
537
538 /* But don't use 'any' SSID if there's a valid locked BSSID to use */
539 if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
Dan Williams3cf209312007-05-25 17:28:30 -0400540 if (compare_ether_addr(assoc_req->bssid, bssid_any)
541 && compare_ether_addr(assoc_req->bssid, bssid_off))
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200542 find_any_ssid = 0;
543 }
544
545 if (find_any_ssid) {
Dan Williams0dc5a292007-05-10 22:58:02 -0400546 u8 new_mode;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200547
Holger Schurig10078322007-11-15 18:05:47 -0500548 ret = lbs_find_best_network_ssid(priv, assoc_req->ssid,
Dan Williamsd8efea22007-05-28 23:54:55 -0400549 &assoc_req->ssid_len, assoc_req->mode, &new_mode);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200550 if (ret) {
Holger Schurig9012b282007-05-25 11:27:16 -0400551 lbs_deb_assoc("Could not find best network\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200552 ret = -ENETUNREACH;
553 goto out;
554 }
555
556 /* Ensure we switch to the mode of the AP */
Dan Williams0dc5a292007-05-10 22:58:02 -0400557 if (assoc_req->mode == IW_MODE_AUTO) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200558 set_bit(ASSOC_FLAG_MODE, &assoc_req->flags);
559 assoc_req->mode = new_mode;
560 }
561 }
562
563 /*
564 * Check if the attributes being changing require deauthentication
565 * from the currently associated infrastructure access point.
566 */
David Woodhouseaa21c002007-12-08 20:04:36 +0000567 if (priv->mode == IW_MODE_INFRA) {
568 if (should_deauth_infrastructure(priv, assoc_req)) {
Holger Schurig10078322007-11-15 18:05:47 -0500569 ret = lbs_send_deauthentication(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200570 if (ret) {
Holger Schurig9012b282007-05-25 11:27:16 -0400571 lbs_deb_assoc("Deauthentication due to new "
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200572 "configuration request failed: %d\n",
573 ret);
574 }
575 }
David Woodhouseaa21c002007-12-08 20:04:36 +0000576 } else if (priv->mode == IW_MODE_ADHOC) {
577 if (should_stop_adhoc(priv, assoc_req)) {
Holger Schurig10078322007-11-15 18:05:47 -0500578 ret = lbs_stop_adhoc_network(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200579 if (ret) {
Holger Schurig9012b282007-05-25 11:27:16 -0400580 lbs_deb_assoc("Teardown of AdHoc network due to "
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200581 "new configuration request failed: %d\n",
582 ret);
583 }
584
585 }
586 }
587
588 /* Send the various configuration bits to the firmware */
589 if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) {
590 ret = assoc_helper_mode(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200591 if (ret)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200592 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200593 }
594
Dan Williamsef9a2642007-05-25 16:46:33 -0400595 if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) {
596 ret = assoc_helper_channel(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200597 if (ret)
Dan Williamsef9a2642007-05-25 16:46:33 -0400598 goto out;
Dan Williamsef9a2642007-05-25 16:46:33 -0400599 }
600
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200601 if ( test_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags)
602 || test_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags)) {
603 ret = assoc_helper_wep_keys(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200604 if (ret)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200605 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200606 }
607
608 if (test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) {
609 ret = assoc_helper_secinfo(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200610 if (ret)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200611 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200612 }
613
614 if (test_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags)) {
615 ret = assoc_helper_wpa_ie(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200616 if (ret)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200617 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200618 }
619
620 if (test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)
621 || test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) {
622 ret = assoc_helper_wpa_keys(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200623 if (ret)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200624 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200625 }
626
627 /* SSID/BSSID should be the _last_ config option set, because they
628 * trigger the association attempt.
629 */
630 if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)
631 || test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
632 int success = 1;
633
634 ret = assoc_helper_associate(priv, assoc_req);
635 if (ret) {
Holger Schurig91843462007-11-28 14:05:02 +0100636 lbs_deb_assoc("ASSOC: association unsuccessful: %d\n",
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200637 ret);
638 success = 0;
639 }
640
David Woodhouseaa21c002007-12-08 20:04:36 +0000641 if (priv->connect_status != LBS_CONNECTED) {
Holger Schurig91843462007-11-28 14:05:02 +0100642 lbs_deb_assoc("ASSOC: association unsuccessful, "
643 "not connected\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200644 success = 0;
645 }
646
647 if (success) {
Holger Schurig91843462007-11-28 14:05:02 +0100648 lbs_deb_assoc("ASSOC: associated to '%s', %s\n",
David Woodhouseaa21c002007-12-08 20:04:36 +0000649 escape_essid(priv->curbssparams.ssid,
650 priv->curbssparams.ssid_len),
651 print_mac(mac, priv->curbssparams.bssid));
Holger Schurig10078322007-11-15 18:05:47 -0500652 lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400653 CMD_802_11_RSSI,
654 0, CMD_OPTION_WAITFORRSP, 0, NULL);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200655
Holger Schurig10078322007-11-15 18:05:47 -0500656 lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400657 CMD_802_11_GET_LOG,
658 0, CMD_OPTION_WAITFORRSP, 0, NULL);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200659 } else {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200660 ret = -1;
661 }
662 }
663
664out:
665 if (ret) {
Holger Schurig9012b282007-05-25 11:27:16 -0400666 lbs_deb_assoc("ASSOC: reconfiguration attempt unsuccessful: %d\n",
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200667 ret);
668 }
Dan Williamse76850d2007-05-25 17:09:41 -0400669
David Woodhouseaa21c002007-12-08 20:04:36 +0000670 mutex_lock(&priv->lock);
671 priv->in_progress_assoc_req = NULL;
672 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200673 kfree(assoc_req);
Holger Schurig9012b282007-05-25 11:27:16 -0400674
675done:
676 lbs_deb_leave(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200677}
678
679
680/*
681 * Caller MUST hold any necessary locks
682 */
David Woodhouseaa21c002007-12-08 20:04:36 +0000683struct assoc_request *lbs_get_association_request(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200684{
685 struct assoc_request * assoc_req;
686
Holger Schurig0765af42007-10-15 12:55:56 +0200687 lbs_deb_enter(LBS_DEB_ASSOC);
David Woodhouseaa21c002007-12-08 20:04:36 +0000688 if (!priv->pending_assoc_req) {
689 priv->pending_assoc_req = kzalloc(sizeof(struct assoc_request),
Dan Williamse76850d2007-05-25 17:09:41 -0400690 GFP_KERNEL);
David Woodhouseaa21c002007-12-08 20:04:36 +0000691 if (!priv->pending_assoc_req) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200692 lbs_pr_info("Not enough memory to allocate association"
693 " request!\n");
694 return NULL;
695 }
696 }
697
698 /* Copy current configuration attributes to the association request,
699 * but don't overwrite any that are already set.
700 */
David Woodhouseaa21c002007-12-08 20:04:36 +0000701 assoc_req = priv->pending_assoc_req;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200702 if (!test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000703 memcpy(&assoc_req->ssid, &priv->curbssparams.ssid,
Dan Williamsd8efea22007-05-28 23:54:55 -0400704 IW_ESSID_MAX_SIZE);
David Woodhouseaa21c002007-12-08 20:04:36 +0000705 assoc_req->ssid_len = priv->curbssparams.ssid_len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200706 }
707
708 if (!test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags))
David Woodhouseaa21c002007-12-08 20:04:36 +0000709 assoc_req->channel = priv->curbssparams.channel;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200710
Dan Williamse76850d2007-05-25 17:09:41 -0400711 if (!test_bit(ASSOC_FLAG_BAND, &assoc_req->flags))
David Woodhouseaa21c002007-12-08 20:04:36 +0000712 assoc_req->band = priv->curbssparams.band;
Dan Williamse76850d2007-05-25 17:09:41 -0400713
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200714 if (!test_bit(ASSOC_FLAG_MODE, &assoc_req->flags))
David Woodhouseaa21c002007-12-08 20:04:36 +0000715 assoc_req->mode = priv->mode;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200716
717 if (!test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000718 memcpy(&assoc_req->bssid, priv->curbssparams.bssid,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200719 ETH_ALEN);
720 }
721
722 if (!test_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags)) {
723 int i;
724 for (i = 0; i < 4; i++) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000725 memcpy(&assoc_req->wep_keys[i], &priv->wep_keys[i],
Dan Williams1443b652007-08-02 10:45:55 -0400726 sizeof(struct enc_key));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200727 }
728 }
729
730 if (!test_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags))
David Woodhouseaa21c002007-12-08 20:04:36 +0000731 assoc_req->wep_tx_keyidx = priv->wep_tx_keyidx;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200732
733 if (!test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000734 memcpy(&assoc_req->wpa_mcast_key, &priv->wpa_mcast_key,
Dan Williams1443b652007-08-02 10:45:55 -0400735 sizeof(struct enc_key));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200736 }
737
738 if (!test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000739 memcpy(&assoc_req->wpa_unicast_key, &priv->wpa_unicast_key,
Dan Williams1443b652007-08-02 10:45:55 -0400740 sizeof(struct enc_key));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200741 }
742
743 if (!test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000744 memcpy(&assoc_req->secinfo, &priv->secinfo,
Holger Schurig10078322007-11-15 18:05:47 -0500745 sizeof(struct lbs_802_11_security));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200746 }
747
748 if (!test_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000749 memcpy(&assoc_req->wpa_ie, &priv->wpa_ie,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200750 MAX_WPA_IE_LEN);
David Woodhouseaa21c002007-12-08 20:04:36 +0000751 assoc_req->wpa_ie_len = priv->wpa_ie_len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200752 }
753
Holger Schurig0765af42007-10-15 12:55:56 +0200754 lbs_deb_leave(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200755 return assoc_req;
756}