projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
ath6kl: Optimize target power in deep sleep suspend
[deliverable/linux.git] / drivers / net / wireless / ath / ath6kl / cfg80211.c
1 /*
2 * Copyright (c) 2004-2011 Atheros Communications Inc.
3 * Copyright (c) 2011-2012 Qualcomm Atheros, Inc.
4 *
5 * Permission to use, copy, modify, and/or distribute this software for any
6 * purpose with or without fee is hereby granted, provided that the above
7 * copyright notice and this permission notice appear in all copies.
8 *
9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
16 */
17
18 #include <linux/moduleparam.h>
19 #include <linux/inetdevice.h>
20 #include <linux/export.h>
21
22 #include "core.h"
23 #include "cfg80211.h"
24 #include "debug.h"
25 #include "hif-ops.h"
26 #include "testmode.h"
27
28 #define RATETAB_ENT(_rate, _rateid, _flags) { \
29 .bitrate = (_rate), \
30 .flags = (_flags), \
31 .hw_value = (_rateid), \
32 }
33
34 #define CHAN2G(_channel, _freq, _flags) { \
35 .band = IEEE80211_BAND_2GHZ, \
36 .hw_value = (_channel), \
37 .center_freq = (_freq), \
38 .flags = (_flags), \
39 .max_antenna_gain = 0, \
40 .max_power = 30, \
41 }
42
43 #define CHAN5G(_channel, _flags) { \
44 .band = IEEE80211_BAND_5GHZ, \
45 .hw_value = (_channel), \
46 .center_freq = 5000 + (5 * (_channel)), \
47 .flags = (_flags), \
48 .max_antenna_gain = 0, \
49 .max_power = 30, \
50 }
51
52 static struct ieee80211_rate ath6kl_rates[] = {
53 RATETAB_ENT(10, 0x1, 0),
54 RATETAB_ENT(20, 0x2, 0),
55 RATETAB_ENT(55, 0x4, 0),
56 RATETAB_ENT(110, 0x8, 0),
57 RATETAB_ENT(60, 0x10, 0),
58 RATETAB_ENT(90, 0x20, 0),
59 RATETAB_ENT(120, 0x40, 0),
60 RATETAB_ENT(180, 0x80, 0),
61 RATETAB_ENT(240, 0x100, 0),
62 RATETAB_ENT(360, 0x200, 0),
63 RATETAB_ENT(480, 0x400, 0),
64 RATETAB_ENT(540, 0x800, 0),
65 };
66
67 #define ath6kl_a_rates (ath6kl_rates + 4)
68 #define ath6kl_a_rates_size 8
69 #define ath6kl_g_rates (ath6kl_rates + 0)
70 #define ath6kl_g_rates_size 12
71
72 #define ath6kl_g_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \
73 IEEE80211_HT_CAP_SGI_20 | \
74 IEEE80211_HT_CAP_SGI_40)
75
76 static struct ieee80211_channel ath6kl_2ghz_channels[] = {
77 CHAN2G(1, 2412, 0),
78 CHAN2G(2, 2417, 0),
79 CHAN2G(3, 2422, 0),
80 CHAN2G(4, 2427, 0),
81 CHAN2G(5, 2432, 0),
82 CHAN2G(6, 2437, 0),
83 CHAN2G(7, 2442, 0),
84 CHAN2G(8, 2447, 0),
85 CHAN2G(9, 2452, 0),
86 CHAN2G(10, 2457, 0),
87 CHAN2G(11, 2462, 0),
88 CHAN2G(12, 2467, 0),
89 CHAN2G(13, 2472, 0),
90 CHAN2G(14, 2484, 0),
91 };
92
93 static struct ieee80211_channel ath6kl_5ghz_a_channels[] = {
94 CHAN5G(34, 0), CHAN5G(36, 0),
95 CHAN5G(38, 0), CHAN5G(40, 0),
96 CHAN5G(42, 0), CHAN5G(44, 0),
97 CHAN5G(46, 0), CHAN5G(48, 0),
98 CHAN5G(52, 0), CHAN5G(56, 0),
99 CHAN5G(60, 0), CHAN5G(64, 0),
100 CHAN5G(100, 0), CHAN5G(104, 0),
101 CHAN5G(108, 0), CHAN5G(112, 0),
102 CHAN5G(116, 0), CHAN5G(120, 0),
103 CHAN5G(124, 0), CHAN5G(128, 0),
104 CHAN5G(132, 0), CHAN5G(136, 0),
105 CHAN5G(140, 0), CHAN5G(149, 0),
106 CHAN5G(153, 0), CHAN5G(157, 0),
107 CHAN5G(161, 0), CHAN5G(165, 0),
108 CHAN5G(184, 0), CHAN5G(188, 0),
109 CHAN5G(192, 0), CHAN5G(196, 0),
110 CHAN5G(200, 0), CHAN5G(204, 0),
111 CHAN5G(208, 0), CHAN5G(212, 0),
112 CHAN5G(216, 0),
113 };
114
115 static struct ieee80211_supported_band ath6kl_band_2ghz = {
116 .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels),
117 .channels = ath6kl_2ghz_channels,
118 .n_bitrates = ath6kl_g_rates_size,
119 .bitrates = ath6kl_g_rates,
120 .ht_cap.cap = ath6kl_g_htcap,
121 .ht_cap.ht_supported = true,
122 };
123
124 static struct ieee80211_supported_band ath6kl_band_5ghz = {
125 .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels),
126 .channels = ath6kl_5ghz_a_channels,
127 .n_bitrates = ath6kl_a_rates_size,
128 .bitrates = ath6kl_a_rates,
129 .ht_cap.cap = ath6kl_g_htcap,
130 .ht_cap.ht_supported = true,
131 };
132
133 #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */
134
135 /* returns true if scheduled scan was stopped */
136 static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif)
137 {
138 struct ath6kl *ar = vif->ar;
139
140 if (ar->state != ATH6KL_STATE_SCHED_SCAN)
141 return false;
142
143 del_timer_sync(&vif->sched_scan_timer);
144
145 ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
146 ATH6KL_HOST_MODE_AWAKE);
147
148 ar->state = ATH6KL_STATE_ON;
149
150 return true;
151 }
152
153 static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif)
154 {
155 struct ath6kl *ar = vif->ar;
156 bool stopped;
157
158 stopped = __ath6kl_cfg80211_sscan_stop(vif);
159
160 if (!stopped)
161 return;
162
163 cfg80211_sched_scan_stopped(ar->wiphy);
164 }
165
166 static int ath6kl_set_wpa_version(struct ath6kl_vif *vif,
167 enum nl80211_wpa_versions wpa_version)
168 {
169 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version);
170
171 if (!wpa_version) {
172 vif->auth_mode = NONE_AUTH;
173 } else if (wpa_version & NL80211_WPA_VERSION_2) {
174 vif->auth_mode = WPA2_AUTH;
175 } else if (wpa_version & NL80211_WPA_VERSION_1) {
176 vif->auth_mode = WPA_AUTH;
177 } else {
178 ath6kl_err("%s: %u not supported\n", __func__, wpa_version);
179 return -ENOTSUPP;
180 }
181
182 return 0;
183 }
184
185 static int ath6kl_set_auth_type(struct ath6kl_vif *vif,
186 enum nl80211_auth_type auth_type)
187 {
188 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type);
189
190 switch (auth_type) {
191 case NL80211_AUTHTYPE_OPEN_SYSTEM:
192 vif->dot11_auth_mode = OPEN_AUTH;
193 break;
194 case NL80211_AUTHTYPE_SHARED_KEY:
195 vif->dot11_auth_mode = SHARED_AUTH;
196 break;
197 case NL80211_AUTHTYPE_NETWORK_EAP:
198 vif->dot11_auth_mode = LEAP_AUTH;
199 break;
200
201 case NL80211_AUTHTYPE_AUTOMATIC:
202 vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH;
203 break;
204
205 default:
206 ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type);
207 return -ENOTSUPP;
208 }
209
210 return 0;
211 }
212
213 static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast)
214 {
215 u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto;
216 u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len :
217 &vif->grp_crypto_len;
218
219 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n",
220 __func__, cipher, ucast);
221
222 switch (cipher) {
223 case 0:
224 /* our own hack to use value 0 as no crypto used */
225 *ar_cipher = NONE_CRYPT;
226 *ar_cipher_len = 0;
227 break;
228 case WLAN_CIPHER_SUITE_WEP40:
229 *ar_cipher = WEP_CRYPT;
230 *ar_cipher_len = 5;
231 break;
232 case WLAN_CIPHER_SUITE_WEP104:
233 *ar_cipher = WEP_CRYPT;
234 *ar_cipher_len = 13;
235 break;
236 case WLAN_CIPHER_SUITE_TKIP:
237 *ar_cipher = TKIP_CRYPT;
238 *ar_cipher_len = 0;
239 break;
240 case WLAN_CIPHER_SUITE_CCMP:
241 *ar_cipher = AES_CRYPT;
242 *ar_cipher_len = 0;
243 break;
244 case WLAN_CIPHER_SUITE_SMS4:
245 *ar_cipher = WAPI_CRYPT;
246 *ar_cipher_len = 0;
247 break;
248 default:
249 ath6kl_err("cipher 0x%x not supported\n", cipher);
250 return -ENOTSUPP;
251 }
252
253 return 0;
254 }
255
256 static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt)
257 {
258 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt);
259
260 if (key_mgmt == WLAN_AKM_SUITE_PSK) {
261 if (vif->auth_mode == WPA_AUTH)
262 vif->auth_mode = WPA_PSK_AUTH;
263 else if (vif->auth_mode == WPA2_AUTH)
264 vif->auth_mode = WPA2_PSK_AUTH;
265 } else if (key_mgmt == 0x00409600) {
266 if (vif->auth_mode == WPA_AUTH)
267 vif->auth_mode = WPA_AUTH_CCKM;
268 else if (vif->auth_mode == WPA2_AUTH)
269 vif->auth_mode = WPA2_AUTH_CCKM;
270 } else if (key_mgmt != WLAN_AKM_SUITE_8021X) {
271 vif->auth_mode = NONE_AUTH;
272 }
273 }
274
275 static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif)
276 {
277 struct ath6kl *ar = vif->ar;
278
279 if (!test_bit(WMI_READY, &ar->flag)) {
280 ath6kl_err("wmi is not ready\n");
281 return false;
282 }
283
284 if (!test_bit(WLAN_ENABLED, &vif->flags)) {
285 ath6kl_err("wlan disabled\n");
286 return false;
287 }
288
289 return true;
290 }
291
292 static bool ath6kl_is_wpa_ie(const u8 *pos)
293 {
294 return pos[0] == WLAN_EID_WPA && pos[1] >= 4 &&
295 pos[2] == 0x00 && pos[3] == 0x50 &&
296 pos[4] == 0xf2 && pos[5] == 0x01;
297 }
298
299 static bool ath6kl_is_rsn_ie(const u8 *pos)
300 {
301 return pos[0] == WLAN_EID_RSN;
302 }
303
304 static bool ath6kl_is_wps_ie(const u8 *pos)
305 {
306 return (pos[0] == WLAN_EID_VENDOR_SPECIFIC &&
307 pos[1] >= 4 &&
308 pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 &&
309 pos[5] == 0x04);
310 }
311
312 static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies,
313 size_t ies_len)
314 {
315 struct ath6kl *ar = vif->ar;
316 const u8 *pos;
317 u8 *buf = NULL;
318 size_t len = 0;
319 int ret;
320
321 /*
322 * Clear previously set flag
323 */
324
325 ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG;
326
327 /*
328 * Filter out RSN/WPA IE(s)
329 */
330
331 if (ies && ies_len) {
332 buf = kmalloc(ies_len, GFP_KERNEL);
333 if (buf == NULL)
334 return -ENOMEM;
335 pos = ies;
336
337 while (pos + 1 < ies + ies_len) {
338 if (pos + 2 + pos[1] > ies + ies_len)
339 break;
340 if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) {
341 memcpy(buf + len, pos, 2 + pos[1]);
342 len += 2 + pos[1];
343 }
344
345 if (ath6kl_is_wps_ie(pos))
346 ar->connect_ctrl_flags |= CONNECT_WPS_FLAG;
347
348 pos += 2 + pos[1];
349 }
350 }
351
352 ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
353 WMI_FRAME_ASSOC_REQ, buf, len);
354 kfree(buf);
355 return ret;
356 }
357
358 static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type)
359 {
360 switch (type) {
361 case NL80211_IFTYPE_STATION:
362 *nw_type = INFRA_NETWORK;
363 break;
364 case NL80211_IFTYPE_ADHOC:
365 *nw_type = ADHOC_NETWORK;
366 break;
367 case NL80211_IFTYPE_AP:
368 *nw_type = AP_NETWORK;
369 break;
370 case NL80211_IFTYPE_P2P_CLIENT:
371 *nw_type = INFRA_NETWORK;
372 break;
373 case NL80211_IFTYPE_P2P_GO:
374 *nw_type = AP_NETWORK;
375 break;
376 default:
377 ath6kl_err("invalid interface type %u\n", type);
378 return -ENOTSUPP;
379 }
380
381 return 0;
382 }
383
384 static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type,
385 u8 *if_idx, u8 *nw_type)
386 {
387 int i;
388
389 if (ath6kl_nliftype_to_drv_iftype(type, nw_type))
390 return false;
391
392 if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) &&
393 ar->num_vif))
394 return false;
395
396 if (type == NL80211_IFTYPE_STATION ||
397 type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) {
398 for (i = 0; i < ar->vif_max; i++) {
399 if ((ar->avail_idx_map >> i) & BIT(0)) {
400 *if_idx = i;
401 return true;
402 }
403 }
404 }
405
406 if (type == NL80211_IFTYPE_P2P_CLIENT ||
407 type == NL80211_IFTYPE_P2P_GO) {
408 for (i = ar->max_norm_iface; i < ar->vif_max; i++) {
409 if ((ar->avail_idx_map >> i) & BIT(0)) {
410 *if_idx = i;
411 return true;
412 }
413 }
414 }
415
416 return false;
417 }
418
419 static bool ath6kl_is_tx_pending(struct ath6kl *ar)
420 {
421 return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0;
422 }
423
424
425 static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev,
426 struct cfg80211_connect_params *sme)
427 {
428 struct ath6kl *ar = ath6kl_priv(dev);
429 struct ath6kl_vif *vif = netdev_priv(dev);
430 int status;
431 u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE;
432 u16 interval;
433
434 ath6kl_cfg80211_sscan_disable(vif);
435
436 vif->sme_state = SME_CONNECTING;
437
438 if (!ath6kl_cfg80211_ready(vif))
439 return -EIO;
440
441 if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
442 ath6kl_err("destroy in progress\n");
443 return -EBUSY;
444 }
445
446 if (test_bit(SKIP_SCAN, &ar->flag) &&
447 ((sme->channel && sme->channel->center_freq == 0) ||
448 (sme->bssid && is_zero_ether_addr(sme->bssid)))) {
449 ath6kl_err("SkipScan: channel or bssid invalid\n");
450 return -EINVAL;
451 }
452
453 if (down_interruptible(&ar->sem)) {
454 ath6kl_err("busy, couldn't get access\n");
455 return -ERESTARTSYS;
456 }
457
458 if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
459 ath6kl_err("busy, destroy in progress\n");
460 up(&ar->sem);
461 return -EBUSY;
462 }
463
464 if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) {
465 /*
466 * sleep until the command queue drains
467 */
468 wait_event_interruptible_timeout(ar->event_wq,
469 ath6kl_is_tx_pending(ar),
470 WMI_TIMEOUT);
471 if (signal_pending(current)) {
472 ath6kl_err("cmd queue drain timeout\n");
473 up(&ar->sem);
474 return -EINTR;
475 }
476 }
477
478 status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len);
479 if (status) {
480 up(&ar->sem);
481 return status;
482 }
483
484 if (sme->ie == NULL || sme->ie_len == 0)
485 ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG;
486
487 if (test_bit(CONNECTED, &vif->flags) &&
488 vif->ssid_len == sme->ssid_len &&
489 !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) {
490 vif->reconnect_flag = true;
491 status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx,
492 vif->req_bssid,
493 vif->ch_hint);
494
495 up(&ar->sem);
496 if (status) {
497 ath6kl_err("wmi_reconnect_cmd failed\n");
498 return -EIO;
499 }
500 return 0;
501 } else if (vif->ssid_len == sme->ssid_len &&
502 !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) {
503 ath6kl_disconnect(vif);
504 }
505
506 memset(vif->ssid, 0, sizeof(vif->ssid));
507 vif->ssid_len = sme->ssid_len;
508 memcpy(vif->ssid, sme->ssid, sme->ssid_len);
509
510 if (sme->channel)
511 vif->ch_hint = sme->channel->center_freq;
512
513 memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
514 if (sme->bssid && !is_broadcast_ether_addr(sme->bssid))
515 memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid));
516
517 ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions);
518
519 status = ath6kl_set_auth_type(vif, sme->auth_type);
520 if (status) {
521 up(&ar->sem);
522 return status;
523 }
524
525 if (sme->crypto.n_ciphers_pairwise)
526 ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true);
527 else
528 ath6kl_set_cipher(vif, 0, true);
529
530 ath6kl_set_cipher(vif, sme->crypto.cipher_group, false);
531
532 if (sme->crypto.n_akm_suites)
533 ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]);
534
535 if ((sme->key_len) &&
536 (vif->auth_mode == NONE_AUTH) &&
537 (vif->prwise_crypto == WEP_CRYPT)) {
538 struct ath6kl_key *key = NULL;
539
540 if (sme->key_idx > WMI_MAX_KEY_INDEX) {
541 ath6kl_err("key index %d out of bounds\n",
542 sme->key_idx);
543 up(&ar->sem);
544 return -ENOENT;
545 }
546
547 key = &vif->keys[sme->key_idx];
548 key->key_len = sme->key_len;
549 memcpy(key->key, sme->key, key->key_len);
550 key->cipher = vif->prwise_crypto;
551 vif->def_txkey_index = sme->key_idx;
552
553 ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx,
554 vif->prwise_crypto,
555 GROUP_USAGE | TX_USAGE,
556 key->key_len,
557 NULL, 0,
558 key->key, KEY_OP_INIT_VAL, NULL,
559 NO_SYNC_WMIFLAG);
560 }
561
562 if (!ar->usr_bss_filter) {
563 clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
564 if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
565 ALL_BSS_FILTER, 0) != 0) {
566 ath6kl_err("couldn't set bss filtering\n");
567 up(&ar->sem);
568 return -EIO;
569 }
570 }
571
572 vif->nw_type = vif->next_mode;
573
574 if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT)
575 nw_subtype = SUBTYPE_P2PCLIENT;
576
577 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
578 "%s: connect called with authmode %d dot11 auth %d"
579 " PW crypto %d PW crypto len %d GRP crypto %d"
580 " GRP crypto len %d channel hint %u\n",
581 __func__,
582 vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto,
583 vif->prwise_crypto_len, vif->grp_crypto,
584 vif->grp_crypto_len, vif->ch_hint);
585
586 vif->reconnect_flag = 0;
587
588 if (vif->nw_type == INFRA_NETWORK) {
589 interval = max_t(u16, vif->listen_intvl_t,
590 ATH6KL_MAX_WOW_LISTEN_INTL);
591 status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx,
592 interval,
593 0);
594 if (status) {
595 ath6kl_err("couldn't set listen intervel\n");
596 up(&ar->sem);
597 return status;
598 }
599 }
600
601 status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type,
602 vif->dot11_auth_mode, vif->auth_mode,
603 vif->prwise_crypto,
604 vif->prwise_crypto_len,
605 vif->grp_crypto, vif->grp_crypto_len,
606 vif->ssid_len, vif->ssid,
607 vif->req_bssid, vif->ch_hint,
608 ar->connect_ctrl_flags, nw_subtype);
609
610 up(&ar->sem);
611
612 if (status == -EINVAL) {
613 memset(vif->ssid, 0, sizeof(vif->ssid));
614 vif->ssid_len = 0;
615 ath6kl_err("invalid request\n");
616 return -ENOENT;
617 } else if (status) {
618 ath6kl_err("ath6kl_wmi_connect_cmd failed\n");
619 return -EIO;
620 }
621
622 if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) &&
623 ((vif->auth_mode == WPA_PSK_AUTH) ||
624 (vif->auth_mode == WPA2_PSK_AUTH))) {
625 mod_timer(&vif->disconnect_timer,
626 jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL));
627 }
628
629 ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD;
630 set_bit(CONNECT_PEND, &vif->flags);
631
632 return 0;
633 }
634
635 static struct cfg80211_bss *
636 ath6kl_add_bss_if_needed(struct ath6kl_vif *vif,
637 enum network_type nw_type,
638 const u8 *bssid,
639 struct ieee80211_channel *chan,
640 const u8 *beacon_ie,
641 size_t beacon_ie_len)
642 {
643 struct ath6kl *ar = vif->ar;
644 struct cfg80211_bss *bss;
645 u16 cap_mask, cap_val;
646 u8 *ie;
647
648 if (nw_type & ADHOC_NETWORK) {
649 cap_mask = WLAN_CAPABILITY_IBSS;
650 cap_val = WLAN_CAPABILITY_IBSS;
651 } else {
652 cap_mask = WLAN_CAPABILITY_ESS;
653 cap_val = WLAN_CAPABILITY_ESS;
654 }
655
656 bss = cfg80211_get_bss(ar->wiphy, chan, bssid,
657 vif->ssid, vif->ssid_len,
658 cap_mask, cap_val);
659 if (bss == NULL) {
660 /*
661 * Since cfg80211 may not yet know about the BSS,
662 * generate a partial entry until the first BSS info
663 * event becomes available.
664 *
665 * Prepend SSID element since it is not included in the Beacon
666 * IEs from the target.
667 */
668 ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL);
669 if (ie == NULL)
670 return NULL;
671 ie[0] = WLAN_EID_SSID;
672 ie[1] = vif->ssid_len;
673 memcpy(ie + 2, vif->ssid, vif->ssid_len);
674 memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len);
675 bss = cfg80211_inform_bss(ar->wiphy, chan,
676 bssid, 0, cap_val, 100,
677 ie, 2 + vif->ssid_len + beacon_ie_len,
678 0, GFP_KERNEL);
679 if (bss)
680 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to "
681 "cfg80211\n", bssid);
682 kfree(ie);
683 } else
684 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n");
685
686 return bss;
687 }
688
689 void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel,
690 u8 *bssid, u16 listen_intvl,
691 u16 beacon_intvl,
692 enum network_type nw_type,
693 u8 beacon_ie_len, u8 assoc_req_len,
694 u8 assoc_resp_len, u8 *assoc_info)
695 {
696 struct ieee80211_channel *chan;
697 struct ath6kl *ar = vif->ar;
698 struct cfg80211_bss *bss;
699
700 /* capinfo + listen interval */
701 u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16);
702
703 /* capinfo + status code + associd */
704 u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16);
705
706 u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset;
707 u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len +
708 assoc_resp_ie_offset;
709
710 assoc_req_len -= assoc_req_ie_offset;
711 assoc_resp_len -= assoc_resp_ie_offset;
712
713 /*
714 * Store Beacon interval here; DTIM period will be available only once
715 * a Beacon frame from the AP is seen.
716 */
717 vif->assoc_bss_beacon_int = beacon_intvl;
718 clear_bit(DTIM_PERIOD_AVAIL, &vif->flags);
719
720 if (nw_type & ADHOC_NETWORK) {
721 if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) {
722 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
723 "%s: ath6k not in ibss mode\n", __func__);
724 return;
725 }
726 }
727
728 if (nw_type & INFRA_NETWORK) {
729 if (vif->wdev.iftype != NL80211_IFTYPE_STATION &&
730 vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) {
731 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
732 "%s: ath6k not in station mode\n", __func__);
733 return;
734 }
735 }
736
737 chan = ieee80211_get_channel(ar->wiphy, (int) channel);
738
739 bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan,
740 assoc_info, beacon_ie_len);
741 if (!bss) {
742 ath6kl_err("could not add cfg80211 bss entry\n");
743 return;
744 }
745
746 if (nw_type & ADHOC_NETWORK) {
747 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n",
748 nw_type & ADHOC_CREATOR ? "creator" : "joiner");
749 cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL);
750 cfg80211_put_bss(bss);
751 return;
752 }
753
754 if (vif->sme_state == SME_CONNECTING) {
755 /* inform connect result to cfg80211 */
756 vif->sme_state = SME_CONNECTED;
757 cfg80211_connect_result(vif->ndev, bssid,
758 assoc_req_ie, assoc_req_len,
759 assoc_resp_ie, assoc_resp_len,
760 WLAN_STATUS_SUCCESS, GFP_KERNEL);
761 cfg80211_put_bss(bss);
762 } else if (vif->sme_state == SME_CONNECTED) {
763 /* inform roam event to cfg80211 */
764 cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len,
765 assoc_resp_ie, assoc_resp_len, GFP_KERNEL);
766 }
767 }
768
769 static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy,
770 struct net_device *dev, u16 reason_code)
771 {
772 struct ath6kl *ar = ath6kl_priv(dev);
773 struct ath6kl_vif *vif = netdev_priv(dev);
774
775 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__,
776 reason_code);
777
778 ath6kl_cfg80211_sscan_disable(vif);
779
780 if (!ath6kl_cfg80211_ready(vif))
781 return -EIO;
782
783 if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
784 ath6kl_err("busy, destroy in progress\n");
785 return -EBUSY;
786 }
787
788 if (down_interruptible(&ar->sem)) {
789 ath6kl_err("busy, couldn't get access\n");
790 return -ERESTARTSYS;
791 }
792
793 vif->reconnect_flag = 0;
794 ath6kl_disconnect(vif);
795 memset(vif->ssid, 0, sizeof(vif->ssid));
796 vif->ssid_len = 0;
797
798 if (!test_bit(SKIP_SCAN, &ar->flag))
799 memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
800
801 up(&ar->sem);
802
803 vif->sme_state = SME_DISCONNECTED;
804
805 return 0;
806 }
807
808 void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason,
809 u8 *bssid, u8 assoc_resp_len,
810 u8 *assoc_info, u16 proto_reason)
811 {
812 struct ath6kl *ar = vif->ar;
813
814 if (vif->scan_req) {
815 cfg80211_scan_done(vif->scan_req, true);
816 vif->scan_req = NULL;
817 }
818
819 if (vif->nw_type & ADHOC_NETWORK) {
820 if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) {
821 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
822 "%s: ath6k not in ibss mode\n", __func__);
823 return;
824 }
825 memset(bssid, 0, ETH_ALEN);
826 cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL);
827 return;
828 }
829
830 if (vif->nw_type & INFRA_NETWORK) {
831 if (vif->wdev.iftype != NL80211_IFTYPE_STATION &&
832 vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) {
833 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
834 "%s: ath6k not in station mode\n", __func__);
835 return;
836 }
837 }
838
839 /*
840 * Send a disconnect command to target when a disconnect event is
841 * received with reason code other than 3 (DISCONNECT_CMD - disconnect
842 * request from host) to make the firmware stop trying to connect even
843 * after giving disconnect event. There will be one more disconnect
844 * event for this disconnect command with reason code DISCONNECT_CMD
845 * which will be notified to cfg80211.
846 */
847
848 if (reason != DISCONNECT_CMD) {
849 ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx);
850 return;
851 }
852
853 clear_bit(CONNECT_PEND, &vif->flags);
854
855 if (vif->sme_state == SME_CONNECTING) {
856 cfg80211_connect_result(vif->ndev,
857 bssid, NULL, 0,
858 NULL, 0,
859 WLAN_STATUS_UNSPECIFIED_FAILURE,
860 GFP_KERNEL);
861 } else if (vif->sme_state == SME_CONNECTED) {
862 cfg80211_disconnected(vif->ndev, reason,
863 NULL, 0, GFP_KERNEL);
864 }
865
866 vif->sme_state = SME_DISCONNECTED;
867 }
868
869 static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev,
870 struct cfg80211_scan_request *request)
871 {
872 struct ath6kl *ar = ath6kl_priv(ndev);
873 struct ath6kl_vif *vif = netdev_priv(ndev);
874 s8 n_channels = 0;
875 u16 *channels = NULL;
876 int ret = 0;
877 u32 force_fg_scan = 0;
878
879 if (!ath6kl_cfg80211_ready(vif))
880 return -EIO;
881
882 ath6kl_cfg80211_sscan_disable(vif);
883
884 if (!ar->usr_bss_filter) {
885 clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
886 ret = ath6kl_wmi_bssfilter_cmd(
887 ar->wmi, vif->fw_vif_idx,
888 (test_bit(CONNECTED, &vif->flags) ?
889 ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0);
890 if (ret) {
891 ath6kl_err("couldn't set bss filtering\n");
892 return ret;
893 }
894 }
895
896 if (request->n_ssids && request->ssids[0].ssid_len) {
897 u8 i;
898
899 if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1))
900 request->n_ssids = MAX_PROBED_SSID_INDEX - 1;
901
902 for (i = 0; i < request->n_ssids; i++)
903 ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
904 i + 1, SPECIFIC_SSID_FLAG,
905 request->ssids[i].ssid_len,
906 request->ssids[i].ssid);
907 }
908
909 /* this also clears IE in fw if it's not set */
910 ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
911 WMI_FRAME_PROBE_REQ,
912 request->ie, request->ie_len);
913 if (ret) {
914 ath6kl_err("failed to set Probe Request appie for "
915 "scan");
916 return ret;
917 }
918
919 /*
920 * Scan only the requested channels if the request specifies a set of
921 * channels. If the list is longer than the target supports, do not
922 * configure the list and instead, scan all available channels.
923 */
924 if (request->n_channels > 0 &&
925 request->n_channels <= WMI_MAX_CHANNELS) {
926 u8 i;
927
928 n_channels = request->n_channels;
929
930 channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL);
931 if (channels == NULL) {
932 ath6kl_warn("failed to set scan channels, "
933 "scan all channels");
934 n_channels = 0;
935 }
936
937 for (i = 0; i < n_channels; i++)
938 channels[i] = request->channels[i]->center_freq;
939 }
940
941 if (test_bit(CONNECTED, &vif->flags))
942 force_fg_scan = 1;
943
944 if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX,
945 ar->fw_capabilities)) {
946 /*
947 * If capable of doing P2P mgmt operations using
948 * station interface, send additional information like
949 * supported rates to advertise and xmit rates for
950 * probe requests
951 */
952 ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx,
953 WMI_LONG_SCAN, force_fg_scan,
954 false, 0,
955 ATH6KL_FG_SCAN_INTERVAL,
956 n_channels, channels,
957 request->no_cck,
958 request->rates);
959 } else {
960 ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx,
961 WMI_LONG_SCAN, force_fg_scan,
962 false, 0,
963 ATH6KL_FG_SCAN_INTERVAL,
964 n_channels, channels);
965 }
966 if (ret)
967 ath6kl_err("wmi_startscan_cmd failed\n");
968 else
969 vif->scan_req = request;
970
971 kfree(channels);
972
973 return ret;
974 }
975
976 void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted)
977 {
978 struct ath6kl *ar = vif->ar;
979 int i;
980
981 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__,
982 aborted ? " aborted" : "");
983
984 if (!vif->scan_req)
985 return;
986
987 if (aborted)
988 goto out;
989
990 if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) {
991 for (i = 0; i < vif->scan_req->n_ssids; i++) {
992 ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
993 i + 1, DISABLE_SSID_FLAG,
994 0, NULL);
995 }
996 }
997
998 out:
999 cfg80211_scan_done(vif->scan_req, aborted);
1000 vif->scan_req = NULL;
1001 }
1002
1003 static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev,
1004 u8 key_index, bool pairwise,
1005 const u8 *mac_addr,
1006 struct key_params *params)
1007 {
1008 struct ath6kl *ar = ath6kl_priv(ndev);
1009 struct ath6kl_vif *vif = netdev_priv(ndev);
1010 struct ath6kl_key *key = NULL;
1011 int seq_len;
1012 u8 key_usage;
1013 u8 key_type;
1014
1015 if (!ath6kl_cfg80211_ready(vif))
1016 return -EIO;
1017
1018 if (params->cipher == CCKM_KRK_CIPHER_SUITE) {
1019 if (params->key_len != WMI_KRK_LEN)
1020 return -EINVAL;
1021 return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx,
1022 params->key);
1023 }
1024
1025 if (key_index > WMI_MAX_KEY_INDEX) {
1026 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1027 "%s: key index %d out of bounds\n", __func__,
1028 key_index);
1029 return -ENOENT;
1030 }
1031
1032 key = &vif->keys[key_index];
1033 memset(key, 0, sizeof(struct ath6kl_key));
1034
1035 if (pairwise)
1036 key_usage = PAIRWISE_USAGE;
1037 else
1038 key_usage = GROUP_USAGE;
1039
1040 seq_len = params->seq_len;
1041 if (params->cipher == WLAN_CIPHER_SUITE_SMS4 &&
1042 seq_len > ATH6KL_KEY_SEQ_LEN) {
1043 /* Only first half of the WPI PN is configured */
1044 seq_len = ATH6KL_KEY_SEQ_LEN;
1045 }
1046 if (params->key_len > WLAN_MAX_KEY_LEN ||
1047 seq_len > sizeof(key->seq))
1048 return -EINVAL;
1049
1050 key->key_len = params->key_len;
1051 memcpy(key->key, params->key, key->key_len);
1052 key->seq_len = seq_len;
1053 memcpy(key->seq, params->seq, key->seq_len);
1054 key->cipher = params->cipher;
1055
1056 switch (key->cipher) {
1057 case WLAN_CIPHER_SUITE_WEP40:
1058 case WLAN_CIPHER_SUITE_WEP104:
1059 key_type = WEP_CRYPT;
1060 break;
1061
1062 case WLAN_CIPHER_SUITE_TKIP:
1063 key_type = TKIP_CRYPT;
1064 break;
1065
1066 case WLAN_CIPHER_SUITE_CCMP:
1067 key_type = AES_CRYPT;
1068 break;
1069 case WLAN_CIPHER_SUITE_SMS4:
1070 key_type = WAPI_CRYPT;
1071 break;
1072
1073 default:
1074 return -ENOTSUPP;
1075 }
1076
1077 if (((vif->auth_mode == WPA_PSK_AUTH) ||
1078 (vif->auth_mode == WPA2_PSK_AUTH)) &&
1079 (key_usage & GROUP_USAGE))
1080 del_timer(&vif->disconnect_timer);
1081
1082 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1083 "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n",
1084 __func__, key_index, key->key_len, key_type,
1085 key_usage, key->seq_len);
1086
1087 if (vif->nw_type == AP_NETWORK && !pairwise &&
1088 (key_type == TKIP_CRYPT || key_type == AES_CRYPT ||
1089 key_type == WAPI_CRYPT)) {
1090 ar->ap_mode_bkey.valid = true;
1091 ar->ap_mode_bkey.key_index = key_index;
1092 ar->ap_mode_bkey.key_type = key_type;
1093 ar->ap_mode_bkey.key_len = key->key_len;
1094 memcpy(ar->ap_mode_bkey.key, key->key, key->key_len);
1095 if (!test_bit(CONNECTED, &vif->flags)) {
1096 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group "
1097 "key configuration until AP mode has been "
1098 "started\n");
1099 /*
1100 * The key will be set in ath6kl_connect_ap_mode() once
1101 * the connected event is received from the target.
1102 */
1103 return 0;
1104 }
1105 }
1106
1107 if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT &&
1108 !test_bit(CONNECTED, &vif->flags)) {
1109 /*
1110 * Store the key locally so that it can be re-configured after
1111 * the AP mode has properly started
1112 * (ath6kl_install_statioc_wep_keys).
1113 */
1114 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration "
1115 "until AP mode has been started\n");
1116 vif->wep_key_list[key_index].key_len = key->key_len;
1117 memcpy(vif->wep_key_list[key_index].key, key->key,
1118 key->key_len);
1119 return 0;
1120 }
1121
1122 return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index,
1123 key_type, key_usage, key->key_len,
1124 key->seq, key->seq_len, key->key,
1125 KEY_OP_INIT_VAL,
1126 (u8 *) mac_addr, SYNC_BOTH_WMIFLAG);
1127 }
1128
1129 static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev,
1130 u8 key_index, bool pairwise,
1131 const u8 *mac_addr)
1132 {
1133 struct ath6kl *ar = ath6kl_priv(ndev);
1134 struct ath6kl_vif *vif = netdev_priv(ndev);
1135
1136 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
1137
1138 if (!ath6kl_cfg80211_ready(vif))
1139 return -EIO;
1140
1141 if (key_index > WMI_MAX_KEY_INDEX) {
1142 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1143 "%s: key index %d out of bounds\n", __func__,
1144 key_index);
1145 return -ENOENT;
1146 }
1147
1148 if (!vif->keys[key_index].key_len) {
1149 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1150 "%s: index %d is empty\n", __func__, key_index);
1151 return 0;
1152 }
1153
1154 vif->keys[key_index].key_len = 0;
1155
1156 return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index);
1157 }
1158
1159 static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev,
1160 u8 key_index, bool pairwise,
1161 const u8 *mac_addr, void *cookie,
1162 void (*callback) (void *cookie,
1163 struct key_params *))
1164 {
1165 struct ath6kl_vif *vif = netdev_priv(ndev);
1166 struct ath6kl_key *key = NULL;
1167 struct key_params params;
1168
1169 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
1170
1171 if (!ath6kl_cfg80211_ready(vif))
1172 return -EIO;
1173
1174 if (key_index > WMI_MAX_KEY_INDEX) {
1175 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1176 "%s: key index %d out of bounds\n", __func__,
1177 key_index);
1178 return -ENOENT;
1179 }
1180
1181 key = &vif->keys[key_index];
1182 memset(&params, 0, sizeof(params));
1183 params.cipher = key->cipher;
1184 params.key_len = key->key_len;
1185 params.seq_len = key->seq_len;
1186 params.seq = key->seq;
1187 params.key = key->key;
1188
1189 callback(cookie, &params);
1190
1191 return key->key_len ? 0 : -ENOENT;
1192 }
1193
1194 static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy,
1195 struct net_device *ndev,
1196 u8 key_index, bool unicast,
1197 bool multicast)
1198 {
1199 struct ath6kl *ar = ath6kl_priv(ndev);
1200 struct ath6kl_vif *vif = netdev_priv(ndev);
1201 struct ath6kl_key *key = NULL;
1202 u8 key_usage;
1203 enum crypto_type key_type = NONE_CRYPT;
1204
1205 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
1206
1207 if (!ath6kl_cfg80211_ready(vif))
1208 return -EIO;
1209
1210 if (key_index > WMI_MAX_KEY_INDEX) {
1211 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1212 "%s: key index %d out of bounds\n",
1213 __func__, key_index);
1214 return -ENOENT;
1215 }
1216
1217 if (!vif->keys[key_index].key_len) {
1218 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n",
1219 __func__, key_index);
1220 return -EINVAL;
1221 }
1222
1223 vif->def_txkey_index = key_index;
1224 key = &vif->keys[vif->def_txkey_index];
1225 key_usage = GROUP_USAGE;
1226 if (vif->prwise_crypto == WEP_CRYPT)
1227 key_usage |= TX_USAGE;
1228 if (unicast)
1229 key_type = vif->prwise_crypto;
1230 if (multicast)
1231 key_type = vif->grp_crypto;
1232
1233 if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags))
1234 return 0; /* Delay until AP mode has been started */
1235
1236 return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx,
1237 vif->def_txkey_index,
1238 key_type, key_usage,
1239 key->key_len, key->seq, key->seq_len,
1240 key->key,
1241 KEY_OP_INIT_VAL, NULL,
1242 SYNC_BOTH_WMIFLAG);
1243 }
1244
1245 void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid,
1246 bool ismcast)
1247 {
1248 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1249 "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast);
1250
1251 cfg80211_michael_mic_failure(vif->ndev, vif->bssid,
1252 (ismcast ? NL80211_KEYTYPE_GROUP :
1253 NL80211_KEYTYPE_PAIRWISE), keyid, NULL,
1254 GFP_KERNEL);
1255 }
1256
1257 static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
1258 {
1259 struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1260 struct ath6kl_vif *vif;
1261 int ret;
1262
1263 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__,
1264 changed);
1265
1266 vif = ath6kl_vif_first(ar);
1267 if (!vif)
1268 return -EIO;
1269
1270 if (!ath6kl_cfg80211_ready(vif))
1271 return -EIO;
1272
1273 if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
1274 ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold);
1275 if (ret != 0) {
1276 ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n");
1277 return -EIO;
1278 }
1279 }
1280
1281 return 0;
1282 }
1283
1284 /*
1285 * The type nl80211_tx_power_setting replaces the following
1286 * data type from 2.6.36 onwards
1287 */
1288 static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy,
1289 enum nl80211_tx_power_setting type,
1290 int mbm)
1291 {
1292 struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1293 struct ath6kl_vif *vif;
1294 int dbm = MBM_TO_DBM(mbm);
1295
1296 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__,
1297 type, dbm);
1298
1299 vif = ath6kl_vif_first(ar);
1300 if (!vif)
1301 return -EIO;
1302
1303 if (!ath6kl_cfg80211_ready(vif))
1304 return -EIO;
1305
1306 switch (type) {
1307 case NL80211_TX_POWER_AUTOMATIC:
1308 return 0;
1309 case NL80211_TX_POWER_LIMITED:
1310 ar->tx_pwr = dbm;
1311 break;
1312 default:
1313 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n",
1314 __func__, type);
1315 return -EOPNOTSUPP;
1316 }
1317
1318 ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm);
1319
1320 return 0;
1321 }
1322
1323 static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm)
1324 {
1325 struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1326 struct ath6kl_vif *vif;
1327
1328 vif = ath6kl_vif_first(ar);
1329 if (!vif)
1330 return -EIO;
1331
1332 if (!ath6kl_cfg80211_ready(vif))
1333 return -EIO;
1334
1335 if (test_bit(CONNECTED, &vif->flags)) {
1336 ar->tx_pwr = 0;
1337
1338 if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) {
1339 ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n");
1340 return -EIO;
1341 }
1342
1343 wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0,
1344 5 * HZ);
1345
1346 if (signal_pending(current)) {
1347 ath6kl_err("target did not respond\n");
1348 return -EINTR;
1349 }
1350 }
1351
1352 *dbm = ar->tx_pwr;
1353 return 0;
1354 }
1355
1356 static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy,
1357 struct net_device *dev,
1358 bool pmgmt, int timeout)
1359 {
1360 struct ath6kl *ar = ath6kl_priv(dev);
1361 struct wmi_power_mode_cmd mode;
1362 struct ath6kl_vif *vif = netdev_priv(dev);
1363
1364 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n",
1365 __func__, pmgmt, timeout);
1366
1367 if (!ath6kl_cfg80211_ready(vif))
1368 return -EIO;
1369
1370 if (pmgmt) {
1371 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__);
1372 mode.pwr_mode = REC_POWER;
1373 } else {
1374 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__);
1375 mode.pwr_mode = MAX_PERF_POWER;
1376 }
1377
1378 if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx,
1379 mode.pwr_mode) != 0) {
1380 ath6kl_err("wmi_powermode_cmd failed\n");
1381 return -EIO;
1382 }
1383
1384 return 0;
1385 }
1386
1387 static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy,
1388 char *name,
1389 enum nl80211_iftype type,
1390 u32 *flags,
1391 struct vif_params *params)
1392 {
1393 struct ath6kl *ar = wiphy_priv(wiphy);
1394 struct net_device *ndev;
1395 u8 if_idx, nw_type;
1396
1397 if (ar->num_vif == ar->vif_max) {
1398 ath6kl_err("Reached maximum number of supported vif\n");
1399 return ERR_PTR(-EINVAL);
1400 }
1401
1402 if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) {
1403 ath6kl_err("Not a supported interface type\n");
1404 return ERR_PTR(-EINVAL);
1405 }
1406
1407 ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type);
1408 if (!ndev)
1409 return ERR_PTR(-ENOMEM);
1410
1411 ar->num_vif++;
1412
1413 return ndev;
1414 }
1415
1416 static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy,
1417 struct net_device *ndev)
1418 {
1419 struct ath6kl *ar = wiphy_priv(wiphy);
1420 struct ath6kl_vif *vif = netdev_priv(ndev);
1421
1422 spin_lock_bh(&ar->list_lock);
1423 list_del(&vif->list);
1424 spin_unlock_bh(&ar->list_lock);
1425
1426 ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag));
1427
1428 ath6kl_cfg80211_vif_cleanup(vif);
1429
1430 return 0;
1431 }
1432
1433 static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy,
1434 struct net_device *ndev,
1435 enum nl80211_iftype type, u32 *flags,
1436 struct vif_params *params)
1437 {
1438 struct ath6kl_vif *vif = netdev_priv(ndev);
1439
1440 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type);
1441
1442 switch (type) {
1443 case NL80211_IFTYPE_STATION:
1444 vif->next_mode = INFRA_NETWORK;
1445 break;
1446 case NL80211_IFTYPE_ADHOC:
1447 vif->next_mode = ADHOC_NETWORK;
1448 break;
1449 case NL80211_IFTYPE_AP:
1450 vif->next_mode = AP_NETWORK;
1451 break;
1452 case NL80211_IFTYPE_P2P_CLIENT:
1453 vif->next_mode = INFRA_NETWORK;
1454 break;
1455 case NL80211_IFTYPE_P2P_GO:
1456 vif->next_mode = AP_NETWORK;
1457 break;
1458 default:
1459 ath6kl_err("invalid interface type %u\n", type);
1460 return -EOPNOTSUPP;
1461 }
1462
1463 vif->wdev.iftype = type;
1464
1465 return 0;
1466 }
1467
1468 static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy,
1469 struct net_device *dev,
1470 struct cfg80211_ibss_params *ibss_param)
1471 {
1472 struct ath6kl *ar = ath6kl_priv(dev);
1473 struct ath6kl_vif *vif = netdev_priv(dev);
1474 int status;
1475
1476 if (!ath6kl_cfg80211_ready(vif))
1477 return -EIO;
1478
1479 vif->ssid_len = ibss_param->ssid_len;
1480 memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len);
1481
1482 if (ibss_param->channel)
1483 vif->ch_hint = ibss_param->channel->center_freq;
1484
1485 if (ibss_param->channel_fixed) {
1486 /*
1487 * TODO: channel_fixed: The channel should be fixed, do not
1488 * search for IBSSs to join on other channels. Target
1489 * firmware does not support this feature, needs to be
1490 * updated.
1491 */
1492 return -EOPNOTSUPP;
1493 }
1494
1495 memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
1496 if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid))
1497 memcpy(vif->req_bssid, ibss_param->bssid,
1498 sizeof(vif->req_bssid));
1499
1500 ath6kl_set_wpa_version(vif, 0);
1501
1502 status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM);
1503 if (status)
1504 return status;
1505
1506 if (ibss_param->privacy) {
1507 ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true);
1508 ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false);
1509 } else {
1510 ath6kl_set_cipher(vif, 0, true);
1511 ath6kl_set_cipher(vif, 0, false);
1512 }
1513
1514 vif->nw_type = vif->next_mode;
1515
1516 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1517 "%s: connect called with authmode %d dot11 auth %d"
1518 " PW crypto %d PW crypto len %d GRP crypto %d"
1519 " GRP crypto len %d channel hint %u\n",
1520 __func__,
1521 vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto,
1522 vif->prwise_crypto_len, vif->grp_crypto,
1523 vif->grp_crypto_len, vif->ch_hint);
1524
1525 status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type,
1526 vif->dot11_auth_mode, vif->auth_mode,
1527 vif->prwise_crypto,
1528 vif->prwise_crypto_len,
1529 vif->grp_crypto, vif->grp_crypto_len,
1530 vif->ssid_len, vif->ssid,
1531 vif->req_bssid, vif->ch_hint,
1532 ar->connect_ctrl_flags, SUBTYPE_NONE);
1533 set_bit(CONNECT_PEND, &vif->flags);
1534
1535 return 0;
1536 }
1537
1538 static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy,
1539 struct net_device *dev)
1540 {
1541 struct ath6kl_vif *vif = netdev_priv(dev);
1542
1543 if (!ath6kl_cfg80211_ready(vif))
1544 return -EIO;
1545
1546 ath6kl_disconnect(vif);
1547 memset(vif->ssid, 0, sizeof(vif->ssid));
1548 vif->ssid_len = 0;
1549
1550 return 0;
1551 }
1552
1553 static const u32 cipher_suites[] = {
1554 WLAN_CIPHER_SUITE_WEP40,
1555 WLAN_CIPHER_SUITE_WEP104,
1556 WLAN_CIPHER_SUITE_TKIP,
1557 WLAN_CIPHER_SUITE_CCMP,
1558 CCKM_KRK_CIPHER_SUITE,
1559 WLAN_CIPHER_SUITE_SMS4,
1560 };
1561
1562 static bool is_rate_legacy(s32 rate)
1563 {
1564 static const s32 legacy[] = { 1000, 2000, 5500, 11000,
1565 6000, 9000, 12000, 18000, 24000,
1566 36000, 48000, 54000
1567 };
1568 u8 i;
1569
1570 for (i = 0; i < ARRAY_SIZE(legacy); i++)
1571 if (rate == legacy[i])
1572 return true;
1573
1574 return false;
1575 }
1576
1577 static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi)
1578 {
1579 static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000,
1580 52000, 58500, 65000, 72200
1581 };
1582 u8 i;
1583
1584 for (i = 0; i < ARRAY_SIZE(ht20); i++) {
1585 if (rate == ht20[i]) {
1586 if (i == ARRAY_SIZE(ht20) - 1)
1587 /* last rate uses sgi */
1588 *sgi = true;
1589 else
1590 *sgi = false;
1591
1592 *mcs = i;
1593 return true;
1594 }
1595 }
1596 return false;
1597 }
1598
1599 static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi)
1600 {
1601 static const s32 ht40[] = { 13500, 27000, 40500, 54000,
1602 81000, 108000, 121500, 135000,
1603 150000
1604 };
1605 u8 i;
1606
1607 for (i = 0; i < ARRAY_SIZE(ht40); i++) {
1608 if (rate == ht40[i]) {
1609 if (i == ARRAY_SIZE(ht40) - 1)
1610 /* last rate uses sgi */
1611 *sgi = true;
1612 else
1613 *sgi = false;
1614
1615 *mcs = i;
1616 return true;
1617 }
1618 }
1619
1620 return false;
1621 }
1622
1623 static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev,
1624 u8 *mac, struct station_info *sinfo)
1625 {
1626 struct ath6kl *ar = ath6kl_priv(dev);
1627 struct ath6kl_vif *vif = netdev_priv(dev);
1628 long left;
1629 bool sgi;
1630 s32 rate;
1631 int ret;
1632 u8 mcs;
1633
1634 if (memcmp(mac, vif->bssid, ETH_ALEN) != 0)
1635 return -ENOENT;
1636
1637 if (down_interruptible(&ar->sem))
1638 return -EBUSY;
1639
1640 set_bit(STATS_UPDATE_PEND, &vif->flags);
1641
1642 ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx);
1643
1644 if (ret != 0) {
1645 up(&ar->sem);
1646 return -EIO;
1647 }
1648
1649 left = wait_event_interruptible_timeout(ar->event_wq,
1650 !test_bit(STATS_UPDATE_PEND,
1651 &vif->flags),
1652 WMI_TIMEOUT);
1653
1654 up(&ar->sem);
1655
1656 if (left == 0)
1657 return -ETIMEDOUT;
1658 else if (left < 0)
1659 return left;
1660
1661 if (vif->target_stats.rx_byte) {
1662 sinfo->rx_bytes = vif->target_stats.rx_byte;
1663 sinfo->filled |= STATION_INFO_RX_BYTES;
1664 sinfo->rx_packets = vif->target_stats.rx_pkt;
1665 sinfo->filled |= STATION_INFO_RX_PACKETS;
1666 }
1667
1668 if (vif->target_stats.tx_byte) {
1669 sinfo->tx_bytes = vif->target_stats.tx_byte;
1670 sinfo->filled |= STATION_INFO_TX_BYTES;
1671 sinfo->tx_packets = vif->target_stats.tx_pkt;
1672 sinfo->filled |= STATION_INFO_TX_PACKETS;
1673 }
1674
1675 sinfo->signal = vif->target_stats.cs_rssi;
1676 sinfo->filled |= STATION_INFO_SIGNAL;
1677
1678 rate = vif->target_stats.tx_ucast_rate;
1679
1680 if (is_rate_legacy(rate)) {
1681 sinfo->txrate.legacy = rate / 100;
1682 } else if (is_rate_ht20(rate, &mcs, &sgi)) {
1683 if (sgi) {
1684 sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
1685 sinfo->txrate.mcs = mcs - 1;
1686 } else {
1687 sinfo->txrate.mcs = mcs;
1688 }
1689
1690 sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
1691 } else if (is_rate_ht40(rate, &mcs, &sgi)) {
1692 if (sgi) {
1693 sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
1694 sinfo->txrate.mcs = mcs - 1;
1695 } else {
1696 sinfo->txrate.mcs = mcs;
1697 }
1698
1699 sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH;
1700 sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
1701 } else {
1702 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1703 "invalid rate from stats: %d\n", rate);
1704 ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE);
1705 return 0;
1706 }
1707
1708 sinfo->filled |= STATION_INFO_TX_BITRATE;
1709
1710 if (test_bit(CONNECTED, &vif->flags) &&
1711 test_bit(DTIM_PERIOD_AVAIL, &vif->flags) &&
1712 vif->nw_type == INFRA_NETWORK) {
1713 sinfo->filled |= STATION_INFO_BSS_PARAM;
1714 sinfo->bss_param.flags = 0;
1715 sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period;
1716 sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int;
1717 }
1718
1719 return 0;
1720 }
1721
1722 static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev,
1723 struct cfg80211_pmksa *pmksa)
1724 {
1725 struct ath6kl *ar = ath6kl_priv(netdev);
1726 struct ath6kl_vif *vif = netdev_priv(netdev);
1727
1728 return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid,
1729 pmksa->pmkid, true);
1730 }
1731
1732 static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev,
1733 struct cfg80211_pmksa *pmksa)
1734 {
1735 struct ath6kl *ar = ath6kl_priv(netdev);
1736 struct ath6kl_vif *vif = netdev_priv(netdev);
1737
1738 return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid,
1739 pmksa->pmkid, false);
1740 }
1741
1742 static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev)
1743 {
1744 struct ath6kl *ar = ath6kl_priv(netdev);
1745 struct ath6kl_vif *vif = netdev_priv(netdev);
1746
1747 if (test_bit(CONNECTED, &vif->flags))
1748 return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx,
1749 vif->bssid, NULL, false);
1750 return 0;
1751 }
1752
1753 static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif,
1754 struct cfg80211_wowlan *wow, u32 *filter)
1755 {
1756 int ret, pos;
1757 u8 mask[WOW_MASK_SIZE];
1758 u16 i;
1759
1760 /* Configure the patterns that we received from the user. */
1761 for (i = 0; i < wow->n_patterns; i++) {
1762
1763 /*
1764 * Convert given nl80211 specific mask value to equivalent
1765 * driver specific mask value and send it to the chip along
1766 * with patterns. For example, If the mask value defined in
1767 * struct cfg80211_wowlan is 0xA (equivalent binary is 1010),
1768 * then equivalent driver specific mask value is
1769 * "0xFF 0x00 0xFF 0x00".
1770 */
1771 memset(&mask, 0, sizeof(mask));
1772 for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) {
1773 if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8)))
1774 mask[pos] = 0xFF;
1775 }
1776 /*
1777 * Note: Pattern's offset is not passed as part of wowlan
1778 * parameter from CFG layer. So it's always passed as ZERO
1779 * to the firmware. It means, given WOW patterns are always
1780 * matched from the first byte of received pkt in the firmware.
1781 */
1782 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
1783 vif->fw_vif_idx, WOW_LIST_ID,
1784 wow->patterns[i].pattern_len,
1785 0 /* pattern offset */,
1786 wow->patterns[i].pattern, mask);
1787 if (ret)
1788 return ret;
1789 }
1790
1791 if (wow->disconnect)
1792 *filter |= WOW_FILTER_OPTION_NWK_DISASSOC;
1793
1794 if (wow->magic_pkt)
1795 *filter |= WOW_FILTER_OPTION_MAGIC_PACKET;
1796
1797 if (wow->gtk_rekey_failure)
1798 *filter |= WOW_FILTER_OPTION_GTK_ERROR;
1799
1800 if (wow->eap_identity_req)
1801 *filter |= WOW_FILTER_OPTION_EAP_REQ;
1802
1803 if (wow->four_way_handshake)
1804 *filter |= WOW_FILTER_OPTION_8021X_4WAYHS;
1805
1806 return 0;
1807 }
1808
1809 static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif)
1810 {
1811 static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00,
1812 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1813 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1814 0x00, 0x08 };
1815 static const u8 unicst_mask[] = { 0x01, 0x00, 0x00,
1816 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1817 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1818 0x00, 0x7f };
1819 u8 unicst_offset = 0;
1820 static const u8 arp_pattern[] = { 0x08, 0x06 };
1821 static const u8 arp_mask[] = { 0xff, 0xff };
1822 u8 arp_offset = 20;
1823 static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 };
1824 static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 };
1825 u8 discvr_offset = 38;
1826 static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff,
1827 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1828 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00,
1829 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1830 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1831 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ };
1832 static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff,
1833 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1834 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff,
1835 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1836 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1837 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ };
1838 u8 dhcp_offset = 0;
1839 int ret;
1840
1841 /* Setup unicast IP, EAPOL-like and ARP pkt pattern */
1842 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
1843 vif->fw_vif_idx, WOW_LIST_ID,
1844 sizeof(unicst_pattern), unicst_offset,
1845 unicst_pattern, unicst_mask);
1846 if (ret) {
1847 ath6kl_err("failed to add WOW unicast IP pattern\n");
1848 return ret;
1849 }
1850
1851 /* Setup all ARP pkt pattern */
1852 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
1853 vif->fw_vif_idx, WOW_LIST_ID,
1854 sizeof(arp_pattern), arp_offset,
1855 arp_pattern, arp_mask);
1856 if (ret) {
1857 ath6kl_err("failed to add WOW ARP pattern\n");
1858 return ret;
1859 }
1860
1861 /*
1862 * Setup multicast pattern for mDNS 224.0.0.251,
1863 * SSDP 239.255.255.250 and LLMNR 224.0.0.252
1864 */
1865 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
1866 vif->fw_vif_idx, WOW_LIST_ID,
1867 sizeof(discvr_pattern), discvr_offset,
1868 discvr_pattern, discvr_mask);
1869 if (ret) {
1870 ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n");
1871 return ret;
1872 }
1873
1874 /* Setup all DHCP broadcast pkt pattern */
1875 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
1876 vif->fw_vif_idx, WOW_LIST_ID,
1877 sizeof(dhcp_pattern), dhcp_offset,
1878 dhcp_pattern, dhcp_mask);
1879 if (ret) {
1880 ath6kl_err("failed to add WOW DHCP broadcast pattern\n");
1881 return ret;
1882 }
1883
1884 return 0;
1885 }
1886
1887 static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif)
1888 {
1889 struct net_device *ndev = vif->ndev;
1890 static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 };
1891 static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 };
1892 u8 discvr_offset = 38;
1893 u8 mac_mask[ETH_ALEN];
1894 int ret;
1895
1896 /* Setup unicast pkt pattern */
1897 memset(mac_mask, 0xff, ETH_ALEN);
1898 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
1899 vif->fw_vif_idx, WOW_LIST_ID,
1900 ETH_ALEN, 0, ndev->dev_addr,
1901 mac_mask);
1902 if (ret) {
1903 ath6kl_err("failed to add WOW unicast pattern\n");
1904 return ret;
1905 }
1906
1907 /*
1908 * Setup multicast pattern for mDNS 224.0.0.251,
1909 * SSDP 239.255.255.250 and LLMNR 224.0.0.252
1910 */
1911 if ((ndev->flags & IFF_ALLMULTI) ||
1912 (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) {
1913 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
1914 vif->fw_vif_idx, WOW_LIST_ID,
1915 sizeof(discvr_pattern), discvr_offset,
1916 discvr_pattern, discvr_mask);
1917 if (ret) {
1918 ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR "
1919 "pattern\n");
1920 return ret;
1921 }
1922 }
1923
1924 return 0;
1925 }
1926
1927 static int is_hsleep_mode_procsed(struct ath6kl_vif *vif)
1928 {
1929 return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags);
1930 }
1931
1932 static bool is_ctrl_ep_empty(struct ath6kl *ar)
1933 {
1934 return !ar->tx_pending[ar->ctrl_ep];
1935 }
1936
1937 static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif)
1938 {
1939 int ret, left;
1940
1941 clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags);
1942
1943 ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
1944 ATH6KL_HOST_MODE_ASLEEP);
1945 if (ret)
1946 return ret;
1947
1948 left = wait_event_interruptible_timeout(ar->event_wq,
1949 is_hsleep_mode_procsed(vif),
1950 WMI_TIMEOUT);
1951 if (left == 0) {
1952 ath6kl_warn("timeout, didn't get host sleep cmd processed event\n");
1953 ret = -ETIMEDOUT;
1954 } else if (left < 0) {
1955 ath6kl_warn("error while waiting for host sleep cmd processed event %d\n",
1956 left);
1957 ret = left;
1958 }
1959
1960 if (ar->tx_pending[ar->ctrl_ep]) {
1961 left = wait_event_interruptible_timeout(ar->event_wq,
1962 is_ctrl_ep_empty(ar),
1963 WMI_TIMEOUT);
1964 if (left == 0) {
1965 ath6kl_warn("clear wmi ctrl data timeout\n");
1966 ret = -ETIMEDOUT;
1967 } else if (left < 0) {
1968 ath6kl_warn("clear wmi ctrl data failed: %d\n", left);
1969 ret = left;
1970 }
1971 }
1972
1973 return ret;
1974 }
1975
1976 static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow)
1977 {
1978 struct in_device *in_dev;
1979 struct in_ifaddr *ifa;
1980 struct ath6kl_vif *vif;
1981 int ret;
1982 u32 filter = 0;
1983 u16 i, bmiss_time;
1984 u8 index = 0;
1985 __be32 ips[MAX_IP_ADDRS];
1986
1987 vif = ath6kl_vif_first(ar);
1988 if (!vif)
1989 return -EIO;
1990
1991 if (!ath6kl_cfg80211_ready(vif))
1992 return -EIO;
1993
1994 if (!test_bit(CONNECTED, &vif->flags))
1995 return -ENOTCONN;
1996
1997 if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST))
1998 return -EINVAL;
1999
2000 /* Clear existing WOW patterns */
2001 for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++)
2002 ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx,
2003 WOW_LIST_ID, i);
2004
2005 /*
2006 * Skip the default WOW pattern configuration
2007 * if the driver receives any WOW patterns from
2008 * the user.
2009 */
2010 if (wow)
2011 ret = ath6kl_wow_usr(ar, vif, wow, &filter);
2012 else if (vif->nw_type == AP_NETWORK)
2013 ret = ath6kl_wow_ap(ar, vif);
2014 else
2015 ret = ath6kl_wow_sta(ar, vif);
2016
2017 if (ret)
2018 return ret;
2019
2020 netif_stop_queue(vif->ndev);
2021
2022 if (vif->nw_type != AP_NETWORK) {
2023 ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx,
2024 ATH6KL_MAX_WOW_LISTEN_INTL,
2025 0);
2026 if (ret)
2027 return ret;
2028
2029 /* Set listen interval x 15 times as bmiss time */
2030 bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15;
2031 if (bmiss_time > ATH6KL_MAX_BMISS_TIME)
2032 bmiss_time = ATH6KL_MAX_BMISS_TIME;
2033
2034 ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx,
2035 bmiss_time, 0);
2036 if (ret)
2037 return ret;
2038
2039 ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx,
2040 0xFFFF, 0, 0xFFFF, 0, 0, 0,
2041 0, 0, 0, 0);
2042 if (ret)
2043 return ret;
2044 }
2045
2046 ar->state = ATH6KL_STATE_SUSPENDING;
2047
2048 /* Setup own IP addr for ARP agent. */
2049 in_dev = __in_dev_get_rtnl(vif->ndev);
2050 if (!in_dev)
2051 goto skip_arp;
2052
2053 ifa = in_dev->ifa_list;
2054 memset(&ips, 0, sizeof(ips));
2055
2056 /* Configure IP addr only if IP address count < MAX_IP_ADDRS */
2057 while (index < MAX_IP_ADDRS && ifa) {
2058 ips[index] = ifa->ifa_local;
2059 ifa = ifa->ifa_next;
2060 index++;
2061 }
2062
2063 if (ifa) {
2064 ath6kl_err("total IP addr count is exceeding fw limit\n");
2065 return -EINVAL;
2066 }
2067
2068 ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]);
2069 if (ret) {
2070 ath6kl_err("fail to setup ip for arp agent\n");
2071 return ret;
2072 }
2073
2074 skip_arp:
2075 ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx,
2076 ATH6KL_WOW_MODE_ENABLE,
2077 filter,
2078 WOW_HOST_REQ_DELAY);
2079 if (ret)
2080 return ret;
2081
2082 ret = ath6kl_cfg80211_host_sleep(ar, vif);
2083 if (ret)
2084 return ret;
2085
2086 return 0;
2087 }
2088
2089 static int ath6kl_wow_resume(struct ath6kl *ar)
2090 {
2091 struct ath6kl_vif *vif;
2092 int ret;
2093
2094 vif = ath6kl_vif_first(ar);
2095 if (!vif)
2096 return -EIO;
2097
2098 ar->state = ATH6KL_STATE_RESUMING;
2099
2100 ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
2101 ATH6KL_HOST_MODE_AWAKE);
2102 if (ret) {
2103 ath6kl_warn("Failed to configure host sleep mode for "
2104 "wow resume: %d\n", ret);
2105 ar->state = ATH6KL_STATE_WOW;
2106 return ret;
2107 }
2108
2109 if (vif->nw_type != AP_NETWORK) {
2110 ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx,
2111 0, 0, 0, 0, 0, 0, 3, 0, 0, 0);
2112 if (ret)
2113 return ret;
2114
2115 ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx,
2116 vif->listen_intvl_t, 0);
2117 if (ret)
2118 return ret;
2119
2120 ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx,
2121 vif->bmiss_time_t, 0);
2122 if (ret)
2123 return ret;
2124 }
2125
2126 ar->state = ATH6KL_STATE_ON;
2127
2128 netif_wake_queue(vif->ndev);
2129
2130 return 0;
2131 }
2132
2133 static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar)
2134 {
2135 struct ath6kl_vif *vif;
2136 int ret;
2137
2138 vif = ath6kl_vif_first(ar);
2139 if (!vif)
2140 return -EIO;
2141
2142 if (!ath6kl_cfg80211_ready(vif))
2143 return -EIO;
2144
2145 ath6kl_cfg80211_stop_all(ar);
2146
2147 /* Save the current power mode before enabling power save */
2148 ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode;
2149
2150 ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER);
2151 if (ret)
2152 return ret;
2153
2154 /* Disable WOW mode */
2155 ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx,
2156 ATH6KL_WOW_MODE_DISABLE,
2157 0, 0);
2158 if (ret)
2159 return ret;
2160
2161 /* Flush all non control pkts in TX path */
2162 ath6kl_tx_data_cleanup(ar);
2163
2164 ret = ath6kl_cfg80211_host_sleep(ar, vif);
2165 if (ret)
2166 return ret;
2167
2168 return 0;
2169 }
2170
2171 static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar)
2172 {
2173 struct ath6kl_vif *vif;
2174 int ret;
2175
2176 vif = ath6kl_vif_first(ar);
2177
2178 if (!vif)
2179 return -EIO;
2180
2181 if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) {
2182 ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0,
2183 ar->wmi->saved_pwr_mode);
2184 if (ret)
2185 return ret;
2186 }
2187
2188 ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
2189 ATH6KL_HOST_MODE_AWAKE);
2190 if (ret)
2191 return ret;
2192
2193 ar->state = ATH6KL_STATE_ON;
2194
2195 /* Reset scan parameter to default values */
2196 ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx,
2197 0, 0, 0, 0, 0, 0, 3, 0, 0, 0);
2198 if (ret)
2199 return ret;
2200
2201 return 0;
2202 }
2203
2204 int ath6kl_cfg80211_suspend(struct ath6kl *ar,
2205 enum ath6kl_cfg_suspend_mode mode,
2206 struct cfg80211_wowlan *wow)
2207 {
2208 enum ath6kl_state prev_state;
2209 int ret;
2210
2211 switch (mode) {
2212 case ATH6KL_CFG_SUSPEND_WOW:
2213
2214 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n");
2215
2216 /* Flush all non control pkts in TX path */
2217 ath6kl_tx_data_cleanup(ar);
2218
2219 prev_state = ar->state;
2220
2221 ret = ath6kl_wow_suspend(ar, wow);
2222 if (ret) {
2223 ar->state = prev_state;
2224 return ret;
2225 }
2226
2227 ar->state = ATH6KL_STATE_WOW;
2228 break;
2229
2230 case ATH6KL_CFG_SUSPEND_DEEPSLEEP:
2231
2232 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n");
2233
2234 ret = ath6kl_cfg80211_deepsleep_suspend(ar);
2235 if (ret) {
2236 ath6kl_err("deepsleep suspend failed: %d\n", ret);
2237 return ret;
2238 }
2239
2240 ar->state = ATH6KL_STATE_DEEPSLEEP;
2241
2242 break;
2243
2244 case ATH6KL_CFG_SUSPEND_CUTPOWER:
2245
2246 ath6kl_cfg80211_stop_all(ar);
2247
2248 if (ar->state == ATH6KL_STATE_OFF) {
2249 ath6kl_dbg(ATH6KL_DBG_SUSPEND,
2250 "suspend hw off, no action for cutpower\n");
2251 break;
2252 }
2253
2254 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n");
2255
2256 ret = ath6kl_init_hw_stop(ar);
2257 if (ret) {
2258 ath6kl_warn("failed to stop hw during suspend: %d\n",
2259 ret);
2260 }
2261
2262 ar->state = ATH6KL_STATE_CUTPOWER;
2263
2264 break;
2265
2266 case ATH6KL_CFG_SUSPEND_SCHED_SCAN:
2267 /*
2268 * Nothing needed for schedule scan, firmware is already in
2269 * wow mode and sleeping most of the time.
2270 */
2271 break;
2272
2273 default:
2274 break;
2275 }
2276
2277 return 0;
2278 }
2279 EXPORT_SYMBOL(ath6kl_cfg80211_suspend);
2280
2281 int ath6kl_cfg80211_resume(struct ath6kl *ar)
2282 {
2283 int ret;
2284
2285 switch (ar->state) {
2286 case ATH6KL_STATE_WOW:
2287 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n");
2288
2289 ret = ath6kl_wow_resume(ar);
2290 if (ret) {
2291 ath6kl_warn("wow mode resume failed: %d\n", ret);
2292 return ret;
2293 }
2294
2295 break;
2296
2297 case ATH6KL_STATE_DEEPSLEEP:
2298 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n");
2299
2300 ret = ath6kl_cfg80211_deepsleep_resume(ar);
2301 if (ret) {
2302 ath6kl_warn("deep sleep resume failed: %d\n", ret);
2303 return ret;
2304 }
2305 break;
2306
2307 case ATH6KL_STATE_CUTPOWER:
2308 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n");
2309
2310 ret = ath6kl_init_hw_start(ar);
2311 if (ret) {
2312 ath6kl_warn("Failed to boot hw in resume: %d\n", ret);
2313 return ret;
2314 }
2315 break;
2316
2317 case ATH6KL_STATE_SCHED_SCAN:
2318 break;
2319
2320 default:
2321 break;
2322 }
2323
2324 return 0;
2325 }
2326 EXPORT_SYMBOL(ath6kl_cfg80211_resume);
2327
2328 #ifdef CONFIG_PM
2329
2330 /* hif layer decides what suspend mode to use */
2331 static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy,
2332 struct cfg80211_wowlan *wow)
2333 {
2334 struct ath6kl *ar = wiphy_priv(wiphy);
2335
2336 return ath6kl_hif_suspend(ar, wow);
2337 }
2338
2339 static int __ath6kl_cfg80211_resume(struct wiphy *wiphy)
2340 {
2341 struct ath6kl *ar = wiphy_priv(wiphy);
2342
2343 return ath6kl_hif_resume(ar);
2344 }
2345
2346 /*
2347 * FIXME: WOW suspend mode is selected if the host sdio controller supports
2348 * both sdio irq wake up and keep power. The target pulls sdio data line to
2349 * wake up the host when WOW pattern matches. This causes sdio irq handler
2350 * is being called in the host side which internally hits ath6kl's RX path.
2351 *
2352 * Since sdio interrupt is not disabled, RX path executes even before
2353 * the host executes the actual resume operation from PM module.
2354 *
2355 * In the current scenario, WOW resume should happen before start processing
2356 * any data from the target. So It's required to perform WOW resume in RX path.
2357 * Ideally we should perform WOW resume only in the actual platform
2358 * resume path. This area needs bit rework to avoid WOW resume in RX path.
2359 *
2360 * ath6kl_check_wow_status() is called from ath6kl_rx().
2361 */
2362 void ath6kl_check_wow_status(struct ath6kl *ar)
2363 {
2364 if (ar->state == ATH6KL_STATE_SUSPENDING)
2365 return;
2366
2367 if (ar->state == ATH6KL_STATE_WOW)
2368 ath6kl_cfg80211_resume(ar);
2369 }
2370
2371 #else
2372
2373 void ath6kl_check_wow_status(struct ath6kl *ar)
2374 {
2375 }
2376 #endif
2377
2378 static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev,
2379 struct ieee80211_channel *chan,
2380 enum nl80211_channel_type channel_type)
2381 {
2382 struct ath6kl_vif *vif;
2383
2384 /*
2385 * 'dev' could be NULL if a channel change is required for the hardware
2386 * device itself, instead of a particular VIF.
2387 *
2388 * FIXME: To be handled properly when monitor mode is supported.
2389 */
2390 if (!dev)
2391 return -EBUSY;
2392
2393 vif = netdev_priv(dev);
2394
2395 if (!ath6kl_cfg80211_ready(vif))
2396 return -EIO;
2397
2398 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n",
2399 __func__, chan->center_freq, chan->hw_value);
2400 vif->next_chan = chan->center_freq;
2401
2402 return 0;
2403 }
2404
2405 static bool ath6kl_is_p2p_ie(const u8 *pos)
2406 {
2407 return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
2408 pos[2] == 0x50 && pos[3] == 0x6f &&
2409 pos[4] == 0x9a && pos[5] == 0x09;
2410 }
2411
2412 static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif,
2413 const u8 *ies, size_t ies_len)
2414 {
2415 struct ath6kl *ar = vif->ar;
2416 const u8 *pos;
2417 u8 *buf = NULL;
2418 size_t len = 0;
2419 int ret;
2420
2421 /*
2422 * Filter out P2P IE(s) since they will be included depending on
2423 * the Probe Request frame in ath6kl_send_go_probe_resp().
2424 */
2425
2426 if (ies && ies_len) {
2427 buf = kmalloc(ies_len, GFP_KERNEL);
2428 if (buf == NULL)
2429 return -ENOMEM;
2430 pos = ies;
2431 while (pos + 1 < ies + ies_len) {
2432 if (pos + 2 + pos[1] > ies + ies_len)
2433 break;
2434 if (!ath6kl_is_p2p_ie(pos)) {
2435 memcpy(buf + len, pos, 2 + pos[1]);
2436 len += 2 + pos[1];
2437 }
2438 pos += 2 + pos[1];
2439 }
2440 }
2441
2442 ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
2443 WMI_FRAME_PROBE_RESP, buf, len);
2444 kfree(buf);
2445 return ret;
2446 }
2447
2448 static int ath6kl_set_ies(struct ath6kl_vif *vif,
2449 struct cfg80211_beacon_data *info)
2450 {
2451 struct ath6kl *ar = vif->ar;
2452 int res;
2453
2454 /* this also clears IE in fw if it's not set */
2455 res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
2456 WMI_FRAME_BEACON,
2457 info->beacon_ies,
2458 info->beacon_ies_len);
2459 if (res)
2460 return res;
2461
2462 /* this also clears IE in fw if it's not set */
2463 res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies,
2464 info->proberesp_ies_len);
2465 if (res)
2466 return res;
2467
2468 /* this also clears IE in fw if it's not set */
2469 res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
2470 WMI_FRAME_ASSOC_RESP,
2471 info->assocresp_ies,
2472 info->assocresp_ies_len);
2473 if (res)
2474 return res;
2475
2476 return 0;
2477 }
2478
2479 static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev,
2480 struct cfg80211_ap_settings *info)
2481 {
2482 struct ath6kl *ar = ath6kl_priv(dev);
2483 struct ath6kl_vif *vif = netdev_priv(dev);
2484 struct ieee80211_mgmt *mgmt;
2485 bool hidden = false;
2486 u8 *ies;
2487 int ies_len;
2488 struct wmi_connect_cmd p;
2489 int res;
2490 int i, ret;
2491
2492 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__);
2493
2494 if (!ath6kl_cfg80211_ready(vif))
2495 return -EIO;
2496
2497 if (vif->next_mode != AP_NETWORK)
2498 return -EOPNOTSUPP;
2499
2500 res = ath6kl_set_ies(vif, &info->beacon);
2501
2502 ar->ap_mode_bkey.valid = false;
2503
2504 /* TODO:
2505 * info->interval
2506 * info->dtim_period
2507 */
2508
2509 if (info->beacon.head == NULL)
2510 return -EINVAL;
2511 mgmt = (struct ieee80211_mgmt *) info->beacon.head;
2512 ies = mgmt->u.beacon.variable;
2513 if (ies > info->beacon.head + info->beacon.head_len)
2514 return -EINVAL;
2515 ies_len = info->beacon.head + info->beacon.head_len - ies;
2516
2517 if (info->ssid == NULL)
2518 return -EINVAL;
2519 memcpy(vif->ssid, info->ssid, info->ssid_len);
2520 vif->ssid_len = info->ssid_len;
2521 if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE)
2522 hidden = true;
2523
2524 res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden);
2525 if (res)
2526 return res;
2527
2528 ret = ath6kl_set_auth_type(vif, info->auth_type);
2529 if (ret)
2530 return ret;
2531
2532 memset(&p, 0, sizeof(p));
2533
2534 for (i = 0; i < info->crypto.n_akm_suites; i++) {
2535 switch (info->crypto.akm_suites[i]) {
2536 case WLAN_AKM_SUITE_8021X:
2537 if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1)
2538 p.auth_mode |= WPA_AUTH;
2539 if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2)
2540 p.auth_mode |= WPA2_AUTH;
2541 break;
2542 case WLAN_AKM_SUITE_PSK:
2543 if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1)
2544 p.auth_mode |= WPA_PSK_AUTH;
2545 if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2)
2546 p.auth_mode |= WPA2_PSK_AUTH;
2547 break;
2548 }
2549 }
2550 if (p.auth_mode == 0)
2551 p.auth_mode = NONE_AUTH;
2552 vif->auth_mode = p.auth_mode;
2553
2554 for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) {
2555 switch (info->crypto.ciphers_pairwise[i]) {
2556 case WLAN_CIPHER_SUITE_WEP40:
2557 case WLAN_CIPHER_SUITE_WEP104:
2558 p.prwise_crypto_type |= WEP_CRYPT;
2559 break;
2560 case WLAN_CIPHER_SUITE_TKIP:
2561 p.prwise_crypto_type |= TKIP_CRYPT;
2562 break;
2563 case WLAN_CIPHER_SUITE_CCMP:
2564 p.prwise_crypto_type |= AES_CRYPT;
2565 break;
2566 case WLAN_CIPHER_SUITE_SMS4:
2567 p.prwise_crypto_type |= WAPI_CRYPT;
2568 break;
2569 }
2570 }
2571 if (p.prwise_crypto_type == 0) {
2572 p.prwise_crypto_type = NONE_CRYPT;
2573 ath6kl_set_cipher(vif, 0, true);
2574 } else if (info->crypto.n_ciphers_pairwise == 1)
2575 ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true);
2576
2577 switch (info->crypto.cipher_group) {
2578 case WLAN_CIPHER_SUITE_WEP40:
2579 case WLAN_CIPHER_SUITE_WEP104:
2580 p.grp_crypto_type = WEP_CRYPT;
2581 break;
2582 case WLAN_CIPHER_SUITE_TKIP:
2583 p.grp_crypto_type = TKIP_CRYPT;
2584 break;
2585 case WLAN_CIPHER_SUITE_CCMP:
2586 p.grp_crypto_type = AES_CRYPT;
2587 break;
2588 case WLAN_CIPHER_SUITE_SMS4:
2589 p.grp_crypto_type = WAPI_CRYPT;
2590 break;
2591 default:
2592 p.grp_crypto_type = NONE_CRYPT;
2593 break;
2594 }
2595 ath6kl_set_cipher(vif, info->crypto.cipher_group, false);
2596
2597 p.nw_type = AP_NETWORK;
2598 vif->nw_type = vif->next_mode;
2599
2600 p.ssid_len = vif->ssid_len;
2601 memcpy(p.ssid, vif->ssid, vif->ssid_len);
2602 p.dot11_auth_mode = vif->dot11_auth_mode;
2603 p.ch = cpu_to_le16(vif->next_chan);
2604
2605 /* Enable uAPSD support by default */
2606 res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true);
2607 if (res < 0)
2608 return res;
2609
2610 if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) {
2611 p.nw_subtype = SUBTYPE_P2PGO;
2612 } else {
2613 /*
2614 * Due to firmware limitation, it is not possible to
2615 * do P2P mgmt operations in AP mode
2616 */
2617 p.nw_subtype = SUBTYPE_NONE;
2618 }
2619
2620 res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p);
2621 if (res < 0)
2622 return res;
2623
2624 return 0;
2625 }
2626
2627 static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev,
2628 struct cfg80211_beacon_data *beacon)
2629 {
2630 struct ath6kl_vif *vif = netdev_priv(dev);
2631
2632 if (!ath6kl_cfg80211_ready(vif))
2633 return -EIO;
2634
2635 if (vif->next_mode != AP_NETWORK)
2636 return -EOPNOTSUPP;
2637
2638 return ath6kl_set_ies(vif, beacon);
2639 }
2640
2641 static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev)
2642 {
2643 struct ath6kl *ar = ath6kl_priv(dev);
2644 struct ath6kl_vif *vif = netdev_priv(dev);
2645
2646 if (vif->nw_type != AP_NETWORK)
2647 return -EOPNOTSUPP;
2648 if (!test_bit(CONNECTED, &vif->flags))
2649 return -ENOTCONN;
2650
2651 ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx);
2652 clear_bit(CONNECTED, &vif->flags);
2653
2654 return 0;
2655 }
2656
2657 static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
2658
2659 static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev,
2660 u8 *mac)
2661 {
2662 struct ath6kl *ar = ath6kl_priv(dev);
2663 struct ath6kl_vif *vif = netdev_priv(dev);
2664 const u8 *addr = mac ? mac : bcast_addr;
2665
2666 return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH,
2667 addr, WLAN_REASON_PREV_AUTH_NOT_VALID);
2668 }
2669
2670 static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev,
2671 u8 *mac, struct station_parameters *params)
2672 {
2673 struct ath6kl *ar = ath6kl_priv(dev);
2674 struct ath6kl_vif *vif = netdev_priv(dev);
2675
2676 if (vif->nw_type != AP_NETWORK)
2677 return -EOPNOTSUPP;
2678
2679 /* Use this only for authorizing/unauthorizing a station */
2680 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
2681 return -EOPNOTSUPP;
2682
2683 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED))
2684 return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx,
2685 WMI_AP_MLME_AUTHORIZE, mac, 0);
2686 return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx,
2687 WMI_AP_MLME_UNAUTHORIZE, mac, 0);
2688 }
2689
2690 static int ath6kl_remain_on_channel(struct wiphy *wiphy,
2691 struct net_device *dev,
2692 struct ieee80211_channel *chan,
2693 enum nl80211_channel_type channel_type,
2694 unsigned int duration,
2695 u64 *cookie)
2696 {
2697 struct ath6kl *ar = ath6kl_priv(dev);
2698 struct ath6kl_vif *vif = netdev_priv(dev);
2699 u32 id;
2700
2701 /* TODO: if already pending or ongoing remain-on-channel,
2702 * return -EBUSY */
2703 id = ++vif->last_roc_id;
2704 if (id == 0) {
2705 /* Do not use 0 as the cookie value */
2706 id = ++vif->last_roc_id;
2707 }
2708 *cookie = id;
2709
2710 return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx,
2711 chan->center_freq, duration);
2712 }
2713
2714 static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy,
2715 struct net_device *dev,
2716 u64 cookie)
2717 {
2718 struct ath6kl *ar = ath6kl_priv(dev);
2719 struct ath6kl_vif *vif = netdev_priv(dev);
2720
2721 if (cookie != vif->last_roc_id)
2722 return -ENOENT;
2723 vif->last_cancel_roc_id = cookie;
2724
2725 return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx);
2726 }
2727
2728 static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif,
2729 const u8 *buf, size_t len,
2730 unsigned int freq)
2731 {
2732 struct ath6kl *ar = vif->ar;
2733 const u8 *pos;
2734 u8 *p2p;
2735 int p2p_len;
2736 int ret;
2737 const struct ieee80211_mgmt *mgmt;
2738
2739 mgmt = (const struct ieee80211_mgmt *) buf;
2740
2741 /* Include P2P IE(s) from the frame generated in user space. */
2742
2743 p2p = kmalloc(len, GFP_KERNEL);
2744 if (p2p == NULL)
2745 return -ENOMEM;
2746 p2p_len = 0;
2747
2748 pos = mgmt->u.probe_resp.variable;
2749 while (pos + 1 < buf + len) {
2750 if (pos + 2 + pos[1] > buf + len)
2751 break;
2752 if (ath6kl_is_p2p_ie(pos)) {
2753 memcpy(p2p + p2p_len, pos, 2 + pos[1]);
2754 p2p_len += 2 + pos[1];
2755 }
2756 pos += 2 + pos[1];
2757 }
2758
2759 ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq,
2760 mgmt->da, p2p, p2p_len);
2761 kfree(p2p);
2762 return ret;
2763 }
2764
2765 static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif,
2766 u32 id,
2767 u32 freq,
2768 u32 wait,
2769 const u8 *buf,
2770 size_t len,
2771 bool *more_data,
2772 bool no_cck)
2773 {
2774 struct ieee80211_mgmt *mgmt;
2775 struct ath6kl_sta *conn;
2776 bool is_psq_empty = false;
2777 struct ath6kl_mgmt_buff *mgmt_buf;
2778 size_t mgmt_buf_size;
2779 struct ath6kl *ar = vif->ar;
2780
2781 mgmt = (struct ieee80211_mgmt *) buf;
2782 if (is_multicast_ether_addr(mgmt->da))
2783 return false;
2784
2785 conn = ath6kl_find_sta(vif, mgmt->da);
2786 if (!conn)
2787 return false;
2788
2789 if (conn->sta_flags & STA_PS_SLEEP) {
2790 if (!(conn->sta_flags & STA_PS_POLLED)) {
2791 /* Queue the frames if the STA is sleeping */
2792 mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff);
2793 mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL);
2794 if (!mgmt_buf)
2795 return false;
2796
2797 INIT_LIST_HEAD(&mgmt_buf->list);
2798 mgmt_buf->id = id;
2799 mgmt_buf->freq = freq;
2800 mgmt_buf->wait = wait;
2801 mgmt_buf->len = len;
2802 mgmt_buf->no_cck = no_cck;
2803 memcpy(mgmt_buf->buf, buf, len);
2804 spin_lock_bh(&conn->psq_lock);
2805 is_psq_empty = skb_queue_empty(&conn->psq) &&
2806 (conn->mgmt_psq_len == 0);
2807 list_add_tail(&mgmt_buf->list, &conn->mgmt_psq);
2808 conn->mgmt_psq_len++;
2809 spin_unlock_bh(&conn->psq_lock);
2810
2811 /*
2812 * If this is the first pkt getting queued
2813 * for this STA, update the PVB for this
2814 * STA.
2815 */
2816 if (is_psq_empty)
2817 ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx,
2818 conn->aid, 1);
2819 return true;
2820 }
2821
2822 /*
2823 * This tx is because of a PsPoll.
2824 * Determine if MoreData bit has to be set.
2825 */
2826 spin_lock_bh(&conn->psq_lock);
2827 if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0))
2828 *more_data = true;
2829 spin_unlock_bh(&conn->psq_lock);
2830 }
2831
2832 return false;
2833 }
2834
2835 /* Check if SSID length is greater than DIRECT- */
2836 static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len)
2837 {
2838 const struct ieee80211_mgmt *mgmt;
2839 mgmt = (const struct ieee80211_mgmt *) buf;
2840
2841 /* variable[1] contains the SSID tag length */
2842 if (buf + len >= &mgmt->u.probe_resp.variable[1] &&
2843 (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) {
2844 return true;
2845 }
2846
2847 return false;
2848 }
2849
2850 static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev,
2851 struct ieee80211_channel *chan, bool offchan,
2852 enum nl80211_channel_type channel_type,
2853 bool channel_type_valid, unsigned int wait,
2854 const u8 *buf, size_t len, bool no_cck,
2855 bool dont_wait_for_ack, u64 *cookie)
2856 {
2857 struct ath6kl *ar = ath6kl_priv(dev);
2858 struct ath6kl_vif *vif = netdev_priv(dev);
2859 u32 id;
2860 const struct ieee80211_mgmt *mgmt;
2861 bool more_data, queued;
2862
2863 mgmt = (const struct ieee80211_mgmt *) buf;
2864 if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) &&
2865 ieee80211_is_probe_resp(mgmt->frame_control) &&
2866 ath6kl_is_p2p_go_ssid(buf, len)) {
2867 /*
2868 * Send Probe Response frame in GO mode using a separate WMI
2869 * command to allow the target to fill in the generic IEs.
2870 */
2871 *cookie = 0; /* TX status not supported */
2872 return ath6kl_send_go_probe_resp(vif, buf, len,
2873 chan->center_freq);
2874 }
2875
2876 id = vif->send_action_id++;
2877 if (id == 0) {
2878 /*
2879 * 0 is a reserved value in the WMI command and shall not be
2880 * used for the command.
2881 */
2882 id = vif->send_action_id++;
2883 }
2884
2885 *cookie = id;
2886
2887 /* AP mode Power saving processing */
2888 if (vif->nw_type == AP_NETWORK) {
2889 queued = ath6kl_mgmt_powersave_ap(vif,
2890 id, chan->center_freq,
2891 wait, buf,
2892 len, &more_data, no_cck);
2893 if (queued)
2894 return 0;
2895 }
2896
2897 return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id,
2898 chan->center_freq, wait,
2899 buf, len, no_cck);
2900 }
2901
2902 static void ath6kl_mgmt_frame_register(struct wiphy *wiphy,
2903 struct net_device *dev,
2904 u16 frame_type, bool reg)
2905 {
2906 struct ath6kl_vif *vif = netdev_priv(dev);
2907
2908 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n",
2909 __func__, frame_type, reg);
2910 if (frame_type == IEEE80211_STYPE_PROBE_REQ) {
2911 /*
2912 * Note: This notification callback is not allowed to sleep, so
2913 * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we
2914 * hardcode target to report Probe Request frames all the time.
2915 */
2916 vif->probe_req_report = reg;
2917 }
2918 }
2919
2920 static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy,
2921 struct net_device *dev,
2922 struct cfg80211_sched_scan_request *request)
2923 {
2924 struct ath6kl *ar = ath6kl_priv(dev);
2925 struct ath6kl_vif *vif = netdev_priv(dev);
2926 u16 interval;
2927 int ret;
2928 u8 i;
2929
2930 if (ar->state != ATH6KL_STATE_ON)
2931 return -EIO;
2932
2933 if (vif->sme_state != SME_DISCONNECTED)
2934 return -EBUSY;
2935
2936 ath6kl_cfg80211_scan_complete_event(vif, true);
2937
2938 for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) {
2939 ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
2940 i, DISABLE_SSID_FLAG,
2941 0, NULL);
2942 }
2943
2944 /* fw uses seconds, also make sure that it's >0 */
2945 interval = max_t(u16, 1, request->interval / 1000);
2946
2947 ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx,
2948 interval, interval,
2949 10, 0, 0, 0, 3, 0, 0, 0);
2950
2951 if (request->n_ssids && request->ssids[0].ssid_len) {
2952 for (i = 0; i < request->n_ssids; i++) {
2953 ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
2954 i, SPECIFIC_SSID_FLAG,
2955 request->ssids[i].ssid_len,
2956 request->ssids[i].ssid);
2957 }
2958 }
2959
2960 ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx,
2961 ATH6KL_WOW_MODE_ENABLE,
2962 WOW_FILTER_SSID,
2963 WOW_HOST_REQ_DELAY);
2964 if (ret) {
2965 ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret);
2966 return ret;
2967 }
2968
2969 /* this also clears IE in fw if it's not set */
2970 ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
2971 WMI_FRAME_PROBE_REQ,
2972 request->ie, request->ie_len);
2973 if (ret) {
2974 ath6kl_warn("Failed to set probe request IE for scheduled scan: %d",
2975 ret);
2976 return ret;
2977 }
2978
2979 ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
2980 ATH6KL_HOST_MODE_ASLEEP);
2981 if (ret) {
2982 ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n",
2983 ret);
2984 return ret;
2985 }
2986
2987 ar->state = ATH6KL_STATE_SCHED_SCAN;
2988
2989 return ret;
2990 }
2991
2992 static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy,
2993 struct net_device *dev)
2994 {
2995 struct ath6kl_vif *vif = netdev_priv(dev);
2996 bool stopped;
2997
2998 stopped = __ath6kl_cfg80211_sscan_stop(vif);
2999
3000 if (!stopped)
3001 return -EIO;
3002
3003 return 0;
3004 }
3005
3006 static const struct ieee80211_txrx_stypes
3007 ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = {
3008 [NL80211_IFTYPE_STATION] = {
3009 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3010 BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
3011 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3012 BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
3013 },
3014 [NL80211_IFTYPE_AP] = {
3015 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3016 BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
3017 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3018 BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
3019 },
3020 [NL80211_IFTYPE_P2P_CLIENT] = {
3021 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3022 BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
3023 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3024 BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
3025 },
3026 [NL80211_IFTYPE_P2P_GO] = {
3027 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3028 BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
3029 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3030 BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
3031 },
3032 };
3033
3034 static struct cfg80211_ops ath6kl_cfg80211_ops = {
3035 .add_virtual_intf = ath6kl_cfg80211_add_iface,
3036 .del_virtual_intf = ath6kl_cfg80211_del_iface,
3037 .change_virtual_intf = ath6kl_cfg80211_change_iface,
3038 .scan = ath6kl_cfg80211_scan,
3039 .connect = ath6kl_cfg80211_connect,
3040 .disconnect = ath6kl_cfg80211_disconnect,
3041 .add_key = ath6kl_cfg80211_add_key,
3042 .get_key = ath6kl_cfg80211_get_key,
3043 .del_key = ath6kl_cfg80211_del_key,
3044 .set_default_key = ath6kl_cfg80211_set_default_key,
3045 .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params,
3046 .set_tx_power = ath6kl_cfg80211_set_txpower,
3047 .get_tx_power = ath6kl_cfg80211_get_txpower,
3048 .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt,
3049 .join_ibss = ath6kl_cfg80211_join_ibss,
3050 .leave_ibss = ath6kl_cfg80211_leave_ibss,
3051 .get_station = ath6kl_get_station,
3052 .set_pmksa = ath6kl_set_pmksa,
3053 .del_pmksa = ath6kl_del_pmksa,
3054 .flush_pmksa = ath6kl_flush_pmksa,
3055 CFG80211_TESTMODE_CMD(ath6kl_tm_cmd)
3056 #ifdef CONFIG_PM
3057 .suspend = __ath6kl_cfg80211_suspend,
3058 .resume = __ath6kl_cfg80211_resume,
3059 #endif
3060 .set_channel = ath6kl_set_channel,
3061 .start_ap = ath6kl_start_ap,
3062 .change_beacon = ath6kl_change_beacon,
3063 .stop_ap = ath6kl_stop_ap,
3064 .del_station = ath6kl_del_station,
3065 .change_station = ath6kl_change_station,
3066 .remain_on_channel = ath6kl_remain_on_channel,
3067 .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel,
3068 .mgmt_tx = ath6kl_mgmt_tx,
3069 .mgmt_frame_register = ath6kl_mgmt_frame_register,
3070 .sched_scan_start = ath6kl_cfg80211_sscan_start,
3071 .sched_scan_stop = ath6kl_cfg80211_sscan_stop,
3072 };
3073
3074 void ath6kl_cfg80211_stop(struct ath6kl_vif *vif)
3075 {
3076 ath6kl_cfg80211_sscan_disable(vif);
3077
3078 switch (vif->sme_state) {
3079 case SME_DISCONNECTED:
3080 break;
3081 case SME_CONNECTING:
3082 cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0,
3083 NULL, 0,
3084 WLAN_STATUS_UNSPECIFIED_FAILURE,
3085 GFP_KERNEL);
3086 break;
3087 case SME_CONNECTED:
3088 cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL);
3089 break;
3090 }
3091
3092 if (test_bit(CONNECTED, &vif->flags) ||
3093 test_bit(CONNECT_PEND, &vif->flags))
3094 ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx);
3095
3096 vif->sme_state = SME_DISCONNECTED;
3097 clear_bit(CONNECTED, &vif->flags);
3098 clear_bit(CONNECT_PEND, &vif->flags);
3099
3100 /* disable scanning */
3101 if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF,
3102 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0)
3103 ath6kl_warn("failed to disable scan during stop\n");
3104
3105 ath6kl_cfg80211_scan_complete_event(vif, true);
3106 }
3107
3108 void ath6kl_cfg80211_stop_all(struct ath6kl *ar)
3109 {
3110 struct ath6kl_vif *vif;
3111
3112 vif = ath6kl_vif_first(ar);
3113 if (!vif) {
3114 /* save the current power mode before enabling power save */
3115 ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode;
3116
3117 if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0)
3118 ath6kl_warn("ath6kl_deep_sleep_enable: "
3119 "wmi_powermode_cmd failed\n");
3120 return;
3121 }
3122
3123 /*
3124 * FIXME: we should take ar->list_lock to protect changes in the
3125 * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop()
3126 * sleeps.
3127 */
3128 list_for_each_entry(vif, &ar->vif_list, list)
3129 ath6kl_cfg80211_stop(vif);
3130 }
3131
3132 static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif)
3133 {
3134 vif->aggr_cntxt = aggr_init(vif);
3135 if (!vif->aggr_cntxt) {
3136 ath6kl_err("failed to initialize aggr\n");
3137 return -ENOMEM;
3138 }
3139
3140 setup_timer(&vif->disconnect_timer, disconnect_timer_handler,
3141 (unsigned long) vif->ndev);
3142 setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer,
3143 (unsigned long) vif);
3144
3145 set_bit(WMM_ENABLED, &vif->flags);
3146 spin_lock_init(&vif->if_lock);
3147
3148 INIT_LIST_HEAD(&vif->mc_filter);
3149
3150 return 0;
3151 }
3152
3153 void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif)
3154 {
3155 struct ath6kl *ar = vif->ar;
3156 struct ath6kl_mc_filter *mc_filter, *tmp;
3157
3158 aggr_module_destroy(vif->aggr_cntxt);
3159
3160 ar->avail_idx_map |= BIT(vif->fw_vif_idx);
3161
3162 if (vif->nw_type == ADHOC_NETWORK)
3163 ar->ibss_if_active = false;
3164
3165 list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) {
3166 list_del(&mc_filter->list);
3167 kfree(mc_filter);
3168 }
3169
3170 unregister_netdevice(vif->ndev);
3171
3172 ar->num_vif--;
3173 }
3174
3175 struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name,
3176 enum nl80211_iftype type, u8 fw_vif_idx,
3177 u8 nw_type)
3178 {
3179 struct net_device *ndev;
3180 struct ath6kl_vif *vif;
3181
3182 ndev = alloc_netdev(sizeof(*vif), name, ether_setup);
3183 if (!ndev)
3184 return NULL;
3185
3186 vif = netdev_priv(ndev);
3187 ndev->ieee80211_ptr = &vif->wdev;
3188 vif->wdev.wiphy = ar->wiphy;
3189 vif->ar = ar;
3190 vif->ndev = ndev;
3191 SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy));
3192 vif->wdev.netdev = ndev;
3193 vif->wdev.iftype = type;
3194 vif->fw_vif_idx = fw_vif_idx;
3195 vif->nw_type = nw_type;
3196 vif->next_mode = nw_type;
3197 vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL;
3198 vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME;
3199
3200 memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN);
3201 if (fw_vif_idx != 0)
3202 ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) |
3203 0x2;
3204
3205 init_netdev(ndev);
3206
3207 ath6kl_init_control_info(vif);
3208
3209 if (ath6kl_cfg80211_vif_init(vif))
3210 goto err;
3211
3212 if (register_netdevice(ndev))
3213 goto err;
3214
3215 ar->avail_idx_map &= ~BIT(fw_vif_idx);
3216 vif->sme_state = SME_DISCONNECTED;
3217 set_bit(WLAN_ENABLED, &vif->flags);
3218 ar->wlan_pwr_state = WLAN_POWER_STATE_ON;
3219 set_bit(NETDEV_REGISTERED, &vif->flags);
3220
3221 if (type == NL80211_IFTYPE_ADHOC)
3222 ar->ibss_if_active = true;
3223
3224 spin_lock_bh(&ar->list_lock);
3225 list_add_tail(&vif->list, &ar->vif_list);
3226 spin_unlock_bh(&ar->list_lock);
3227
3228 return ndev;
3229
3230 err:
3231 aggr_module_destroy(vif->aggr_cntxt);
3232 free_netdev(ndev);
3233 return NULL;
3234 }
3235
3236 int ath6kl_cfg80211_init(struct ath6kl *ar)
3237 {
3238 struct wiphy *wiphy = ar->wiphy;
3239 int ret;
3240
3241 wiphy->mgmt_stypes = ath6kl_mgmt_stypes;
3242
3243 wiphy->max_remain_on_channel_duration = 5000;
3244
3245 /* set device pointer for wiphy */
3246 set_wiphy_dev(wiphy, ar->dev);
3247
3248 wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
3249 BIT(NL80211_IFTYPE_ADHOC) |
3250 BIT(NL80211_IFTYPE_AP);
3251 if (ar->p2p) {
3252 wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) |
3253 BIT(NL80211_IFTYPE_P2P_CLIENT);
3254 }
3255
3256 /* max num of ssids that can be probed during scanning */
3257 wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX;
3258 wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */
3259 wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz;
3260 wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz;
3261 wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
3262
3263 wiphy->cipher_suites = cipher_suites;
3264 wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
3265
3266 wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT |
3267 WIPHY_WOWLAN_DISCONNECT |
3268 WIPHY_WOWLAN_GTK_REKEY_FAILURE |
3269 WIPHY_WOWLAN_SUPPORTS_GTK_REKEY |
3270 WIPHY_WOWLAN_EAP_IDENTITY_REQ |
3271 WIPHY_WOWLAN_4WAY_HANDSHAKE;
3272 wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST;
3273 wiphy->wowlan.pattern_min_len = 1;
3274 wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE;
3275
3276 wiphy->max_sched_scan_ssids = 10;
3277
3278 ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM |
3279 WIPHY_FLAG_HAVE_AP_SME |
3280 WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL |
3281 WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD;
3282
3283 if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities))
3284 ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN;
3285
3286 ar->wiphy->probe_resp_offload =
3287 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS |
3288 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 |
3289 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P |
3290 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_80211U;
3291
3292 ret = wiphy_register(wiphy);
3293 if (ret < 0) {
3294 ath6kl_err("couldn't register wiphy device\n");
3295 return ret;
3296 }
3297
3298 ar->wiphy_registered = true;
3299
3300 return 0;
3301 }
3302
3303 void ath6kl_cfg80211_cleanup(struct ath6kl *ar)
3304 {
3305 wiphy_unregister(ar->wiphy);
3306
3307 ar->wiphy_registered = false;
3308 }
3309
3310 struct ath6kl *ath6kl_cfg80211_create(void)
3311 {
3312 struct ath6kl *ar;
3313 struct wiphy *wiphy;
3314
3315 /* create a new wiphy for use with cfg80211 */
3316 wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl));
3317
3318 if (!wiphy) {
3319 ath6kl_err("couldn't allocate wiphy device\n");
3320 return NULL;
3321 }
3322
3323 ar = wiphy_priv(wiphy);
3324 ar->wiphy = wiphy;
3325
3326 return ar;
3327 }
3328
3329 /* Note: ar variable must not be accessed after calling this! */
3330 void ath6kl_cfg80211_destroy(struct ath6kl *ar)
3331 {
3332 int i;
3333
3334 for (i = 0; i < AP_MAX_NUM_STA; i++)
3335 kfree(ar->sta_list[i].aggr_conn);
3336
3337 wiphy_free(ar->wiphy);
3338 }
3339
Linux kernel - Deliverables
This page took 0.105275 seconds and 6 git commands to generate.