Commit | Line | Data |
---|---|---|
876c9d3a MT |
1 | /* Copyright (C) 2006, Red Hat, Inc. */ |
2 | ||
3 | #include <linux/bitops.h> | |
4 | #include <net/ieee80211.h> | |
3cf20931 | 5 | #include <linux/etherdevice.h> |
876c9d3a MT |
6 | |
7 | #include "assoc.h" | |
8 | #include "join.h" | |
9 | #include "decl.h" | |
10 | #include "hostcmd.h" | |
11 | #include "host.h" | |
12 | ||
13 | ||
14 | static const u8 bssid_any[ETH_ALEN] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF }; | |
15 | static const u8 bssid_off[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; | |
16 | ||
e76850d6 DW |
17 | /* From ieee80211_module.c */ |
18 | static const char *libertas_escape_essid(const char *essid, u8 essid_len) | |
19 | { | |
20 | static char escaped[IW_ESSID_MAX_SIZE * 2 + 1]; | |
21 | const char *s = essid; | |
22 | char *d = escaped; | |
23 | ||
24 | if (ieee80211_is_empty_essid(essid, essid_len)) | |
25 | return ""; | |
26 | ||
27 | essid_len = min(essid_len, (u8) IW_ESSID_MAX_SIZE); | |
28 | while (essid_len--) { | |
29 | if (*s == '\0') { | |
30 | *d++ = '\\'; | |
31 | *d++ = '0'; | |
32 | s++; | |
33 | } else { | |
34 | *d++ = *s++; | |
35 | } | |
36 | } | |
37 | *d = '\0'; | |
38 | return escaped; | |
39 | } | |
40 | ||
41 | static void print_assoc_req(const char * extra, struct assoc_request * assoc_req) | |
42 | { | |
43 | lbs_deb_assoc( | |
44 | "#### Association Request: %s\n" | |
45 | " flags: 0x%08lX\n" | |
46 | " SSID: '%s'\n" | |
47 | " channel: %d\n" | |
48 | " band: %d\n" | |
49 | " mode: %d\n" | |
50 | " BSSID: " MAC_FMT "\n" | |
51 | " WPA: %d\n" | |
52 | " WPA2: %d\n" | |
53 | " WEP status: %d\n" | |
54 | " auth: %d\n" | |
55 | " auth_alg: %d\n" | |
56 | " encmode: %d\n", | |
57 | extra, assoc_req->flags, | |
58 | libertas_escape_essid(assoc_req->ssid.ssid, assoc_req->ssid.ssidlength), | |
59 | assoc_req->channel, assoc_req->band, assoc_req->mode, | |
60 | MAC_ARG(assoc_req->bssid), assoc_req->secinfo.WPAenabled, | |
61 | assoc_req->secinfo.WPA2enabled, assoc_req->secinfo.WEPstatus, | |
62 | assoc_req->secinfo.authmode, assoc_req->secinfo.auth1xalg, | |
63 | assoc_req->secinfo.Encryptionmode); | |
64 | } | |
65 | ||
66 | ||
876c9d3a MT |
67 | static int assoc_helper_essid(wlan_private *priv, |
68 | struct assoc_request * assoc_req) | |
69 | { | |
70 | wlan_adapter *adapter = priv->adapter; | |
71 | int ret = 0; | |
fcdb53db | 72 | struct bss_descriptor * bss; |
aeea0ab4 | 73 | int channel = -1; |
876c9d3a | 74 | |
9012b28a | 75 | lbs_deb_enter(LBS_DEB_ASSOC); |
876c9d3a | 76 | |
ef9a264b DW |
77 | /* FIXME: take channel into account when picking SSIDs if a channel |
78 | * is set. | |
79 | */ | |
80 | ||
aeea0ab4 DW |
81 | if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) |
82 | channel = assoc_req->channel; | |
83 | ||
9012b28a | 84 | lbs_deb_assoc("New SSID requested: %s\n", assoc_req->ssid.ssid); |
0dc5a290 | 85 | if (assoc_req->mode == IW_MODE_INFRA) { |
876c9d3a | 86 | if (adapter->prescan) { |
eb8f7330 | 87 | libertas_send_specific_SSID_scan(priv, &assoc_req->ssid, 0); |
876c9d3a MT |
88 | } |
89 | ||
fcdb53db | 90 | bss = libertas_find_SSID_in_list(adapter, &assoc_req->ssid, |
aeea0ab4 | 91 | NULL, IW_MODE_INFRA, channel); |
fcdb53db DW |
92 | if (bss != NULL) { |
93 | lbs_deb_assoc("SSID found in scan list, associating\n"); | |
e76850d6 DW |
94 | memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor)); |
95 | ret = wlan_associate(priv, assoc_req); | |
876c9d3a | 96 | } else { |
9012b28a | 97 | lbs_deb_assoc("SSID '%s' not found; cannot associate\n", |
876c9d3a MT |
98 | assoc_req->ssid.ssid); |
99 | } | |
0dc5a290 | 100 | } else if (assoc_req->mode == IW_MODE_ADHOC) { |
876c9d3a MT |
101 | /* Scan for the network, do not save previous results. Stale |
102 | * scan data will cause us to join a non-existant adhoc network | |
103 | */ | |
eb8f7330 | 104 | libertas_send_specific_SSID_scan(priv, &assoc_req->ssid, 1); |
876c9d3a MT |
105 | |
106 | /* Search for the requested SSID in the scan table */ | |
fcdb53db | 107 | bss = libertas_find_SSID_in_list(adapter, &assoc_req->ssid, NULL, |
aeea0ab4 | 108 | IW_MODE_ADHOC, channel); |
fcdb53db DW |
109 | if (bss != NULL) { |
110 | lbs_deb_assoc("SSID found joining\n"); | |
e76850d6 DW |
111 | memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor)); |
112 | libertas_join_adhoc_network(priv, assoc_req); | |
876c9d3a MT |
113 | } else { |
114 | /* else send START command */ | |
9012b28a | 115 | lbs_deb_assoc("SSID not found in list, so creating adhoc" |
876c9d3a | 116 | " with SSID '%s'\n", assoc_req->ssid.ssid); |
e76850d6 DW |
117 | memcpy(&assoc_req->bss.ssid, &assoc_req->ssid, |
118 | sizeof(struct WLAN_802_11_SSID)); | |
119 | libertas_start_adhoc_network(priv, assoc_req); | |
876c9d3a | 120 | } |
876c9d3a MT |
121 | } |
122 | ||
9012b28a | 123 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); |
876c9d3a MT |
124 | return ret; |
125 | } | |
126 | ||
127 | ||
128 | static int assoc_helper_bssid(wlan_private *priv, | |
129 | struct assoc_request * assoc_req) | |
130 | { | |
131 | wlan_adapter *adapter = priv->adapter; | |
fcdb53db DW |
132 | int ret = 0; |
133 | struct bss_descriptor * bss; | |
876c9d3a | 134 | |
57361c6e | 135 | lbs_deb_enter_args(LBS_DEB_ASSOC, "BSSID " MAC_FMT "\n", |
876c9d3a MT |
136 | MAC_ARG(assoc_req->bssid)); |
137 | ||
138 | /* Search for index position in list for requested MAC */ | |
fcdb53db | 139 | bss = libertas_find_BSSID_in_list(adapter, assoc_req->bssid, |
876c9d3a | 140 | assoc_req->mode); |
fcdb53db | 141 | if (bss == NULL) { |
9012b28a | 142 | lbs_deb_assoc("ASSOC: WAP: BSSID " MAC_FMT " not found, " |
876c9d3a MT |
143 | "cannot associate.\n", MAC_ARG(assoc_req->bssid)); |
144 | goto out; | |
145 | } | |
146 | ||
e76850d6 | 147 | memcpy(&assoc_req->bss, bss, sizeof(struct bss_descriptor)); |
0dc5a290 | 148 | if (assoc_req->mode == IW_MODE_INFRA) { |
e76850d6 | 149 | ret = wlan_associate(priv, assoc_req); |
fcdb53db | 150 | lbs_deb_assoc("ASSOC: wlan_associate(bssid) returned %d\n", ret); |
0dc5a290 | 151 | } else if (assoc_req->mode == IW_MODE_ADHOC) { |
e76850d6 | 152 | libertas_join_adhoc_network(priv, assoc_req); |
876c9d3a | 153 | } |
876c9d3a MT |
154 | |
155 | out: | |
9012b28a | 156 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); |
876c9d3a MT |
157 | return ret; |
158 | } | |
159 | ||
160 | ||
161 | static int assoc_helper_associate(wlan_private *priv, | |
162 | struct assoc_request * assoc_req) | |
163 | { | |
164 | int ret = 0, done = 0; | |
165 | ||
166 | /* If we're given and 'any' BSSID, try associating based on SSID */ | |
167 | ||
168 | if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) { | |
3cf20931 DW |
169 | if (compare_ether_addr(bssid_any, assoc_req->bssid) |
170 | && compare_ether_addr(bssid_off, assoc_req->bssid)) { | |
876c9d3a MT |
171 | ret = assoc_helper_bssid(priv, assoc_req); |
172 | done = 1; | |
173 | if (ret) { | |
9012b28a | 174 | lbs_deb_assoc("ASSOC: bssid: ret = %d\n", ret); |
876c9d3a MT |
175 | } |
176 | } | |
177 | } | |
178 | ||
179 | if (!done && test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) { | |
180 | ret = assoc_helper_essid(priv, assoc_req); | |
181 | if (ret) { | |
9012b28a | 182 | lbs_deb_assoc("ASSOC: bssid: ret = %d\n", ret); |
876c9d3a MT |
183 | } |
184 | } | |
185 | ||
186 | return ret; | |
187 | } | |
188 | ||
189 | ||
190 | static int assoc_helper_mode(wlan_private *priv, | |
191 | struct assoc_request * assoc_req) | |
192 | { | |
193 | wlan_adapter *adapter = priv->adapter; | |
194 | int ret = 0; | |
195 | ||
9012b28a | 196 | lbs_deb_enter(LBS_DEB_ASSOC); |
876c9d3a | 197 | |
9012b28a HS |
198 | if (assoc_req->mode == adapter->mode) |
199 | goto done; | |
876c9d3a | 200 | |
0dc5a290 | 201 | if (assoc_req->mode == IW_MODE_INFRA) { |
876c9d3a MT |
202 | if (adapter->psstate != PS_STATE_FULL_POWER) |
203 | libertas_ps_wakeup(priv, cmd_option_waitforrsp); | |
204 | adapter->psmode = wlan802_11powermodecam; | |
205 | } | |
206 | ||
0dc5a290 | 207 | adapter->mode = assoc_req->mode; |
876c9d3a MT |
208 | ret = libertas_prepare_and_send_command(priv, |
209 | cmd_802_11_snmp_mib, | |
210 | 0, cmd_option_waitforrsp, | |
211 | OID_802_11_INFRASTRUCTURE_MODE, | |
981f187b | 212 | /* Shoot me now */ (void *) (size_t) assoc_req->mode); |
876c9d3a | 213 | |
9012b28a HS |
214 | done: |
215 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | |
876c9d3a MT |
216 | return ret; |
217 | } | |
218 | ||
219 | ||
ef9a264b DW |
220 | static int update_channel(wlan_private * priv) |
221 | { | |
222 | /* the channel in f/w could be out of sync, get the current channel */ | |
223 | return libertas_prepare_and_send_command(priv, cmd_802_11_rf_channel, | |
224 | cmd_opt_802_11_rf_channel_get, | |
225 | cmd_option_waitforrsp, 0, NULL); | |
226 | } | |
227 | ||
228 | static int assoc_helper_channel(wlan_private *priv, | |
229 | struct assoc_request * assoc_req) | |
230 | { | |
231 | wlan_adapter *adapter = priv->adapter; | |
232 | int ret = 0; | |
233 | ||
234 | lbs_deb_enter(LBS_DEB_ASSOC); | |
235 | ||
236 | ret = update_channel(priv); | |
237 | if (ret < 0) { | |
238 | lbs_deb_assoc("ASSOC: channel: error getting channel."); | |
239 | } | |
240 | ||
241 | if (assoc_req->channel == adapter->curbssparams.channel) | |
242 | goto done; | |
243 | ||
244 | lbs_deb_assoc("ASSOC: channel: %d -> %d\n", | |
245 | adapter->curbssparams.channel, assoc_req->channel); | |
246 | ||
247 | ret = libertas_prepare_and_send_command(priv, cmd_802_11_rf_channel, | |
248 | cmd_opt_802_11_rf_channel_set, | |
249 | cmd_option_waitforrsp, 0, &assoc_req->channel); | |
250 | if (ret < 0) { | |
251 | lbs_deb_assoc("ASSOC: channel: error setting channel."); | |
252 | } | |
253 | ||
254 | ret = update_channel(priv); | |
255 | if (ret < 0) { | |
256 | lbs_deb_assoc("ASSOC: channel: error getting channel."); | |
257 | } | |
258 | ||
259 | if (assoc_req->channel != adapter->curbssparams.channel) { | |
260 | lbs_deb_assoc("ASSOC: channel: failed to update channel to %d", | |
261 | assoc_req->channel); | |
262 | goto done; | |
263 | } | |
264 | ||
265 | if ( assoc_req->secinfo.wep_enabled | |
266 | && (assoc_req->wep_keys[0].len | |
267 | || assoc_req->wep_keys[1].len | |
268 | || assoc_req->wep_keys[2].len | |
269 | || assoc_req->wep_keys[3].len)) { | |
270 | /* Make sure WEP keys are re-sent to firmware */ | |
271 | set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags); | |
272 | } | |
273 | ||
274 | /* Must restart/rejoin adhoc networks after channel change */ | |
275 | set_bit(ASSOC_FLAG_SSID, &assoc_req->flags); | |
276 | ||
277 | done: | |
278 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); | |
279 | return ret; | |
280 | } | |
281 | ||
282 | ||
876c9d3a MT |
283 | static int assoc_helper_wep_keys(wlan_private *priv, |
284 | struct assoc_request * assoc_req) | |
285 | { | |
286 | wlan_adapter *adapter = priv->adapter; | |
287 | int i; | |
288 | int ret = 0; | |
289 | ||
9012b28a | 290 | lbs_deb_enter(LBS_DEB_ASSOC); |
876c9d3a MT |
291 | |
292 | /* Set or remove WEP keys */ | |
293 | if ( assoc_req->wep_keys[0].len | |
294 | || assoc_req->wep_keys[1].len | |
295 | || assoc_req->wep_keys[2].len | |
296 | || assoc_req->wep_keys[3].len) { | |
297 | ret = libertas_prepare_and_send_command(priv, | |
298 | cmd_802_11_set_wep, | |
299 | cmd_act_add, | |
300 | cmd_option_waitforrsp, | |
301 | 0, assoc_req); | |
302 | } else { | |
303 | ret = libertas_prepare_and_send_command(priv, | |
304 | cmd_802_11_set_wep, | |
305 | cmd_act_remove, | |
306 | cmd_option_waitforrsp, | |
307 | 0, NULL); | |
308 | } | |
309 | ||
310 | if (ret) | |
311 | goto out; | |
312 | ||
313 | /* enable/disable the MAC's WEP packet filter */ | |
889c05bd | 314 | if (assoc_req->secinfo.wep_enabled) |
876c9d3a MT |
315 | adapter->currentpacketfilter |= cmd_act_mac_wep_enable; |
316 | else | |
317 | adapter->currentpacketfilter &= ~cmd_act_mac_wep_enable; | |
318 | ret = libertas_set_mac_packet_filter(priv); | |
319 | if (ret) | |
320 | goto out; | |
321 | ||
322 | mutex_lock(&adapter->lock); | |
323 | ||
324 | /* Copy WEP keys into adapter wep key fields */ | |
325 | for (i = 0; i < 4; i++) { | |
326 | memcpy(&adapter->wep_keys[i], &assoc_req->wep_keys[i], | |
327 | sizeof(struct WLAN_802_11_KEY)); | |
328 | } | |
329 | adapter->wep_tx_keyidx = assoc_req->wep_tx_keyidx; | |
330 | ||
331 | mutex_unlock(&adapter->lock); | |
332 | ||
333 | out: | |
9012b28a | 334 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); |
876c9d3a MT |
335 | return ret; |
336 | } | |
337 | ||
338 | static int assoc_helper_secinfo(wlan_private *priv, | |
339 | struct assoc_request * assoc_req) | |
340 | { | |
341 | wlan_adapter *adapter = priv->adapter; | |
342 | int ret = 0; | |
343 | ||
9012b28a | 344 | lbs_deb_enter(LBS_DEB_ASSOC); |
876c9d3a MT |
345 | |
346 | memcpy(&adapter->secinfo, &assoc_req->secinfo, | |
347 | sizeof(struct wlan_802_11_security)); | |
348 | ||
349 | ret = libertas_set_mac_packet_filter(priv); | |
90a42210 DW |
350 | if (ret) |
351 | goto out; | |
876c9d3a | 352 | |
90a42210 DW |
353 | /* enable/disable RSN */ |
354 | ret = libertas_prepare_and_send_command(priv, | |
355 | cmd_802_11_enable_rsn, | |
356 | cmd_act_set, | |
357 | cmd_option_waitforrsp, | |
358 | 0, assoc_req); | |
359 | ||
360 | out: | |
9012b28a | 361 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); |
876c9d3a MT |
362 | return ret; |
363 | } | |
364 | ||
365 | ||
366 | static int assoc_helper_wpa_keys(wlan_private *priv, | |
367 | struct assoc_request * assoc_req) | |
368 | { | |
369 | int ret = 0; | |
370 | ||
9012b28a | 371 | lbs_deb_enter(LBS_DEB_ASSOC); |
876c9d3a | 372 | |
876c9d3a MT |
373 | ret = libertas_prepare_and_send_command(priv, |
374 | cmd_802_11_key_material, | |
375 | cmd_act_set, | |
376 | cmd_option_waitforrsp, | |
377 | 0, assoc_req); | |
378 | ||
9012b28a | 379 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); |
876c9d3a MT |
380 | return ret; |
381 | } | |
382 | ||
383 | ||
384 | static int assoc_helper_wpa_ie(wlan_private *priv, | |
385 | struct assoc_request * assoc_req) | |
386 | { | |
387 | wlan_adapter *adapter = priv->adapter; | |
388 | int ret = 0; | |
389 | ||
9012b28a | 390 | lbs_deb_enter(LBS_DEB_ASSOC); |
876c9d3a MT |
391 | |
392 | if (assoc_req->secinfo.WPAenabled || assoc_req->secinfo.WPA2enabled) { | |
393 | memcpy(&adapter->wpa_ie, &assoc_req->wpa_ie, assoc_req->wpa_ie_len); | |
394 | adapter->wpa_ie_len = assoc_req->wpa_ie_len; | |
395 | } else { | |
396 | memset(&adapter->wpa_ie, 0, MAX_WPA_IE_LEN); | |
397 | adapter->wpa_ie_len = 0; | |
398 | } | |
399 | ||
9012b28a | 400 | lbs_deb_leave_args(LBS_DEB_ASSOC, "ret %d", ret); |
876c9d3a MT |
401 | return ret; |
402 | } | |
403 | ||
404 | ||
405 | static int should_deauth_infrastructure(wlan_adapter *adapter, | |
406 | struct assoc_request * assoc_req) | |
407 | { | |
408 | if (adapter->connect_status != libertas_connected) | |
409 | return 0; | |
410 | ||
411 | if (test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) { | |
9012b28a | 412 | lbs_deb_assoc("Deauthenticating due to new SSID in " |
876c9d3a MT |
413 | " configuration request.\n"); |
414 | return 1; | |
415 | } | |
416 | ||
417 | if (test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) { | |
6affe785 | 418 | if (adapter->secinfo.auth_mode != assoc_req->secinfo.auth_mode) { |
9012b28a | 419 | lbs_deb_assoc("Deauthenticating due to updated security " |
876c9d3a MT |
420 | "info in configuration request.\n"); |
421 | return 1; | |
422 | } | |
423 | } | |
424 | ||
425 | if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) { | |
9012b28a | 426 | lbs_deb_assoc("Deauthenticating due to new BSSID in " |
876c9d3a MT |
427 | " configuration request.\n"); |
428 | return 1; | |
429 | } | |
430 | ||
431 | /* FIXME: deal with 'auto' mode somehow */ | |
432 | if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) { | |
0dc5a290 | 433 | if (assoc_req->mode != IW_MODE_INFRA) |
876c9d3a MT |
434 | return 1; |
435 | } | |
436 | ||
437 | return 0; | |
438 | } | |
439 | ||
440 | ||
441 | static int should_stop_adhoc(wlan_adapter *adapter, | |
442 | struct assoc_request * assoc_req) | |
443 | { | |
444 | if (adapter->connect_status != libertas_connected) | |
445 | return 0; | |
446 | ||
447 | if (adapter->curbssparams.ssid.ssidlength != assoc_req->ssid.ssidlength) | |
448 | return 1; | |
449 | if (memcmp(adapter->curbssparams.ssid.ssid, assoc_req->ssid.ssid, | |
ad1f3298 | 450 | adapter->curbssparams.ssid.ssidlength)) |
876c9d3a MT |
451 | return 1; |
452 | ||
453 | /* FIXME: deal with 'auto' mode somehow */ | |
454 | if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) { | |
0dc5a290 | 455 | if (assoc_req->mode != IW_MODE_ADHOC) |
876c9d3a MT |
456 | return 1; |
457 | } | |
458 | ||
ef9a264b DW |
459 | if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) { |
460 | if (assoc_req->channel != adapter->curbssparams.channel) | |
461 | return 1; | |
462 | } | |
463 | ||
876c9d3a MT |
464 | return 0; |
465 | } | |
466 | ||
467 | ||
eb3ce631 | 468 | void libertas_association_worker(struct work_struct *work) |
876c9d3a MT |
469 | { |
470 | wlan_private *priv = container_of(work, wlan_private, assoc_work.work); | |
471 | wlan_adapter *adapter = priv->adapter; | |
472 | struct assoc_request * assoc_req = NULL; | |
473 | int ret = 0; | |
474 | int find_any_ssid = 0; | |
475 | ||
9012b28a | 476 | lbs_deb_enter(LBS_DEB_ASSOC); |
876c9d3a MT |
477 | |
478 | mutex_lock(&adapter->lock); | |
e76850d6 DW |
479 | assoc_req = adapter->pending_assoc_req; |
480 | adapter->pending_assoc_req = NULL; | |
481 | adapter->in_progress_assoc_req = assoc_req; | |
876c9d3a MT |
482 | mutex_unlock(&adapter->lock); |
483 | ||
9012b28a HS |
484 | if (!assoc_req) |
485 | goto done; | |
876c9d3a | 486 | |
e76850d6 | 487 | print_assoc_req(__func__, assoc_req); |
876c9d3a MT |
488 | |
489 | /* If 'any' SSID was specified, find an SSID to associate with */ | |
490 | if (test_bit(ASSOC_FLAG_SSID, &assoc_req->flags) | |
491 | && !assoc_req->ssid.ssidlength) | |
492 | find_any_ssid = 1; | |
493 | ||
494 | /* But don't use 'any' SSID if there's a valid locked BSSID to use */ | |
495 | if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) { | |
3cf20931 DW |
496 | if (compare_ether_addr(assoc_req->bssid, bssid_any) |
497 | && compare_ether_addr(assoc_req->bssid, bssid_off)) | |
876c9d3a MT |
498 | find_any_ssid = 0; |
499 | } | |
500 | ||
501 | if (find_any_ssid) { | |
0dc5a290 | 502 | u8 new_mode; |
876c9d3a MT |
503 | |
504 | ret = libertas_find_best_network_SSID(priv, &assoc_req->ssid, | |
505 | assoc_req->mode, &new_mode); | |
506 | if (ret) { | |
9012b28a | 507 | lbs_deb_assoc("Could not find best network\n"); |
876c9d3a MT |
508 | ret = -ENETUNREACH; |
509 | goto out; | |
510 | } | |
511 | ||
512 | /* Ensure we switch to the mode of the AP */ | |
0dc5a290 | 513 | if (assoc_req->mode == IW_MODE_AUTO) { |
876c9d3a MT |
514 | set_bit(ASSOC_FLAG_MODE, &assoc_req->flags); |
515 | assoc_req->mode = new_mode; | |
516 | } | |
517 | } | |
518 | ||
519 | /* | |
520 | * Check if the attributes being changing require deauthentication | |
521 | * from the currently associated infrastructure access point. | |
522 | */ | |
0dc5a290 | 523 | if (adapter->mode == IW_MODE_INFRA) { |
876c9d3a MT |
524 | if (should_deauth_infrastructure(adapter, assoc_req)) { |
525 | ret = libertas_send_deauthentication(priv); | |
526 | if (ret) { | |
9012b28a | 527 | lbs_deb_assoc("Deauthentication due to new " |
876c9d3a MT |
528 | "configuration request failed: %d\n", |
529 | ret); | |
530 | } | |
531 | } | |
0dc5a290 | 532 | } else if (adapter->mode == IW_MODE_ADHOC) { |
876c9d3a MT |
533 | if (should_stop_adhoc(adapter, assoc_req)) { |
534 | ret = libertas_stop_adhoc_network(priv); | |
535 | if (ret) { | |
9012b28a | 536 | lbs_deb_assoc("Teardown of AdHoc network due to " |
876c9d3a MT |
537 | "new configuration request failed: %d\n", |
538 | ret); | |
539 | } | |
540 | ||
541 | } | |
542 | } | |
543 | ||
544 | /* Send the various configuration bits to the firmware */ | |
545 | if (test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) { | |
546 | ret = assoc_helper_mode(priv, assoc_req); | |
547 | if (ret) { | |
9012b28a | 548 | lbs_deb_assoc("ASSOC(:%d) mode: ret = %d\n", __LINE__, ret); |
876c9d3a MT |
549 | goto out; |
550 | } | |
551 | } | |
552 | ||
ef9a264b DW |
553 | if (test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) { |
554 | ret = assoc_helper_channel(priv, assoc_req); | |
555 | if (ret) { | |
556 | lbs_deb_assoc("ASSOC(:%d) channel: ret = %d\n", | |
557 | __LINE__, ret); | |
558 | goto out; | |
559 | } | |
560 | } | |
561 | ||
876c9d3a MT |
562 | if ( test_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags) |
563 | || test_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags)) { | |
564 | ret = assoc_helper_wep_keys(priv, assoc_req); | |
565 | if (ret) { | |
9012b28a | 566 | lbs_deb_assoc("ASSOC(:%d) wep_keys: ret = %d\n", __LINE__, ret); |
876c9d3a MT |
567 | goto out; |
568 | } | |
569 | } | |
570 | ||
571 | if (test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) { | |
572 | ret = assoc_helper_secinfo(priv, assoc_req); | |
573 | if (ret) { | |
9012b28a | 574 | lbs_deb_assoc("ASSOC(:%d) secinfo: ret = %d\n", __LINE__, ret); |
876c9d3a MT |
575 | goto out; |
576 | } | |
577 | } | |
578 | ||
579 | if (test_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags)) { | |
580 | ret = assoc_helper_wpa_ie(priv, assoc_req); | |
581 | if (ret) { | |
9012b28a | 582 | lbs_deb_assoc("ASSOC(:%d) wpa_ie: ret = %d\n", __LINE__, ret); |
876c9d3a MT |
583 | goto out; |
584 | } | |
585 | } | |
586 | ||
587 | if (test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags) | |
588 | || test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) { | |
589 | ret = assoc_helper_wpa_keys(priv, assoc_req); | |
590 | if (ret) { | |
9012b28a | 591 | lbs_deb_assoc("ASSOC(:%d) wpa_keys: ret = %d\n", __LINE__, ret); |
876c9d3a MT |
592 | goto out; |
593 | } | |
594 | } | |
595 | ||
596 | /* SSID/BSSID should be the _last_ config option set, because they | |
597 | * trigger the association attempt. | |
598 | */ | |
599 | if (test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags) | |
600 | || test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) { | |
601 | int success = 1; | |
602 | ||
603 | ret = assoc_helper_associate(priv, assoc_req); | |
604 | if (ret) { | |
9012b28a | 605 | lbs_deb_assoc("ASSOC: association attempt unsuccessful: %d\n", |
876c9d3a MT |
606 | ret); |
607 | success = 0; | |
608 | } | |
609 | ||
610 | if (adapter->connect_status != libertas_connected) { | |
9012b28a | 611 | lbs_deb_assoc("ASSOC: assoication attempt unsuccessful, " |
876c9d3a MT |
612 | "not connected.\n"); |
613 | success = 0; | |
614 | } | |
615 | ||
616 | if (success) { | |
9012b28a | 617 | lbs_deb_assoc("ASSOC: association attempt successful. " |
876c9d3a | 618 | "Associated to '%s' (" MAC_FMT ")\n", |
e76850d6 DW |
619 | libertas_escape_essid(adapter->curbssparams.ssid.ssid, |
620 | adapter->curbssparams.ssid.ssidlength), | |
621 | MAC_ARG(adapter->curbssparams.bssid)); | |
876c9d3a MT |
622 | libertas_prepare_and_send_command(priv, |
623 | cmd_802_11_rssi, | |
624 | 0, cmd_option_waitforrsp, 0, NULL); | |
625 | ||
626 | libertas_prepare_and_send_command(priv, | |
627 | cmd_802_11_get_log, | |
628 | 0, cmd_option_waitforrsp, 0, NULL); | |
629 | } else { | |
876c9d3a MT |
630 | ret = -1; |
631 | } | |
632 | } | |
633 | ||
634 | out: | |
635 | if (ret) { | |
9012b28a | 636 | lbs_deb_assoc("ASSOC: reconfiguration attempt unsuccessful: %d\n", |
876c9d3a MT |
637 | ret); |
638 | } | |
e76850d6 DW |
639 | |
640 | mutex_lock(&adapter->lock); | |
641 | adapter->in_progress_assoc_req = NULL; | |
642 | mutex_unlock(&adapter->lock); | |
876c9d3a | 643 | kfree(assoc_req); |
9012b28a HS |
644 | |
645 | done: | |
646 | lbs_deb_leave(LBS_DEB_ASSOC); | |
876c9d3a MT |
647 | } |
648 | ||
649 | ||
650 | /* | |
651 | * Caller MUST hold any necessary locks | |
652 | */ | |
653 | struct assoc_request * wlan_get_association_request(wlan_adapter *adapter) | |
654 | { | |
655 | struct assoc_request * assoc_req; | |
656 | ||
e76850d6 DW |
657 | if (!adapter->pending_assoc_req) { |
658 | adapter->pending_assoc_req = kzalloc(sizeof(struct assoc_request), | |
659 | GFP_KERNEL); | |
660 | if (!adapter->pending_assoc_req) { | |
876c9d3a MT |
661 | lbs_pr_info("Not enough memory to allocate association" |
662 | " request!\n"); | |
663 | return NULL; | |
664 | } | |
665 | } | |
666 | ||
667 | /* Copy current configuration attributes to the association request, | |
668 | * but don't overwrite any that are already set. | |
669 | */ | |
e76850d6 | 670 | assoc_req = adapter->pending_assoc_req; |
876c9d3a | 671 | if (!test_bit(ASSOC_FLAG_SSID, &assoc_req->flags)) { |
e76850d6 DW |
672 | memcpy(&assoc_req->ssid, &adapter->curbssparams.ssid, |
673 | sizeof(struct WLAN_802_11_SSID)); | |
876c9d3a MT |
674 | } |
675 | ||
676 | if (!test_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags)) | |
677 | assoc_req->channel = adapter->curbssparams.channel; | |
678 | ||
e76850d6 DW |
679 | if (!test_bit(ASSOC_FLAG_BAND, &assoc_req->flags)) |
680 | assoc_req->band = adapter->curbssparams.band; | |
681 | ||
876c9d3a | 682 | if (!test_bit(ASSOC_FLAG_MODE, &assoc_req->flags)) |
0dc5a290 | 683 | assoc_req->mode = adapter->mode; |
876c9d3a MT |
684 | |
685 | if (!test_bit(ASSOC_FLAG_BSSID, &assoc_req->flags)) { | |
686 | memcpy(&assoc_req->bssid, adapter->curbssparams.bssid, | |
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++) { | |
693 | memcpy(&assoc_req->wep_keys[i], &adapter->wep_keys[i], | |
694 | sizeof(struct WLAN_802_11_KEY)); | |
695 | } | |
696 | } | |
697 | ||
698 | if (!test_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags)) | |
699 | assoc_req->wep_tx_keyidx = adapter->wep_tx_keyidx; | |
700 | ||
701 | if (!test_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags)) { | |
702 | memcpy(&assoc_req->wpa_mcast_key, &adapter->wpa_mcast_key, | |
703 | sizeof(struct WLAN_802_11_KEY)); | |
704 | } | |
705 | ||
706 | if (!test_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags)) { | |
707 | memcpy(&assoc_req->wpa_unicast_key, &adapter->wpa_unicast_key, | |
708 | sizeof(struct WLAN_802_11_KEY)); | |
709 | } | |
710 | ||
711 | if (!test_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags)) { | |
712 | memcpy(&assoc_req->secinfo, &adapter->secinfo, | |
713 | sizeof(struct wlan_802_11_security)); | |
714 | } | |
715 | ||
716 | if (!test_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags)) { | |
717 | memcpy(&assoc_req->wpa_ie, &adapter->wpa_ie, | |
718 | MAX_WPA_IE_LEN); | |
719 | assoc_req->wpa_ie_len = adapter->wpa_ie_len; | |
720 | } | |
721 | ||
e76850d6 DW |
722 | print_assoc_req(__func__, assoc_req); |
723 | ||
876c9d3a MT |
724 | return assoc_req; |
725 | } |