blob: 7b672fe62cf936b38ff75149c617ff365fdf211d [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
David Woodhouse8642f1f2007-12-11 20:03:01 -0500207 if (priv->mesh_dev) {
208 /* Disconnect mesh while associating -- otherwise it
209 won't let us change channels */
210 lbs_mesh_config(priv, 0);
211 }
212
Dan Williamsef9a2642007-05-25 16:46:33 -0400213 lbs_deb_assoc("ASSOC: channel: %d -> %d\n",
David Woodhouseaa21c002007-12-08 20:04:36 +0000214 priv->curbssparams.channel, assoc_req->channel);
Dan Williamsef9a2642007-05-25 16:46:33 -0400215
Dan Williams2dd4b262007-12-11 16:54:15 -0500216 ret = lbs_set_channel(priv, assoc_req->channel);
217 if (ret < 0)
Dan Williamsef9a2642007-05-25 16:46:33 -0400218 lbs_deb_assoc("ASSOC: channel: error setting channel.");
Dan Williamsef9a2642007-05-25 16:46:33 -0400219
Dan Williams2dd4b262007-12-11 16:54:15 -0500220 /* FIXME: shouldn't need to grab the channel _again_ after setting
221 * it since the firmware is supposed to return the new channel, but
222 * whatever... */
Dan Williamsef9a2642007-05-25 16:46:33 -0400223 ret = update_channel(priv);
Dan Williams2dd4b262007-12-11 16:54:15 -0500224 if (ret < 0)
Dan Williamsef9a2642007-05-25 16:46:33 -0400225 lbs_deb_assoc("ASSOC: channel: error getting channel.");
Dan Williamsef9a2642007-05-25 16:46:33 -0400226
David Woodhouseaa21c002007-12-08 20:04:36 +0000227 if (assoc_req->channel != priv->curbssparams.channel) {
David Woodhouse88ae2912007-12-11 19:57:05 -0500228 lbs_deb_assoc("ASSOC: channel: failed to update channel to %d\n",
Dan Williamsef9a2642007-05-25 16:46:33 -0400229 assoc_req->channel);
David Woodhouse8642f1f2007-12-11 20:03:01 -0500230 goto restore_mesh;
Dan Williamsef9a2642007-05-25 16:46:33 -0400231 }
232
233 if ( assoc_req->secinfo.wep_enabled
234 && (assoc_req->wep_keys[0].len
235 || assoc_req->wep_keys[1].len
236 || assoc_req->wep_keys[2].len
237 || assoc_req->wep_keys[3].len)) {
238 /* Make sure WEP keys are re-sent to firmware */
239 set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
240 }
241
242 /* Must restart/rejoin adhoc networks after channel change */
243 set_bit(ASSOC_FLAG_SSID, &assoc_req->flags);
244
David Woodhouse8642f1f2007-12-11 20:03:01 -0500245 restore_mesh:
246 if (priv->mesh_dev)
247 lbs_mesh_config(priv, 1);
248
249 done:
Dan Williamsef9a2642007-05-25 16:46:33 -0400250 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
251 return ret;
252}
253
254
Holger Schurig69f90322007-11-23 15:43:44 +0100255static int assoc_helper_wep_keys(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200256 struct assoc_request * assoc_req)
257{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200258 int i;
259 int ret = 0;
260
Holger Schurig9012b282007-05-25 11:27:16 -0400261 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200262
263 /* Set or remove WEP keys */
264 if ( assoc_req->wep_keys[0].len
265 || assoc_req->wep_keys[1].len
266 || assoc_req->wep_keys[2].len
267 || assoc_req->wep_keys[3].len) {
Holger Schurig10078322007-11-15 18:05:47 -0500268 ret = lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400269 CMD_802_11_SET_WEP,
270 CMD_ACT_ADD,
271 CMD_OPTION_WAITFORRSP,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200272 0, assoc_req);
273 } else {
Holger Schurig10078322007-11-15 18:05:47 -0500274 ret = lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400275 CMD_802_11_SET_WEP,
276 CMD_ACT_REMOVE,
277 CMD_OPTION_WAITFORRSP,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200278 0, NULL);
279 }
280
281 if (ret)
282 goto out;
283
284 /* enable/disable the MAC's WEP packet filter */
Dan Williams889c05b2007-05-10 22:57:23 -0400285 if (assoc_req->secinfo.wep_enabled)
David Woodhouseaa21c002007-12-08 20:04:36 +0000286 priv->currentpacketfilter |= CMD_ACT_MAC_WEP_ENABLE;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200287 else
David Woodhouseaa21c002007-12-08 20:04:36 +0000288 priv->currentpacketfilter &= ~CMD_ACT_MAC_WEP_ENABLE;
Holger Schurig10078322007-11-15 18:05:47 -0500289 ret = lbs_set_mac_packet_filter(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200290 if (ret)
291 goto out;
292
David Woodhouseaa21c002007-12-08 20:04:36 +0000293 mutex_lock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200294
David Woodhouseaa21c002007-12-08 20:04:36 +0000295 /* Copy WEP keys into priv wep key fields */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200296 for (i = 0; i < 4; i++) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000297 memcpy(&priv->wep_keys[i], &assoc_req->wep_keys[i],
Dan Williams1443b652007-08-02 10:45:55 -0400298 sizeof(struct enc_key));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200299 }
David Woodhouseaa21c002007-12-08 20:04:36 +0000300 priv->wep_tx_keyidx = assoc_req->wep_tx_keyidx;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200301
David Woodhouseaa21c002007-12-08 20:04:36 +0000302 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200303
304out:
Holger Schurig9012b282007-05-25 11:27:16 -0400305 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200306 return ret;
307}
308
Holger Schurig69f90322007-11-23 15:43:44 +0100309static int assoc_helper_secinfo(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200310 struct assoc_request * assoc_req)
311{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200312 int ret = 0;
Dan Williams18c96c342007-06-18 12:01:12 -0400313 u32 do_wpa;
314 u32 rsn = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200315
Holger Schurig9012b282007-05-25 11:27:16 -0400316 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200317
David Woodhouseaa21c002007-12-08 20:04:36 +0000318 memcpy(&priv->secinfo, &assoc_req->secinfo,
Holger Schurig10078322007-11-15 18:05:47 -0500319 sizeof(struct lbs_802_11_security));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200320
Holger Schurig10078322007-11-15 18:05:47 -0500321 ret = lbs_set_mac_packet_filter(priv);
Dan Williams90a42212007-05-25 23:01:24 -0400322 if (ret)
323 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200324
Dan Williams18c96c342007-06-18 12:01:12 -0400325 /* If RSN is already enabled, don't try to enable it again, since
326 * ENABLE_RSN resets internal state machines and will clobber the
327 * 4-way WPA handshake.
328 */
329
330 /* Get RSN enabled/disabled */
Holger Schurig10078322007-11-15 18:05:47 -0500331 ret = lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400332 CMD_802_11_ENABLE_RSN,
333 CMD_ACT_GET,
334 CMD_OPTION_WAITFORRSP,
Dan Williams18c96c342007-06-18 12:01:12 -0400335 0, &rsn);
336 if (ret) {
337 lbs_deb_assoc("Failed to get RSN status: %d", ret);
338 goto out;
339 }
340
341 /* Don't re-enable RSN if it's already enabled */
342 do_wpa = (assoc_req->secinfo.WPAenabled || assoc_req->secinfo.WPA2enabled);
343 if (do_wpa == rsn)
344 goto out;
345
346 /* Set RSN enabled/disabled */
347 rsn = do_wpa;
Holger Schurig10078322007-11-15 18:05:47 -0500348 ret = lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400349 CMD_802_11_ENABLE_RSN,
350 CMD_ACT_SET,
351 CMD_OPTION_WAITFORRSP,
Dan Williams18c96c342007-06-18 12:01:12 -0400352 0, &rsn);
Dan Williams90a42212007-05-25 23:01:24 -0400353
354out:
Holger Schurig9012b282007-05-25 11:27:16 -0400355 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200356 return ret;
357}
358
359
Holger Schurig69f90322007-11-23 15:43:44 +0100360static int assoc_helper_wpa_keys(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200361 struct assoc_request * assoc_req)
362{
363 int ret = 0;
Dan Williams2bcde512007-10-03 10:37:45 -0400364 unsigned int flags = assoc_req->flags;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200365
Holger Schurig9012b282007-05-25 11:27:16 -0400366 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200367
Dan Williams2bcde512007-10-03 10:37:45 -0400368 /* Work around older firmware bug where WPA unicast and multicast
369 * keys must be set independently. Seen in SDIO parts with firmware
370 * version 5.0.11p0.
371 */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200372
Dan Williams2bcde512007-10-03 10:37:45 -0400373 if (test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) {
374 clear_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);
Holger Schurig10078322007-11-15 18:05:47 -0500375 ret = lbs_prepare_and_send_command(priv,
Dan Williams2bcde512007-10-03 10:37:45 -0400376 CMD_802_11_KEY_MATERIAL,
377 CMD_ACT_SET,
378 CMD_OPTION_WAITFORRSP,
379 0, assoc_req);
380 assoc_req->flags = flags;
381 }
382
383 if (ret)
384 goto out;
385
386 if (test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)) {
387 clear_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags);
388
Holger Schurig10078322007-11-15 18:05:47 -0500389 ret = lbs_prepare_and_send_command(priv,
Dan Williams2bcde512007-10-03 10:37:45 -0400390 CMD_802_11_KEY_MATERIAL,
391 CMD_ACT_SET,
392 CMD_OPTION_WAITFORRSP,
393 0, assoc_req);
394 assoc_req->flags = flags;
395 }
396
397out:
Holger Schurig9012b282007-05-25 11:27:16 -0400398 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200399 return ret;
400}
401
402
Holger Schurig69f90322007-11-23 15:43:44 +0100403static int assoc_helper_wpa_ie(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200404 struct assoc_request * assoc_req)
405{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200406 int ret = 0;
407
Holger Schurig9012b282007-05-25 11:27:16 -0400408 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200409
410 if (assoc_req->secinfo.WPAenabled || assoc_req->secinfo.WPA2enabled) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000411 memcpy(&priv->wpa_ie, &assoc_req->wpa_ie, assoc_req->wpa_ie_len);
412 priv->wpa_ie_len = assoc_req->wpa_ie_len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200413 } else {
David Woodhouseaa21c002007-12-08 20:04:36 +0000414 memset(&priv->wpa_ie, 0, MAX_WPA_IE_LEN);
415 priv->wpa_ie_len = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200416 }
417
Holger Schurig9012b282007-05-25 11:27:16 -0400418 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200419 return ret;
420}
421
422
David Woodhouseaa21c002007-12-08 20:04:36 +0000423static int should_deauth_infrastructure(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200424 struct assoc_request * assoc_req)
425{
Holger Schurig0765af42007-10-15 12:55:56 +0200426 int ret = 0;
427
428 lbs_deb_enter(LBS_DEB_ASSOC);
429
David Woodhouseaa21c002007-12-08 20:04:36 +0000430 if (priv->connect_status != LBS_CONNECTED)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200431 return 0;
432
433 if (test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
Holger Schurig0765af42007-10-15 12:55:56 +0200434 lbs_deb_assoc("Deauthenticating due to new SSID\n");
435 ret = 1;
436 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200437 }
438
439 if (test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000440 if (priv->secinfo.auth_mode != assoc_req->secinfo.auth_mode) {
Holger Schurig0765af42007-10-15 12:55:56 +0200441 lbs_deb_assoc("Deauthenticating due to new security\n");
442 ret = 1;
443 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200444 }
445 }
446
447 if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
Holger Schurig0765af42007-10-15 12:55:56 +0200448 lbs_deb_assoc("Deauthenticating due to new BSSID\n");
449 ret = 1;
450 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200451 }
452
Luis Carlos Cobo Rusfff47f12007-05-30 12:16:13 -0400453 if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) {
Holger Schurig0765af42007-10-15 12:55:56 +0200454 lbs_deb_assoc("Deauthenticating due to channel switch\n");
455 ret = 1;
456 goto out;
Luis Carlos Cobo Rusfff47f12007-05-30 12:16:13 -0400457 }
458
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200459 /* FIXME: deal with 'auto' mode somehow */
460 if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) {
Holger Schurig0765af42007-10-15 12:55:56 +0200461 if (assoc_req->mode != IW_MODE_INFRA) {
462 lbs_deb_assoc("Deauthenticating due to leaving "
463 "infra mode\n");
464 ret = 1;
465 goto out;
466 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200467 }
468
Holger Schurig0765af42007-10-15 12:55:56 +0200469out:
470 lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200471 return 0;
472}
473
474
David Woodhouseaa21c002007-12-08 20:04:36 +0000475static int should_stop_adhoc(struct lbs_private *priv,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200476 struct assoc_request * assoc_req)
477{
Holger Schurig0765af42007-10-15 12:55:56 +0200478 lbs_deb_enter(LBS_DEB_ASSOC);
479
David Woodhouseaa21c002007-12-08 20:04:36 +0000480 if (priv->connect_status != LBS_CONNECTED)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200481 return 0;
482
David Woodhouseaa21c002007-12-08 20:04:36 +0000483 if (lbs_ssid_cmp(priv->curbssparams.ssid,
484 priv->curbssparams.ssid_len,
Dan Williamsd8efea22007-05-28 23:54:55 -0400485 assoc_req->ssid, assoc_req->ssid_len) != 0)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200486 return 1;
487
488 /* FIXME: deal with 'auto' mode somehow */
489 if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) {
Dan Williams0dc5a292007-05-10 22:58:02 -0400490 if (assoc_req->mode != IW_MODE_ADHOC)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200491 return 1;
492 }
493
Dan Williamsef9a2642007-05-25 16:46:33 -0400494 if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000495 if (assoc_req->channel != priv->curbssparams.channel)
Dan Williamsef9a2642007-05-25 16:46:33 -0400496 return 1;
497 }
498
Holger Schurig0765af42007-10-15 12:55:56 +0200499 lbs_deb_leave(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200500 return 0;
501}
502
503
Holger Schurig10078322007-11-15 18:05:47 -0500504void lbs_association_worker(struct work_struct *work)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200505{
Holger Schurig69f90322007-11-23 15:43:44 +0100506 struct lbs_private *priv = container_of(work, struct lbs_private,
507 assoc_work.work);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200508 struct assoc_request * assoc_req = NULL;
509 int ret = 0;
510 int find_any_ssid = 0;
Joe Perches0795af52007-10-03 17:59:30 -0700511 DECLARE_MAC_BUF(mac);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200512
Holger Schurig9012b282007-05-25 11:27:16 -0400513 lbs_deb_enter(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200514
David Woodhouseaa21c002007-12-08 20:04:36 +0000515 mutex_lock(&priv->lock);
516 assoc_req = priv->pending_assoc_req;
517 priv->pending_assoc_req = NULL;
518 priv->in_progress_assoc_req = assoc_req;
519 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200520
Holger Schurig9012b282007-05-25 11:27:16 -0400521 if (!assoc_req)
522 goto done;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200523
Holger Schurig0765af42007-10-15 12:55:56 +0200524 lbs_deb_assoc(
525 "Association Request:\n"
526 " flags: 0x%08lx\n"
527 " SSID: '%s'\n"
528 " chann: %d\n"
529 " band: %d\n"
530 " mode: %d\n"
531 " BSSID: %s\n"
532 " secinfo: %s%s%s\n"
533 " auth_mode: %d\n",
534 assoc_req->flags,
535 escape_essid(assoc_req->ssid, assoc_req->ssid_len),
536 assoc_req->channel, assoc_req->band, assoc_req->mode,
537 print_mac(mac, assoc_req->bssid),
538 assoc_req->secinfo.WPAenabled ? " WPA" : "",
539 assoc_req->secinfo.WPA2enabled ? " WPA2" : "",
540 assoc_req->secinfo.wep_enabled ? " WEP" : "",
541 assoc_req->secinfo.auth_mode);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200542
543 /* If 'any' SSID was specified, find an SSID to associate with */
544 if (test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)
Dan Williamsd8efea22007-05-28 23:54:55 -0400545 && !assoc_req->ssid_len)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200546 find_any_ssid = 1;
547
548 /* But don't use 'any' SSID if there's a valid locked BSSID to use */
549 if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
Dan Williams3cf209312007-05-25 17:28:30 -0400550 if (compare_ether_addr(assoc_req->bssid, bssid_any)
551 && compare_ether_addr(assoc_req->bssid, bssid_off))
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200552 find_any_ssid = 0;
553 }
554
555 if (find_any_ssid) {
Dan Williams0dc5a292007-05-10 22:58:02 -0400556 u8 new_mode;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200557
Holger Schurig10078322007-11-15 18:05:47 -0500558 ret = lbs_find_best_network_ssid(priv, assoc_req->ssid,
Dan Williamsd8efea22007-05-28 23:54:55 -0400559 &assoc_req->ssid_len, assoc_req->mode, &new_mode);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200560 if (ret) {
Holger Schurig9012b282007-05-25 11:27:16 -0400561 lbs_deb_assoc("Could not find best network\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200562 ret = -ENETUNREACH;
563 goto out;
564 }
565
566 /* Ensure we switch to the mode of the AP */
Dan Williams0dc5a292007-05-10 22:58:02 -0400567 if (assoc_req->mode == IW_MODE_AUTO) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200568 set_bit(ASSOC_FLAG_MODE, &assoc_req->flags);
569 assoc_req->mode = new_mode;
570 }
571 }
572
573 /*
574 * Check if the attributes being changing require deauthentication
575 * from the currently associated infrastructure access point.
576 */
David Woodhouseaa21c002007-12-08 20:04:36 +0000577 if (priv->mode == IW_MODE_INFRA) {
578 if (should_deauth_infrastructure(priv, assoc_req)) {
Holger Schurig10078322007-11-15 18:05:47 -0500579 ret = lbs_send_deauthentication(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200580 if (ret) {
Holger Schurig9012b282007-05-25 11:27:16 -0400581 lbs_deb_assoc("Deauthentication due to new "
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200582 "configuration request failed: %d\n",
583 ret);
584 }
585 }
David Woodhouseaa21c002007-12-08 20:04:36 +0000586 } else if (priv->mode == IW_MODE_ADHOC) {
587 if (should_stop_adhoc(priv, assoc_req)) {
Holger Schurig10078322007-11-15 18:05:47 -0500588 ret = lbs_stop_adhoc_network(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200589 if (ret) {
Holger Schurig9012b282007-05-25 11:27:16 -0400590 lbs_deb_assoc("Teardown of AdHoc network due to "
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200591 "new configuration request failed: %d\n",
592 ret);
593 }
594
595 }
596 }
597
598 /* Send the various configuration bits to the firmware */
599 if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) {
600 ret = assoc_helper_mode(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200601 if (ret)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200602 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200603 }
604
Dan Williamsef9a2642007-05-25 16:46:33 -0400605 if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) {
606 ret = assoc_helper_channel(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200607 if (ret)
Dan Williamsef9a2642007-05-25 16:46:33 -0400608 goto out;
Dan Williamsef9a2642007-05-25 16:46:33 -0400609 }
610
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200611 if ( test_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags)
612 || test_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags)) {
613 ret = assoc_helper_wep_keys(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200614 if (ret)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200615 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200616 }
617
618 if (test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) {
619 ret = assoc_helper_secinfo(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200620 if (ret)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200621 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200622 }
623
624 if (test_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags)) {
625 ret = assoc_helper_wpa_ie(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200626 if (ret)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200627 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200628 }
629
630 if (test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)
631 || test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) {
632 ret = assoc_helper_wpa_keys(priv, assoc_req);
Holger Schurig0765af42007-10-15 12:55:56 +0200633 if (ret)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200634 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200635 }
636
637 /* SSID/BSSID should be the _last_ config option set, because they
638 * trigger the association attempt.
639 */
640 if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)
641 || test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
642 int success = 1;
643
644 ret = assoc_helper_associate(priv, assoc_req);
645 if (ret) {
Holger Schurig91843462007-11-28 14:05:02 +0100646 lbs_deb_assoc("ASSOC: association unsuccessful: %d\n",
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200647 ret);
648 success = 0;
649 }
650
David Woodhouseaa21c002007-12-08 20:04:36 +0000651 if (priv->connect_status != LBS_CONNECTED) {
Holger Schurig91843462007-11-28 14:05:02 +0100652 lbs_deb_assoc("ASSOC: association unsuccessful, "
653 "not connected\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200654 success = 0;
655 }
656
657 if (success) {
Holger Schurig91843462007-11-28 14:05:02 +0100658 lbs_deb_assoc("ASSOC: associated to '%s', %s\n",
David Woodhouseaa21c002007-12-08 20:04:36 +0000659 escape_essid(priv->curbssparams.ssid,
660 priv->curbssparams.ssid_len),
661 print_mac(mac, priv->curbssparams.bssid));
Holger Schurig10078322007-11-15 18:05:47 -0500662 lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400663 CMD_802_11_RSSI,
664 0, CMD_OPTION_WAITFORRSP, 0, NULL);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200665
Holger Schurig10078322007-11-15 18:05:47 -0500666 lbs_prepare_and_send_command(priv,
Dan Williams0aef64d2007-08-02 11:31:18 -0400667 CMD_802_11_GET_LOG,
668 0, CMD_OPTION_WAITFORRSP, 0, NULL);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200669 } else {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200670 ret = -1;
671 }
672 }
673
674out:
675 if (ret) {
Holger Schurig9012b282007-05-25 11:27:16 -0400676 lbs_deb_assoc("ASSOC: reconfiguration attempt unsuccessful: %d\n",
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200677 ret);
678 }
Dan Williamse76850d2007-05-25 17:09:41 -0400679
David Woodhouseaa21c002007-12-08 20:04:36 +0000680 mutex_lock(&priv->lock);
681 priv->in_progress_assoc_req = NULL;
682 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200683 kfree(assoc_req);
Holger Schurig9012b282007-05-25 11:27:16 -0400684
685done:
686 lbs_deb_leave(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200687}
688
689
690/*
691 * Caller MUST hold any necessary locks
692 */
David Woodhouseaa21c002007-12-08 20:04:36 +0000693struct assoc_request *lbs_get_association_request(struct lbs_private *priv)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200694{
695 struct assoc_request * assoc_req;
696
Holger Schurig0765af42007-10-15 12:55:56 +0200697 lbs_deb_enter(LBS_DEB_ASSOC);
David Woodhouseaa21c002007-12-08 20:04:36 +0000698 if (!priv->pending_assoc_req) {
699 priv->pending_assoc_req = kzalloc(sizeof(struct assoc_request),
Dan Williamse76850d2007-05-25 17:09:41 -0400700 GFP_KERNEL);
David Woodhouseaa21c002007-12-08 20:04:36 +0000701 if (!priv->pending_assoc_req) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200702 lbs_pr_info("Not enough memory to allocate association"
703 " request!\n");
704 return NULL;
705 }
706 }
707
708 /* Copy current configuration attributes to the association request,
709 * but don't overwrite any that are already set.
710 */
David Woodhouseaa21c002007-12-08 20:04:36 +0000711 assoc_req = priv->pending_assoc_req;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200712 if (!test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000713 memcpy(&assoc_req->ssid, &priv->curbssparams.ssid,
Dan Williamsd8efea22007-05-28 23:54:55 -0400714 IW_ESSID_MAX_SIZE);
David Woodhouseaa21c002007-12-08 20:04:36 +0000715 assoc_req->ssid_len = priv->curbssparams.ssid_len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200716 }
717
718 if (!test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags))
David Woodhouseaa21c002007-12-08 20:04:36 +0000719 assoc_req->channel = priv->curbssparams.channel;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200720
Dan Williamse76850d2007-05-25 17:09:41 -0400721 if (!test_bit(ASSOC_FLAG_BAND, &assoc_req->flags))
David Woodhouseaa21c002007-12-08 20:04:36 +0000722 assoc_req->band = priv->curbssparams.band;
Dan Williamse76850d2007-05-25 17:09:41 -0400723
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200724 if (!test_bit(ASSOC_FLAG_MODE, &assoc_req->flags))
David Woodhouseaa21c002007-12-08 20:04:36 +0000725 assoc_req->mode = priv->mode;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200726
727 if (!test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000728 memcpy(&assoc_req->bssid, priv->curbssparams.bssid,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200729 ETH_ALEN);
730 }
731
732 if (!test_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags)) {
733 int i;
734 for (i = 0; i < 4; i++) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000735 memcpy(&assoc_req->wep_keys[i], &priv->wep_keys[i],
Dan Williams1443b652007-08-02 10:45:55 -0400736 sizeof(struct enc_key));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200737 }
738 }
739
740 if (!test_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags))
David Woodhouseaa21c002007-12-08 20:04:36 +0000741 assoc_req->wep_tx_keyidx = priv->wep_tx_keyidx;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200742
743 if (!test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000744 memcpy(&assoc_req->wpa_mcast_key, &priv->wpa_mcast_key,
Dan Williams1443b652007-08-02 10:45:55 -0400745 sizeof(struct enc_key));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200746 }
747
748 if (!test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000749 memcpy(&assoc_req->wpa_unicast_key, &priv->wpa_unicast_key,
Dan Williams1443b652007-08-02 10:45:55 -0400750 sizeof(struct enc_key));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200751 }
752
753 if (!test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000754 memcpy(&assoc_req->secinfo, &priv->secinfo,
Holger Schurig10078322007-11-15 18:05:47 -0500755 sizeof(struct lbs_802_11_security));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200756 }
757
758 if (!test_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags)) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000759 memcpy(&assoc_req->wpa_ie, &priv->wpa_ie,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200760 MAX_WPA_IE_LEN);
David Woodhouseaa21c002007-12-08 20:04:36 +0000761 assoc_req->wpa_ie_len = priv->wpa_ie_len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200762 }
763
Holger Schurig0765af42007-10-15 12:55:56 +0200764 lbs_deb_leave(LBS_DEB_ASSOC);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200765 return assoc_req;
766}