1bdcd8170SKalle Valo /*
2bdcd8170SKalle Valo  * Copyright (c) 2004-2011 Atheros Communications Inc.
31b2df407SVasanthakumar Thiagarajan  * Copyright (c) 2011-2012 Qualcomm Atheros, Inc.
4bdcd8170SKalle Valo  *
5bdcd8170SKalle Valo  * Permission to use, copy, modify, and/or distribute this software for any
6bdcd8170SKalle Valo  * purpose with or without fee is hereby granted, provided that the above
7bdcd8170SKalle Valo  * copyright notice and this permission notice appear in all copies.
8bdcd8170SKalle Valo  *
9bdcd8170SKalle Valo  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10bdcd8170SKalle Valo  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11bdcd8170SKalle Valo  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12bdcd8170SKalle Valo  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13bdcd8170SKalle Valo  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14bdcd8170SKalle Valo  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15bdcd8170SKalle Valo  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
16bdcd8170SKalle Valo  */
17bdcd8170SKalle Valo 
18516304b0SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19516304b0SJoe Perches 
206eb07cafSPaul Gortmaker #include <linux/moduleparam.h>
21c08631c6SRaja Mani #include <linux/inetdevice.h>
22d6a434d6SKalle Valo #include <linux/export.h>
23174cd4b1SIngo Molnar #include <linux/sched/signal.h>
246eb07cafSPaul Gortmaker 
25bdcd8170SKalle Valo #include "core.h"
26bdcd8170SKalle Valo #include "cfg80211.h"
27bdcd8170SKalle Valo #include "debug.h"
28abcb344bSKalle Valo #include "hif-ops.h"
29003353b0SKalle Valo #include "testmode.h"
30bdcd8170SKalle Valo 
31bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) {   \
32bdcd8170SKalle Valo 	.bitrate    = (_rate),                  \
33bdcd8170SKalle Valo 	.flags      = (_flags),                 \
34bdcd8170SKalle Valo 	.hw_value   = (_rateid),                \
35bdcd8170SKalle Valo }
36bdcd8170SKalle Valo 
37bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) {   \
3857fbcce3SJohannes Berg 	.band           = NL80211_BAND_2GHZ,  \
39bdcd8170SKalle Valo 	.hw_value       = (_channel),           \
40bdcd8170SKalle Valo 	.center_freq    = (_freq),              \
41bdcd8170SKalle Valo 	.flags          = (_flags),             \
42bdcd8170SKalle Valo 	.max_antenna_gain   = 0,                \
43bdcd8170SKalle Valo 	.max_power      = 30,                   \
44bdcd8170SKalle Valo }
45bdcd8170SKalle Valo 
46bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) {		    \
4757fbcce3SJohannes Berg 	.band           = NL80211_BAND_5GHZ,      \
48bdcd8170SKalle Valo 	.hw_value       = (_channel),               \
49bdcd8170SKalle Valo 	.center_freq    = 5000 + (5 * (_channel)),  \
50bdcd8170SKalle Valo 	.flags          = (_flags),                 \
51bdcd8170SKalle Valo 	.max_antenna_gain   = 0,                    \
52bdcd8170SKalle Valo 	.max_power      = 30,                       \
53bdcd8170SKalle Valo }
54bdcd8170SKalle Valo 
55f599359cSBala Shanmugam #define DEFAULT_BG_SCAN_PERIOD 60
56f599359cSBala Shanmugam 
57dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid {
58dd45b759SNaveen Singh 	struct cfg80211_ssid ssid;
59dd45b759SNaveen Singh 	u8 flag;
60dd45b759SNaveen Singh };
61dd45b759SNaveen Singh 
62bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = {
63bdcd8170SKalle Valo 	RATETAB_ENT(10, 0x1, 0),
64bdcd8170SKalle Valo 	RATETAB_ENT(20, 0x2, 0),
65bdcd8170SKalle Valo 	RATETAB_ENT(55, 0x4, 0),
66bdcd8170SKalle Valo 	RATETAB_ENT(110, 0x8, 0),
67bdcd8170SKalle Valo 	RATETAB_ENT(60, 0x10, 0),
68bdcd8170SKalle Valo 	RATETAB_ENT(90, 0x20, 0),
69bdcd8170SKalle Valo 	RATETAB_ENT(120, 0x40, 0),
70bdcd8170SKalle Valo 	RATETAB_ENT(180, 0x80, 0),
71bdcd8170SKalle Valo 	RATETAB_ENT(240, 0x100, 0),
72bdcd8170SKalle Valo 	RATETAB_ENT(360, 0x200, 0),
73bdcd8170SKalle Valo 	RATETAB_ENT(480, 0x400, 0),
74bdcd8170SKalle Valo 	RATETAB_ENT(540, 0x800, 0),
75bdcd8170SKalle Valo };
76bdcd8170SKalle Valo 
77bdcd8170SKalle Valo #define ath6kl_a_rates     (ath6kl_rates + 4)
78bdcd8170SKalle Valo #define ath6kl_a_rates_size    8
79bdcd8170SKalle Valo #define ath6kl_g_rates     (ath6kl_rates + 0)
80bdcd8170SKalle Valo #define ath6kl_g_rates_size    12
81bdcd8170SKalle Valo 
82bed56e31SVasanthakumar Thiagarajan #define ath6kl_g_htcap IEEE80211_HT_CAP_SGI_20
83bed56e31SVasanthakumar Thiagarajan #define ath6kl_a_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \
84faaf1929SVasanthakumar Thiagarajan 			IEEE80211_HT_CAP_SGI_20		 | \
85faaf1929SVasanthakumar Thiagarajan 			IEEE80211_HT_CAP_SGI_40)
86faaf1929SVasanthakumar Thiagarajan 
87bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = {
88bdcd8170SKalle Valo 	CHAN2G(1, 2412, 0),
89bdcd8170SKalle Valo 	CHAN2G(2, 2417, 0),
90bdcd8170SKalle Valo 	CHAN2G(3, 2422, 0),
91bdcd8170SKalle Valo 	CHAN2G(4, 2427, 0),
92bdcd8170SKalle Valo 	CHAN2G(5, 2432, 0),
93bdcd8170SKalle Valo 	CHAN2G(6, 2437, 0),
94bdcd8170SKalle Valo 	CHAN2G(7, 2442, 0),
95bdcd8170SKalle Valo 	CHAN2G(8, 2447, 0),
96bdcd8170SKalle Valo 	CHAN2G(9, 2452, 0),
97bdcd8170SKalle Valo 	CHAN2G(10, 2457, 0),
98bdcd8170SKalle Valo 	CHAN2G(11, 2462, 0),
99bdcd8170SKalle Valo 	CHAN2G(12, 2467, 0),
100bdcd8170SKalle Valo 	CHAN2G(13, 2472, 0),
101bdcd8170SKalle Valo 	CHAN2G(14, 2484, 0),
102bdcd8170SKalle Valo };
103bdcd8170SKalle Valo 
104bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = {
105b51040fcSRostyslav Khudolii 	CHAN5G(36, 0), CHAN5G(40, 0),
106b51040fcSRostyslav Khudolii 	CHAN5G(44, 0), CHAN5G(48, 0),
107bdcd8170SKalle Valo 	CHAN5G(52, 0), CHAN5G(56, 0),
108bdcd8170SKalle Valo 	CHAN5G(60, 0), CHAN5G(64, 0),
109bdcd8170SKalle Valo 	CHAN5G(100, 0), CHAN5G(104, 0),
110bdcd8170SKalle Valo 	CHAN5G(108, 0), CHAN5G(112, 0),
111bdcd8170SKalle Valo 	CHAN5G(116, 0), CHAN5G(120, 0),
112bdcd8170SKalle Valo 	CHAN5G(124, 0), CHAN5G(128, 0),
113bdcd8170SKalle Valo 	CHAN5G(132, 0), CHAN5G(136, 0),
114bdcd8170SKalle Valo 	CHAN5G(140, 0), CHAN5G(149, 0),
115bdcd8170SKalle Valo 	CHAN5G(153, 0), CHAN5G(157, 0),
116bdcd8170SKalle Valo 	CHAN5G(161, 0), CHAN5G(165, 0),
117bdcd8170SKalle Valo 	CHAN5G(184, 0), CHAN5G(188, 0),
118bdcd8170SKalle Valo 	CHAN5G(192, 0), CHAN5G(196, 0),
119bdcd8170SKalle Valo 	CHAN5G(200, 0), CHAN5G(204, 0),
120bdcd8170SKalle Valo 	CHAN5G(208, 0), CHAN5G(212, 0),
121bdcd8170SKalle Valo 	CHAN5G(216, 0),
122bdcd8170SKalle Valo };
123bdcd8170SKalle Valo 
124bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = {
125bdcd8170SKalle Valo 	.n_channels = ARRAY_SIZE(ath6kl_2ghz_channels),
126bdcd8170SKalle Valo 	.channels = ath6kl_2ghz_channels,
127bdcd8170SKalle Valo 	.n_bitrates = ath6kl_g_rates_size,
128bdcd8170SKalle Valo 	.bitrates = ath6kl_g_rates,
129faaf1929SVasanthakumar Thiagarajan 	.ht_cap.cap = ath6kl_g_htcap,
130faaf1929SVasanthakumar Thiagarajan 	.ht_cap.ht_supported = true,
131bdcd8170SKalle Valo };
132bdcd8170SKalle Valo 
133bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = {
134bdcd8170SKalle Valo 	.n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels),
135bdcd8170SKalle Valo 	.channels = ath6kl_5ghz_a_channels,
136bdcd8170SKalle Valo 	.n_bitrates = ath6kl_a_rates_size,
137bdcd8170SKalle Valo 	.bitrates = ath6kl_a_rates,
138bed56e31SVasanthakumar Thiagarajan 	.ht_cap.cap = ath6kl_a_htcap,
139faaf1929SVasanthakumar Thiagarajan 	.ht_cap.ht_supported = true,
140bdcd8170SKalle Valo };
141bdcd8170SKalle Valo 
142837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */
143837cb97eSJouni Malinen 
14410509f90SKalle Valo /* returns true if scheduled scan was stopped */
14510509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif)
14610509f90SKalle Valo {
14710509f90SKalle Valo 	struct ath6kl *ar = vif->ar;
14810509f90SKalle Valo 
149b1f47e3aSThomas Pedersen 	if (!test_and_clear_bit(SCHED_SCANNING, &vif->flags))
15010509f90SKalle Valo 		return false;
15110509f90SKalle Valo 
15210509f90SKalle Valo 	del_timer_sync(&vif->sched_scan_timer);
15310509f90SKalle Valo 
15458109df6SVasanthakumar Thiagarajan 	if (ar->state == ATH6KL_STATE_RECOVERY)
15558109df6SVasanthakumar Thiagarajan 		return true;
15610509f90SKalle Valo 
157b1f47e3aSThomas Pedersen 	ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, false);
15810509f90SKalle Valo 
15910509f90SKalle Valo 	return true;
16010509f90SKalle Valo }
16110509f90SKalle Valo 
16210509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif)
16310509f90SKalle Valo {
16410509f90SKalle Valo 	struct ath6kl *ar = vif->ar;
16510509f90SKalle Valo 	bool stopped;
16610509f90SKalle Valo 
16710509f90SKalle Valo 	stopped = __ath6kl_cfg80211_sscan_stop(vif);
16810509f90SKalle Valo 
16910509f90SKalle Valo 	if (!stopped)
17010509f90SKalle Valo 		return;
17110509f90SKalle Valo 
17210509f90SKalle Valo 	cfg80211_sched_scan_stopped(ar->wiphy);
17310509f90SKalle Valo }
17410509f90SKalle Valo 
175240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif,
176bdcd8170SKalle Valo 				  enum nl80211_wpa_versions wpa_version)
177bdcd8170SKalle Valo {
178bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version);
179bdcd8170SKalle Valo 
180bdcd8170SKalle Valo 	if (!wpa_version) {
1813450334fSVasanthakumar Thiagarajan 		vif->auth_mode = NONE_AUTH;
182bdcd8170SKalle Valo 	} else if (wpa_version & NL80211_WPA_VERSION_2) {
1833450334fSVasanthakumar Thiagarajan 		vif->auth_mode = WPA2_AUTH;
184bdcd8170SKalle Valo 	} else if (wpa_version & NL80211_WPA_VERSION_1) {
1853450334fSVasanthakumar Thiagarajan 		vif->auth_mode = WPA_AUTH;
186bdcd8170SKalle Valo 	} else {
187bdcd8170SKalle Valo 		ath6kl_err("%s: %u not supported\n", __func__, wpa_version);
188bdcd8170SKalle Valo 		return -ENOTSUPP;
189bdcd8170SKalle Valo 	}
190bdcd8170SKalle Valo 
191bdcd8170SKalle Valo 	return 0;
192bdcd8170SKalle Valo }
193bdcd8170SKalle Valo 
194240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif,
195bdcd8170SKalle Valo 				enum nl80211_auth_type auth_type)
196bdcd8170SKalle Valo {
197bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type);
198bdcd8170SKalle Valo 
199bdcd8170SKalle Valo 	switch (auth_type) {
200bdcd8170SKalle Valo 	case NL80211_AUTHTYPE_OPEN_SYSTEM:
2013450334fSVasanthakumar Thiagarajan 		vif->dot11_auth_mode = OPEN_AUTH;
202bdcd8170SKalle Valo 		break;
203bdcd8170SKalle Valo 	case NL80211_AUTHTYPE_SHARED_KEY:
2043450334fSVasanthakumar Thiagarajan 		vif->dot11_auth_mode = SHARED_AUTH;
205bdcd8170SKalle Valo 		break;
206bdcd8170SKalle Valo 	case NL80211_AUTHTYPE_NETWORK_EAP:
2073450334fSVasanthakumar Thiagarajan 		vif->dot11_auth_mode = LEAP_AUTH;
208bdcd8170SKalle Valo 		break;
209bdcd8170SKalle Valo 
210bdcd8170SKalle Valo 	case NL80211_AUTHTYPE_AUTOMATIC:
2113450334fSVasanthakumar Thiagarajan 		vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH;
212bdcd8170SKalle Valo 		break;
213bdcd8170SKalle Valo 
214bdcd8170SKalle Valo 	default:
2153c325fbdSMasanari Iida 		ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type);
216bdcd8170SKalle Valo 		return -ENOTSUPP;
217bdcd8170SKalle Valo 	}
218bdcd8170SKalle Valo 
219bdcd8170SKalle Valo 	return 0;
220bdcd8170SKalle Valo }
221bdcd8170SKalle Valo 
222240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast)
223bdcd8170SKalle Valo {
2243450334fSVasanthakumar Thiagarajan 	u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto;
2253450334fSVasanthakumar Thiagarajan 	u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len :
2263450334fSVasanthakumar Thiagarajan 		&vif->grp_crypto_len;
227bdcd8170SKalle Valo 
228bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n",
229bdcd8170SKalle Valo 		   __func__, cipher, ucast);
230bdcd8170SKalle Valo 
231bdcd8170SKalle Valo 	switch (cipher) {
232bdcd8170SKalle Valo 	case 0:
233bdcd8170SKalle Valo 		/* our own hack to use value 0 as no crypto used */
234bdcd8170SKalle Valo 		*ar_cipher = NONE_CRYPT;
235bdcd8170SKalle Valo 		*ar_cipher_len = 0;
236bdcd8170SKalle Valo 		break;
237bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_WEP40:
238bdcd8170SKalle Valo 		*ar_cipher = WEP_CRYPT;
239bdcd8170SKalle Valo 		*ar_cipher_len = 5;
240bdcd8170SKalle Valo 		break;
241bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_WEP104:
242bdcd8170SKalle Valo 		*ar_cipher = WEP_CRYPT;
243bdcd8170SKalle Valo 		*ar_cipher_len = 13;
244bdcd8170SKalle Valo 		break;
245bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_TKIP:
246bdcd8170SKalle Valo 		*ar_cipher = TKIP_CRYPT;
247bdcd8170SKalle Valo 		*ar_cipher_len = 0;
248bdcd8170SKalle Valo 		break;
249bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_CCMP:
250bdcd8170SKalle Valo 		*ar_cipher = AES_CRYPT;
251bdcd8170SKalle Valo 		*ar_cipher_len = 0;
252bdcd8170SKalle Valo 		break;
2535e07021eSDai Shuibing 	case WLAN_CIPHER_SUITE_SMS4:
2545e07021eSDai Shuibing 		*ar_cipher = WAPI_CRYPT;
2555e07021eSDai Shuibing 		*ar_cipher_len = 0;
2565e07021eSDai Shuibing 		break;
257bdcd8170SKalle Valo 	default:
258bdcd8170SKalle Valo 		ath6kl_err("cipher 0x%x not supported\n", cipher);
259bdcd8170SKalle Valo 		return -ENOTSUPP;
260bdcd8170SKalle Valo 	}
261bdcd8170SKalle Valo 
262bdcd8170SKalle Valo 	return 0;
263bdcd8170SKalle Valo }
264bdcd8170SKalle Valo 
265240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt)
266bdcd8170SKalle Valo {
267bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt);
268bdcd8170SKalle Valo 
269bdcd8170SKalle Valo 	if (key_mgmt == WLAN_AKM_SUITE_PSK) {
2703450334fSVasanthakumar Thiagarajan 		if (vif->auth_mode == WPA_AUTH)
2713450334fSVasanthakumar Thiagarajan 			vif->auth_mode = WPA_PSK_AUTH;
2723450334fSVasanthakumar Thiagarajan 		else if (vif->auth_mode == WPA2_AUTH)
2733450334fSVasanthakumar Thiagarajan 			vif->auth_mode = WPA2_PSK_AUTH;
274837cb97eSJouni Malinen 	} else if (key_mgmt == 0x00409600) {
2753450334fSVasanthakumar Thiagarajan 		if (vif->auth_mode == WPA_AUTH)
2763450334fSVasanthakumar Thiagarajan 			vif->auth_mode = WPA_AUTH_CCKM;
2773450334fSVasanthakumar Thiagarajan 		else if (vif->auth_mode == WPA2_AUTH)
2783450334fSVasanthakumar Thiagarajan 			vif->auth_mode = WPA2_AUTH_CCKM;
279bdcd8170SKalle Valo 	} else if (key_mgmt != WLAN_AKM_SUITE_8021X) {
2803450334fSVasanthakumar Thiagarajan 		vif->auth_mode = NONE_AUTH;
281bdcd8170SKalle Valo 	}
282bdcd8170SKalle Valo }
283bdcd8170SKalle Valo 
284990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif)
285bdcd8170SKalle Valo {
286990bd915SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
28759c98449SVasanthakumar Thiagarajan 
288bdcd8170SKalle Valo 	if (!test_bit(WMI_READY, &ar->flag)) {
289bdcd8170SKalle Valo 		ath6kl_err("wmi is not ready\n");
290bdcd8170SKalle Valo 		return false;
291bdcd8170SKalle Valo 	}
292bdcd8170SKalle Valo 
29359c98449SVasanthakumar Thiagarajan 	if (!test_bit(WLAN_ENABLED, &vif->flags)) {
294bdcd8170SKalle Valo 		ath6kl_err("wlan disabled\n");
295bdcd8170SKalle Valo 		return false;
296bdcd8170SKalle Valo 	}
297bdcd8170SKalle Valo 
298bdcd8170SKalle Valo 	return true;
299bdcd8170SKalle Valo }
300bdcd8170SKalle Valo 
3016981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos)
3026981ffdcSKevin Fang {
30304b2312aSArend van Spriel 	return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
3046981ffdcSKevin Fang 		pos[2] == 0x00 && pos[3] == 0x50 &&
3056981ffdcSKevin Fang 		pos[4] == 0xf2 && pos[5] == 0x01;
3066981ffdcSKevin Fang }
3076981ffdcSKevin Fang 
3086981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos)
3096981ffdcSKevin Fang {
3106981ffdcSKevin Fang 	return pos[0] == WLAN_EID_RSN;
3116981ffdcSKevin Fang }
3126981ffdcSKevin Fang 
31363541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos)
31463541212SAarthi Thiruvengadam {
31563541212SAarthi Thiruvengadam 	return (pos[0] == WLAN_EID_VENDOR_SPECIFIC &&
31663541212SAarthi Thiruvengadam 		pos[1] >= 4 &&
31763541212SAarthi Thiruvengadam 		pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 &&
31863541212SAarthi Thiruvengadam 		pos[5] == 0x04);
31963541212SAarthi Thiruvengadam }
32063541212SAarthi Thiruvengadam 
321334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies,
3226981ffdcSKevin Fang 				    size_t ies_len)
3236981ffdcSKevin Fang {
324334234b5SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
3256981ffdcSKevin Fang 	const u8 *pos;
3266981ffdcSKevin Fang 	u8 *buf = NULL;
3276981ffdcSKevin Fang 	size_t len = 0;
3286981ffdcSKevin Fang 	int ret;
3296981ffdcSKevin Fang 
3306981ffdcSKevin Fang 	/*
33163541212SAarthi Thiruvengadam 	 * Clear previously set flag
33263541212SAarthi Thiruvengadam 	 */
33363541212SAarthi Thiruvengadam 
33463541212SAarthi Thiruvengadam 	ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG;
33563541212SAarthi Thiruvengadam 
33663541212SAarthi Thiruvengadam 	/*
3376981ffdcSKevin Fang 	 * Filter out RSN/WPA IE(s)
3386981ffdcSKevin Fang 	 */
3396981ffdcSKevin Fang 
3406981ffdcSKevin Fang 	if (ies && ies_len) {
3416981ffdcSKevin Fang 		buf = kmalloc(ies_len, GFP_KERNEL);
3426981ffdcSKevin Fang 		if (buf == NULL)
3436981ffdcSKevin Fang 			return -ENOMEM;
3446981ffdcSKevin Fang 		pos = ies;
3456981ffdcSKevin Fang 
3466981ffdcSKevin Fang 		while (pos + 1 < ies + ies_len) {
3476981ffdcSKevin Fang 			if (pos + 2 + pos[1] > ies + ies_len)
3486981ffdcSKevin Fang 				break;
3496981ffdcSKevin Fang 			if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) {
3506981ffdcSKevin Fang 				memcpy(buf + len, pos, 2 + pos[1]);
3516981ffdcSKevin Fang 				len += 2 + pos[1];
3526981ffdcSKevin Fang 			}
35363541212SAarthi Thiruvengadam 
35463541212SAarthi Thiruvengadam 			if (ath6kl_is_wps_ie(pos))
35563541212SAarthi Thiruvengadam 				ar->connect_ctrl_flags |= CONNECT_WPS_FLAG;
35663541212SAarthi Thiruvengadam 
3576981ffdcSKevin Fang 			pos += 2 + pos[1];
3586981ffdcSKevin Fang 		}
3596981ffdcSKevin Fang 	}
3606981ffdcSKevin Fang 
361334234b5SVasanthakumar Thiagarajan 	ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
362334234b5SVasanthakumar Thiagarajan 				       WMI_FRAME_ASSOC_REQ, buf, len);
3636981ffdcSKevin Fang 	kfree(buf);
3646981ffdcSKevin Fang 	return ret;
3656981ffdcSKevin Fang }
3666981ffdcSKevin Fang 
36755055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type)
36855055976SVasanthakumar Thiagarajan {
36955055976SVasanthakumar Thiagarajan 	switch (type) {
37055055976SVasanthakumar Thiagarajan 	case NL80211_IFTYPE_STATION:
37138142644SMohammed Shafi Shajakhan 	case NL80211_IFTYPE_P2P_CLIENT:
37255055976SVasanthakumar Thiagarajan 		*nw_type = INFRA_NETWORK;
37355055976SVasanthakumar Thiagarajan 		break;
37455055976SVasanthakumar Thiagarajan 	case NL80211_IFTYPE_ADHOC:
37555055976SVasanthakumar Thiagarajan 		*nw_type = ADHOC_NETWORK;
37655055976SVasanthakumar Thiagarajan 		break;
37755055976SVasanthakumar Thiagarajan 	case NL80211_IFTYPE_AP:
37855055976SVasanthakumar Thiagarajan 	case NL80211_IFTYPE_P2P_GO:
37955055976SVasanthakumar Thiagarajan 		*nw_type = AP_NETWORK;
38055055976SVasanthakumar Thiagarajan 		break;
38155055976SVasanthakumar Thiagarajan 	default:
38255055976SVasanthakumar Thiagarajan 		ath6kl_err("invalid interface type %u\n", type);
38355055976SVasanthakumar Thiagarajan 		return -ENOTSUPP;
38455055976SVasanthakumar Thiagarajan 	}
38555055976SVasanthakumar Thiagarajan 
38655055976SVasanthakumar Thiagarajan 	return 0;
38755055976SVasanthakumar Thiagarajan }
38855055976SVasanthakumar Thiagarajan 
38955055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type,
39055055976SVasanthakumar Thiagarajan 				   u8 *if_idx, u8 *nw_type)
39155055976SVasanthakumar Thiagarajan {
39255055976SVasanthakumar Thiagarajan 	int i;
39355055976SVasanthakumar Thiagarajan 
39455055976SVasanthakumar Thiagarajan 	if (ath6kl_nliftype_to_drv_iftype(type, nw_type))
39555055976SVasanthakumar Thiagarajan 		return false;
39655055976SVasanthakumar Thiagarajan 
39755055976SVasanthakumar Thiagarajan 	if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) &&
39855055976SVasanthakumar Thiagarajan 				   ar->num_vif))
39955055976SVasanthakumar Thiagarajan 		return false;
40055055976SVasanthakumar Thiagarajan 
40155055976SVasanthakumar Thiagarajan 	if (type == NL80211_IFTYPE_STATION ||
40255055976SVasanthakumar Thiagarajan 	    type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) {
40371f96ee6SKalle Valo 		for (i = 0; i < ar->vif_max; i++) {
4040db96de6SMohammed Shafi Shajakhan 			if ((ar->avail_idx_map) & BIT(i)) {
40555055976SVasanthakumar Thiagarajan 				*if_idx = i;
40655055976SVasanthakumar Thiagarajan 				return true;
40755055976SVasanthakumar Thiagarajan 			}
40855055976SVasanthakumar Thiagarajan 		}
40955055976SVasanthakumar Thiagarajan 	}
41055055976SVasanthakumar Thiagarajan 
4113226f68aSVasanthakumar Thiagarajan 	if (type == NL80211_IFTYPE_P2P_CLIENT ||
4123226f68aSVasanthakumar Thiagarajan 	    type == NL80211_IFTYPE_P2P_GO) {
41371f96ee6SKalle Valo 		for (i = ar->max_norm_iface; i < ar->vif_max; i++) {
4140db96de6SMohammed Shafi Shajakhan 			if ((ar->avail_idx_map) & BIT(i)) {
4153226f68aSVasanthakumar Thiagarajan 				*if_idx = i;
4163226f68aSVasanthakumar Thiagarajan 				return true;
4173226f68aSVasanthakumar Thiagarajan 			}
4183226f68aSVasanthakumar Thiagarajan 		}
4193226f68aSVasanthakumar Thiagarajan 	}
4203226f68aSVasanthakumar Thiagarajan 
42155055976SVasanthakumar Thiagarajan 	return false;
42255055976SVasanthakumar Thiagarajan }
42355055976SVasanthakumar Thiagarajan 
4248c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar)
4258c9bb054SKalle Valo {
4268c9bb054SKalle Valo 	return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0;
4278c9bb054SKalle Valo }
4288c9bb054SKalle Valo 
429355b3a98SMohammed Shafi Shajakhan static void ath6kl_cfg80211_sta_bmiss_enhance(struct ath6kl_vif *vif,
430355b3a98SMohammed Shafi Shajakhan 					      bool enable)
431355b3a98SMohammed Shafi Shajakhan {
432355b3a98SMohammed Shafi Shajakhan 	int err;
433355b3a98SMohammed Shafi Shajakhan 
434355b3a98SMohammed Shafi Shajakhan 	if (WARN_ON(!test_bit(WMI_READY, &vif->ar->flag)))
435355b3a98SMohammed Shafi Shajakhan 		return;
436355b3a98SMohammed Shafi Shajakhan 
437355b3a98SMohammed Shafi Shajakhan 	if (vif->nw_type != INFRA_NETWORK)
438355b3a98SMohammed Shafi Shajakhan 		return;
439355b3a98SMohammed Shafi Shajakhan 
440355b3a98SMohammed Shafi Shajakhan 	if (!test_bit(ATH6KL_FW_CAPABILITY_BMISS_ENHANCE,
441355b3a98SMohammed Shafi Shajakhan 		      vif->ar->fw_capabilities))
442355b3a98SMohammed Shafi Shajakhan 		return;
443355b3a98SMohammed Shafi Shajakhan 
444355b3a98SMohammed Shafi Shajakhan 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s fw bmiss enhance\n",
445355b3a98SMohammed Shafi Shajakhan 		   enable ? "enable" : "disable");
446355b3a98SMohammed Shafi Shajakhan 
447355b3a98SMohammed Shafi Shajakhan 	err = ath6kl_wmi_sta_bmiss_enhance_cmd(vif->ar->wmi,
448355b3a98SMohammed Shafi Shajakhan 					       vif->fw_vif_idx, enable);
449355b3a98SMohammed Shafi Shajakhan 	if (err)
450355b3a98SMohammed Shafi Shajakhan 		ath6kl_err("failed to %s enhanced bmiss detection: %d\n",
451355b3a98SMohammed Shafi Shajakhan 			   enable ? "enable" : "disable", err);
452355b3a98SMohammed Shafi Shajakhan }
4538c9bb054SKalle Valo 
454bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev,
455bdcd8170SKalle Valo 				   struct cfg80211_connect_params *sme)
456bdcd8170SKalle Valo {
457bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
45859c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
459bdcd8170SKalle Valo 	int status;
4603ca9d1fcSAarthi Thiruvengadam 	u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE;
461ce0dc0cfSRaja Mani 	u16 interval;
462bdcd8170SKalle Valo 
46310509f90SKalle Valo 	ath6kl_cfg80211_sscan_disable(vif);
46410509f90SKalle Valo 
46514ee6f6bSVasanthakumar Thiagarajan 	vif->sme_state = SME_CONNECTING;
466bdcd8170SKalle Valo 
467990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
468bdcd8170SKalle Valo 		return -EIO;
469bdcd8170SKalle Valo 
470bdcd8170SKalle Valo 	if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
471bdcd8170SKalle Valo 		ath6kl_err("destroy in progress\n");
472bdcd8170SKalle Valo 		return -EBUSY;
473bdcd8170SKalle Valo 	}
474bdcd8170SKalle Valo 
475bdcd8170SKalle Valo 	if (test_bit(SKIP_SCAN, &ar->flag) &&
476bdcd8170SKalle Valo 	    ((sme->channel && sme->channel->center_freq == 0) ||
477bdcd8170SKalle Valo 	     (sme->bssid && is_zero_ether_addr(sme->bssid)))) {
478bdcd8170SKalle Valo 		ath6kl_err("SkipScan: channel or bssid invalid\n");
479bdcd8170SKalle Valo 		return -EINVAL;
480bdcd8170SKalle Valo 	}
481bdcd8170SKalle Valo 
482bdcd8170SKalle Valo 	if (down_interruptible(&ar->sem)) {
483bdcd8170SKalle Valo 		ath6kl_err("busy, couldn't get access\n");
484bdcd8170SKalle Valo 		return -ERESTARTSYS;
485bdcd8170SKalle Valo 	}
486bdcd8170SKalle Valo 
487bdcd8170SKalle Valo 	if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
488bdcd8170SKalle Valo 		ath6kl_err("busy, destroy in progress\n");
489bdcd8170SKalle Valo 		up(&ar->sem);
490bdcd8170SKalle Valo 		return -EBUSY;
491bdcd8170SKalle Valo 	}
492bdcd8170SKalle Valo 
493bdcd8170SKalle Valo 	if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) {
494bdcd8170SKalle Valo 		/*
495bdcd8170SKalle Valo 		 * sleep until the command queue drains
496bdcd8170SKalle Valo 		 */
497bdcd8170SKalle Valo 		wait_event_interruptible_timeout(ar->event_wq,
4988c9bb054SKalle Valo 						 ath6kl_is_tx_pending(ar),
499bdcd8170SKalle Valo 						 WMI_TIMEOUT);
500bdcd8170SKalle Valo 		if (signal_pending(current)) {
501bdcd8170SKalle Valo 			ath6kl_err("cmd queue drain timeout\n");
502bdcd8170SKalle Valo 			up(&ar->sem);
503bdcd8170SKalle Valo 			return -EINTR;
504bdcd8170SKalle Valo 		}
505bdcd8170SKalle Valo 	}
506bdcd8170SKalle Valo 
507334234b5SVasanthakumar Thiagarajan 	status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len);
508743b4518SDan Carpenter 	if (status) {
509743b4518SDan Carpenter 		up(&ar->sem);
5106981ffdcSKevin Fang 		return status;
511743b4518SDan Carpenter 	}
5126e786cb1SJouni Malinen 
5136e786cb1SJouni Malinen 	if (sme->ie == NULL || sme->ie_len == 0)
514542c519aSRaja Mani 		ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG;
5156981ffdcSKevin Fang 
51659c98449SVasanthakumar Thiagarajan 	if (test_bit(CONNECTED, &vif->flags) &&
5173450334fSVasanthakumar Thiagarajan 	    vif->ssid_len == sme->ssid_len &&
5183450334fSVasanthakumar Thiagarajan 	    !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) {
519cf5333d7SVasanthakumar Thiagarajan 		vif->reconnect_flag = true;
520334234b5SVasanthakumar Thiagarajan 		status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx,
521334234b5SVasanthakumar Thiagarajan 						  vif->req_bssid,
522f74bac54SVasanthakumar Thiagarajan 						  vif->ch_hint);
523bdcd8170SKalle Valo 
524bdcd8170SKalle Valo 		up(&ar->sem);
525bdcd8170SKalle Valo 		if (status) {
526bdcd8170SKalle Valo 			ath6kl_err("wmi_reconnect_cmd failed\n");
527bdcd8170SKalle Valo 			return -EIO;
528bdcd8170SKalle Valo 		}
529bdcd8170SKalle Valo 		return 0;
5303450334fSVasanthakumar Thiagarajan 	} else if (vif->ssid_len == sme->ssid_len &&
5313450334fSVasanthakumar Thiagarajan 		   !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) {
532240d2799SVasanthakumar Thiagarajan 		ath6kl_disconnect(vif);
533bdcd8170SKalle Valo 	}
534bdcd8170SKalle Valo 
5353450334fSVasanthakumar Thiagarajan 	memset(vif->ssid, 0, sizeof(vif->ssid));
5363450334fSVasanthakumar Thiagarajan 	vif->ssid_len = sme->ssid_len;
5373450334fSVasanthakumar Thiagarajan 	memcpy(vif->ssid, sme->ssid, sme->ssid_len);
538bdcd8170SKalle Valo 
539bdcd8170SKalle Valo 	if (sme->channel)
540f74bac54SVasanthakumar Thiagarajan 		vif->ch_hint = sme->channel->center_freq;
541bdcd8170SKalle Valo 
5428c8b65e3SVasanthakumar Thiagarajan 	memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
543bdcd8170SKalle Valo 	if (sme->bssid && !is_broadcast_ether_addr(sme->bssid))
5448c8b65e3SVasanthakumar Thiagarajan 		memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid));
545bdcd8170SKalle Valo 
546240d2799SVasanthakumar Thiagarajan 	ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions);
547bdcd8170SKalle Valo 
548240d2799SVasanthakumar Thiagarajan 	status = ath6kl_set_auth_type(vif, sme->auth_type);
549bdcd8170SKalle Valo 	if (status) {
550bdcd8170SKalle Valo 		up(&ar->sem);
551bdcd8170SKalle Valo 		return status;
552bdcd8170SKalle Valo 	}
553bdcd8170SKalle Valo 
554bdcd8170SKalle Valo 	if (sme->crypto.n_ciphers_pairwise)
555240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true);
556bdcd8170SKalle Valo 	else
557240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, 0, true);
558bdcd8170SKalle Valo 
559240d2799SVasanthakumar Thiagarajan 	ath6kl_set_cipher(vif, sme->crypto.cipher_group, false);
560bdcd8170SKalle Valo 
561bdcd8170SKalle Valo 	if (sme->crypto.n_akm_suites)
562240d2799SVasanthakumar Thiagarajan 		ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]);
563bdcd8170SKalle Valo 
564bdcd8170SKalle Valo 	if ((sme->key_len) &&
5653450334fSVasanthakumar Thiagarajan 	    (vif->auth_mode == NONE_AUTH) &&
5663450334fSVasanthakumar Thiagarajan 	    (vif->prwise_crypto == WEP_CRYPT)) {
567bdcd8170SKalle Valo 		struct ath6kl_key *key = NULL;
568bdcd8170SKalle Valo 
569792ecb33SVivek Natarajan 		if (sme->key_idx > WMI_MAX_KEY_INDEX) {
570bdcd8170SKalle Valo 			ath6kl_err("key index %d out of bounds\n",
571bdcd8170SKalle Valo 				   sme->key_idx);
572bdcd8170SKalle Valo 			up(&ar->sem);
573bdcd8170SKalle Valo 			return -ENOENT;
574bdcd8170SKalle Valo 		}
575bdcd8170SKalle Valo 
5766f2a73f9SVasanthakumar Thiagarajan 		key = &vif->keys[sme->key_idx];
577bdcd8170SKalle Valo 		key->key_len = sme->key_len;
578bdcd8170SKalle Valo 		memcpy(key->key, sme->key, key->key_len);
5793450334fSVasanthakumar Thiagarajan 		key->cipher = vif->prwise_crypto;
5803450334fSVasanthakumar Thiagarajan 		vif->def_txkey_index = sme->key_idx;
581bdcd8170SKalle Valo 
582334234b5SVasanthakumar Thiagarajan 		ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx,
5833450334fSVasanthakumar Thiagarajan 				      vif->prwise_crypto,
584bdcd8170SKalle Valo 				      GROUP_USAGE | TX_USAGE,
585bdcd8170SKalle Valo 				      key->key_len,
586f4bb9a6fSJouni Malinen 				      NULL, 0,
587bdcd8170SKalle Valo 				      key->key, KEY_OP_INIT_VAL, NULL,
588bdcd8170SKalle Valo 				      NO_SYNC_WMIFLAG);
589bdcd8170SKalle Valo 	}
590bdcd8170SKalle Valo 
591bdcd8170SKalle Valo 	if (!ar->usr_bss_filter) {
59259c98449SVasanthakumar Thiagarajan 		clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
593240d2799SVasanthakumar Thiagarajan 		if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
594240d2799SVasanthakumar Thiagarajan 					     ALL_BSS_FILTER, 0) != 0) {
595bdcd8170SKalle Valo 			ath6kl_err("couldn't set bss filtering\n");
596bdcd8170SKalle Valo 			up(&ar->sem);
597bdcd8170SKalle Valo 			return -EIO;
598bdcd8170SKalle Valo 		}
599bdcd8170SKalle Valo 	}
600bdcd8170SKalle Valo 
601f5938f24SVasanthakumar Thiagarajan 	vif->nw_type = vif->next_mode;
602bdcd8170SKalle Valo 
603c422d52dSThomas Pedersen 	/* enable enhanced bmiss detection if applicable */
604c422d52dSThomas Pedersen 	ath6kl_cfg80211_sta_bmiss_enhance(vif, true);
605c422d52dSThomas Pedersen 
6063ca9d1fcSAarthi Thiruvengadam 	if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT)
6073ca9d1fcSAarthi Thiruvengadam 		nw_subtype = SUBTYPE_P2PCLIENT;
6083ca9d1fcSAarthi Thiruvengadam 
609bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
610bdcd8170SKalle Valo 		   "%s: connect called with authmode %d dot11 auth %d"
611bdcd8170SKalle Valo 		   " PW crypto %d PW crypto len %d GRP crypto %d"
612bdcd8170SKalle Valo 		   " GRP crypto len %d channel hint %u\n",
613bdcd8170SKalle Valo 		   __func__,
6143450334fSVasanthakumar Thiagarajan 		   vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto,
6153450334fSVasanthakumar Thiagarajan 		   vif->prwise_crypto_len, vif->grp_crypto,
616f74bac54SVasanthakumar Thiagarajan 		   vif->grp_crypto_len, vif->ch_hint);
617bdcd8170SKalle Valo 
618cf5333d7SVasanthakumar Thiagarajan 	vif->reconnect_flag = 0;
619ce0dc0cfSRaja Mani 
620ce0dc0cfSRaja Mani 	if (vif->nw_type == INFRA_NETWORK) {
621b5283871SKalle Valo 		interval = max_t(u16, vif->listen_intvl_t,
622b5283871SKalle Valo 				 ATH6KL_MAX_WOW_LISTEN_INTL);
623ce0dc0cfSRaja Mani 		status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx,
624ce0dc0cfSRaja Mani 						       interval,
625ce0dc0cfSRaja Mani 						       0);
626ce0dc0cfSRaja Mani 		if (status) {
627ce0dc0cfSRaja Mani 			ath6kl_err("couldn't set listen intervel\n");
628ce0dc0cfSRaja Mani 			up(&ar->sem);
629ce0dc0cfSRaja Mani 			return status;
630ce0dc0cfSRaja Mani 		}
631ce0dc0cfSRaja Mani 	}
632ce0dc0cfSRaja Mani 
633334234b5SVasanthakumar Thiagarajan 	status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type,
6343450334fSVasanthakumar Thiagarajan 					vif->dot11_auth_mode, vif->auth_mode,
6353450334fSVasanthakumar Thiagarajan 					vif->prwise_crypto,
6363450334fSVasanthakumar Thiagarajan 					vif->prwise_crypto_len,
6373450334fSVasanthakumar Thiagarajan 					vif->grp_crypto, vif->grp_crypto_len,
6383450334fSVasanthakumar Thiagarajan 					vif->ssid_len, vif->ssid,
639f74bac54SVasanthakumar Thiagarajan 					vif->req_bssid, vif->ch_hint,
6403ca9d1fcSAarthi Thiruvengadam 					ar->connect_ctrl_flags, nw_subtype);
641bdcd8170SKalle Valo 
6426f7c1adbSMohammed Shafi Shajakhan 	if (sme->bg_scan_period == 0) {
643f599359cSBala Shanmugam 		/* disable background scan if period is 0 */
644f599359cSBala Shanmugam 		sme->bg_scan_period = 0xffff;
6456f7c1adbSMohammed Shafi Shajakhan 	} else if (sme->bg_scan_period == -1) {
646f599359cSBala Shanmugam 		/* configure default value if not specified */
647f599359cSBala Shanmugam 		sme->bg_scan_period = DEFAULT_BG_SCAN_PERIOD;
6486f7c1adbSMohammed Shafi Shajakhan 	}
649f599359cSBala Shanmugam 
650f599359cSBala Shanmugam 	ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0, 0,
651f599359cSBala Shanmugam 				  sme->bg_scan_period, 0, 0, 0, 3, 0, 0, 0);
652f599359cSBala Shanmugam 
653bdcd8170SKalle Valo 	up(&ar->sem);
654bdcd8170SKalle Valo 
655bdcd8170SKalle Valo 	if (status == -EINVAL) {
6563450334fSVasanthakumar Thiagarajan 		memset(vif->ssid, 0, sizeof(vif->ssid));
6573450334fSVasanthakumar Thiagarajan 		vif->ssid_len = 0;
658bdcd8170SKalle Valo 		ath6kl_err("invalid request\n");
659bdcd8170SKalle Valo 		return -ENOENT;
660bdcd8170SKalle Valo 	} else if (status) {
661bdcd8170SKalle Valo 		ath6kl_err("ath6kl_wmi_connect_cmd failed\n");
662bdcd8170SKalle Valo 		return -EIO;
663bdcd8170SKalle Valo 	}
664bdcd8170SKalle Valo 
665bdcd8170SKalle Valo 	if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) &&
666ddc3d77cSKalle Valo 	    ((vif->auth_mode == WPA_PSK_AUTH) ||
667ddc3d77cSKalle Valo 	     (vif->auth_mode == WPA2_PSK_AUTH))) {
668de3ad713SVasanthakumar Thiagarajan 		mod_timer(&vif->disconnect_timer,
669bdcd8170SKalle Valo 			  jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL));
670bdcd8170SKalle Valo 	}
671bdcd8170SKalle Valo 
672bdcd8170SKalle Valo 	ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD;
67359c98449SVasanthakumar Thiagarajan 	set_bit(CONNECT_PEND, &vif->flags);
674bdcd8170SKalle Valo 
675bdcd8170SKalle Valo 	return 0;
676bdcd8170SKalle Valo }
677bdcd8170SKalle Valo 
6785e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss *
6795e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif,
6804eab6f4fSRaja Mani 			 enum network_type nw_type,
6814eab6f4fSRaja Mani 			 const u8 *bssid,
68201cac476SJouni Malinen 			 struct ieee80211_channel *chan,
6835e13fd35SVasanthakumar Thiagarajan 			 const u8 *beacon_ie,
6845e13fd35SVasanthakumar Thiagarajan 			 size_t beacon_ie_len)
68501cac476SJouni Malinen {
686240d2799SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
68701cac476SJouni Malinen 	struct cfg80211_bss *bss;
6886eb18137SDedy Lansky 	u16 cap_val;
6896eb18137SDedy Lansky 	enum ieee80211_bss_type bss_type;
69001cac476SJouni Malinen 	u8 *ie;
69101cac476SJouni Malinen 
6924eab6f4fSRaja Mani 	if (nw_type & ADHOC_NETWORK) {
6934eab6f4fSRaja Mani 		cap_val = WLAN_CAPABILITY_IBSS;
6946eb18137SDedy Lansky 		bss_type = IEEE80211_BSS_TYPE_IBSS;
6954eab6f4fSRaja Mani 	} else {
6964eab6f4fSRaja Mani 		cap_val = WLAN_CAPABILITY_ESS;
6976eb18137SDedy Lansky 		bss_type = IEEE80211_BSS_TYPE_ESS;
6984eab6f4fSRaja Mani 	}
6994eab6f4fSRaja Mani 
700be98e3a4SVasanthakumar Thiagarajan 	bss = cfg80211_get_bss(ar->wiphy, chan, bssid,
7014eab6f4fSRaja Mani 			       vif->ssid, vif->ssid_len,
7026eb18137SDedy Lansky 			       bss_type, IEEE80211_PRIVACY_ANY);
70301cac476SJouni Malinen 	if (bss == NULL) {
70401cac476SJouni Malinen 		/*
70501cac476SJouni Malinen 		 * Since cfg80211 may not yet know about the BSS,
70601cac476SJouni Malinen 		 * generate a partial entry until the first BSS info
70701cac476SJouni Malinen 		 * event becomes available.
70801cac476SJouni Malinen 		 *
70901cac476SJouni Malinen 		 * Prepend SSID element since it is not included in the Beacon
71001cac476SJouni Malinen 		 * IEs from the target.
71101cac476SJouni Malinen 		 */
7123450334fSVasanthakumar Thiagarajan 		ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL);
71301cac476SJouni Malinen 		if (ie == NULL)
7145e13fd35SVasanthakumar Thiagarajan 			return NULL;
71501cac476SJouni Malinen 		ie[0] = WLAN_EID_SSID;
7163450334fSVasanthakumar Thiagarajan 		ie[1] = vif->ssid_len;
7173450334fSVasanthakumar Thiagarajan 		memcpy(ie + 2, vif->ssid, vif->ssid_len);
7183450334fSVasanthakumar Thiagarajan 		memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len);
719be98e3a4SVasanthakumar Thiagarajan 		bss = cfg80211_inform_bss(ar->wiphy, chan,
7205bc8c1f2SJohannes Berg 					  CFG80211_BSS_FTYPE_UNKNOWN,
7214eab6f4fSRaja Mani 					  bssid, 0, cap_val, 100,
7223450334fSVasanthakumar Thiagarajan 					  ie, 2 + vif->ssid_len + beacon_ie_len,
72301cac476SJouni Malinen 					  0, GFP_KERNEL);
72401cac476SJouni Malinen 		if (bss)
725cdeb8602SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
726cdeb8602SKalle Valo 				   "added bss %pM to cfg80211\n", bssid);
72701cac476SJouni Malinen 		kfree(ie);
728a5d8f9dfSKalle Valo 	} else {
7295e13fd35SVasanthakumar Thiagarajan 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n");
730a5d8f9dfSKalle Valo 	}
73101cac476SJouni Malinen 
7325e13fd35SVasanthakumar Thiagarajan 	return bss;
73301cac476SJouni Malinen }
73401cac476SJouni Malinen 
735240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel,
736bdcd8170SKalle Valo 				   u8 *bssid, u16 listen_intvl,
737bdcd8170SKalle Valo 				   u16 beacon_intvl,
738bdcd8170SKalle Valo 				   enum network_type nw_type,
739bdcd8170SKalle Valo 				   u8 beacon_ie_len, u8 assoc_req_len,
740bdcd8170SKalle Valo 				   u8 assoc_resp_len, u8 *assoc_info)
741bdcd8170SKalle Valo {
74201cac476SJouni Malinen 	struct ieee80211_channel *chan;
743240d2799SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
7445e13fd35SVasanthakumar Thiagarajan 	struct cfg80211_bss *bss;
745bdcd8170SKalle Valo 
746bdcd8170SKalle Valo 	/* capinfo + listen interval */
747bdcd8170SKalle Valo 	u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16);
748bdcd8170SKalle Valo 
749bdcd8170SKalle Valo 	/* capinfo + status code +  associd */
750bdcd8170SKalle Valo 	u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16);
751bdcd8170SKalle Valo 
752bdcd8170SKalle Valo 	u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset;
753bdcd8170SKalle Valo 	u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len +
754bdcd8170SKalle Valo 	    assoc_resp_ie_offset;
755bdcd8170SKalle Valo 
756bdcd8170SKalle Valo 	assoc_req_len -= assoc_req_ie_offset;
757bdcd8170SKalle Valo 	assoc_resp_len -= assoc_resp_ie_offset;
758bdcd8170SKalle Valo 
75932c10874SJouni Malinen 	/*
76032c10874SJouni Malinen 	 * Store Beacon interval here; DTIM period will be available only once
76132c10874SJouni Malinen 	 * a Beacon frame from the AP is seen.
76232c10874SJouni Malinen 	 */
763cf5333d7SVasanthakumar Thiagarajan 	vif->assoc_bss_beacon_int = beacon_intvl;
76459c98449SVasanthakumar Thiagarajan 	clear_bit(DTIM_PERIOD_AVAIL, &vif->flags);
76532c10874SJouni Malinen 
766bdcd8170SKalle Valo 	if (nw_type & ADHOC_NETWORK) {
767551959d8SVasanthakumar Thiagarajan 		if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) {
768bdcd8170SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
769bdcd8170SKalle Valo 				   "%s: ath6k not in ibss mode\n", __func__);
770bdcd8170SKalle Valo 			return;
771bdcd8170SKalle Valo 		}
772bdcd8170SKalle Valo 	}
773bdcd8170SKalle Valo 
774bdcd8170SKalle Valo 	if (nw_type & INFRA_NETWORK) {
775551959d8SVasanthakumar Thiagarajan 		if (vif->wdev.iftype != NL80211_IFTYPE_STATION &&
776551959d8SVasanthakumar Thiagarajan 		    vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) {
777bdcd8170SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
778bdcd8170SKalle Valo 				   "%s: ath6k not in station mode\n", __func__);
779bdcd8170SKalle Valo 			return;
780bdcd8170SKalle Valo 		}
781bdcd8170SKalle Valo 	}
782bdcd8170SKalle Valo 
783be98e3a4SVasanthakumar Thiagarajan 	chan = ieee80211_get_channel(ar->wiphy, (int) channel);
784bdcd8170SKalle Valo 
7855e13fd35SVasanthakumar Thiagarajan 	bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan,
7865e13fd35SVasanthakumar Thiagarajan 				       assoc_info, beacon_ie_len);
7875e13fd35SVasanthakumar Thiagarajan 	if (!bss) {
7884eab6f4fSRaja Mani 		ath6kl_err("could not add cfg80211 bss entry\n");
789bdcd8170SKalle Valo 		return;
790bdcd8170SKalle Valo 	}
791bdcd8170SKalle Valo 
7924eab6f4fSRaja Mani 	if (nw_type & ADHOC_NETWORK) {
7934eab6f4fSRaja Mani 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n",
7944eab6f4fSRaja Mani 			   nw_type & ADHOC_CREATOR ? "creator" : "joiner");
795fe94f3a4SAntonio Quartulli 		cfg80211_ibss_joined(vif->ndev, bssid, chan, GFP_KERNEL);
7965b112d3dSJohannes Berg 		cfg80211_put_bss(ar->wiphy, bss);
79701cac476SJouni Malinen 		return;
79801cac476SJouni Malinen 	}
79901cac476SJouni Malinen 
80014ee6f6bSVasanthakumar Thiagarajan 	if (vif->sme_state == SME_CONNECTING) {
801bdcd8170SKalle Valo 		/* inform connect result to cfg80211 */
80214ee6f6bSVasanthakumar Thiagarajan 		vif->sme_state = SME_CONNECTED;
803240d2799SVasanthakumar Thiagarajan 		cfg80211_connect_result(vif->ndev, bssid,
804bdcd8170SKalle Valo 					assoc_req_ie, assoc_req_len,
805bdcd8170SKalle Valo 					assoc_resp_ie, assoc_resp_len,
806bdcd8170SKalle Valo 					WLAN_STATUS_SUCCESS, GFP_KERNEL);
8075b112d3dSJohannes Berg 		cfg80211_put_bss(ar->wiphy, bss);
80814ee6f6bSVasanthakumar Thiagarajan 	} else if (vif->sme_state == SME_CONNECTED) {
809bdcd8170SKalle Valo 		/* inform roam event to cfg80211 */
8105e13fd35SVasanthakumar Thiagarajan 		cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len,
811bdcd8170SKalle Valo 				    assoc_resp_ie, assoc_resp_len, GFP_KERNEL);
812bdcd8170SKalle Valo 	}
813bdcd8170SKalle Valo }
814bdcd8170SKalle Valo 
815bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy,
816bdcd8170SKalle Valo 				      struct net_device *dev, u16 reason_code)
817bdcd8170SKalle Valo {
818d6d5c06cSKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
8193450334fSVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
820bdcd8170SKalle Valo 
821bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__,
822bdcd8170SKalle Valo 		   reason_code);
823bdcd8170SKalle Valo 
82410509f90SKalle Valo 	ath6kl_cfg80211_sscan_disable(vif);
82510509f90SKalle Valo 
826990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
827bdcd8170SKalle Valo 		return -EIO;
828bdcd8170SKalle Valo 
829bdcd8170SKalle Valo 	if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
830bdcd8170SKalle Valo 		ath6kl_err("busy, destroy in progress\n");
831bdcd8170SKalle Valo 		return -EBUSY;
832bdcd8170SKalle Valo 	}
833bdcd8170SKalle Valo 
834bdcd8170SKalle Valo 	if (down_interruptible(&ar->sem)) {
835bdcd8170SKalle Valo 		ath6kl_err("busy, couldn't get access\n");
836bdcd8170SKalle Valo 		return -ERESTARTSYS;
837bdcd8170SKalle Valo 	}
838bdcd8170SKalle Valo 
839cf5333d7SVasanthakumar Thiagarajan 	vif->reconnect_flag = 0;
840240d2799SVasanthakumar Thiagarajan 	ath6kl_disconnect(vif);
8413450334fSVasanthakumar Thiagarajan 	memset(vif->ssid, 0, sizeof(vif->ssid));
8423450334fSVasanthakumar Thiagarajan 	vif->ssid_len = 0;
843bdcd8170SKalle Valo 
844bdcd8170SKalle Valo 	if (!test_bit(SKIP_SCAN, &ar->flag))
8458c8b65e3SVasanthakumar Thiagarajan 		memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
846bdcd8170SKalle Valo 
847bdcd8170SKalle Valo 	up(&ar->sem);
848bdcd8170SKalle Valo 
849bdcd8170SKalle Valo 	return 0;
850bdcd8170SKalle Valo }
851bdcd8170SKalle Valo 
852240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason,
853bdcd8170SKalle Valo 				      u8 *bssid, u8 assoc_resp_len,
854bdcd8170SKalle Valo 				      u8 *assoc_info, u16 proto_reason)
855bdcd8170SKalle Valo {
856240d2799SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
85759c98449SVasanthakumar Thiagarajan 
85814ee6f6bSVasanthakumar Thiagarajan 	if (vif->scan_req) {
8591d76250bSAvraham Stern 		struct cfg80211_scan_info info = {
8601d76250bSAvraham Stern 			.aborted = true,
8611d76250bSAvraham Stern 		};
8621d76250bSAvraham Stern 
8631d76250bSAvraham Stern 		cfg80211_scan_done(vif->scan_req, &info);
86414ee6f6bSVasanthakumar Thiagarajan 		vif->scan_req = NULL;
865bdcd8170SKalle Valo 	}
866bdcd8170SKalle Valo 
867f5938f24SVasanthakumar Thiagarajan 	if (vif->nw_type & ADHOC_NETWORK) {
868fe94f3a4SAntonio Quartulli 		if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC)
869bdcd8170SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
870bdcd8170SKalle Valo 				   "%s: ath6k not in ibss mode\n", __func__);
871bdcd8170SKalle Valo 		return;
872bdcd8170SKalle Valo 	}
873bdcd8170SKalle Valo 
874f5938f24SVasanthakumar Thiagarajan 	if (vif->nw_type & INFRA_NETWORK) {
875551959d8SVasanthakumar Thiagarajan 		if (vif->wdev.iftype != NL80211_IFTYPE_STATION &&
876551959d8SVasanthakumar Thiagarajan 		    vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) {
877bdcd8170SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
878bdcd8170SKalle Valo 				   "%s: ath6k not in station mode\n", __func__);
879bdcd8170SKalle Valo 			return;
880bdcd8170SKalle Valo 		}
881bdcd8170SKalle Valo 	}
882bdcd8170SKalle Valo 
88359c98449SVasanthakumar Thiagarajan 	clear_bit(CONNECT_PEND, &vif->flags);
884bdcd8170SKalle Valo 
88514ee6f6bSVasanthakumar Thiagarajan 	if (vif->sme_state == SME_CONNECTING) {
886240d2799SVasanthakumar Thiagarajan 		cfg80211_connect_result(vif->ndev,
887bdcd8170SKalle Valo 					bssid, NULL, 0,
888bdcd8170SKalle Valo 					NULL, 0,
889bdcd8170SKalle Valo 					WLAN_STATUS_UNSPECIFIED_FAILURE,
890bdcd8170SKalle Valo 					GFP_KERNEL);
89114ee6f6bSVasanthakumar Thiagarajan 	} else if (vif->sme_state == SME_CONNECTED) {
89233a6664aSThomas Pedersen 		cfg80211_disconnected(vif->ndev, proto_reason,
89380279fb7SJohannes Berg 				      NULL, 0, false, GFP_KERNEL);
894bdcd8170SKalle Valo 	}
895bdcd8170SKalle Valo 
89614ee6f6bSVasanthakumar Thiagarajan 	vif->sme_state = SME_DISCONNECTED;
89733a6664aSThomas Pedersen 
89833a6664aSThomas Pedersen 	/*
89933a6664aSThomas Pedersen 	 * Send a disconnect command to target when a disconnect event is
90033a6664aSThomas Pedersen 	 * received with reason code other than 3 (DISCONNECT_CMD - disconnect
90133a6664aSThomas Pedersen 	 * request from host) to make the firmware stop trying to connect even
90233a6664aSThomas Pedersen 	 * after giving disconnect event. There will be one more disconnect
90333a6664aSThomas Pedersen 	 * event for this disconnect command with reason code DISCONNECT_CMD
90433a6664aSThomas Pedersen 	 * which won't be notified to cfg80211.
90533a6664aSThomas Pedersen 	 */
90633a6664aSThomas Pedersen 	if (reason != DISCONNECT_CMD)
90733a6664aSThomas Pedersen 		ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx);
908bdcd8170SKalle Valo }
909bdcd8170SKalle Valo 
9103b8ffc6aSJouni Malinen static int ath6kl_set_probed_ssids(struct ath6kl *ar,
9113b8ffc6aSJouni Malinen 				   struct ath6kl_vif *vif,
912dd45b759SNaveen Singh 				   struct cfg80211_ssid *ssids, int n_ssids,
913dd45b759SNaveen Singh 				   struct cfg80211_match_set *match_set,
914dd45b759SNaveen Singh 				   int n_match_ssid)
9153b8ffc6aSJouni Malinen {
916dd45b759SNaveen Singh 	u8 i, j, index_to_add, ssid_found = false;
917dd45b759SNaveen Singh 	struct ath6kl_cfg80211_match_probe_ssid ssid_list[MAX_PROBED_SSIDS];
9183b8ffc6aSJouni Malinen 
919dd45b759SNaveen Singh 	memset(ssid_list, 0, sizeof(ssid_list));
920dd45b759SNaveen Singh 
921dd45b759SNaveen Singh 	if (n_ssids > MAX_PROBED_SSIDS ||
922dd45b759SNaveen Singh 	    n_match_ssid > MAX_PROBED_SSIDS)
9233b8ffc6aSJouni Malinen 		return -EINVAL;
9243b8ffc6aSJouni Malinen 
9253b8ffc6aSJouni Malinen 	for (i = 0; i < n_ssids; i++) {
926dd45b759SNaveen Singh 		memcpy(ssid_list[i].ssid.ssid,
927dd45b759SNaveen Singh 		       ssids[i].ssid,
928dd45b759SNaveen Singh 		       ssids[i].ssid_len);
929dd45b759SNaveen Singh 		ssid_list[i].ssid.ssid_len = ssids[i].ssid_len;
930dd45b759SNaveen Singh 
931dd45b759SNaveen Singh 		if (ssids[i].ssid_len)
932dd45b759SNaveen Singh 			ssid_list[i].flag = SPECIFIC_SSID_FLAG;
933dd45b759SNaveen Singh 		else
934dd45b759SNaveen Singh 			ssid_list[i].flag = ANY_SSID_FLAG;
935dd45b759SNaveen Singh 
936dd45b759SNaveen Singh 		if (n_match_ssid == 0)
937dd45b759SNaveen Singh 			ssid_list[i].flag |= MATCH_SSID_FLAG;
938dd45b759SNaveen Singh 	}
939dd45b759SNaveen Singh 
940dd45b759SNaveen Singh 	index_to_add = i;
941dd45b759SNaveen Singh 
942dd45b759SNaveen Singh 	for (i = 0; i < n_match_ssid; i++) {
943dd45b759SNaveen Singh 		ssid_found = false;
944dd45b759SNaveen Singh 
945dd45b759SNaveen Singh 		for (j = 0; j < n_ssids; j++) {
946dd45b759SNaveen Singh 			if ((match_set[i].ssid.ssid_len ==
947dd45b759SNaveen Singh 			     ssid_list[j].ssid.ssid_len) &&
948dd45b759SNaveen Singh 			    (!memcmp(ssid_list[j].ssid.ssid,
949dd45b759SNaveen Singh 				     match_set[i].ssid.ssid,
950dd45b759SNaveen Singh 				     match_set[i].ssid.ssid_len))) {
951dd45b759SNaveen Singh 				ssid_list[j].flag |= MATCH_SSID_FLAG;
952dd45b759SNaveen Singh 				ssid_found = true;
953dd45b759SNaveen Singh 				break;
954dd45b759SNaveen Singh 			}
955dd45b759SNaveen Singh 		}
956dd45b759SNaveen Singh 
957dd45b759SNaveen Singh 		if (ssid_found)
958dd45b759SNaveen Singh 			continue;
959dd45b759SNaveen Singh 
960dd45b759SNaveen Singh 		if (index_to_add >= MAX_PROBED_SSIDS)
961dd45b759SNaveen Singh 			continue;
962dd45b759SNaveen Singh 
963dd45b759SNaveen Singh 		ssid_list[index_to_add].ssid.ssid_len =
964dd45b759SNaveen Singh 			match_set[i].ssid.ssid_len;
965dd45b759SNaveen Singh 		memcpy(ssid_list[index_to_add].ssid.ssid,
966dd45b759SNaveen Singh 		       match_set[i].ssid.ssid,
967dd45b759SNaveen Singh 		       match_set[i].ssid.ssid_len);
968dd45b759SNaveen Singh 		ssid_list[index_to_add].flag |= MATCH_SSID_FLAG;
969dd45b759SNaveen Singh 		index_to_add++;
970dd45b759SNaveen Singh 	}
971dd45b759SNaveen Singh 
972dd45b759SNaveen Singh 	for (i = 0; i < index_to_add; i++) {
9733b8ffc6aSJouni Malinen 		ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i,
974dd45b759SNaveen Singh 					  ssid_list[i].flag,
975dd45b759SNaveen Singh 					  ssid_list[i].ssid.ssid_len,
976dd45b759SNaveen Singh 					  ssid_list[i].ssid.ssid);
9773b8ffc6aSJouni Malinen 	}
9783b8ffc6aSJouni Malinen 
9793b8ffc6aSJouni Malinen 	/* Make sure no old entries are left behind */
980dd45b759SNaveen Singh 	for (i = index_to_add; i < MAX_PROBED_SSIDS; i++) {
9813b8ffc6aSJouni Malinen 		ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i,
9823b8ffc6aSJouni Malinen 					  DISABLE_SSID_FLAG, 0, NULL);
9833b8ffc6aSJouni Malinen 	}
9843b8ffc6aSJouni Malinen 
9853b8ffc6aSJouni Malinen 	return 0;
9863b8ffc6aSJouni Malinen }
9873b8ffc6aSJouni Malinen 
988fd014284SJohannes Berg static int ath6kl_cfg80211_scan(struct wiphy *wiphy,
989bdcd8170SKalle Valo 				struct cfg80211_scan_request *request)
990bdcd8170SKalle Valo {
991fd014284SJohannes Berg 	struct ath6kl_vif *vif = ath6kl_vif_from_wdev(request->wdev);
992fd014284SJohannes Berg 	struct ath6kl *ar = ath6kl_priv(vif->ndev);
9931276c9efSEdward Lu 	s8 n_channels = 0;
9941276c9efSEdward Lu 	u16 *channels = NULL;
995bdcd8170SKalle Valo 	int ret = 0;
996f1f92179SVasanthakumar Thiagarajan 	u32 force_fg_scan = 0;
997bdcd8170SKalle Valo 
998990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
999bdcd8170SKalle Valo 		return -EIO;
1000bdcd8170SKalle Valo 
100110509f90SKalle Valo 	ath6kl_cfg80211_sscan_disable(vif);
100210509f90SKalle Valo 
1003bdcd8170SKalle Valo 	if (!ar->usr_bss_filter) {
100459c98449SVasanthakumar Thiagarajan 		clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
1005954e6ce5SVasanthakumar Thiagarajan 		ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
1006954e6ce5SVasanthakumar Thiagarajan 					       ALL_BSS_FILTER, 0);
10071b1e6ee3SJouni Malinen 		if (ret) {
1008bdcd8170SKalle Valo 			ath6kl_err("couldn't set bss filtering\n");
10091b1e6ee3SJouni Malinen 			return ret;
1010bdcd8170SKalle Valo 		}
1011bdcd8170SKalle Valo 	}
1012bdcd8170SKalle Valo 
10133b8ffc6aSJouni Malinen 	ret = ath6kl_set_probed_ssids(ar, vif, request->ssids,
1014dd45b759SNaveen Singh 				      request->n_ssids, NULL, 0);
10153b8ffc6aSJouni Malinen 	if (ret < 0)
10163b8ffc6aSJouni Malinen 		return ret;
1017bdcd8170SKalle Valo 
1018080eec4fSAarthi Thiruvengadam 	/* this also clears IE in fw if it's not set */
1019334234b5SVasanthakumar Thiagarajan 	ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
1020334234b5SVasanthakumar Thiagarajan 				       WMI_FRAME_PROBE_REQ,
1021b84da8c7SJouni Malinen 				       request->ie, request->ie_len);
1022b84da8c7SJouni Malinen 	if (ret) {
1023f1ff32e8SJoe Perches 		ath6kl_err("failed to set Probe Request appie for scan\n");
1024b84da8c7SJouni Malinen 		return ret;
1025b84da8c7SJouni Malinen 	}
1026b84da8c7SJouni Malinen 
102711869befSJouni Malinen 	/*
102811869befSJouni Malinen 	 * Scan only the requested channels if the request specifies a set of
102911869befSJouni Malinen 	 * channels. If the list is longer than the target supports, do not
103011869befSJouni Malinen 	 * configure the list and instead, scan all available channels.
103111869befSJouni Malinen 	 */
103211869befSJouni Malinen 	if (request->n_channels > 0 &&
103311869befSJouni Malinen 	    request->n_channels <= WMI_MAX_CHANNELS) {
10341276c9efSEdward Lu 		u8 i;
10351276c9efSEdward Lu 
103611869befSJouni Malinen 		n_channels = request->n_channels;
10371276c9efSEdward Lu 
10381276c9efSEdward Lu 		channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL);
10391276c9efSEdward Lu 		if (channels == NULL) {
1040cdeb8602SKalle Valo 			ath6kl_warn("failed to set scan channels, scan all channels");
10411276c9efSEdward Lu 			n_channels = 0;
10421276c9efSEdward Lu 		}
10431276c9efSEdward Lu 
10441276c9efSEdward Lu 		for (i = 0; i < n_channels; i++)
10451276c9efSEdward Lu 			channels[i] = request->channels[i]->center_freq;
10461276c9efSEdward Lu 	}
10471276c9efSEdward Lu 
104859c98449SVasanthakumar Thiagarajan 	if (test_bit(CONNECTED, &vif->flags))
1049f1f92179SVasanthakumar Thiagarajan 		force_fg_scan = 1;
1050f1f92179SVasanthakumar Thiagarajan 
10515b35dff0SRaja Mani 	vif->scan_req = request;
10525b35dff0SRaja Mani 
10533ca9d1fcSAarthi Thiruvengadam 	ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx,
10543ca9d1fcSAarthi Thiruvengadam 				       WMI_LONG_SCAN, force_fg_scan,
105513423c31SVasanthakumar Thiagarajan 				       false, 0,
105613423c31SVasanthakumar Thiagarajan 				       ATH6KL_FG_SCAN_INTERVAL,
105713423c31SVasanthakumar Thiagarajan 				       n_channels, channels,
105813423c31SVasanthakumar Thiagarajan 				       request->no_cck,
10593ca9d1fcSAarthi Thiruvengadam 				       request->rates);
10605b35dff0SRaja Mani 	if (ret) {
106111f0bfcfSKalle Valo 		ath6kl_err("failed to start scan: %d\n", ret);
10625b35dff0SRaja Mani 		vif->scan_req = NULL;
10635b35dff0SRaja Mani 	}
1064bdcd8170SKalle Valo 
10651276c9efSEdward Lu 	kfree(channels);
10661276c9efSEdward Lu 
1067bdcd8170SKalle Valo 	return ret;
1068bdcd8170SKalle Valo }
1069bdcd8170SKalle Valo 
10701c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted)
1071bdcd8170SKalle Valo {
1072240d2799SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
10731d76250bSAvraham Stern 	struct cfg80211_scan_info info = {
10741d76250bSAvraham Stern 		.aborted = aborted,
10751d76250bSAvraham Stern 	};
10766fd1eaceSKalle Valo 	int i;
1077bdcd8170SKalle Valo 
10781c17d313SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__,
10791c17d313SKalle Valo 		   aborted ? " aborted" : "");
1080bdcd8170SKalle Valo 
108114ee6f6bSVasanthakumar Thiagarajan 	if (!vif->scan_req)
10826fd1eaceSKalle Valo 		return;
10836fd1eaceSKalle Valo 
10841c17d313SKalle Valo 	if (aborted)
10856fd1eaceSKalle Valo 		goto out;
1086bdcd8170SKalle Valo 
108714ee6f6bSVasanthakumar Thiagarajan 	if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) {
108814ee6f6bSVasanthakumar Thiagarajan 		for (i = 0; i < vif->scan_req->n_ssids; i++) {
1089334234b5SVasanthakumar Thiagarajan 			ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
1090334234b5SVasanthakumar Thiagarajan 						  i + 1, DISABLE_SSID_FLAG,
1091bdcd8170SKalle Valo 						  0, NULL);
1092bdcd8170SKalle Valo 		}
1093bdcd8170SKalle Valo 	}
10946fd1eaceSKalle Valo 
10956fd1eaceSKalle Valo out:
10961d76250bSAvraham Stern 	cfg80211_scan_done(vif->scan_req, &info);
109714ee6f6bSVasanthakumar Thiagarajan 	vif->scan_req = NULL;
1098bdcd8170SKalle Valo }
1099bdcd8170SKalle Valo 
1100c4f7863eSThomas Pedersen void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq,
1101c4f7863eSThomas Pedersen 				      enum wmi_phy_mode mode)
1102c4f7863eSThomas Pedersen {
1103683b6d3bSJohannes Berg 	struct cfg80211_chan_def chandef;
1104c4f7863eSThomas Pedersen 
1105c4f7863eSThomas Pedersen 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1106c4f7863eSThomas Pedersen 		   "channel switch notify nw_type %d freq %d mode %d\n",
1107c4f7863eSThomas Pedersen 		   vif->nw_type, freq, mode);
1108c4f7863eSThomas Pedersen 
11093d9d1d66SJohannes Berg 	cfg80211_chandef_create(&chandef,
11103d9d1d66SJohannes Berg 				ieee80211_get_channel(vif->ar->wiphy, freq),
1111f3651baeSPierre Le Magourou 				(mode == WMI_11G_HT20 &&
1112f3651baeSPierre Le Magourou 				 ath6kl_band_2ghz.ht_cap.ht_supported) ?
11133d9d1d66SJohannes Berg 					NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT);
1114c4f7863eSThomas Pedersen 
1115e487eaebSSimon Wunderlich 	mutex_lock(&vif->wdev.mtx);
1116683b6d3bSJohannes Berg 	cfg80211_ch_switch_notify(vif->ndev, &chandef);
1117e487eaebSSimon Wunderlich 	mutex_unlock(&vif->wdev.mtx);
1118c4f7863eSThomas Pedersen }
1119c4f7863eSThomas Pedersen 
1120bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev,
1121bdcd8170SKalle Valo 				   u8 key_index, bool pairwise,
1122bdcd8170SKalle Valo 				   const u8 *mac_addr,
1123bdcd8170SKalle Valo 				   struct key_params *params)
1124bdcd8170SKalle Valo {
1125d6d5c06cSKalle Valo 	struct ath6kl *ar = ath6kl_priv(ndev);
112659c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
1127bdcd8170SKalle Valo 	struct ath6kl_key *key = NULL;
11284a8ce2fdSSujith Manoharan 	int seq_len;
1129bdcd8170SKalle Valo 	u8 key_usage;
1130bdcd8170SKalle Valo 	u8 key_type;
1131bdcd8170SKalle Valo 
1132990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1133bdcd8170SKalle Valo 		return -EIO;
1134bdcd8170SKalle Valo 
1135837cb97eSJouni Malinen 	if (params->cipher == CCKM_KRK_CIPHER_SUITE) {
1136837cb97eSJouni Malinen 		if (params->key_len != WMI_KRK_LEN)
1137837cb97eSJouni Malinen 			return -EINVAL;
1138240d2799SVasanthakumar Thiagarajan 		return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx,
1139240d2799SVasanthakumar Thiagarajan 					      params->key);
1140837cb97eSJouni Malinen 	}
1141837cb97eSJouni Malinen 
1142792ecb33SVivek Natarajan 	if (key_index > WMI_MAX_KEY_INDEX) {
1143bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1144bdcd8170SKalle Valo 			   "%s: key index %d out of bounds\n", __func__,
1145bdcd8170SKalle Valo 			   key_index);
1146bdcd8170SKalle Valo 		return -ENOENT;
1147bdcd8170SKalle Valo 	}
1148bdcd8170SKalle Valo 
11496f2a73f9SVasanthakumar Thiagarajan 	key = &vif->keys[key_index];
1150bdcd8170SKalle Valo 	memset(key, 0, sizeof(struct ath6kl_key));
1151bdcd8170SKalle Valo 
1152bdcd8170SKalle Valo 	if (pairwise)
1153bdcd8170SKalle Valo 		key_usage = PAIRWISE_USAGE;
1154bdcd8170SKalle Valo 	else
1155bdcd8170SKalle Valo 		key_usage = GROUP_USAGE;
1156bdcd8170SKalle Valo 
11574a8ce2fdSSujith Manoharan 	seq_len = params->seq_len;
11585e07021eSDai Shuibing 	if (params->cipher == WLAN_CIPHER_SUITE_SMS4 &&
11595e07021eSDai Shuibing 	    seq_len > ATH6KL_KEY_SEQ_LEN) {
11605e07021eSDai Shuibing 		/* Only first half of the WPI PN is configured */
11615e07021eSDai Shuibing 		seq_len = ATH6KL_KEY_SEQ_LEN;
11625e07021eSDai Shuibing 	}
1163bdcd8170SKalle Valo 	if (params->key_len > WLAN_MAX_KEY_LEN ||
11645e07021eSDai Shuibing 	    seq_len > sizeof(key->seq))
1165bdcd8170SKalle Valo 		return -EINVAL;
1166bdcd8170SKalle Valo 
1167bdcd8170SKalle Valo 	key->key_len = params->key_len;
1168bdcd8170SKalle Valo 	memcpy(key->key, params->key, key->key_len);
11695e07021eSDai Shuibing 	key->seq_len = seq_len;
1170bdcd8170SKalle Valo 	memcpy(key->seq, params->seq, key->seq_len);
1171bdcd8170SKalle Valo 	key->cipher = params->cipher;
1172bdcd8170SKalle Valo 
1173bdcd8170SKalle Valo 	switch (key->cipher) {
1174bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_WEP40:
1175bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_WEP104:
1176bdcd8170SKalle Valo 		key_type = WEP_CRYPT;
1177bdcd8170SKalle Valo 		break;
1178bdcd8170SKalle Valo 
1179bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_TKIP:
1180bdcd8170SKalle Valo 		key_type = TKIP_CRYPT;
1181bdcd8170SKalle Valo 		break;
1182bdcd8170SKalle Valo 
1183bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_CCMP:
1184bdcd8170SKalle Valo 		key_type = AES_CRYPT;
1185bdcd8170SKalle Valo 		break;
11865e07021eSDai Shuibing 	case WLAN_CIPHER_SUITE_SMS4:
11875e07021eSDai Shuibing 		key_type = WAPI_CRYPT;
11885e07021eSDai Shuibing 		break;
1189bdcd8170SKalle Valo 
1190bdcd8170SKalle Valo 	default:
1191bdcd8170SKalle Valo 		return -ENOTSUPP;
1192bdcd8170SKalle Valo 	}
1193bdcd8170SKalle Valo 
1194ddc3d77cSKalle Valo 	if (((vif->auth_mode == WPA_PSK_AUTH) ||
1195ddc3d77cSKalle Valo 	     (vif->auth_mode == WPA2_PSK_AUTH)) &&
1196ddc3d77cSKalle Valo 	    (key_usage & GROUP_USAGE))
1197de3ad713SVasanthakumar Thiagarajan 		del_timer(&vif->disconnect_timer);
1198bdcd8170SKalle Valo 
1199bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1200bdcd8170SKalle Valo 		   "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n",
1201bdcd8170SKalle Valo 		   __func__, key_index, key->key_len, key_type,
1202bdcd8170SKalle Valo 		   key_usage, key->seq_len);
1203bdcd8170SKalle Valo 
1204f5938f24SVasanthakumar Thiagarajan 	if (vif->nw_type == AP_NETWORK && !pairwise &&
12054703290aSJouni Malinen 	    (key_type == TKIP_CRYPT || key_type == AES_CRYPT ||
1206cc4d623dSVasanthakumar Thiagarajan 	     key_type == WAPI_CRYPT)) {
12079a5b1318SJouni Malinen 		ar->ap_mode_bkey.valid = true;
12089a5b1318SJouni Malinen 		ar->ap_mode_bkey.key_index = key_index;
12099a5b1318SJouni Malinen 		ar->ap_mode_bkey.key_type = key_type;
12109a5b1318SJouni Malinen 		ar->ap_mode_bkey.key_len = key->key_len;
12119a5b1318SJouni Malinen 		memcpy(ar->ap_mode_bkey.key, key->key, key->key_len);
121259c98449SVasanthakumar Thiagarajan 		if (!test_bit(CONNECTED, &vif->flags)) {
1213cdeb8602SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1214cdeb8602SKalle Valo 				   "Delay initial group key configuration until AP mode has been started\n");
12159a5b1318SJouni Malinen 			/*
12169a5b1318SJouni Malinen 			 * The key will be set in ath6kl_connect_ap_mode() once
12179a5b1318SJouni Malinen 			 * the connected event is received from the target.
12189a5b1318SJouni Malinen 			 */
12199a5b1318SJouni Malinen 			return 0;
12209a5b1318SJouni Malinen 		}
12219a5b1318SJouni Malinen 	}
12229a5b1318SJouni Malinen 
1223f5938f24SVasanthakumar Thiagarajan 	if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT &&
122459c98449SVasanthakumar Thiagarajan 	    !test_bit(CONNECTED, &vif->flags)) {
1225151411e8SJouni Malinen 		/*
1226151411e8SJouni Malinen 		 * Store the key locally so that it can be re-configured after
1227151411e8SJouni Malinen 		 * the AP mode has properly started
1228151411e8SJouni Malinen 		 * (ath6kl_install_statioc_wep_keys).
1229151411e8SJouni Malinen 		 */
1230cdeb8602SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1231cdeb8602SKalle Valo 			   "Delay WEP key configuration until AP mode has been started\n");
12326f2a73f9SVasanthakumar Thiagarajan 		vif->wep_key_list[key_index].key_len = key->key_len;
12336f2a73f9SVasanthakumar Thiagarajan 		memcpy(vif->wep_key_list[key_index].key, key->key,
12346f2a73f9SVasanthakumar Thiagarajan 		       key->key_len);
1235151411e8SJouni Malinen 		return 0;
1236151411e8SJouni Malinen 	}
1237151411e8SJouni Malinen 
12387cefa44fSVasanthakumar Thiagarajan 	return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index,
1239bdcd8170SKalle Valo 				     key_type, key_usage, key->key_len,
1240f4bb9a6fSJouni Malinen 				     key->seq, key->seq_len, key->key,
1241f4bb9a6fSJouni Malinen 				     KEY_OP_INIT_VAL,
1242bdcd8170SKalle Valo 				     (u8 *) mac_addr, SYNC_BOTH_WMIFLAG);
1243bdcd8170SKalle Valo }
1244bdcd8170SKalle Valo 
1245bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev,
1246bdcd8170SKalle Valo 				   u8 key_index, bool pairwise,
1247bdcd8170SKalle Valo 				   const u8 *mac_addr)
1248bdcd8170SKalle Valo {
1249d6d5c06cSKalle Valo 	struct ath6kl *ar = ath6kl_priv(ndev);
12506f2a73f9SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
1251bdcd8170SKalle Valo 
1252bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
1253bdcd8170SKalle Valo 
1254990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1255bdcd8170SKalle Valo 		return -EIO;
1256bdcd8170SKalle Valo 
1257792ecb33SVivek Natarajan 	if (key_index > WMI_MAX_KEY_INDEX) {
1258bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1259bdcd8170SKalle Valo 			   "%s: key index %d out of bounds\n", __func__,
1260bdcd8170SKalle Valo 			   key_index);
1261bdcd8170SKalle Valo 		return -ENOENT;
1262bdcd8170SKalle Valo 	}
1263bdcd8170SKalle Valo 
12646f2a73f9SVasanthakumar Thiagarajan 	if (!vif->keys[key_index].key_len) {
1265bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1266bdcd8170SKalle Valo 			   "%s: index %d is empty\n", __func__, key_index);
1267bdcd8170SKalle Valo 		return 0;
1268bdcd8170SKalle Valo 	}
1269bdcd8170SKalle Valo 
12706f2a73f9SVasanthakumar Thiagarajan 	vif->keys[key_index].key_len = 0;
1271bdcd8170SKalle Valo 
1272334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index);
1273bdcd8170SKalle Valo }
1274bdcd8170SKalle Valo 
1275bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev,
1276bdcd8170SKalle Valo 				   u8 key_index, bool pairwise,
1277bdcd8170SKalle Valo 				   const u8 *mac_addr, void *cookie,
1278bdcd8170SKalle Valo 				   void (*callback) (void *cookie,
1279bdcd8170SKalle Valo 						     struct key_params *))
1280bdcd8170SKalle Valo {
12816f2a73f9SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
1282bdcd8170SKalle Valo 	struct ath6kl_key *key = NULL;
1283bdcd8170SKalle Valo 	struct key_params params;
1284bdcd8170SKalle Valo 
1285bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
1286bdcd8170SKalle Valo 
1287990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1288bdcd8170SKalle Valo 		return -EIO;
1289bdcd8170SKalle Valo 
1290792ecb33SVivek Natarajan 	if (key_index > WMI_MAX_KEY_INDEX) {
1291bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1292bdcd8170SKalle Valo 			   "%s: key index %d out of bounds\n", __func__,
1293bdcd8170SKalle Valo 			   key_index);
1294bdcd8170SKalle Valo 		return -ENOENT;
1295bdcd8170SKalle Valo 	}
1296bdcd8170SKalle Valo 
12976f2a73f9SVasanthakumar Thiagarajan 	key = &vif->keys[key_index];
1298bdcd8170SKalle Valo 	memset(&params, 0, sizeof(params));
1299bdcd8170SKalle Valo 	params.cipher = key->cipher;
1300bdcd8170SKalle Valo 	params.key_len = key->key_len;
1301bdcd8170SKalle Valo 	params.seq_len = key->seq_len;
1302bdcd8170SKalle Valo 	params.seq = key->seq;
1303bdcd8170SKalle Valo 	params.key = key->key;
1304bdcd8170SKalle Valo 
1305bdcd8170SKalle Valo 	callback(cookie, &params);
1306bdcd8170SKalle Valo 
1307bdcd8170SKalle Valo 	return key->key_len ? 0 : -ENOENT;
1308bdcd8170SKalle Valo }
1309bdcd8170SKalle Valo 
1310bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy,
1311bdcd8170SKalle Valo 					   struct net_device *ndev,
1312bdcd8170SKalle Valo 					   u8 key_index, bool unicast,
1313bdcd8170SKalle Valo 					   bool multicast)
1314bdcd8170SKalle Valo {
1315d6d5c06cSKalle Valo 	struct ath6kl *ar = ath6kl_priv(ndev);
131659c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
1317bdcd8170SKalle Valo 	struct ath6kl_key *key = NULL;
1318bdcd8170SKalle Valo 	u8 key_usage;
1319229ed6b5SEdward Lu 	enum crypto_type key_type = NONE_CRYPT;
1320bdcd8170SKalle Valo 
1321bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
1322bdcd8170SKalle Valo 
1323990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1324bdcd8170SKalle Valo 		return -EIO;
1325bdcd8170SKalle Valo 
1326792ecb33SVivek Natarajan 	if (key_index > WMI_MAX_KEY_INDEX) {
1327bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1328bdcd8170SKalle Valo 			   "%s: key index %d out of bounds\n",
1329bdcd8170SKalle Valo 			   __func__, key_index);
1330bdcd8170SKalle Valo 		return -ENOENT;
1331bdcd8170SKalle Valo 	}
1332bdcd8170SKalle Valo 
13336f2a73f9SVasanthakumar Thiagarajan 	if (!vif->keys[key_index].key_len) {
1334bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n",
1335bdcd8170SKalle Valo 			   __func__, key_index);
1336bdcd8170SKalle Valo 		return -EINVAL;
1337bdcd8170SKalle Valo 	}
1338bdcd8170SKalle Valo 
13393450334fSVasanthakumar Thiagarajan 	vif->def_txkey_index = key_index;
13406f2a73f9SVasanthakumar Thiagarajan 	key = &vif->keys[vif->def_txkey_index];
1341bdcd8170SKalle Valo 	key_usage = GROUP_USAGE;
13423450334fSVasanthakumar Thiagarajan 	if (vif->prwise_crypto == WEP_CRYPT)
1343bdcd8170SKalle Valo 		key_usage |= TX_USAGE;
1344229ed6b5SEdward Lu 	if (unicast)
13453450334fSVasanthakumar Thiagarajan 		key_type = vif->prwise_crypto;
1346229ed6b5SEdward Lu 	if (multicast)
13473450334fSVasanthakumar Thiagarajan 		key_type = vif->grp_crypto;
1348bdcd8170SKalle Valo 
1349f5938f24SVasanthakumar Thiagarajan 	if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags))
13509a5b1318SJouni Malinen 		return 0; /* Delay until AP mode has been started */
13519a5b1318SJouni Malinen 
1352f3e61eceSJouni Malinen 	return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx,
1353334234b5SVasanthakumar Thiagarajan 				     vif->def_txkey_index,
1354229ed6b5SEdward Lu 				     key_type, key_usage,
1355f4bb9a6fSJouni Malinen 				     key->key_len, key->seq, key->seq_len,
1356f4bb9a6fSJouni Malinen 				     key->key,
1357bdcd8170SKalle Valo 				     KEY_OP_INIT_VAL, NULL,
1358bdcd8170SKalle Valo 				     SYNC_BOTH_WMIFLAG);
1359bdcd8170SKalle Valo }
1360bdcd8170SKalle Valo 
1361240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid,
1362bdcd8170SKalle Valo 				       bool ismcast)
1363bdcd8170SKalle Valo {
1364bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1365bdcd8170SKalle Valo 		   "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast);
1366bdcd8170SKalle Valo 
1367240d2799SVasanthakumar Thiagarajan 	cfg80211_michael_mic_failure(vif->ndev, vif->bssid,
1368bdcd8170SKalle Valo 				     (ismcast ? NL80211_KEYTYPE_GROUP :
1369bdcd8170SKalle Valo 				      NL80211_KEYTYPE_PAIRWISE), keyid, NULL,
1370bdcd8170SKalle Valo 				     GFP_KERNEL);
1371bdcd8170SKalle Valo }
1372bdcd8170SKalle Valo 
1373bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
1374bdcd8170SKalle Valo {
1375bdcd8170SKalle Valo 	struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1376990bd915SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif;
1377bdcd8170SKalle Valo 	int ret;
1378bdcd8170SKalle Valo 
1379bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__,
1380bdcd8170SKalle Valo 		   changed);
1381bdcd8170SKalle Valo 
1382990bd915SVasanthakumar Thiagarajan 	vif = ath6kl_vif_first(ar);
1383990bd915SVasanthakumar Thiagarajan 	if (!vif)
1384990bd915SVasanthakumar Thiagarajan 		return -EIO;
1385990bd915SVasanthakumar Thiagarajan 
1386990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1387bdcd8170SKalle Valo 		return -EIO;
1388bdcd8170SKalle Valo 
1389bdcd8170SKalle Valo 	if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
1390bdcd8170SKalle Valo 		ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold);
1391bdcd8170SKalle Valo 		if (ret != 0) {
1392bdcd8170SKalle Valo 			ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n");
1393bdcd8170SKalle Valo 			return -EIO;
1394bdcd8170SKalle Valo 		}
1395bdcd8170SKalle Valo 	}
1396bdcd8170SKalle Valo 
1397bdcd8170SKalle Valo 	return 0;
1398bdcd8170SKalle Valo }
1399bdcd8170SKalle Valo 
1400bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy,
1401c8442118SJohannes Berg 				       struct wireless_dev *wdev,
1402bdcd8170SKalle Valo 				       enum nl80211_tx_power_setting type,
1403b992a285SLuis R. Rodriguez 				       int mbm)
1404bdcd8170SKalle Valo {
1405bdcd8170SKalle Valo 	struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1406990bd915SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif;
1407b992a285SLuis R. Rodriguez 	int dbm = MBM_TO_DBM(mbm);
1408bdcd8170SKalle Valo 
1409bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__,
1410bdcd8170SKalle Valo 		   type, dbm);
1411bdcd8170SKalle Valo 
1412990bd915SVasanthakumar Thiagarajan 	vif = ath6kl_vif_first(ar);
1413990bd915SVasanthakumar Thiagarajan 	if (!vif)
1414990bd915SVasanthakumar Thiagarajan 		return -EIO;
1415990bd915SVasanthakumar Thiagarajan 
1416990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1417bdcd8170SKalle Valo 		return -EIO;
1418bdcd8170SKalle Valo 
1419bdcd8170SKalle Valo 	switch (type) {
1420bdcd8170SKalle Valo 	case NL80211_TX_POWER_AUTOMATIC:
1421bdcd8170SKalle Valo 		return 0;
1422bdcd8170SKalle Valo 	case NL80211_TX_POWER_LIMITED:
1423d0d670abSKalle Valo 		ar->tx_pwr = dbm;
1424bdcd8170SKalle Valo 		break;
1425bdcd8170SKalle Valo 	default:
1426bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n",
1427bdcd8170SKalle Valo 			   __func__, type);
1428bdcd8170SKalle Valo 		return -EOPNOTSUPP;
1429bdcd8170SKalle Valo 	}
1430bdcd8170SKalle Valo 
1431d0d670abSKalle Valo 	ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm);
1432bdcd8170SKalle Valo 
1433bdcd8170SKalle Valo 	return 0;
1434bdcd8170SKalle Valo }
1435bdcd8170SKalle Valo 
1436c8442118SJohannes Berg static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy,
1437c8442118SJohannes Berg 				       struct wireless_dev *wdev,
1438c8442118SJohannes Berg 				       int *dbm)
1439bdcd8170SKalle Valo {
1440bdcd8170SKalle Valo 	struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1441990bd915SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif;
1442bdcd8170SKalle Valo 
1443990bd915SVasanthakumar Thiagarajan 	vif = ath6kl_vif_first(ar);
1444990bd915SVasanthakumar Thiagarajan 	if (!vif)
1445990bd915SVasanthakumar Thiagarajan 		return -EIO;
1446990bd915SVasanthakumar Thiagarajan 
1447990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1448bdcd8170SKalle Valo 		return -EIO;
1449bdcd8170SKalle Valo 
145059c98449SVasanthakumar Thiagarajan 	if (test_bit(CONNECTED, &vif->flags)) {
1451cabd34d0SEric Bentley 		ar->tx_pwr = 255;
1452bdcd8170SKalle Valo 
1453990bd915SVasanthakumar Thiagarajan 		if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) {
1454bdcd8170SKalle Valo 			ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n");
1455bdcd8170SKalle Valo 			return -EIO;
1456bdcd8170SKalle Valo 		}
1457bdcd8170SKalle Valo 
1458cabd34d0SEric Bentley 		wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 255,
1459bdcd8170SKalle Valo 						 5 * HZ);
1460bdcd8170SKalle Valo 
1461bdcd8170SKalle Valo 		if (signal_pending(current)) {
1462bdcd8170SKalle Valo 			ath6kl_err("target did not respond\n");
1463bdcd8170SKalle Valo 			return -EINTR;
1464bdcd8170SKalle Valo 		}
1465bdcd8170SKalle Valo 	}
1466bdcd8170SKalle Valo 
1467bdcd8170SKalle Valo 	*dbm = ar->tx_pwr;
1468bdcd8170SKalle Valo 	return 0;
1469bdcd8170SKalle Valo }
1470bdcd8170SKalle Valo 
1471bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy,
1472bdcd8170SKalle Valo 					  struct net_device *dev,
1473bdcd8170SKalle Valo 					  bool pmgmt, int timeout)
1474bdcd8170SKalle Valo {
1475bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
1476bdcd8170SKalle Valo 	struct wmi_power_mode_cmd mode;
1477334234b5SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
1478bdcd8170SKalle Valo 
1479bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n",
1480bdcd8170SKalle Valo 		   __func__, pmgmt, timeout);
1481bdcd8170SKalle Valo 
1482990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1483bdcd8170SKalle Valo 		return -EIO;
1484bdcd8170SKalle Valo 
1485bdcd8170SKalle Valo 	if (pmgmt) {
1486f0ed67ecSMohammed Shafi Shajakhan 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__);
1487bdcd8170SKalle Valo 		mode.pwr_mode = REC_POWER;
1488bdcd8170SKalle Valo 	} else {
1489f0ed67ecSMohammed Shafi Shajakhan 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__);
1490bdcd8170SKalle Valo 		mode.pwr_mode = MAX_PERF_POWER;
1491bdcd8170SKalle Valo 	}
1492bdcd8170SKalle Valo 
1493334234b5SVasanthakumar Thiagarajan 	if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx,
1494334234b5SVasanthakumar Thiagarajan 				     mode.pwr_mode) != 0) {
1495bdcd8170SKalle Valo 		ath6kl_err("wmi_powermode_cmd failed\n");
1496bdcd8170SKalle Valo 		return -EIO;
1497bdcd8170SKalle Valo 	}
1498bdcd8170SKalle Valo 
1499bdcd8170SKalle Valo 	return 0;
1500bdcd8170SKalle Valo }
1501bdcd8170SKalle Valo 
150284efbb84SJohannes Berg static struct wireless_dev *ath6kl_cfg80211_add_iface(struct wiphy *wiphy,
1503552bff0cSJohannes Berg 						      const char *name,
15046bab2e19STom Gundersen 						      unsigned char name_assign_type,
150555055976SVasanthakumar Thiagarajan 						      enum nl80211_iftype type,
150655055976SVasanthakumar Thiagarajan 						      struct vif_params *params)
150755055976SVasanthakumar Thiagarajan {
150855055976SVasanthakumar Thiagarajan 	struct ath6kl *ar = wiphy_priv(wiphy);
150984efbb84SJohannes Berg 	struct wireless_dev *wdev;
151055055976SVasanthakumar Thiagarajan 	u8 if_idx, nw_type;
151155055976SVasanthakumar Thiagarajan 
151271f96ee6SKalle Valo 	if (ar->num_vif == ar->vif_max) {
151355055976SVasanthakumar Thiagarajan 		ath6kl_err("Reached maximum number of supported vif\n");
151455055976SVasanthakumar Thiagarajan 		return ERR_PTR(-EINVAL);
151555055976SVasanthakumar Thiagarajan 	}
151655055976SVasanthakumar Thiagarajan 
151755055976SVasanthakumar Thiagarajan 	if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) {
151855055976SVasanthakumar Thiagarajan 		ath6kl_err("Not a supported interface type\n");
151955055976SVasanthakumar Thiagarajan 		return ERR_PTR(-EINVAL);
152055055976SVasanthakumar Thiagarajan 	}
152155055976SVasanthakumar Thiagarajan 
15226bab2e19STom Gundersen 	wdev = ath6kl_interface_add(ar, name, name_assign_type, type, if_idx, nw_type);
152384efbb84SJohannes Berg 	if (!wdev)
152455055976SVasanthakumar Thiagarajan 		return ERR_PTR(-ENOMEM);
152555055976SVasanthakumar Thiagarajan 
152655055976SVasanthakumar Thiagarajan 	ar->num_vif++;
152755055976SVasanthakumar Thiagarajan 
152884efbb84SJohannes Berg 	return wdev;
152955055976SVasanthakumar Thiagarajan }
153055055976SVasanthakumar Thiagarajan 
153155055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy,
153284efbb84SJohannes Berg 				     struct wireless_dev *wdev)
153355055976SVasanthakumar Thiagarajan {
153455055976SVasanthakumar Thiagarajan 	struct ath6kl *ar = wiphy_priv(wiphy);
153584efbb84SJohannes Berg 	struct ath6kl_vif *vif = netdev_priv(wdev->netdev);
153655055976SVasanthakumar Thiagarajan 
153711f6e40dSVasanthakumar Thiagarajan 	spin_lock_bh(&ar->list_lock);
153855055976SVasanthakumar Thiagarajan 	list_del(&vif->list);
153911f6e40dSVasanthakumar Thiagarajan 	spin_unlock_bh(&ar->list_lock);
154055055976SVasanthakumar Thiagarajan 
1541355b3a98SMohammed Shafi Shajakhan 	ath6kl_cfg80211_vif_stop(vif, test_bit(WMI_READY, &ar->flag));
154255055976SVasanthakumar Thiagarajan 
1543bc52aab3SMohammed Shafi Shajakhan 	rtnl_lock();
1544c25889e8SKalle Valo 	ath6kl_cfg80211_vif_cleanup(vif);
1545bc52aab3SMohammed Shafi Shajakhan 	rtnl_unlock();
154655055976SVasanthakumar Thiagarajan 
154755055976SVasanthakumar Thiagarajan 	return 0;
154855055976SVasanthakumar Thiagarajan }
154955055976SVasanthakumar Thiagarajan 
1550bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy,
1551bdcd8170SKalle Valo 					struct net_device *ndev,
1552818a986eSJohannes Berg 					enum nl80211_iftype type,
1553bdcd8170SKalle Valo 					struct vif_params *params)
1554bdcd8170SKalle Valo {
1555f5938f24SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
15561e8d13b0SVasanthakumar Thiagarajan 	int i;
1557bdcd8170SKalle Valo 
1558bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type);
1559bdcd8170SKalle Valo 
15601e8d13b0SVasanthakumar Thiagarajan 	/*
15611e8d13b0SVasanthakumar Thiagarajan 	 * Don't bring up p2p on an interface which is not initialized
15621e8d13b0SVasanthakumar Thiagarajan 	 * for p2p operation where fw does not have capability to switch
15631e8d13b0SVasanthakumar Thiagarajan 	 * dynamically between non-p2p and p2p type interface.
15641e8d13b0SVasanthakumar Thiagarajan 	 */
15651e8d13b0SVasanthakumar Thiagarajan 	if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX,
15661e8d13b0SVasanthakumar Thiagarajan 		      vif->ar->fw_capabilities) &&
15671e8d13b0SVasanthakumar Thiagarajan 	    (type == NL80211_IFTYPE_P2P_CLIENT ||
15681e8d13b0SVasanthakumar Thiagarajan 	     type == NL80211_IFTYPE_P2P_GO)) {
15691e8d13b0SVasanthakumar Thiagarajan 		if (vif->ar->vif_max == 1) {
15701e8d13b0SVasanthakumar Thiagarajan 			if (vif->fw_vif_idx != 0)
15711e8d13b0SVasanthakumar Thiagarajan 				return -EINVAL;
15721e8d13b0SVasanthakumar Thiagarajan 			else
15731e8d13b0SVasanthakumar Thiagarajan 				goto set_iface_type;
15741e8d13b0SVasanthakumar Thiagarajan 		}
15751e8d13b0SVasanthakumar Thiagarajan 
15761e8d13b0SVasanthakumar Thiagarajan 		for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) {
15771e8d13b0SVasanthakumar Thiagarajan 			if (i == vif->fw_vif_idx)
15781e8d13b0SVasanthakumar Thiagarajan 				break;
15791e8d13b0SVasanthakumar Thiagarajan 		}
15801e8d13b0SVasanthakumar Thiagarajan 
15811e8d13b0SVasanthakumar Thiagarajan 		if (i == vif->ar->vif_max) {
15821e8d13b0SVasanthakumar Thiagarajan 			ath6kl_err("Invalid interface to bring up P2P\n");
15831e8d13b0SVasanthakumar Thiagarajan 			return -EINVAL;
15841e8d13b0SVasanthakumar Thiagarajan 		}
15851e8d13b0SVasanthakumar Thiagarajan 	}
15861e8d13b0SVasanthakumar Thiagarajan 
1587c422d52dSThomas Pedersen 	/* need to clean up enhanced bmiss detection fw state */
1588c422d52dSThomas Pedersen 	ath6kl_cfg80211_sta_bmiss_enhance(vif, false);
1589c422d52dSThomas Pedersen 
15901e8d13b0SVasanthakumar Thiagarajan set_iface_type:
1591bdcd8170SKalle Valo 	switch (type) {
1592bdcd8170SKalle Valo 	case NL80211_IFTYPE_STATION:
15938aa659d2SMohammed Shafi Shajakhan 	case NL80211_IFTYPE_P2P_CLIENT:
1594f5938f24SVasanthakumar Thiagarajan 		vif->next_mode = INFRA_NETWORK;
1595bdcd8170SKalle Valo 		break;
1596bdcd8170SKalle Valo 	case NL80211_IFTYPE_ADHOC:
1597f5938f24SVasanthakumar Thiagarajan 		vif->next_mode = ADHOC_NETWORK;
1598bdcd8170SKalle Valo 		break;
15996e4604c8SJouni Malinen 	case NL80211_IFTYPE_AP:
16006b5e5d25SJouni Malinen 	case NL80211_IFTYPE_P2P_GO:
1601f5938f24SVasanthakumar Thiagarajan 		vif->next_mode = AP_NETWORK;
16026b5e5d25SJouni Malinen 		break;
1603bdcd8170SKalle Valo 	default:
1604bdcd8170SKalle Valo 		ath6kl_err("invalid interface type %u\n", type);
1605bdcd8170SKalle Valo 		return -EOPNOTSUPP;
1606bdcd8170SKalle Valo 	}
1607bdcd8170SKalle Valo 
1608551959d8SVasanthakumar Thiagarajan 	vif->wdev.iftype = type;
1609bdcd8170SKalle Valo 
1610bdcd8170SKalle Valo 	return 0;
1611bdcd8170SKalle Valo }
1612bdcd8170SKalle Valo 
1613bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy,
1614bdcd8170SKalle Valo 				     struct net_device *dev,
1615bdcd8170SKalle Valo 				     struct cfg80211_ibss_params *ibss_param)
1616bdcd8170SKalle Valo {
1617bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
161859c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
1619bdcd8170SKalle Valo 	int status;
1620bdcd8170SKalle Valo 
1621990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1622bdcd8170SKalle Valo 		return -EIO;
1623bdcd8170SKalle Valo 
16243450334fSVasanthakumar Thiagarajan 	vif->ssid_len = ibss_param->ssid_len;
16253450334fSVasanthakumar Thiagarajan 	memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len);
1626bdcd8170SKalle Valo 
1627683b6d3bSJohannes Berg 	if (ibss_param->chandef.chan)
1628683b6d3bSJohannes Berg 		vif->ch_hint = ibss_param->chandef.chan->center_freq;
1629bdcd8170SKalle Valo 
1630bdcd8170SKalle Valo 	if (ibss_param->channel_fixed) {
1631bdcd8170SKalle Valo 		/*
1632bdcd8170SKalle Valo 		 * TODO: channel_fixed: The channel should be fixed, do not
1633bdcd8170SKalle Valo 		 * search for IBSSs to join on other channels. Target
1634bdcd8170SKalle Valo 		 * firmware does not support this feature, needs to be
1635bdcd8170SKalle Valo 		 * updated.
1636bdcd8170SKalle Valo 		 */
1637bdcd8170SKalle Valo 		return -EOPNOTSUPP;
1638bdcd8170SKalle Valo 	}
1639bdcd8170SKalle Valo 
16408c8b65e3SVasanthakumar Thiagarajan 	memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
1641bdcd8170SKalle Valo 	if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid))
16428c8b65e3SVasanthakumar Thiagarajan 		memcpy(vif->req_bssid, ibss_param->bssid,
16438c8b65e3SVasanthakumar Thiagarajan 		       sizeof(vif->req_bssid));
1644bdcd8170SKalle Valo 
1645240d2799SVasanthakumar Thiagarajan 	ath6kl_set_wpa_version(vif, 0);
1646bdcd8170SKalle Valo 
1647240d2799SVasanthakumar Thiagarajan 	status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM);
1648bdcd8170SKalle Valo 	if (status)
1649bdcd8170SKalle Valo 		return status;
1650bdcd8170SKalle Valo 
1651bdcd8170SKalle Valo 	if (ibss_param->privacy) {
1652240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true);
1653240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false);
1654bdcd8170SKalle Valo 	} else {
1655240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, 0, true);
1656240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, 0, false);
1657bdcd8170SKalle Valo 	}
1658bdcd8170SKalle Valo 
1659f5938f24SVasanthakumar Thiagarajan 	vif->nw_type = vif->next_mode;
1660bdcd8170SKalle Valo 
1661bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1662bdcd8170SKalle Valo 		   "%s: connect called with authmode %d dot11 auth %d"
1663bdcd8170SKalle Valo 		   " PW crypto %d PW crypto len %d GRP crypto %d"
1664bdcd8170SKalle Valo 		   " GRP crypto len %d channel hint %u\n",
1665bdcd8170SKalle Valo 		   __func__,
16663450334fSVasanthakumar Thiagarajan 		   vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto,
16673450334fSVasanthakumar Thiagarajan 		   vif->prwise_crypto_len, vif->grp_crypto,
1668f74bac54SVasanthakumar Thiagarajan 		   vif->grp_crypto_len, vif->ch_hint);
1669bdcd8170SKalle Valo 
1670334234b5SVasanthakumar Thiagarajan 	status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type,
16713450334fSVasanthakumar Thiagarajan 					vif->dot11_auth_mode, vif->auth_mode,
16723450334fSVasanthakumar Thiagarajan 					vif->prwise_crypto,
16733450334fSVasanthakumar Thiagarajan 					vif->prwise_crypto_len,
16743450334fSVasanthakumar Thiagarajan 					vif->grp_crypto, vif->grp_crypto_len,
16753450334fSVasanthakumar Thiagarajan 					vif->ssid_len, vif->ssid,
1676f74bac54SVasanthakumar Thiagarajan 					vif->req_bssid, vif->ch_hint,
16773ca9d1fcSAarthi Thiruvengadam 					ar->connect_ctrl_flags, SUBTYPE_NONE);
167859c98449SVasanthakumar Thiagarajan 	set_bit(CONNECT_PEND, &vif->flags);
1679bdcd8170SKalle Valo 
1680bdcd8170SKalle Valo 	return 0;
1681bdcd8170SKalle Valo }
1682bdcd8170SKalle Valo 
1683bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy,
1684bdcd8170SKalle Valo 				      struct net_device *dev)
1685bdcd8170SKalle Valo {
16863450334fSVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
1687bdcd8170SKalle Valo 
1688990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1689bdcd8170SKalle Valo 		return -EIO;
1690bdcd8170SKalle Valo 
1691240d2799SVasanthakumar Thiagarajan 	ath6kl_disconnect(vif);
16923450334fSVasanthakumar Thiagarajan 	memset(vif->ssid, 0, sizeof(vif->ssid));
16933450334fSVasanthakumar Thiagarajan 	vif->ssid_len = 0;
1694bdcd8170SKalle Valo 
1695bdcd8170SKalle Valo 	return 0;
1696bdcd8170SKalle Valo }
1697bdcd8170SKalle Valo 
1698bdcd8170SKalle Valo static const u32 cipher_suites[] = {
1699bdcd8170SKalle Valo 	WLAN_CIPHER_SUITE_WEP40,
1700bdcd8170SKalle Valo 	WLAN_CIPHER_SUITE_WEP104,
1701bdcd8170SKalle Valo 	WLAN_CIPHER_SUITE_TKIP,
1702bdcd8170SKalle Valo 	WLAN_CIPHER_SUITE_CCMP,
1703837cb97eSJouni Malinen 	CCKM_KRK_CIPHER_SUITE,
17045e07021eSDai Shuibing 	WLAN_CIPHER_SUITE_SMS4,
1705bdcd8170SKalle Valo };
1706bdcd8170SKalle Valo 
1707bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate)
1708bdcd8170SKalle Valo {
1709bdcd8170SKalle Valo 	static const s32 legacy[] = { 1000, 2000, 5500, 11000,
1710bdcd8170SKalle Valo 		6000, 9000, 12000, 18000, 24000,
1711bdcd8170SKalle Valo 		36000, 48000, 54000
1712bdcd8170SKalle Valo 	};
1713bdcd8170SKalle Valo 	u8 i;
1714bdcd8170SKalle Valo 
1715bdcd8170SKalle Valo 	for (i = 0; i < ARRAY_SIZE(legacy); i++)
1716bdcd8170SKalle Valo 		if (rate == legacy[i])
1717bdcd8170SKalle Valo 			return true;
1718bdcd8170SKalle Valo 
1719bdcd8170SKalle Valo 	return false;
1720bdcd8170SKalle Valo }
1721bdcd8170SKalle Valo 
1722bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi)
1723bdcd8170SKalle Valo {
1724bdcd8170SKalle Valo 	static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000,
1725bdcd8170SKalle Valo 		52000, 58500, 65000, 72200
1726bdcd8170SKalle Valo 	};
1727bdcd8170SKalle Valo 	u8 i;
1728bdcd8170SKalle Valo 
1729bdcd8170SKalle Valo 	for (i = 0; i < ARRAY_SIZE(ht20); i++) {
1730bdcd8170SKalle Valo 		if (rate == ht20[i]) {
1731bdcd8170SKalle Valo 			if (i == ARRAY_SIZE(ht20) - 1)
1732bdcd8170SKalle Valo 				/* last rate uses sgi */
1733bdcd8170SKalle Valo 				*sgi = true;
1734bdcd8170SKalle Valo 			else
1735bdcd8170SKalle Valo 				*sgi = false;
1736bdcd8170SKalle Valo 
1737bdcd8170SKalle Valo 			*mcs = i;
1738bdcd8170SKalle Valo 			return true;
1739bdcd8170SKalle Valo 		}
1740bdcd8170SKalle Valo 	}
1741bdcd8170SKalle Valo 	return false;
1742bdcd8170SKalle Valo }
1743bdcd8170SKalle Valo 
1744bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi)
1745bdcd8170SKalle Valo {
1746bdcd8170SKalle Valo 	static const s32 ht40[] = { 13500, 27000, 40500, 54000,
1747bdcd8170SKalle Valo 		81000, 108000, 121500, 135000,
1748bdcd8170SKalle Valo 		150000
1749bdcd8170SKalle Valo 	};
1750bdcd8170SKalle Valo 	u8 i;
1751bdcd8170SKalle Valo 
1752bdcd8170SKalle Valo 	for (i = 0; i < ARRAY_SIZE(ht40); i++) {
1753bdcd8170SKalle Valo 		if (rate == ht40[i]) {
1754bdcd8170SKalle Valo 			if (i == ARRAY_SIZE(ht40) - 1)
1755bdcd8170SKalle Valo 				/* last rate uses sgi */
1756bdcd8170SKalle Valo 				*sgi = true;
1757bdcd8170SKalle Valo 			else
1758bdcd8170SKalle Valo 				*sgi = false;
1759bdcd8170SKalle Valo 
1760bdcd8170SKalle Valo 			*mcs = i;
1761bdcd8170SKalle Valo 			return true;
1762bdcd8170SKalle Valo 		}
1763bdcd8170SKalle Valo 	}
1764bdcd8170SKalle Valo 
1765bdcd8170SKalle Valo 	return false;
1766bdcd8170SKalle Valo }
1767bdcd8170SKalle Valo 
1768bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev,
17693b3a0162SJohannes Berg 			      const u8 *mac, struct station_info *sinfo)
1770bdcd8170SKalle Valo {
1771bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
177259c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
1773bdcd8170SKalle Valo 	long left;
1774bdcd8170SKalle Valo 	bool sgi;
1775bdcd8170SKalle Valo 	s32 rate;
1776bdcd8170SKalle Valo 	int ret;
1777bdcd8170SKalle Valo 	u8 mcs;
1778bdcd8170SKalle Valo 
17798c8b65e3SVasanthakumar Thiagarajan 	if (memcmp(mac, vif->bssid, ETH_ALEN) != 0)
1780bdcd8170SKalle Valo 		return -ENOENT;
1781bdcd8170SKalle Valo 
1782bdcd8170SKalle Valo 	if (down_interruptible(&ar->sem))
1783bdcd8170SKalle Valo 		return -EBUSY;
1784bdcd8170SKalle Valo 
1785b95907a7SVasanthakumar Thiagarajan 	set_bit(STATS_UPDATE_PEND, &vif->flags);
1786bdcd8170SKalle Valo 
1787334234b5SVasanthakumar Thiagarajan 	ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx);
1788bdcd8170SKalle Valo 
1789bdcd8170SKalle Valo 	if (ret != 0) {
1790bdcd8170SKalle Valo 		up(&ar->sem);
1791bdcd8170SKalle Valo 		return -EIO;
1792bdcd8170SKalle Valo 	}
1793bdcd8170SKalle Valo 
1794bdcd8170SKalle Valo 	left = wait_event_interruptible_timeout(ar->event_wq,
1795bdcd8170SKalle Valo 						!test_bit(STATS_UPDATE_PEND,
1796b95907a7SVasanthakumar Thiagarajan 							  &vif->flags),
1797bdcd8170SKalle Valo 						WMI_TIMEOUT);
1798bdcd8170SKalle Valo 
1799bdcd8170SKalle Valo 	up(&ar->sem);
1800bdcd8170SKalle Valo 
1801bdcd8170SKalle Valo 	if (left == 0)
1802bdcd8170SKalle Valo 		return -ETIMEDOUT;
1803bdcd8170SKalle Valo 	else if (left < 0)
1804bdcd8170SKalle Valo 		return left;
1805bdcd8170SKalle Valo 
1806b95907a7SVasanthakumar Thiagarajan 	if (vif->target_stats.rx_byte) {
1807b95907a7SVasanthakumar Thiagarajan 		sinfo->rx_bytes = vif->target_stats.rx_byte;
1808319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_RX_BYTES64);
1809b95907a7SVasanthakumar Thiagarajan 		sinfo->rx_packets = vif->target_stats.rx_pkt;
1810319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_RX_PACKETS);
1811bdcd8170SKalle Valo 	}
1812bdcd8170SKalle Valo 
1813b95907a7SVasanthakumar Thiagarajan 	if (vif->target_stats.tx_byte) {
1814b95907a7SVasanthakumar Thiagarajan 		sinfo->tx_bytes = vif->target_stats.tx_byte;
1815319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_TX_BYTES64);
1816b95907a7SVasanthakumar Thiagarajan 		sinfo->tx_packets = vif->target_stats.tx_pkt;
1817319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_TX_PACKETS);
1818bdcd8170SKalle Valo 	}
1819bdcd8170SKalle Valo 
1820b95907a7SVasanthakumar Thiagarajan 	sinfo->signal = vif->target_stats.cs_rssi;
1821319090bfSJohannes Berg 	sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL);
1822bdcd8170SKalle Valo 
1823b95907a7SVasanthakumar Thiagarajan 	rate = vif->target_stats.tx_ucast_rate;
1824bdcd8170SKalle Valo 
1825bdcd8170SKalle Valo 	if (is_rate_legacy(rate)) {
1826bdcd8170SKalle Valo 		sinfo->txrate.legacy = rate / 100;
1827bdcd8170SKalle Valo 	} else if (is_rate_ht20(rate, &mcs, &sgi)) {
1828bdcd8170SKalle Valo 		if (sgi) {
1829bdcd8170SKalle Valo 			sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
1830bdcd8170SKalle Valo 			sinfo->txrate.mcs = mcs - 1;
1831bdcd8170SKalle Valo 		} else {
1832bdcd8170SKalle Valo 			sinfo->txrate.mcs = mcs;
1833bdcd8170SKalle Valo 		}
1834bdcd8170SKalle Valo 
1835bdcd8170SKalle Valo 		sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
1836b51f3beeSJohannes Berg 		sinfo->txrate.bw = RATE_INFO_BW_20;
1837bdcd8170SKalle Valo 	} else if (is_rate_ht40(rate, &mcs, &sgi)) {
1838bdcd8170SKalle Valo 		if (sgi) {
1839bdcd8170SKalle Valo 			sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
1840bdcd8170SKalle Valo 			sinfo->txrate.mcs = mcs - 1;
1841bdcd8170SKalle Valo 		} else {
1842bdcd8170SKalle Valo 			sinfo->txrate.mcs = mcs;
1843bdcd8170SKalle Valo 		}
1844bdcd8170SKalle Valo 
1845b51f3beeSJohannes Berg 		sinfo->txrate.bw = RATE_INFO_BW_40;
1846bdcd8170SKalle Valo 		sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
1847bdcd8170SKalle Valo 	} else {
18489a730834SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
18499a730834SKalle Valo 			   "invalid rate from stats: %d\n", rate);
18509a730834SKalle Valo 		ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE);
1851bdcd8170SKalle Valo 		return 0;
1852bdcd8170SKalle Valo 	}
1853bdcd8170SKalle Valo 
1854319090bfSJohannes Berg 	sinfo->filled |= BIT(NL80211_STA_INFO_TX_BITRATE);
1855bdcd8170SKalle Valo 
185659c98449SVasanthakumar Thiagarajan 	if (test_bit(CONNECTED, &vif->flags) &&
185759c98449SVasanthakumar Thiagarajan 	    test_bit(DTIM_PERIOD_AVAIL, &vif->flags) &&
1858f5938f24SVasanthakumar Thiagarajan 	    vif->nw_type == INFRA_NETWORK) {
1859319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_BSS_PARAM);
186032c10874SJouni Malinen 		sinfo->bss_param.flags = 0;
1861cf5333d7SVasanthakumar Thiagarajan 		sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period;
1862cf5333d7SVasanthakumar Thiagarajan 		sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int;
186332c10874SJouni Malinen 	}
186432c10874SJouni Malinen 
1865bdcd8170SKalle Valo 	return 0;
1866bdcd8170SKalle Valo }
1867bdcd8170SKalle Valo 
1868bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev,
1869bdcd8170SKalle Valo 			    struct cfg80211_pmksa *pmksa)
1870bdcd8170SKalle Valo {
1871bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(netdev);
1872334234b5SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(netdev);
1873334234b5SVasanthakumar Thiagarajan 
1874334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid,
1875bdcd8170SKalle Valo 				       pmksa->pmkid, true);
1876bdcd8170SKalle Valo }
1877bdcd8170SKalle Valo 
1878bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev,
1879bdcd8170SKalle Valo 			    struct cfg80211_pmksa *pmksa)
1880bdcd8170SKalle Valo {
1881bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(netdev);
1882334234b5SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(netdev);
1883334234b5SVasanthakumar Thiagarajan 
1884334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid,
1885bdcd8170SKalle Valo 				       pmksa->pmkid, false);
1886bdcd8170SKalle Valo }
1887bdcd8170SKalle Valo 
1888bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev)
1889bdcd8170SKalle Valo {
1890bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(netdev);
189159c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(netdev);
189259c98449SVasanthakumar Thiagarajan 
189359c98449SVasanthakumar Thiagarajan 	if (test_bit(CONNECTED, &vif->flags))
1894334234b5SVasanthakumar Thiagarajan 		return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx,
1895334234b5SVasanthakumar Thiagarajan 					       vif->bssid, NULL, false);
1896bdcd8170SKalle Valo 	return 0;
1897bdcd8170SKalle Valo }
1898bdcd8170SKalle Valo 
1899d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif,
1900d91e8eeeSRaja Mani 			  struct cfg80211_wowlan *wow, u32 *filter)
19016cb3c714SRaja Mani {
1902d91e8eeeSRaja Mani 	int ret, pos;
19032c07cf44SThomas Pedersen 	u8 mask[WOW_PATTERN_SIZE];
19046cb3c714SRaja Mani 	u16 i;
19056cb3c714SRaja Mani 
1906d91e8eeeSRaja Mani 	/* Configure the patterns that we received from the user. */
19076cb3c714SRaja Mani 	for (i = 0; i < wow->n_patterns; i++) {
19086cb3c714SRaja Mani 		/*
19096cb3c714SRaja Mani 		 * Convert given nl80211 specific mask value to equivalent
19106cb3c714SRaja Mani 		 * driver specific mask value and send it to the chip along
19116cb3c714SRaja Mani 		 * with patterns. For example, If the mask value defined in
19126cb3c714SRaja Mani 		 * struct cfg80211_wowlan is 0xA (equivalent binary is 1010),
19136cb3c714SRaja Mani 		 * then equivalent driver specific mask value is
19146cb3c714SRaja Mani 		 * "0xFF 0x00 0xFF 0x00".
19156cb3c714SRaja Mani 		 */
19166cb3c714SRaja Mani 		memset(&mask, 0, sizeof(mask));
19176cb3c714SRaja Mani 		for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) {
19186cb3c714SRaja Mani 			if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8)))
19196cb3c714SRaja Mani 				mask[pos] = 0xFF;
19206cb3c714SRaja Mani 		}
19216cb3c714SRaja Mani 		/*
19226cb3c714SRaja Mani 		 * Note: Pattern's offset is not passed as part of wowlan
19236cb3c714SRaja Mani 		 * parameter from CFG layer. So it's always passed as ZERO
19246cb3c714SRaja Mani 		 * to the firmware. It means, given WOW patterns are always
19256cb3c714SRaja Mani 		 * matched from the first byte of received pkt in the firmware.
19266cb3c714SRaja Mani 		 */
19276cb3c714SRaja Mani 		ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
19286cb3c714SRaja Mani 				vif->fw_vif_idx, WOW_LIST_ID,
19296cb3c714SRaja Mani 				wow->patterns[i].pattern_len,
19306cb3c714SRaja Mani 				0 /* pattern offset */,
19316cb3c714SRaja Mani 				wow->patterns[i].pattern, mask);
19326cb3c714SRaja Mani 		if (ret)
19336cb3c714SRaja Mani 			return ret;
19346cb3c714SRaja Mani 	}
19356cb3c714SRaja Mani 
1936d91e8eeeSRaja Mani 	if (wow->disconnect)
1937d91e8eeeSRaja Mani 		*filter |= WOW_FILTER_OPTION_NWK_DISASSOC;
1938d91e8eeeSRaja Mani 
1939d91e8eeeSRaja Mani 	if (wow->magic_pkt)
1940d91e8eeeSRaja Mani 		*filter |= WOW_FILTER_OPTION_MAGIC_PACKET;
1941d91e8eeeSRaja Mani 
1942d91e8eeeSRaja Mani 	if (wow->gtk_rekey_failure)
1943d91e8eeeSRaja Mani 		*filter |= WOW_FILTER_OPTION_GTK_ERROR;
1944d91e8eeeSRaja Mani 
1945d91e8eeeSRaja Mani 	if (wow->eap_identity_req)
1946d91e8eeeSRaja Mani 		*filter |= WOW_FILTER_OPTION_EAP_REQ;
1947d91e8eeeSRaja Mani 
1948d91e8eeeSRaja Mani 	if (wow->four_way_handshake)
1949d91e8eeeSRaja Mani 		*filter |= WOW_FILTER_OPTION_8021X_4WAYHS;
1950d91e8eeeSRaja Mani 
1951d91e8eeeSRaja Mani 	return 0;
1952d91e8eeeSRaja Mani }
1953d91e8eeeSRaja Mani 
1954d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif)
1955d91e8eeeSRaja Mani {
1956d91e8eeeSRaja Mani 	static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00,
1957d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1958d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1959d91e8eeeSRaja Mani 		0x00, 0x08 };
1960d91e8eeeSRaja Mani 	static const u8 unicst_mask[] = { 0x01, 0x00, 0x00,
1961d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1962d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1963d91e8eeeSRaja Mani 		0x00, 0x7f };
1964d91e8eeeSRaja Mani 	u8 unicst_offset = 0;
1965d91e8eeeSRaja Mani 	static const u8 arp_pattern[] = { 0x08, 0x06 };
1966d91e8eeeSRaja Mani 	static const u8 arp_mask[] = { 0xff, 0xff };
1967d91e8eeeSRaja Mani 	u8 arp_offset = 20;
1968d91e8eeeSRaja Mani 	static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 };
1969d91e8eeeSRaja Mani 	static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 };
1970d91e8eeeSRaja Mani 	u8 discvr_offset = 38;
1971d91e8eeeSRaja Mani 	static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff,
1972d91e8eeeSRaja Mani 		0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1973d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00,
1974d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1975d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1976d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ };
1977d91e8eeeSRaja Mani 	static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff,
1978d91e8eeeSRaja Mani 		0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1979d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff,
1980d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1981d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
1982d91e8eeeSRaja Mani 		0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ };
1983d91e8eeeSRaja Mani 	u8 dhcp_offset = 0;
1984d91e8eeeSRaja Mani 	int ret;
1985d91e8eeeSRaja Mani 
1986d91e8eeeSRaja Mani 	/* Setup unicast IP, EAPOL-like and ARP pkt pattern */
1987d91e8eeeSRaja Mani 	ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
1988d91e8eeeSRaja Mani 			vif->fw_vif_idx, WOW_LIST_ID,
1989d91e8eeeSRaja Mani 			sizeof(unicst_pattern), unicst_offset,
1990d91e8eeeSRaja Mani 			unicst_pattern, unicst_mask);
1991d91e8eeeSRaja Mani 	if (ret) {
1992d91e8eeeSRaja Mani 		ath6kl_err("failed to add WOW unicast IP pattern\n");
1993d91e8eeeSRaja Mani 		return ret;
1994d91e8eeeSRaja Mani 	}
1995d91e8eeeSRaja Mani 
1996d91e8eeeSRaja Mani 	/* Setup all ARP pkt pattern */
1997d91e8eeeSRaja Mani 	ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
1998d91e8eeeSRaja Mani 			vif->fw_vif_idx, WOW_LIST_ID,
1999d91e8eeeSRaja Mani 			sizeof(arp_pattern), arp_offset,
2000d91e8eeeSRaja Mani 			arp_pattern, arp_mask);
2001d91e8eeeSRaja Mani 	if (ret) {
2002d91e8eeeSRaja Mani 		ath6kl_err("failed to add WOW ARP pattern\n");
2003d91e8eeeSRaja Mani 		return ret;
2004d91e8eeeSRaja Mani 	}
2005d91e8eeeSRaja Mani 
2006d91e8eeeSRaja Mani 	/*
2007d91e8eeeSRaja Mani 	 * Setup multicast pattern for mDNS 224.0.0.251,
2008d91e8eeeSRaja Mani 	 * SSDP 239.255.255.250 and LLMNR  224.0.0.252
2009d91e8eeeSRaja Mani 	 */
2010d91e8eeeSRaja Mani 	ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
2011d91e8eeeSRaja Mani 			vif->fw_vif_idx, WOW_LIST_ID,
2012d91e8eeeSRaja Mani 			sizeof(discvr_pattern), discvr_offset,
2013d91e8eeeSRaja Mani 			discvr_pattern, discvr_mask);
2014d91e8eeeSRaja Mani 	if (ret) {
2015d91e8eeeSRaja Mani 		ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n");
2016d91e8eeeSRaja Mani 		return ret;
2017d91e8eeeSRaja Mani 	}
2018d91e8eeeSRaja Mani 
2019d91e8eeeSRaja Mani 	/* Setup all DHCP broadcast pkt pattern */
2020d91e8eeeSRaja Mani 	ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
2021d91e8eeeSRaja Mani 			vif->fw_vif_idx, WOW_LIST_ID,
2022d91e8eeeSRaja Mani 			sizeof(dhcp_pattern), dhcp_offset,
2023d91e8eeeSRaja Mani 			dhcp_pattern, dhcp_mask);
2024d91e8eeeSRaja Mani 	if (ret) {
2025d91e8eeeSRaja Mani 		ath6kl_err("failed to add WOW DHCP broadcast pattern\n");
2026d91e8eeeSRaja Mani 		return ret;
2027d91e8eeeSRaja Mani 	}
2028d91e8eeeSRaja Mani 
2029d91e8eeeSRaja Mani 	return 0;
2030d91e8eeeSRaja Mani }
2031d91e8eeeSRaja Mani 
2032d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif)
2033d91e8eeeSRaja Mani {
2034d91e8eeeSRaja Mani 	struct net_device *ndev = vif->ndev;
2035d91e8eeeSRaja Mani 	static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 };
2036d91e8eeeSRaja Mani 	static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 };
2037d91e8eeeSRaja Mani 	u8 discvr_offset = 38;
2038d91e8eeeSRaja Mani 	u8 mac_mask[ETH_ALEN];
2039d91e8eeeSRaja Mani 	int ret;
2040d91e8eeeSRaja Mani 
2041d91e8eeeSRaja Mani 	/* Setup unicast pkt pattern */
204293803b33SJoe Perches 	eth_broadcast_addr(mac_mask);
2043d91e8eeeSRaja Mani 	ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
2044d91e8eeeSRaja Mani 				vif->fw_vif_idx, WOW_LIST_ID,
2045d91e8eeeSRaja Mani 				ETH_ALEN, 0, ndev->dev_addr,
2046d91e8eeeSRaja Mani 				mac_mask);
2047d91e8eeeSRaja Mani 	if (ret) {
2048d91e8eeeSRaja Mani 		ath6kl_err("failed to add WOW unicast pattern\n");
2049d91e8eeeSRaja Mani 		return ret;
2050d91e8eeeSRaja Mani 	}
2051d91e8eeeSRaja Mani 
2052d91e8eeeSRaja Mani 	/*
2053d91e8eeeSRaja Mani 	 * Setup multicast pattern for mDNS 224.0.0.251,
2054d91e8eeeSRaja Mani 	 * SSDP 239.255.255.250 and LLMNR 224.0.0.252
2055d91e8eeeSRaja Mani 	 */
2056d91e8eeeSRaja Mani 	if ((ndev->flags & IFF_ALLMULTI) ||
2057d91e8eeeSRaja Mani 	    (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) {
2058d91e8eeeSRaja Mani 		ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
2059d91e8eeeSRaja Mani 				vif->fw_vif_idx, WOW_LIST_ID,
2060d91e8eeeSRaja Mani 				sizeof(discvr_pattern), discvr_offset,
2061d91e8eeeSRaja Mani 				discvr_pattern, discvr_mask);
2062d91e8eeeSRaja Mani 		if (ret) {
2063cdeb8602SKalle Valo 			ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n");
2064d91e8eeeSRaja Mani 			return ret;
2065d91e8eeeSRaja Mani 		}
2066d91e8eeeSRaja Mani 	}
2067d91e8eeeSRaja Mani 
2068d91e8eeeSRaja Mani 	return 0;
2069d91e8eeeSRaja Mani }
2070d91e8eeeSRaja Mani 
2071055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif)
2072055bde49SRaja Mani {
2073055bde49SRaja Mani 	return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags);
2074055bde49SRaja Mani }
2075055bde49SRaja Mani 
2076055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar)
2077055bde49SRaja Mani {
2078055bde49SRaja Mani 	return !ar->tx_pending[ar->ctrl_ep];
2079055bde49SRaja Mani }
2080055bde49SRaja Mani 
2081055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif)
2082055bde49SRaja Mani {
2083055bde49SRaja Mani 	int ret, left;
2084055bde49SRaja Mani 
2085055bde49SRaja Mani 	clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags);
2086055bde49SRaja Mani 
2087055bde49SRaja Mani 	ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
2088055bde49SRaja Mani 						 ATH6KL_HOST_MODE_ASLEEP);
2089055bde49SRaja Mani 	if (ret)
2090055bde49SRaja Mani 		return ret;
2091055bde49SRaja Mani 
2092055bde49SRaja Mani 	left = wait_event_interruptible_timeout(ar->event_wq,
2093055bde49SRaja Mani 						is_hsleep_mode_procsed(vif),
2094055bde49SRaja Mani 						WMI_TIMEOUT);
2095055bde49SRaja Mani 	if (left == 0) {
2096055bde49SRaja Mani 		ath6kl_warn("timeout, didn't get host sleep cmd processed event\n");
2097055bde49SRaja Mani 		ret = -ETIMEDOUT;
2098055bde49SRaja Mani 	} else if (left < 0) {
2099055bde49SRaja Mani 		ath6kl_warn("error while waiting for host sleep cmd processed event %d\n",
2100055bde49SRaja Mani 			    left);
2101055bde49SRaja Mani 		ret = left;
2102055bde49SRaja Mani 	}
2103055bde49SRaja Mani 
2104055bde49SRaja Mani 	if (ar->tx_pending[ar->ctrl_ep]) {
2105055bde49SRaja Mani 		left = wait_event_interruptible_timeout(ar->event_wq,
2106055bde49SRaja Mani 							is_ctrl_ep_empty(ar),
2107055bde49SRaja Mani 							WMI_TIMEOUT);
2108055bde49SRaja Mani 		if (left == 0) {
2109055bde49SRaja Mani 			ath6kl_warn("clear wmi ctrl data timeout\n");
2110055bde49SRaja Mani 			ret = -ETIMEDOUT;
2111055bde49SRaja Mani 		} else if (left < 0) {
2112055bde49SRaja Mani 			ath6kl_warn("clear wmi ctrl data failed: %d\n", left);
2113055bde49SRaja Mani 			ret = left;
2114055bde49SRaja Mani 		}
2115055bde49SRaja Mani 	}
2116055bde49SRaja Mani 
2117055bde49SRaja Mani 	return ret;
2118055bde49SRaja Mani }
2119055bde49SRaja Mani 
2120fd4377b6SThomas Pedersen static int ath6kl_wow_suspend_vif(struct ath6kl_vif *vif,
2121fd4377b6SThomas Pedersen 				  struct cfg80211_wowlan *wow, u32 *filter)
2122d91e8eeeSRaja Mani {
2123fd4377b6SThomas Pedersen 	struct ath6kl *ar = vif->ar;
2124d91e8eeeSRaja Mani 	struct in_device *in_dev;
2125d91e8eeeSRaja Mani 	struct in_ifaddr *ifa;
2126055bde49SRaja Mani 	int ret;
2127ce0dc0cfSRaja Mani 	u16 i, bmiss_time;
2128d91e8eeeSRaja Mani 	__be32 ips[MAX_IP_ADDRS];
2129fd4377b6SThomas Pedersen 	u8 index = 0;
2130d91e8eeeSRaja Mani 
21316821d4f0SNaveen Gangadharan 	if (!test_bit(NETDEV_MCAST_ALL_ON, &vif->flags) &&
21326821d4f0SNaveen Gangadharan 	    test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER,
21336821d4f0SNaveen Gangadharan 		     ar->fw_capabilities)) {
21346251d801SNaveen Gangadharan 		ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi,
21356251d801SNaveen Gangadharan 						vif->fw_vif_idx, false);
21366251d801SNaveen Gangadharan 		if (ret)
21376251d801SNaveen Gangadharan 			return ret;
21386251d801SNaveen Gangadharan 	}
21396251d801SNaveen Gangadharan 
2140d91e8eeeSRaja Mani 	/* Clear existing WOW patterns */
2141d91e8eeeSRaja Mani 	for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++)
2142d91e8eeeSRaja Mani 		ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx,
2143d91e8eeeSRaja Mani 					       WOW_LIST_ID, i);
2144d91e8eeeSRaja Mani 
2145d91e8eeeSRaja Mani 	/*
2146d91e8eeeSRaja Mani 	 * Skip the default WOW pattern configuration
2147d91e8eeeSRaja Mani 	 * if the driver receives any WOW patterns from
2148d91e8eeeSRaja Mani 	 * the user.
2149d91e8eeeSRaja Mani 	 */
2150d91e8eeeSRaja Mani 	if (wow)
2151fd4377b6SThomas Pedersen 		ret = ath6kl_wow_usr(ar, vif, wow, filter);
2152d91e8eeeSRaja Mani 	else if (vif->nw_type == AP_NETWORK)
2153d91e8eeeSRaja Mani 		ret = ath6kl_wow_ap(ar, vif);
2154d91e8eeeSRaja Mani 	else
2155d91e8eeeSRaja Mani 		ret = ath6kl_wow_sta(ar, vif);
2156d91e8eeeSRaja Mani 
2157d91e8eeeSRaja Mani 	if (ret)
2158d91e8eeeSRaja Mani 		return ret;
2159d91e8eeeSRaja Mani 
2160390a8c8fSRaja Mani 	netif_stop_queue(vif->ndev);
2161390a8c8fSRaja Mani 
2162ce0dc0cfSRaja Mani 	if (vif->nw_type != AP_NETWORK) {
2163ce0dc0cfSRaja Mani 		ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx,
2164ce0dc0cfSRaja Mani 						    ATH6KL_MAX_WOW_LISTEN_INTL,
2165ce0dc0cfSRaja Mani 						    0);
2166ce0dc0cfSRaja Mani 		if (ret)
2167ce0dc0cfSRaja Mani 			return ret;
2168ce0dc0cfSRaja Mani 
2169ce0dc0cfSRaja Mani 		/* Set listen interval x 15 times as bmiss time */
2170ce0dc0cfSRaja Mani 		bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15;
2171ce0dc0cfSRaja Mani 		if (bmiss_time > ATH6KL_MAX_BMISS_TIME)
2172ce0dc0cfSRaja Mani 			bmiss_time = ATH6KL_MAX_BMISS_TIME;
2173ce0dc0cfSRaja Mani 
2174ce0dc0cfSRaja Mani 		ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx,
2175ce0dc0cfSRaja Mani 					       bmiss_time, 0);
2176ce0dc0cfSRaja Mani 		if (ret)
2177ce0dc0cfSRaja Mani 			return ret;
2178ce0dc0cfSRaja Mani 
2179ce0dc0cfSRaja Mani 		ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx,
2180ce0dc0cfSRaja Mani 						0xFFFF, 0, 0xFFFF, 0, 0, 0,
2181ce0dc0cfSRaja Mani 						0, 0, 0, 0);
2182ce0dc0cfSRaja Mani 		if (ret)
2183ce0dc0cfSRaja Mani 			return ret;
2184ce0dc0cfSRaja Mani 	}
2185ce0dc0cfSRaja Mani 
2186c08631c6SRaja Mani 	/* Setup own IP addr for ARP agent. */
2187c08631c6SRaja Mani 	in_dev = __in_dev_get_rtnl(vif->ndev);
2188c08631c6SRaja Mani 	if (!in_dev)
2189fd4377b6SThomas Pedersen 		return 0;
2190c08631c6SRaja Mani 
2191c08631c6SRaja Mani 	ifa = in_dev->ifa_list;
2192c08631c6SRaja Mani 	memset(&ips, 0, sizeof(ips));
2193c08631c6SRaja Mani 
2194c08631c6SRaja Mani 	/* Configure IP addr only if IP address count < MAX_IP_ADDRS */
2195c08631c6SRaja Mani 	while (index < MAX_IP_ADDRS && ifa) {
2196c08631c6SRaja Mani 		ips[index] = ifa->ifa_local;
2197c08631c6SRaja Mani 		ifa = ifa->ifa_next;
2198c08631c6SRaja Mani 		index++;
2199c08631c6SRaja Mani 	}
2200c08631c6SRaja Mani 
2201c08631c6SRaja Mani 	if (ifa) {
2202c08631c6SRaja Mani 		ath6kl_err("total IP addr count is exceeding fw limit\n");
2203c08631c6SRaja Mani 		return -EINVAL;
2204c08631c6SRaja Mani 	}
2205c08631c6SRaja Mani 
2206c08631c6SRaja Mani 	ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]);
2207c08631c6SRaja Mani 	if (ret) {
2208c08631c6SRaja Mani 		ath6kl_err("fail to setup ip for arp agent\n");
2209c08631c6SRaja Mani 		return ret;
2210c08631c6SRaja Mani 	}
2211c08631c6SRaja Mani 
2212fd4377b6SThomas Pedersen 	return ret;
2213fd4377b6SThomas Pedersen }
2214fd4377b6SThomas Pedersen 
2215fd4377b6SThomas Pedersen static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow)
2216fd4377b6SThomas Pedersen {
2217fd4377b6SThomas Pedersen 	struct ath6kl_vif *first_vif, *vif;
2218fd4377b6SThomas Pedersen 	int ret = 0;
2219fd4377b6SThomas Pedersen 	u32 filter = 0;
2220fd4377b6SThomas Pedersen 	bool connected = false;
2221fd4377b6SThomas Pedersen 
2222fd4377b6SThomas Pedersen 	/* enter / leave wow suspend on first vif always */
2223fd4377b6SThomas Pedersen 	first_vif = ath6kl_vif_first(ar);
2224bffb7db2SGeliang Tang 	if (WARN_ON(!first_vif) ||
2225fd4377b6SThomas Pedersen 	    !ath6kl_cfg80211_ready(first_vif))
2226fd4377b6SThomas Pedersen 		return -EIO;
2227fd4377b6SThomas Pedersen 
2228fd4377b6SThomas Pedersen 	if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST))
2229fd4377b6SThomas Pedersen 		return -EINVAL;
2230fd4377b6SThomas Pedersen 
2231fd4377b6SThomas Pedersen 	/* install filters for each connected vif */
2232fd4377b6SThomas Pedersen 	spin_lock_bh(&ar->list_lock);
2233fd4377b6SThomas Pedersen 	list_for_each_entry(vif, &ar->vif_list, list) {
2234fd4377b6SThomas Pedersen 		if (!test_bit(CONNECTED, &vif->flags) ||
2235fd4377b6SThomas Pedersen 		    !ath6kl_cfg80211_ready(vif))
2236fd4377b6SThomas Pedersen 			continue;
2237fd4377b6SThomas Pedersen 		connected = true;
2238fd4377b6SThomas Pedersen 
2239fd4377b6SThomas Pedersen 		ret = ath6kl_wow_suspend_vif(vif, wow, &filter);
2240fd4377b6SThomas Pedersen 		if (ret)
2241fd4377b6SThomas Pedersen 			break;
2242fd4377b6SThomas Pedersen 	}
2243fd4377b6SThomas Pedersen 	spin_unlock_bh(&ar->list_lock);
2244fd4377b6SThomas Pedersen 
2245fd4377b6SThomas Pedersen 	if (!connected)
2246fd4377b6SThomas Pedersen 		return -ENOTCONN;
2247fd4377b6SThomas Pedersen 	else if (ret)
2248fd4377b6SThomas Pedersen 		return ret;
2249fd4377b6SThomas Pedersen 
2250fd4377b6SThomas Pedersen 	ar->state = ATH6KL_STATE_SUSPENDING;
2251fd4377b6SThomas Pedersen 
2252fd4377b6SThomas Pedersen 	ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, first_vif->fw_vif_idx,
22536cb3c714SRaja Mani 					  ATH6KL_WOW_MODE_ENABLE,
22546cb3c714SRaja Mani 					  filter,
22556cb3c714SRaja Mani 					  WOW_HOST_REQ_DELAY);
22566cb3c714SRaja Mani 	if (ret)
22576cb3c714SRaja Mani 		return ret;
22586cb3c714SRaja Mani 
2259fd4377b6SThomas Pedersen 	return ath6kl_cfg80211_host_sleep(ar, first_vif);
22606cb3c714SRaja Mani }
22616cb3c714SRaja Mani 
2262fd4377b6SThomas Pedersen static int ath6kl_wow_resume_vif(struct ath6kl_vif *vif)
22636cb3c714SRaja Mani {
2264fd4377b6SThomas Pedersen 	struct ath6kl *ar = vif->ar;
22656cb3c714SRaja Mani 	int ret;
22666cb3c714SRaja Mani 
2267ce0dc0cfSRaja Mani 	if (vif->nw_type != AP_NETWORK) {
2268ce0dc0cfSRaja Mani 		ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx,
2269ce0dc0cfSRaja Mani 						0, 0, 0, 0, 0, 0, 3, 0, 0, 0);
2270ce0dc0cfSRaja Mani 		if (ret)
2271ce0dc0cfSRaja Mani 			return ret;
2272ce0dc0cfSRaja Mani 
2273ce0dc0cfSRaja Mani 		ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx,
2274ce0dc0cfSRaja Mani 						    vif->listen_intvl_t, 0);
2275ce0dc0cfSRaja Mani 		if (ret)
2276ce0dc0cfSRaja Mani 			return ret;
2277ce0dc0cfSRaja Mani 
2278ce0dc0cfSRaja Mani 		ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx,
2279ce0dc0cfSRaja Mani 					       vif->bmiss_time_t, 0);
2280ce0dc0cfSRaja Mani 		if (ret)
2281ce0dc0cfSRaja Mani 			return ret;
2282ce0dc0cfSRaja Mani 	}
2283ce0dc0cfSRaja Mani 
22846821d4f0SNaveen Gangadharan 	if (!test_bit(NETDEV_MCAST_ALL_OFF, &vif->flags) &&
22856821d4f0SNaveen Gangadharan 	    test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER,
22866821d4f0SNaveen Gangadharan 		     ar->fw_capabilities)) {
22876251d801SNaveen Gangadharan 		ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi,
22886251d801SNaveen Gangadharan 						  vif->fw_vif_idx, true);
22896251d801SNaveen Gangadharan 		if (ret)
22906251d801SNaveen Gangadharan 			return ret;
22916251d801SNaveen Gangadharan 	}
22926251d801SNaveen Gangadharan 
2293390a8c8fSRaja Mani 	netif_wake_queue(vif->ndev);
2294390a8c8fSRaja Mani 
2295390a8c8fSRaja Mani 	return 0;
2296390a8c8fSRaja Mani }
2297390a8c8fSRaja Mani 
2298fd4377b6SThomas Pedersen static int ath6kl_wow_resume(struct ath6kl *ar)
2299fd4377b6SThomas Pedersen {
2300fd4377b6SThomas Pedersen 	struct ath6kl_vif *vif;
2301fd4377b6SThomas Pedersen 	int ret;
2302fd4377b6SThomas Pedersen 
2303fd4377b6SThomas Pedersen 	vif = ath6kl_vif_first(ar);
2304bffb7db2SGeliang Tang 	if (WARN_ON(!vif) ||
2305fd4377b6SThomas Pedersen 	    !ath6kl_cfg80211_ready(vif))
2306fd4377b6SThomas Pedersen 		return -EIO;
2307fd4377b6SThomas Pedersen 
2308fd4377b6SThomas Pedersen 	ar->state = ATH6KL_STATE_RESUMING;
2309fd4377b6SThomas Pedersen 
2310fd4377b6SThomas Pedersen 	ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
2311fd4377b6SThomas Pedersen 						 ATH6KL_HOST_MODE_AWAKE);
2312fd4377b6SThomas Pedersen 	if (ret) {
2313fd4377b6SThomas Pedersen 		ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n",
2314fd4377b6SThomas Pedersen 			    ret);
2315fd4377b6SThomas Pedersen 		goto cleanup;
2316fd4377b6SThomas Pedersen 	}
2317fd4377b6SThomas Pedersen 
2318fd4377b6SThomas Pedersen 	spin_lock_bh(&ar->list_lock);
2319fd4377b6SThomas Pedersen 	list_for_each_entry(vif, &ar->vif_list, list) {
2320fd4377b6SThomas Pedersen 		if (!test_bit(CONNECTED, &vif->flags) ||
2321fd4377b6SThomas Pedersen 		    !ath6kl_cfg80211_ready(vif))
2322fd4377b6SThomas Pedersen 			continue;
2323fd4377b6SThomas Pedersen 		ret = ath6kl_wow_resume_vif(vif);
2324fd4377b6SThomas Pedersen 		if (ret)
2325fd4377b6SThomas Pedersen 			break;
2326fd4377b6SThomas Pedersen 	}
2327fd4377b6SThomas Pedersen 	spin_unlock_bh(&ar->list_lock);
2328fd4377b6SThomas Pedersen 
2329fd4377b6SThomas Pedersen 	if (ret)
2330fd4377b6SThomas Pedersen 		goto cleanup;
2331fd4377b6SThomas Pedersen 
2332fd4377b6SThomas Pedersen 	ar->state = ATH6KL_STATE_ON;
2333fd4377b6SThomas Pedersen 	return 0;
2334fd4377b6SThomas Pedersen 
2335fd4377b6SThomas Pedersen cleanup:
2336fd4377b6SThomas Pedersen 	ar->state = ATH6KL_STATE_WOW;
2337fd4377b6SThomas Pedersen 	return ret;
2338fd4377b6SThomas Pedersen }
2339fd4377b6SThomas Pedersen 
234040abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar)
234140abc2deSRaja Mani {
234240abc2deSRaja Mani 	struct ath6kl_vif *vif;
234340abc2deSRaja Mani 	int ret;
234440abc2deSRaja Mani 
234540abc2deSRaja Mani 	vif = ath6kl_vif_first(ar);
234640abc2deSRaja Mani 	if (!vif)
234740abc2deSRaja Mani 		return -EIO;
234840abc2deSRaja Mani 
234948f27587SMing Jiang 	if (!test_bit(WMI_READY, &ar->flag)) {
235048f27587SMing Jiang 		ath6kl_err("deepsleep failed as wmi is not ready\n");
235140abc2deSRaja Mani 		return -EIO;
235248f27587SMing Jiang 	}
235340abc2deSRaja Mani 
235440abc2deSRaja Mani 	ath6kl_cfg80211_stop_all(ar);
235540abc2deSRaja Mani 
235640abc2deSRaja Mani 	/* Save the current power mode before enabling power save */
235740abc2deSRaja Mani 	ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode;
235840abc2deSRaja Mani 
235940abc2deSRaja Mani 	ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER);
236040abc2deSRaja Mani 	if (ret)
236140abc2deSRaja Mani 		return ret;
236240abc2deSRaja Mani 
236340abc2deSRaja Mani 	/* Disable WOW mode */
236440abc2deSRaja Mani 	ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx,
236540abc2deSRaja Mani 					  ATH6KL_WOW_MODE_DISABLE,
236640abc2deSRaja Mani 					  0, 0);
236740abc2deSRaja Mani 	if (ret)
236840abc2deSRaja Mani 		return ret;
236940abc2deSRaja Mani 
237040abc2deSRaja Mani 	/* Flush all non control pkts in TX path */
237140abc2deSRaja Mani 	ath6kl_tx_data_cleanup(ar);
237240abc2deSRaja Mani 
237340abc2deSRaja Mani 	ret = ath6kl_cfg80211_host_sleep(ar, vif);
237440abc2deSRaja Mani 	if (ret)
237540abc2deSRaja Mani 		return ret;
237640abc2deSRaja Mani 
237740abc2deSRaja Mani 	return 0;
237840abc2deSRaja Mani }
237940abc2deSRaja Mani 
238040abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar)
238140abc2deSRaja Mani {
238240abc2deSRaja Mani 	struct ath6kl_vif *vif;
238340abc2deSRaja Mani 	int ret;
238440abc2deSRaja Mani 
238540abc2deSRaja Mani 	vif = ath6kl_vif_first(ar);
238640abc2deSRaja Mani 
238740abc2deSRaja Mani 	if (!vif)
238840abc2deSRaja Mani 		return -EIO;
238940abc2deSRaja Mani 
239040abc2deSRaja Mani 	if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) {
239140abc2deSRaja Mani 		ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0,
239240abc2deSRaja Mani 					       ar->wmi->saved_pwr_mode);
239340abc2deSRaja Mani 		if (ret)
239440abc2deSRaja Mani 			return ret;
239540abc2deSRaja Mani 	}
239640abc2deSRaja Mani 
239740abc2deSRaja Mani 	ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
239840abc2deSRaja Mani 						 ATH6KL_HOST_MODE_AWAKE);
239940abc2deSRaja Mani 	if (ret)
240040abc2deSRaja Mani 		return ret;
240140abc2deSRaja Mani 
240240abc2deSRaja Mani 	ar->state = ATH6KL_STATE_ON;
240340abc2deSRaja Mani 
240440abc2deSRaja Mani 	/* Reset scan parameter to default values */
240540abc2deSRaja Mani 	ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx,
240640abc2deSRaja Mani 					0, 0, 0, 0, 0, 0, 3, 0, 0, 0);
240740abc2deSRaja Mani 	if (ret)
240840abc2deSRaja Mani 		return ret;
240940abc2deSRaja Mani 
241040abc2deSRaja Mani 	return 0;
241140abc2deSRaja Mani }
241240abc2deSRaja Mani 
241352d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar,
24140f60e9f4SRaja Mani 			    enum ath6kl_cfg_suspend_mode mode,
24150f60e9f4SRaja Mani 			    struct cfg80211_wowlan *wow)
241652d81a68SKalle Valo {
24173d79499cSVivek Natarajan 	struct ath6kl_vif *vif;
2418390a8c8fSRaja Mani 	enum ath6kl_state prev_state;
241952d81a68SKalle Valo 	int ret;
242052d81a68SKalle Valo 
242152d81a68SKalle Valo 	switch (mode) {
2422d7c44e0bSRaja Mani 	case ATH6KL_CFG_SUSPEND_WOW:
2423d7c44e0bSRaja Mani 
2424d7c44e0bSRaja Mani 		ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n");
2425d7c44e0bSRaja Mani 
2426d7c44e0bSRaja Mani 		/* Flush all non control pkts in TX path */
2427d7c44e0bSRaja Mani 		ath6kl_tx_data_cleanup(ar);
2428d7c44e0bSRaja Mani 
2429390a8c8fSRaja Mani 		prev_state = ar->state;
2430390a8c8fSRaja Mani 
2431d7c44e0bSRaja Mani 		ret = ath6kl_wow_suspend(ar, wow);
2432390a8c8fSRaja Mani 		if (ret) {
2433390a8c8fSRaja Mani 			ar->state = prev_state;
2434d7c44e0bSRaja Mani 			return ret;
2435390a8c8fSRaja Mani 		}
24361e9a905dSRaja Mani 
2437d7c44e0bSRaja Mani 		ar->state = ATH6KL_STATE_WOW;
2438d7c44e0bSRaja Mani 		break;
2439d7c44e0bSRaja Mani 
244052d81a68SKalle Valo 	case ATH6KL_CFG_SUSPEND_DEEPSLEEP:
2441524441e3SRaja Mani 
244240abc2deSRaja Mani 		ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n");
2443524441e3SRaja Mani 
244440abc2deSRaja Mani 		ret = ath6kl_cfg80211_deepsleep_suspend(ar);
244552d81a68SKalle Valo 		if (ret) {
244640abc2deSRaja Mani 			ath6kl_err("deepsleep suspend failed: %d\n", ret);
244740abc2deSRaja Mani 			return ret;
244852d81a68SKalle Valo 		}
244952d81a68SKalle Valo 
245076a9fbe2SKalle Valo 		ar->state = ATH6KL_STATE_DEEPSLEEP;
245176a9fbe2SKalle Valo 
245252d81a68SKalle Valo 		break;
2453b4b2a0b1SKalle Valo 
2454b4b2a0b1SKalle Valo 	case ATH6KL_CFG_SUSPEND_CUTPOWER:
2455524441e3SRaja Mani 
24567125f01dSKalle Valo 		ath6kl_cfg80211_stop_all(ar);
2457524441e3SRaja Mani 
2458b4b2a0b1SKalle Valo 		if (ar->state == ATH6KL_STATE_OFF) {
2459b4b2a0b1SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_SUSPEND,
2460b4b2a0b1SKalle Valo 				   "suspend hw off, no action for cutpower\n");
2461b4b2a0b1SKalle Valo 			break;
2462b4b2a0b1SKalle Valo 		}
2463b4b2a0b1SKalle Valo 
2464b4b2a0b1SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n");
2465b4b2a0b1SKalle Valo 
2466b4b2a0b1SKalle Valo 		ret = ath6kl_init_hw_stop(ar);
2467b4b2a0b1SKalle Valo 		if (ret) {
2468b4b2a0b1SKalle Valo 			ath6kl_warn("failed to stop hw during suspend: %d\n",
2469b4b2a0b1SKalle Valo 				    ret);
2470b4b2a0b1SKalle Valo 		}
2471b4b2a0b1SKalle Valo 
2472b4b2a0b1SKalle Valo 		ar->state = ATH6KL_STATE_CUTPOWER;
2473b4b2a0b1SKalle Valo 
2474b4b2a0b1SKalle Valo 		break;
2475b4b2a0b1SKalle Valo 
2476b4b2a0b1SKalle Valo 	default:
2477b4b2a0b1SKalle Valo 		break;
247852d81a68SKalle Valo 	}
247952d81a68SKalle Valo 
24803d79499cSVivek Natarajan 	list_for_each_entry(vif, &ar->vif_list, list)
24813d79499cSVivek Natarajan 		ath6kl_cfg80211_scan_complete_event(vif, true);
24823d79499cSVivek Natarajan 
248352d81a68SKalle Valo 	return 0;
248452d81a68SKalle Valo }
2485d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend);
248652d81a68SKalle Valo 
248752d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar)
248852d81a68SKalle Valo {
248976a9fbe2SKalle Valo 	int ret;
249076a9fbe2SKalle Valo 
249176a9fbe2SKalle Valo 	switch (ar->state) {
2492d7c44e0bSRaja Mani 	case  ATH6KL_STATE_WOW:
2493d7c44e0bSRaja Mani 		ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n");
2494d7c44e0bSRaja Mani 
2495d7c44e0bSRaja Mani 		ret = ath6kl_wow_resume(ar);
2496d7c44e0bSRaja Mani 		if (ret) {
2497d7c44e0bSRaja Mani 			ath6kl_warn("wow mode resume failed: %d\n", ret);
2498d7c44e0bSRaja Mani 			return ret;
2499d7c44e0bSRaja Mani 		}
2500d7c44e0bSRaja Mani 
2501d7c44e0bSRaja Mani 		break;
2502d7c44e0bSRaja Mani 
250376a9fbe2SKalle Valo 	case ATH6KL_STATE_DEEPSLEEP:
250440abc2deSRaja Mani 		ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n");
250540abc2deSRaja Mani 
250640abc2deSRaja Mani 		ret = ath6kl_cfg80211_deepsleep_resume(ar);
250776a9fbe2SKalle Valo 		if (ret) {
250840abc2deSRaja Mani 			ath6kl_warn("deep sleep resume failed: %d\n", ret);
250940abc2deSRaja Mani 			return ret;
251076a9fbe2SKalle Valo 		}
251176a9fbe2SKalle Valo 		break;
251276a9fbe2SKalle Valo 
2513b4b2a0b1SKalle Valo 	case ATH6KL_STATE_CUTPOWER:
2514b4b2a0b1SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n");
2515b4b2a0b1SKalle Valo 
2516b4b2a0b1SKalle Valo 		ret = ath6kl_init_hw_start(ar);
2517b4b2a0b1SKalle Valo 		if (ret) {
2518b4b2a0b1SKalle Valo 			ath6kl_warn("Failed to boot hw in resume: %d\n", ret);
2519b4b2a0b1SKalle Valo 			return ret;
2520b4b2a0b1SKalle Valo 		}
2521d7c44e0bSRaja Mani 		break;
2522b4b2a0b1SKalle Valo 
252376a9fbe2SKalle Valo 	default:
252476a9fbe2SKalle Valo 		break;
252552d81a68SKalle Valo 	}
252652d81a68SKalle Valo 
252752d81a68SKalle Valo 	return 0;
252852d81a68SKalle Valo }
2529d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume);
253052d81a68SKalle Valo 
2531abcb344bSKalle Valo #ifdef CONFIG_PM
253252d81a68SKalle Valo 
253352d81a68SKalle Valo /* hif layer decides what suspend mode to use */
253452d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy,
2535abcb344bSKalle Valo 				 struct cfg80211_wowlan *wow)
2536abcb344bSKalle Valo {
2537abcb344bSKalle Valo 	struct ath6kl *ar = wiphy_priv(wiphy);
2538abcb344bSKalle Valo 
253984caf800SVasanthakumar Thiagarajan 	ath6kl_recovery_suspend(ar);
254084caf800SVasanthakumar Thiagarajan 
25410f60e9f4SRaja Mani 	return ath6kl_hif_suspend(ar, wow);
2542abcb344bSKalle Valo }
2543aa6cffc1SChilam Ng 
254452d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy)
2545aa6cffc1SChilam Ng {
2546aa6cffc1SChilam Ng 	struct ath6kl *ar = wiphy_priv(wiphy);
254784caf800SVasanthakumar Thiagarajan 	int err;
2548aa6cffc1SChilam Ng 
254984caf800SVasanthakumar Thiagarajan 	err = ath6kl_hif_resume(ar);
255084caf800SVasanthakumar Thiagarajan 	if (err)
255184caf800SVasanthakumar Thiagarajan 		return err;
255284caf800SVasanthakumar Thiagarajan 
255392332993SVasanthakumar Thiagarajan 	ath6kl_recovery_resume(ar);
255484caf800SVasanthakumar Thiagarajan 
255584caf800SVasanthakumar Thiagarajan 	return 0;
2556aa6cffc1SChilam Ng }
2557a918fb3cSRaja Mani 
2558a918fb3cSRaja Mani /*
2559a918fb3cSRaja Mani  * FIXME: WOW suspend mode is selected if the host sdio controller supports
2560a918fb3cSRaja Mani  * both sdio irq wake up and keep power. The target pulls sdio data line to
2561a918fb3cSRaja Mani  * wake up the host when WOW pattern matches. This causes sdio irq handler
2562a918fb3cSRaja Mani  * is being called in the host side which internally hits ath6kl's RX path.
2563a918fb3cSRaja Mani  *
2564a918fb3cSRaja Mani  * Since sdio interrupt is not disabled, RX path executes even before
2565a918fb3cSRaja Mani  * the host executes the actual resume operation from PM module.
2566a918fb3cSRaja Mani  *
2567a918fb3cSRaja Mani  * In the current scenario, WOW resume should happen before start processing
2568a918fb3cSRaja Mani  * any data from the target. So It's required to perform WOW resume in RX path.
2569a918fb3cSRaja Mani  * Ideally we should perform WOW resume only in the actual platform
2570a918fb3cSRaja Mani  * resume path. This area needs bit rework to avoid WOW resume in RX path.
2571a918fb3cSRaja Mani  *
2572a918fb3cSRaja Mani  * ath6kl_check_wow_status() is called from ath6kl_rx().
2573a918fb3cSRaja Mani  */
2574a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar)
2575a918fb3cSRaja Mani {
2576390a8c8fSRaja Mani 	if (ar->state == ATH6KL_STATE_SUSPENDING)
2577390a8c8fSRaja Mani 		return;
2578390a8c8fSRaja Mani 
2579a918fb3cSRaja Mani 	if (ar->state == ATH6KL_STATE_WOW)
2580a918fb3cSRaja Mani 		ath6kl_cfg80211_resume(ar);
2581a918fb3cSRaja Mani }
2582a918fb3cSRaja Mani 
2583a918fb3cSRaja Mani #else
2584a918fb3cSRaja Mani 
2585a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar)
2586a918fb3cSRaja Mani {
2587a918fb3cSRaja Mani }
2588abcb344bSKalle Valo #endif
2589abcb344bSKalle Valo 
259057fbcce3SJohannes Berg static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum nl80211_band band,
2591df90b369SVasanthakumar Thiagarajan 			    bool ht_enable)
25926a7c9badSJouni Malinen {
259367b3f129SKiran Reddy 	struct ath6kl_htcap *htcap = &vif->htcap[band];
2594e68f6750SSujith Manoharan 
2595df90b369SVasanthakumar Thiagarajan 	if (htcap->ht_enable == ht_enable)
25966a7c9badSJouni Malinen 		return 0;
2597df90b369SVasanthakumar Thiagarajan 
2598df90b369SVasanthakumar Thiagarajan 	if (ht_enable) {
2599df90b369SVasanthakumar Thiagarajan 		/* Set default ht capabilities */
2600df90b369SVasanthakumar Thiagarajan 		htcap->ht_enable = true;
260157fbcce3SJohannes Berg 		htcap->cap_info = (band == NL80211_BAND_2GHZ) ?
2602df90b369SVasanthakumar Thiagarajan 				   ath6kl_g_htcap : ath6kl_a_htcap;
2603df90b369SVasanthakumar Thiagarajan 		htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K;
2604df90b369SVasanthakumar Thiagarajan 	} else /* Disable ht */
2605df90b369SVasanthakumar Thiagarajan 		memset(htcap, 0, sizeof(*htcap));
2606df90b369SVasanthakumar Thiagarajan 
2607df90b369SVasanthakumar Thiagarajan 	return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx,
2608df90b369SVasanthakumar Thiagarajan 					band, htcap);
26096a7c9badSJouni Malinen }
26106a7c9badSJouni Malinen 
261137a2f950SThomas Pedersen static int ath6kl_restore_htcap(struct ath6kl_vif *vif)
261237a2f950SThomas Pedersen {
261337a2f950SThomas Pedersen 	struct wiphy *wiphy = vif->ar->wiphy;
261437a2f950SThomas Pedersen 	int band, ret = 0;
261537a2f950SThomas Pedersen 
261657fbcce3SJohannes Berg 	for (band = 0; band < NUM_NL80211_BANDS; band++) {
261737a2f950SThomas Pedersen 		if (!wiphy->bands[band])
261837a2f950SThomas Pedersen 			continue;
261937a2f950SThomas Pedersen 
262037a2f950SThomas Pedersen 		ret = ath6kl_set_htcap(vif, band,
262137a2f950SThomas Pedersen 				wiphy->bands[band]->ht_cap.ht_supported);
262237a2f950SThomas Pedersen 		if (ret)
262337a2f950SThomas Pedersen 			return ret;
262437a2f950SThomas Pedersen 	}
262537a2f950SThomas Pedersen 
262637a2f950SThomas Pedersen 	return ret;
262737a2f950SThomas Pedersen }
262837a2f950SThomas Pedersen 
26298bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos)
26308bdfbf40SJouni Malinen {
26318bdfbf40SJouni Malinen 	return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
26328bdfbf40SJouni Malinen 		pos[2] == 0x50 && pos[3] == 0x6f &&
26338bdfbf40SJouni Malinen 		pos[4] == 0x9a && pos[5] == 0x09;
26348bdfbf40SJouni Malinen }
26358bdfbf40SJouni Malinen 
2636334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif,
2637334234b5SVasanthakumar Thiagarajan 					const u8 *ies, size_t ies_len)
26388bdfbf40SJouni Malinen {
2639334234b5SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
26408bdfbf40SJouni Malinen 	const u8 *pos;
26418bdfbf40SJouni Malinen 	u8 *buf = NULL;
26428bdfbf40SJouni Malinen 	size_t len = 0;
26438bdfbf40SJouni Malinen 	int ret;
26448bdfbf40SJouni Malinen 
26458bdfbf40SJouni Malinen 	/*
26468bdfbf40SJouni Malinen 	 * Filter out P2P IE(s) since they will be included depending on
26478bdfbf40SJouni Malinen 	 * the Probe Request frame in ath6kl_send_go_probe_resp().
26488bdfbf40SJouni Malinen 	 */
26498bdfbf40SJouni Malinen 
26508bdfbf40SJouni Malinen 	if (ies && ies_len) {
26518bdfbf40SJouni Malinen 		buf = kmalloc(ies_len, GFP_KERNEL);
26528bdfbf40SJouni Malinen 		if (buf == NULL)
26538bdfbf40SJouni Malinen 			return -ENOMEM;
26548bdfbf40SJouni Malinen 		pos = ies;
26558bdfbf40SJouni Malinen 		while (pos + 1 < ies + ies_len) {
26568bdfbf40SJouni Malinen 			if (pos + 2 + pos[1] > ies + ies_len)
26578bdfbf40SJouni Malinen 				break;
26588bdfbf40SJouni Malinen 			if (!ath6kl_is_p2p_ie(pos)) {
26598bdfbf40SJouni Malinen 				memcpy(buf + len, pos, 2 + pos[1]);
26608bdfbf40SJouni Malinen 				len += 2 + pos[1];
26618bdfbf40SJouni Malinen 			}
26628bdfbf40SJouni Malinen 			pos += 2 + pos[1];
26638bdfbf40SJouni Malinen 		}
26648bdfbf40SJouni Malinen 	}
26658bdfbf40SJouni Malinen 
2666334234b5SVasanthakumar Thiagarajan 	ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
2667334234b5SVasanthakumar Thiagarajan 				       WMI_FRAME_PROBE_RESP, buf, len);
26688bdfbf40SJouni Malinen 	kfree(buf);
26698bdfbf40SJouni Malinen 	return ret;
26708bdfbf40SJouni Malinen }
26718bdfbf40SJouni Malinen 
26728860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif,
26738860020eSJohannes Berg 			  struct cfg80211_beacon_data *info)
26748860020eSJohannes Berg {
26758860020eSJohannes Berg 	struct ath6kl *ar = vif->ar;
26768860020eSJohannes Berg 	int res;
26778860020eSJohannes Berg 
267817a7b16dSAarthi Thiruvengadam 	/* this also clears IE in fw if it's not set */
26798860020eSJohannes Berg 	res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
26808860020eSJohannes Berg 				       WMI_FRAME_BEACON,
26818860020eSJohannes Berg 				       info->beacon_ies,
26828860020eSJohannes Berg 				       info->beacon_ies_len);
26838860020eSJohannes Berg 	if (res)
26848860020eSJohannes Berg 		return res;
26858860020eSJohannes Berg 
268617a7b16dSAarthi Thiruvengadam 	/* this also clears IE in fw if it's not set */
26878860020eSJohannes Berg 	res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies,
26888860020eSJohannes Berg 					   info->proberesp_ies_len);
26898860020eSJohannes Berg 	if (res)
26908860020eSJohannes Berg 		return res;
26918860020eSJohannes Berg 
269217a7b16dSAarthi Thiruvengadam 	/* this also clears IE in fw if it's not set */
26938860020eSJohannes Berg 	res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
26948860020eSJohannes Berg 				       WMI_FRAME_ASSOC_RESP,
26958860020eSJohannes Berg 				       info->assocresp_ies,
26968860020eSJohannes Berg 				       info->assocresp_ies_len);
26978860020eSJohannes Berg 	if (res)
26988860020eSJohannes Berg 		return res;
26998860020eSJohannes Berg 
27008860020eSJohannes Berg 	return 0;
27018860020eSJohannes Berg }
27028860020eSJohannes Berg 
2703d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon,
2704d97c121bSVasanthakumar Thiagarajan 				u8 *rsn_capab)
2705d97c121bSVasanthakumar Thiagarajan {
2706d97c121bSVasanthakumar Thiagarajan 	const u8 *rsn_ie;
2707d97c121bSVasanthakumar Thiagarajan 	size_t rsn_ie_len;
2708d97c121bSVasanthakumar Thiagarajan 	u16 cnt;
2709d97c121bSVasanthakumar Thiagarajan 
2710d97c121bSVasanthakumar Thiagarajan 	if (!beacon->tail)
2711d97c121bSVasanthakumar Thiagarajan 		return -EINVAL;
2712d97c121bSVasanthakumar Thiagarajan 
2713d97c121bSVasanthakumar Thiagarajan 	rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len);
2714d97c121bSVasanthakumar Thiagarajan 	if (!rsn_ie)
2715d97c121bSVasanthakumar Thiagarajan 		return -EINVAL;
2716d97c121bSVasanthakumar Thiagarajan 
2717d97c121bSVasanthakumar Thiagarajan 	rsn_ie_len = *(rsn_ie + 1);
2718d97c121bSVasanthakumar Thiagarajan 	/* skip element id and length */
2719d97c121bSVasanthakumar Thiagarajan 	rsn_ie += 2;
2720d97c121bSVasanthakumar Thiagarajan 
27219e8b16dbSVasanthakumar Thiagarajan 	/* skip version */
27229e8b16dbSVasanthakumar Thiagarajan 	if (rsn_ie_len < 2)
2723d97c121bSVasanthakumar Thiagarajan 		return -EINVAL;
27249e8b16dbSVasanthakumar Thiagarajan 	rsn_ie +=  2;
27259e8b16dbSVasanthakumar Thiagarajan 	rsn_ie_len -= 2;
27269e8b16dbSVasanthakumar Thiagarajan 
27279e8b16dbSVasanthakumar Thiagarajan 	/* skip group cipher suite */
27289e8b16dbSVasanthakumar Thiagarajan 	if (rsn_ie_len < 4)
27299e8b16dbSVasanthakumar Thiagarajan 		return 0;
27309e8b16dbSVasanthakumar Thiagarajan 	rsn_ie +=  4;
27319e8b16dbSVasanthakumar Thiagarajan 	rsn_ie_len -= 4;
2732d97c121bSVasanthakumar Thiagarajan 
2733d97c121bSVasanthakumar Thiagarajan 	/* skip pairwise cipher suite */
2734d97c121bSVasanthakumar Thiagarajan 	if (rsn_ie_len < 2)
27359e8b16dbSVasanthakumar Thiagarajan 		return 0;
2736798985c6SVasanthakumar Thiagarajan 	cnt = get_unaligned_le16(rsn_ie);
2737d97c121bSVasanthakumar Thiagarajan 	rsn_ie += (2 + cnt * 4);
2738d97c121bSVasanthakumar Thiagarajan 	rsn_ie_len -= (2 + cnt * 4);
2739d97c121bSVasanthakumar Thiagarajan 
2740d97c121bSVasanthakumar Thiagarajan 	/* skip akm suite */
2741d97c121bSVasanthakumar Thiagarajan 	if (rsn_ie_len < 2)
27429e8b16dbSVasanthakumar Thiagarajan 		return 0;
2743798985c6SVasanthakumar Thiagarajan 	cnt = get_unaligned_le16(rsn_ie);
2744d97c121bSVasanthakumar Thiagarajan 	rsn_ie += (2 + cnt * 4);
2745d97c121bSVasanthakumar Thiagarajan 	rsn_ie_len -= (2 + cnt * 4);
2746d97c121bSVasanthakumar Thiagarajan 
2747d97c121bSVasanthakumar Thiagarajan 	if (rsn_ie_len < 2)
27489e8b16dbSVasanthakumar Thiagarajan 		return 0;
2749d97c121bSVasanthakumar Thiagarajan 
2750d97c121bSVasanthakumar Thiagarajan 	memcpy(rsn_capab, rsn_ie, 2);
2751d97c121bSVasanthakumar Thiagarajan 
2752d97c121bSVasanthakumar Thiagarajan 	return 0;
2753d97c121bSVasanthakumar Thiagarajan }
2754d97c121bSVasanthakumar Thiagarajan 
27558860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev,
27568860020eSJohannes Berg 			   struct cfg80211_ap_settings *info)
27576a7c9badSJouni Malinen {
27586a7c9badSJouni Malinen 	struct ath6kl *ar = ath6kl_priv(dev);
27593450334fSVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
27606a7c9badSJouni Malinen 	struct ieee80211_mgmt *mgmt;
276167cd22e4SThomas Pedersen 	bool hidden = false;
27626a7c9badSJouni Malinen 	u8 *ies;
27636a7c9badSJouni Malinen 	int ies_len;
27646a7c9badSJouni Malinen 	struct wmi_connect_cmd p;
27656a7c9badSJouni Malinen 	int res;
2766be5abaafSVasanthakumar Thiagarajan 	int i, ret;
2767d97c121bSVasanthakumar Thiagarajan 	u16 rsn_capab = 0;
27687ac25eacSMohammed Shafi Shajakhan 	int inactivity_timeout = 0;
27696a7c9badSJouni Malinen 
27708860020eSJohannes Berg 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__);
27716a7c9badSJouni Malinen 
2772990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
27736a7c9badSJouni Malinen 		return -EIO;
27746a7c9badSJouni Malinen 
2775f5938f24SVasanthakumar Thiagarajan 	if (vif->next_mode != AP_NETWORK)
27766a7c9badSJouni Malinen 		return -EOPNOTSUPP;
27776a7c9badSJouni Malinen 
27788860020eSJohannes Berg 	res = ath6kl_set_ies(vif, &info->beacon);
27796a7c9badSJouni Malinen 
27809a5b1318SJouni Malinen 	ar->ap_mode_bkey.valid = false;
27819a5b1318SJouni Malinen 
2782eb922e4bSMohammed Shafi Shajakhan 	ret = ath6kl_wmi_ap_set_beacon_intvl_cmd(ar->wmi, vif->fw_vif_idx,
2783eb922e4bSMohammed Shafi Shajakhan 						 info->beacon_interval);
2784eb922e4bSMohammed Shafi Shajakhan 
2785eb922e4bSMohammed Shafi Shajakhan 	if (ret)
2786eb922e4bSMohammed Shafi Shajakhan 		ath6kl_warn("Failed to set beacon interval: %d\n", ret);
27876a7c9badSJouni Malinen 
2788d154f32eSEtay Luz 	ret = ath6kl_wmi_ap_set_dtim_cmd(ar->wmi, vif->fw_vif_idx,
2789d154f32eSEtay Luz 					 info->dtim_period);
2790d154f32eSEtay Luz 
2791d154f32eSEtay Luz 	/* ignore error, just print a warning and continue normally */
2792d154f32eSEtay Luz 	if (ret)
2793d154f32eSEtay Luz 		ath6kl_warn("Failed to set dtim_period in beacon: %d\n", ret);
2794d154f32eSEtay Luz 
27958860020eSJohannes Berg 	if (info->beacon.head == NULL)
27966a7c9badSJouni Malinen 		return -EINVAL;
27978860020eSJohannes Berg 	mgmt = (struct ieee80211_mgmt *) info->beacon.head;
27986a7c9badSJouni Malinen 	ies = mgmt->u.beacon.variable;
27998860020eSJohannes Berg 	if (ies > info->beacon.head + info->beacon.head_len)
28006a7c9badSJouni Malinen 		return -EINVAL;
28018860020eSJohannes Berg 	ies_len = info->beacon.head + info->beacon.head_len - ies;
28026a7c9badSJouni Malinen 
28036a7c9badSJouni Malinen 	if (info->ssid == NULL)
28046a7c9badSJouni Malinen 		return -EINVAL;
28053450334fSVasanthakumar Thiagarajan 	memcpy(vif->ssid, info->ssid, info->ssid_len);
28063450334fSVasanthakumar Thiagarajan 	vif->ssid_len = info->ssid_len;
28076a7c9badSJouni Malinen 	if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE)
280867cd22e4SThomas Pedersen 		hidden = true;
280967cd22e4SThomas Pedersen 
281067cd22e4SThomas Pedersen 	res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden);
281167cd22e4SThomas Pedersen 	if (res)
281267cd22e4SThomas Pedersen 		return res;
28136a7c9badSJouni Malinen 
2814be5abaafSVasanthakumar Thiagarajan 	ret = ath6kl_set_auth_type(vif, info->auth_type);
2815be5abaafSVasanthakumar Thiagarajan 	if (ret)
2816be5abaafSVasanthakumar Thiagarajan 		return ret;
28176a7c9badSJouni Malinen 
28186a7c9badSJouni Malinen 	memset(&p, 0, sizeof(p));
28196a7c9badSJouni Malinen 
28206a7c9badSJouni Malinen 	for (i = 0; i < info->crypto.n_akm_suites; i++) {
28216a7c9badSJouni Malinen 		switch (info->crypto.akm_suites[i]) {
28226a7c9badSJouni Malinen 		case WLAN_AKM_SUITE_8021X:
28236a7c9badSJouni Malinen 			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1)
28246a7c9badSJouni Malinen 				p.auth_mode |= WPA_AUTH;
28256a7c9badSJouni Malinen 			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2)
28266a7c9badSJouni Malinen 				p.auth_mode |= WPA2_AUTH;
28276a7c9badSJouni Malinen 			break;
28286a7c9badSJouni Malinen 		case WLAN_AKM_SUITE_PSK:
28296a7c9badSJouni Malinen 			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1)
28306a7c9badSJouni Malinen 				p.auth_mode |= WPA_PSK_AUTH;
28316a7c9badSJouni Malinen 			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2)
28326a7c9badSJouni Malinen 				p.auth_mode |= WPA2_PSK_AUTH;
28336a7c9badSJouni Malinen 			break;
28346a7c9badSJouni Malinen 		}
28356a7c9badSJouni Malinen 	}
28366a7c9badSJouni Malinen 	if (p.auth_mode == 0)
28376a7c9badSJouni Malinen 		p.auth_mode = NONE_AUTH;
28383450334fSVasanthakumar Thiagarajan 	vif->auth_mode = p.auth_mode;
28396a7c9badSJouni Malinen 
28406a7c9badSJouni Malinen 	for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) {
28416a7c9badSJouni Malinen 		switch (info->crypto.ciphers_pairwise[i]) {
28426a7c9badSJouni Malinen 		case WLAN_CIPHER_SUITE_WEP40:
28436a7c9badSJouni Malinen 		case WLAN_CIPHER_SUITE_WEP104:
28446a7c9badSJouni Malinen 			p.prwise_crypto_type |= WEP_CRYPT;
28456a7c9badSJouni Malinen 			break;
28466a7c9badSJouni Malinen 		case WLAN_CIPHER_SUITE_TKIP:
28476a7c9badSJouni Malinen 			p.prwise_crypto_type |= TKIP_CRYPT;
28486a7c9badSJouni Malinen 			break;
28496a7c9badSJouni Malinen 		case WLAN_CIPHER_SUITE_CCMP:
28506a7c9badSJouni Malinen 			p.prwise_crypto_type |= AES_CRYPT;
28516a7c9badSJouni Malinen 			break;
2852b8214df1SDai Shuibing 		case WLAN_CIPHER_SUITE_SMS4:
2853b8214df1SDai Shuibing 			p.prwise_crypto_type |= WAPI_CRYPT;
2854b8214df1SDai Shuibing 			break;
28556a7c9badSJouni Malinen 		}
28566a7c9badSJouni Malinen 	}
2857229ed6b5SEdward Lu 	if (p.prwise_crypto_type == 0) {
28586a7c9badSJouni Malinen 		p.prwise_crypto_type = NONE_CRYPT;
2859240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, 0, true);
2860a5d8f9dfSKalle Valo 	} else if (info->crypto.n_ciphers_pairwise == 1) {
2861240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true);
2862a5d8f9dfSKalle Valo 	}
28636a7c9badSJouni Malinen 
28646a7c9badSJouni Malinen 	switch (info->crypto.cipher_group) {
28656a7c9badSJouni Malinen 	case WLAN_CIPHER_SUITE_WEP40:
28666a7c9badSJouni Malinen 	case WLAN_CIPHER_SUITE_WEP104:
28676a7c9badSJouni Malinen 		p.grp_crypto_type = WEP_CRYPT;
28686a7c9badSJouni Malinen 		break;
28696a7c9badSJouni Malinen 	case WLAN_CIPHER_SUITE_TKIP:
28706a7c9badSJouni Malinen 		p.grp_crypto_type = TKIP_CRYPT;
28716a7c9badSJouni Malinen 		break;
28726a7c9badSJouni Malinen 	case WLAN_CIPHER_SUITE_CCMP:
28736a7c9badSJouni Malinen 		p.grp_crypto_type = AES_CRYPT;
28746a7c9badSJouni Malinen 		break;
2875b8214df1SDai Shuibing 	case WLAN_CIPHER_SUITE_SMS4:
2876b8214df1SDai Shuibing 		p.grp_crypto_type = WAPI_CRYPT;
2877b8214df1SDai Shuibing 		break;
28786a7c9badSJouni Malinen 	default:
28796a7c9badSJouni Malinen 		p.grp_crypto_type = NONE_CRYPT;
28806a7c9badSJouni Malinen 		break;
28816a7c9badSJouni Malinen 	}
2882240d2799SVasanthakumar Thiagarajan 	ath6kl_set_cipher(vif, info->crypto.cipher_group, false);
28836a7c9badSJouni Malinen 
28846a7c9badSJouni Malinen 	p.nw_type = AP_NETWORK;
2885f5938f24SVasanthakumar Thiagarajan 	vif->nw_type = vif->next_mode;
28866a7c9badSJouni Malinen 
28873450334fSVasanthakumar Thiagarajan 	p.ssid_len = vif->ssid_len;
28883450334fSVasanthakumar Thiagarajan 	memcpy(p.ssid, vif->ssid, vif->ssid_len);
28893450334fSVasanthakumar Thiagarajan 	p.dot11_auth_mode = vif->dot11_auth_mode;
2890683b6d3bSJohannes Berg 	p.ch = cpu_to_le16(info->chandef.chan->center_freq);
28916a7c9badSJouni Malinen 
2892c1762a3fSThirumalai Pachamuthu 	/* Enable uAPSD support by default */
2893c1762a3fSThirumalai Pachamuthu 	res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true);
2894c1762a3fSThirumalai Pachamuthu 	if (res < 0)
2895c1762a3fSThirumalai Pachamuthu 		return res;
2896c1762a3fSThirumalai Pachamuthu 
28973ca9d1fcSAarthi Thiruvengadam 	if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) {
28983ca9d1fcSAarthi Thiruvengadam 		p.nw_subtype = SUBTYPE_P2PGO;
28993ca9d1fcSAarthi Thiruvengadam 	} else {
29003ca9d1fcSAarthi Thiruvengadam 		/*
29013ca9d1fcSAarthi Thiruvengadam 		 * Due to firmware limitation, it is not possible to
29023ca9d1fcSAarthi Thiruvengadam 		 * do P2P mgmt operations in AP mode
29033ca9d1fcSAarthi Thiruvengadam 		 */
29043ca9d1fcSAarthi Thiruvengadam 		p.nw_subtype = SUBTYPE_NONE;
29053ca9d1fcSAarthi Thiruvengadam 	}
29063ca9d1fcSAarthi Thiruvengadam 
290703bdeb0dSVasanthakumar Thiagarajan 	if (info->inactivity_timeout) {
29087ac25eacSMohammed Shafi Shajakhan 		inactivity_timeout = info->inactivity_timeout;
29097ac25eacSMohammed Shafi Shajakhan 
2910eba95bceSKalle Valo 		if (test_bit(ATH6KL_FW_CAPABILITY_AP_INACTIVITY_MINS,
2911eba95bceSKalle Valo 			     ar->fw_capabilities))
29127ac25eacSMohammed Shafi Shajakhan 			inactivity_timeout = DIV_ROUND_UP(inactivity_timeout,
29137ac25eacSMohammed Shafi Shajakhan 							  60);
29147ac25eacSMohammed Shafi Shajakhan 
291503bdeb0dSVasanthakumar Thiagarajan 		res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx,
29167ac25eacSMohammed Shafi Shajakhan 						  inactivity_timeout);
291703bdeb0dSVasanthakumar Thiagarajan 		if (res < 0)
291803bdeb0dSVasanthakumar Thiagarajan 			return res;
291903bdeb0dSVasanthakumar Thiagarajan 	}
292003bdeb0dSVasanthakumar Thiagarajan 
2921683b6d3bSJohannes Berg 	if (ath6kl_set_htcap(vif, info->chandef.chan->band,
2922683b6d3bSJohannes Berg 			     cfg80211_get_chandef_type(&info->chandef)
2923683b6d3bSJohannes Berg 					!= NL80211_CHAN_NO_HT))
2924df90b369SVasanthakumar Thiagarajan 		return -EIO;
2925df90b369SVasanthakumar Thiagarajan 
2926d97c121bSVasanthakumar Thiagarajan 	/*
2927d97c121bSVasanthakumar Thiagarajan 	 * Get the PTKSA replay counter in the RSN IE. Supplicant
2928d97c121bSVasanthakumar Thiagarajan 	 * will use the RSN IE in M3 message and firmware has to
2929d97c121bSVasanthakumar Thiagarajan 	 * advertise the same in beacon/probe response. Send
2930d97c121bSVasanthakumar Thiagarajan 	 * the complete RSN IE capability field to firmware
2931d97c121bSVasanthakumar Thiagarajan 	 */
2932d97c121bSVasanthakumar Thiagarajan 	if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) &&
2933d97c121bSVasanthakumar Thiagarajan 	    test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE,
2934d97c121bSVasanthakumar Thiagarajan 		     ar->fw_capabilities)) {
2935d97c121bSVasanthakumar Thiagarajan 		res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx,
2936d97c121bSVasanthakumar Thiagarajan 					    WLAN_EID_RSN, WMI_RSN_IE_CAPB,
2937d97c121bSVasanthakumar Thiagarajan 					    (const u8 *) &rsn_capab,
2938d97c121bSVasanthakumar Thiagarajan 					    sizeof(rsn_capab));
2939f21243a8SThomas Pedersen 		vif->rsn_capab = rsn_capab;
2940d97c121bSVasanthakumar Thiagarajan 		if (res < 0)
2941d97c121bSVasanthakumar Thiagarajan 			return res;
2942d97c121bSVasanthakumar Thiagarajan 	}
2943d97c121bSVasanthakumar Thiagarajan 
2944c4f7863eSThomas Pedersen 	memcpy(&vif->profile, &p, sizeof(p));
2945334234b5SVasanthakumar Thiagarajan 	res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p);
29469a5b1318SJouni Malinen 	if (res < 0)
29479a5b1318SJouni Malinen 		return res;
29489a5b1318SJouni Malinen 
29499a5b1318SJouni Malinen 	return 0;
29506a7c9badSJouni Malinen }
29516a7c9badSJouni Malinen 
29528860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev,
29538860020eSJohannes Berg 				struct cfg80211_beacon_data *beacon)
29546a7c9badSJouni Malinen {
29558860020eSJohannes Berg 	struct ath6kl_vif *vif = netdev_priv(dev);
29568860020eSJohannes Berg 
29578860020eSJohannes Berg 	if (!ath6kl_cfg80211_ready(vif))
29588860020eSJohannes Berg 		return -EIO;
29598860020eSJohannes Berg 
29608860020eSJohannes Berg 	if (vif->next_mode != AP_NETWORK)
29618860020eSJohannes Berg 		return -EOPNOTSUPP;
29628860020eSJohannes Berg 
29638860020eSJohannes Berg 	return ath6kl_set_ies(vif, beacon);
29646a7c9badSJouni Malinen }
29656a7c9badSJouni Malinen 
29668860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev)
29676a7c9badSJouni Malinen {
29686a7c9badSJouni Malinen 	struct ath6kl *ar = ath6kl_priv(dev);
296959c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
29706a7c9badSJouni Malinen 
2971f5938f24SVasanthakumar Thiagarajan 	if (vif->nw_type != AP_NETWORK)
29726a7c9badSJouni Malinen 		return -EOPNOTSUPP;
297359c98449SVasanthakumar Thiagarajan 	if (!test_bit(CONNECTED, &vif->flags))
29746a7c9badSJouni Malinen 		return -ENOTCONN;
29756a7c9badSJouni Malinen 
2976334234b5SVasanthakumar Thiagarajan 	ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx);
297759c98449SVasanthakumar Thiagarajan 	clear_bit(CONNECTED, &vif->flags);
297876b817f6SPierre Le Magourou 	netif_carrier_off(vif->ndev);
29796a7c9badSJouni Malinen 
2980df90b369SVasanthakumar Thiagarajan 	/* Restore ht setting in firmware */
298137a2f950SThomas Pedersen 	return ath6kl_restore_htcap(vif);
29826a7c9badSJouni Malinen }
29836a7c9badSJouni Malinen 
298433e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
298533e5308dSJouni Malinen 
298633e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev,
298789c771e5SJouni Malinen 			      struct station_del_parameters *params)
298833e5308dSJouni Malinen {
298933e5308dSJouni Malinen 	struct ath6kl *ar = ath6kl_priv(dev);
299033e5308dSJouni Malinen 	struct ath6kl_vif *vif = netdev_priv(dev);
299189c771e5SJouni Malinen 	const u8 *addr = params->mac ? params->mac : bcast_addr;
299233e5308dSJouni Malinen 
299333e5308dSJouni Malinen 	return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH,
299433e5308dSJouni Malinen 				      addr, WLAN_REASON_PREV_AUTH_NOT_VALID);
299533e5308dSJouni Malinen }
299633e5308dSJouni Malinen 
299723875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev,
29983b3a0162SJohannes Berg 				 const u8 *mac,
29993b3a0162SJohannes Berg 				 struct station_parameters *params)
300023875136SJouni Malinen {
300123875136SJouni Malinen 	struct ath6kl *ar = ath6kl_priv(dev);
3002f5938f24SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
300377ee7c89SJohannes Berg 	int err;
300423875136SJouni Malinen 
3005f5938f24SVasanthakumar Thiagarajan 	if (vif->nw_type != AP_NETWORK)
300623875136SJouni Malinen 		return -EOPNOTSUPP;
300723875136SJouni Malinen 
300877ee7c89SJohannes Berg 	err = cfg80211_check_station_change(wiphy, params,
300977ee7c89SJohannes Berg 					    CFG80211_STA_AP_MLME_CLIENT);
301077ee7c89SJohannes Berg 	if (err)
301177ee7c89SJohannes Berg 		return err;
301223875136SJouni Malinen 
301323875136SJouni Malinen 	if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED))
3014334234b5SVasanthakumar Thiagarajan 		return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx,
3015334234b5SVasanthakumar Thiagarajan 					      WMI_AP_MLME_AUTHORIZE, mac, 0);
3016334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx,
3017334234b5SVasanthakumar Thiagarajan 				      WMI_AP_MLME_UNAUTHORIZE, mac, 0);
301823875136SJouni Malinen }
301923875136SJouni Malinen 
302063fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy,
302171bbc994SJohannes Berg 				    struct wireless_dev *wdev,
302263fa1e0cSJouni Malinen 				    struct ieee80211_channel *chan,
302363fa1e0cSJouni Malinen 				    unsigned int duration,
302463fa1e0cSJouni Malinen 				    u64 *cookie)
302563fa1e0cSJouni Malinen {
302671bbc994SJohannes Berg 	struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev);
302771bbc994SJohannes Berg 	struct ath6kl *ar = ath6kl_priv(vif->ndev);
30281052261eSJouni Malinen 	u32 id;
302963fa1e0cSJouni Malinen 
303063fa1e0cSJouni Malinen 	/* TODO: if already pending or ongoing remain-on-channel,
303163fa1e0cSJouni Malinen 	 * return -EBUSY */
30321052261eSJouni Malinen 	id = ++vif->last_roc_id;
30331052261eSJouni Malinen 	if (id == 0) {
30341052261eSJouni Malinen 		/* Do not use 0 as the cookie value */
30351052261eSJouni Malinen 		id = ++vif->last_roc_id;
30361052261eSJouni Malinen 	}
30371052261eSJouni Malinen 	*cookie = id;
303863fa1e0cSJouni Malinen 
3039334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx,
3040334234b5SVasanthakumar Thiagarajan 					     chan->center_freq, duration);
304163fa1e0cSJouni Malinen }
304263fa1e0cSJouni Malinen 
304363fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy,
304471bbc994SJohannes Berg 					   struct wireless_dev *wdev,
304563fa1e0cSJouni Malinen 					   u64 cookie)
304663fa1e0cSJouni Malinen {
304771bbc994SJohannes Berg 	struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev);
304871bbc994SJohannes Berg 	struct ath6kl *ar = ath6kl_priv(vif->ndev);
304963fa1e0cSJouni Malinen 
30501052261eSJouni Malinen 	if (cookie != vif->last_roc_id)
305163fa1e0cSJouni Malinen 		return -ENOENT;
30521052261eSJouni Malinen 	vif->last_cancel_roc_id = cookie;
305363fa1e0cSJouni Malinen 
3054334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx);
305563fa1e0cSJouni Malinen }
305663fa1e0cSJouni Malinen 
3057334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif,
3058334234b5SVasanthakumar Thiagarajan 				     const u8 *buf, size_t len,
3059334234b5SVasanthakumar Thiagarajan 				     unsigned int freq)
30608bdfbf40SJouni Malinen {
3061334234b5SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
30628bdfbf40SJouni Malinen 	const u8 *pos;
30638bdfbf40SJouni Malinen 	u8 *p2p;
30648bdfbf40SJouni Malinen 	int p2p_len;
30658bdfbf40SJouni Malinen 	int ret;
30668bdfbf40SJouni Malinen 	const struct ieee80211_mgmt *mgmt;
30678bdfbf40SJouni Malinen 
30688bdfbf40SJouni Malinen 	mgmt = (const struct ieee80211_mgmt *) buf;
30698bdfbf40SJouni Malinen 
30708bdfbf40SJouni Malinen 	/* Include P2P IE(s) from the frame generated in user space. */
30718bdfbf40SJouni Malinen 
30728bdfbf40SJouni Malinen 	p2p = kmalloc(len, GFP_KERNEL);
30738bdfbf40SJouni Malinen 	if (p2p == NULL)
30748bdfbf40SJouni Malinen 		return -ENOMEM;
30758bdfbf40SJouni Malinen 	p2p_len = 0;
30768bdfbf40SJouni Malinen 
30778bdfbf40SJouni Malinen 	pos = mgmt->u.probe_resp.variable;
30788bdfbf40SJouni Malinen 	while (pos + 1 < buf + len) {
30798bdfbf40SJouni Malinen 		if (pos + 2 + pos[1] > buf + len)
30808bdfbf40SJouni Malinen 			break;
30818bdfbf40SJouni Malinen 		if (ath6kl_is_p2p_ie(pos)) {
30828bdfbf40SJouni Malinen 			memcpy(p2p + p2p_len, pos, 2 + pos[1]);
30838bdfbf40SJouni Malinen 			p2p_len += 2 + pos[1];
30848bdfbf40SJouni Malinen 		}
30858bdfbf40SJouni Malinen 		pos += 2 + pos[1];
30868bdfbf40SJouni Malinen 	}
30878bdfbf40SJouni Malinen 
3088334234b5SVasanthakumar Thiagarajan 	ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq,
3089334234b5SVasanthakumar Thiagarajan 						 mgmt->da, p2p, p2p_len);
30908bdfbf40SJouni Malinen 	kfree(p2p);
30918bdfbf40SJouni Malinen 	return ret;
30928bdfbf40SJouni Malinen }
30938bdfbf40SJouni Malinen 
3094d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif,
3095d0ff7383SNaveen Gangadharan 				     u32 id,
3096d0ff7383SNaveen Gangadharan 				     u32 freq,
3097d0ff7383SNaveen Gangadharan 				     u32 wait,
3098d0ff7383SNaveen Gangadharan 				     const u8 *buf,
3099d0ff7383SNaveen Gangadharan 				     size_t len,
3100d0ff7383SNaveen Gangadharan 				     bool *more_data,
3101d0ff7383SNaveen Gangadharan 				     bool no_cck)
3102d0ff7383SNaveen Gangadharan {
3103d0ff7383SNaveen Gangadharan 	struct ieee80211_mgmt *mgmt;
3104d0ff7383SNaveen Gangadharan 	struct ath6kl_sta *conn;
3105d0ff7383SNaveen Gangadharan 	bool is_psq_empty = false;
3106d0ff7383SNaveen Gangadharan 	struct ath6kl_mgmt_buff *mgmt_buf;
3107d0ff7383SNaveen Gangadharan 	size_t mgmt_buf_size;
3108d0ff7383SNaveen Gangadharan 	struct ath6kl *ar = vif->ar;
3109d0ff7383SNaveen Gangadharan 
3110d0ff7383SNaveen Gangadharan 	mgmt = (struct ieee80211_mgmt *) buf;
3111d0ff7383SNaveen Gangadharan 	if (is_multicast_ether_addr(mgmt->da))
3112d0ff7383SNaveen Gangadharan 		return false;
3113d0ff7383SNaveen Gangadharan 
3114d0ff7383SNaveen Gangadharan 	conn = ath6kl_find_sta(vif, mgmt->da);
3115d0ff7383SNaveen Gangadharan 	if (!conn)
3116d0ff7383SNaveen Gangadharan 		return false;
3117d0ff7383SNaveen Gangadharan 
3118d0ff7383SNaveen Gangadharan 	if (conn->sta_flags & STA_PS_SLEEP) {
3119d0ff7383SNaveen Gangadharan 		if (!(conn->sta_flags & STA_PS_POLLED)) {
3120d0ff7383SNaveen Gangadharan 			/* Queue the frames if the STA is sleeping */
3121d0ff7383SNaveen Gangadharan 			mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff);
3122d0ff7383SNaveen Gangadharan 			mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL);
3123d0ff7383SNaveen Gangadharan 			if (!mgmt_buf)
3124d0ff7383SNaveen Gangadharan 				return false;
3125d0ff7383SNaveen Gangadharan 
3126d0ff7383SNaveen Gangadharan 			INIT_LIST_HEAD(&mgmt_buf->list);
3127d0ff7383SNaveen Gangadharan 			mgmt_buf->id = id;
3128d0ff7383SNaveen Gangadharan 			mgmt_buf->freq = freq;
3129d0ff7383SNaveen Gangadharan 			mgmt_buf->wait = wait;
3130d0ff7383SNaveen Gangadharan 			mgmt_buf->len = len;
3131d0ff7383SNaveen Gangadharan 			mgmt_buf->no_cck = no_cck;
3132d0ff7383SNaveen Gangadharan 			memcpy(mgmt_buf->buf, buf, len);
3133d0ff7383SNaveen Gangadharan 			spin_lock_bh(&conn->psq_lock);
3134d0ff7383SNaveen Gangadharan 			is_psq_empty = skb_queue_empty(&conn->psq) &&
3135d0ff7383SNaveen Gangadharan 					(conn->mgmt_psq_len == 0);
3136d0ff7383SNaveen Gangadharan 			list_add_tail(&mgmt_buf->list, &conn->mgmt_psq);
3137d0ff7383SNaveen Gangadharan 			conn->mgmt_psq_len++;
3138d0ff7383SNaveen Gangadharan 			spin_unlock_bh(&conn->psq_lock);
3139d0ff7383SNaveen Gangadharan 
3140d0ff7383SNaveen Gangadharan 			/*
3141d0ff7383SNaveen Gangadharan 			 * If this is the first pkt getting queued
3142d0ff7383SNaveen Gangadharan 			 * for this STA, update the PVB for this
3143d0ff7383SNaveen Gangadharan 			 * STA.
3144d0ff7383SNaveen Gangadharan 			 */
3145d0ff7383SNaveen Gangadharan 			if (is_psq_empty)
3146d0ff7383SNaveen Gangadharan 				ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx,
3147d0ff7383SNaveen Gangadharan 						       conn->aid, 1);
3148d0ff7383SNaveen Gangadharan 			return true;
3149d0ff7383SNaveen Gangadharan 		}
3150d0ff7383SNaveen Gangadharan 
3151d0ff7383SNaveen Gangadharan 		/*
3152d0ff7383SNaveen Gangadharan 		 * This tx is because of a PsPoll.
3153d0ff7383SNaveen Gangadharan 		 * Determine if MoreData bit has to be set.
3154d0ff7383SNaveen Gangadharan 		 */
3155d0ff7383SNaveen Gangadharan 		spin_lock_bh(&conn->psq_lock);
3156d0ff7383SNaveen Gangadharan 		if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0))
3157d0ff7383SNaveen Gangadharan 			*more_data = true;
3158d0ff7383SNaveen Gangadharan 		spin_unlock_bh(&conn->psq_lock);
3159d0ff7383SNaveen Gangadharan 	}
3160d0ff7383SNaveen Gangadharan 
3161d0ff7383SNaveen Gangadharan 	return false;
3162d0ff7383SNaveen Gangadharan }
3163d0ff7383SNaveen Gangadharan 
3164c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */
3165c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len)
3166c86e4f44SAarthi Thiruvengadam {
3167c86e4f44SAarthi Thiruvengadam 	const struct ieee80211_mgmt *mgmt;
3168c86e4f44SAarthi Thiruvengadam 	mgmt = (const struct ieee80211_mgmt *) buf;
3169c86e4f44SAarthi Thiruvengadam 
3170c86e4f44SAarthi Thiruvengadam 	/* variable[1] contains the SSID tag length */
3171c86e4f44SAarthi Thiruvengadam 	if (buf + len >= &mgmt->u.probe_resp.variable[1] &&
3172c86e4f44SAarthi Thiruvengadam 	    (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) {
3173c86e4f44SAarthi Thiruvengadam 		return true;
3174c86e4f44SAarthi Thiruvengadam 	}
3175c86e4f44SAarthi Thiruvengadam 
3176c86e4f44SAarthi Thiruvengadam 	return false;
3177c86e4f44SAarthi Thiruvengadam }
3178c86e4f44SAarthi Thiruvengadam 
317971bbc994SJohannes Berg static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev,
3180b176e629SAndrei Otcheretianski 			  struct cfg80211_mgmt_tx_params *params, u64 *cookie)
31818a6c8060SJouni Malinen {
318271bbc994SJohannes Berg 	struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev);
318371bbc994SJohannes Berg 	struct ath6kl *ar = ath6kl_priv(vif->ndev);
3184b176e629SAndrei Otcheretianski 	struct ieee80211_channel *chan = params->chan;
3185b176e629SAndrei Otcheretianski 	const u8 *buf = params->buf;
3186b176e629SAndrei Otcheretianski 	size_t len = params->len;
3187b176e629SAndrei Otcheretianski 	unsigned int wait = params->wait;
3188b176e629SAndrei Otcheretianski 	bool no_cck = params->no_cck;
3189bfd634d0SAntonio Quartulli 	u32 id, freq;
31908bdfbf40SJouni Malinen 	const struct ieee80211_mgmt *mgmt;
3191d0ff7383SNaveen Gangadharan 	bool more_data, queued;
31928bdfbf40SJouni Malinen 
3193bfd634d0SAntonio Quartulli 	/* default to the current channel, but use the one specified as argument
3194bfd634d0SAntonio Quartulli 	 * if any
3195bfd634d0SAntonio Quartulli 	 */
3196bfd634d0SAntonio Quartulli 	freq = vif->ch_hint;
3197bfd634d0SAntonio Quartulli 	if (chan)
3198bfd634d0SAntonio Quartulli 		freq = chan->center_freq;
3199bfd634d0SAntonio Quartulli 
3200bfd634d0SAntonio Quartulli 	/* never send freq zero to the firmware */
3201bfd634d0SAntonio Quartulli 	if (WARN_ON(freq == 0))
3202bfd634d0SAntonio Quartulli 		return -EINVAL;
3203bfd634d0SAntonio Quartulli 
32048bdfbf40SJouni Malinen 	mgmt = (const struct ieee80211_mgmt *) buf;
3205c86e4f44SAarthi Thiruvengadam 	if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) &&
3206c86e4f44SAarthi Thiruvengadam 	    ieee80211_is_probe_resp(mgmt->frame_control) &&
3207c86e4f44SAarthi Thiruvengadam 	    ath6kl_is_p2p_go_ssid(buf, len)) {
32088bdfbf40SJouni Malinen 		/*
3209c86e4f44SAarthi Thiruvengadam 		 * Send Probe Response frame in GO mode using a separate WMI
32108bdfbf40SJouni Malinen 		 * command to allow the target to fill in the generic IEs.
32118bdfbf40SJouni Malinen 		 */
32128bdfbf40SJouni Malinen 		*cookie = 0; /* TX status not supported */
3213bfd634d0SAntonio Quartulli 		return ath6kl_send_go_probe_resp(vif, buf, len, freq);
32148bdfbf40SJouni Malinen 	}
32158a6c8060SJouni Malinen 
3216cf5333d7SVasanthakumar Thiagarajan 	id = vif->send_action_id++;
32178a6c8060SJouni Malinen 	if (id == 0) {
32188a6c8060SJouni Malinen 		/*
32198a6c8060SJouni Malinen 		 * 0 is a reserved value in the WMI command and shall not be
32208a6c8060SJouni Malinen 		 * used for the command.
32218a6c8060SJouni Malinen 		 */
3222cf5333d7SVasanthakumar Thiagarajan 		id = vif->send_action_id++;
32238a6c8060SJouni Malinen 	}
32248a6c8060SJouni Malinen 
32258a6c8060SJouni Malinen 	*cookie = id;
32263ca9d1fcSAarthi Thiruvengadam 
3227d0ff7383SNaveen Gangadharan 	/* AP mode Power saving processing */
3228d0ff7383SNaveen Gangadharan 	if (vif->nw_type == AP_NETWORK) {
3229bfd634d0SAntonio Quartulli 		queued = ath6kl_mgmt_powersave_ap(vif, id, freq, wait, buf, len,
3230bfd634d0SAntonio Quartulli 						  &more_data, no_cck);
3231d0ff7383SNaveen Gangadharan 		if (queued)
3232d0ff7383SNaveen Gangadharan 			return 0;
3233d0ff7383SNaveen Gangadharan 	}
3234d0ff7383SNaveen Gangadharan 
3235bfd634d0SAntonio Quartulli 	return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, freq,
3236bfd634d0SAntonio Quartulli 					wait, buf, len, no_cck);
32373ca9d1fcSAarthi Thiruvengadam }
32388a6c8060SJouni Malinen 
32399c2e90ffSBen Greear static int ath6kl_get_antenna(struct wiphy *wiphy,
32409c2e90ffSBen Greear 			      u32 *tx_ant, u32 *rx_ant)
32419c2e90ffSBen Greear {
32429c2e90ffSBen Greear 	struct ath6kl *ar = wiphy_priv(wiphy);
32439c2e90ffSBen Greear 	*tx_ant = ar->hw.tx_ant;
32449c2e90ffSBen Greear 	*rx_ant = ar->hw.rx_ant;
32459c2e90ffSBen Greear 	return 0;
32469c2e90ffSBen Greear }
32479c2e90ffSBen Greear 
3248ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy,
324971bbc994SJohannes Berg 				       struct wireless_dev *wdev,
3250ae32c30aSJouni Malinen 				       u16 frame_type, bool reg)
3251ae32c30aSJouni Malinen {
325271bbc994SJohannes Berg 	struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev);
3253ae32c30aSJouni Malinen 
3254ae32c30aSJouni Malinen 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n",
3255ae32c30aSJouni Malinen 		   __func__, frame_type, reg);
3256ae32c30aSJouni Malinen 	if (frame_type == IEEE80211_STYPE_PROBE_REQ) {
3257ae32c30aSJouni Malinen 		/*
3258ae32c30aSJouni Malinen 		 * Note: This notification callback is not allowed to sleep, so
3259ae32c30aSJouni Malinen 		 * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we
3260ae32c30aSJouni Malinen 		 * hardcode target to report Probe Request frames all the time.
3261ae32c30aSJouni Malinen 		 */
3262cf5333d7SVasanthakumar Thiagarajan 		vif->probe_req_report = reg;
3263ae32c30aSJouni Malinen 	}
3264ae32c30aSJouni Malinen }
3265ae32c30aSJouni Malinen 
326610509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy,
326710509f90SKalle Valo 			struct net_device *dev,
326810509f90SKalle Valo 			struct cfg80211_sched_scan_request *request)
326910509f90SKalle Valo {
327010509f90SKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
327110509f90SKalle Valo 	struct ath6kl_vif *vif = netdev_priv(dev);
327210509f90SKalle Valo 	u16 interval;
327385b20fc2SThomas Pedersen 	int ret, rssi_thold;
3274ea73cbceSJohannes Berg 	int n_match_sets = request->n_match_sets;
3275ea73cbceSJohannes Berg 
3276ea73cbceSJohannes Berg 	/*
3277ea73cbceSJohannes Berg 	 * If there's a matchset w/o an SSID, then assume it's just for
3278ea73cbceSJohannes Berg 	 * the RSSI (nothing else is currently supported) and ignore it.
3279ea73cbceSJohannes Berg 	 * The device only supports a global RSSI filter that we set below.
3280ea73cbceSJohannes Berg 	 */
3281ea73cbceSJohannes Berg 	if (n_match_sets == 1 && !request->match_sets[0].ssid.ssid_len)
3282ea73cbceSJohannes Berg 		n_match_sets = 0;
328310509f90SKalle Valo 
328410509f90SKalle Valo 	if (ar->state != ATH6KL_STATE_ON)
328510509f90SKalle Valo 		return -EIO;
328610509f90SKalle Valo 
328710509f90SKalle Valo 	if (vif->sme_state != SME_DISCONNECTED)
328810509f90SKalle Valo 		return -EBUSY;
328910509f90SKalle Valo 
3290b4d13d3bSKalle Valo 	ath6kl_cfg80211_scan_complete_event(vif, true);
3291b4d13d3bSKalle Valo 
32923b8ffc6aSJouni Malinen 	ret = ath6kl_set_probed_ssids(ar, vif, request->ssids,
3293dd45b759SNaveen Singh 				      request->n_ssids,
3294dd45b759SNaveen Singh 				      request->match_sets,
3295ea73cbceSJohannes Berg 				      n_match_sets);
32963b8ffc6aSJouni Malinen 	if (ret < 0)
32973b8ffc6aSJouni Malinen 		return ret;
329810509f90SKalle Valo 
3299ea73cbceSJohannes Berg 	if (!n_match_sets) {
3300dd45b759SNaveen Singh 		ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
3301dd45b759SNaveen Singh 					       ALL_BSS_FILTER, 0);
3302dd45b759SNaveen Singh 		if (ret < 0)
3303dd45b759SNaveen Singh 			return ret;
3304dd45b759SNaveen Singh 	} else {
3305dd45b759SNaveen Singh 		 ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
3306dd45b759SNaveen Singh 						MATCHED_SSID_FILTER, 0);
3307dd45b759SNaveen Singh 		if (ret < 0)
3308dd45b759SNaveen Singh 			return ret;
3309dd45b759SNaveen Singh 	}
3310dd45b759SNaveen Singh 
331185b20fc2SThomas Pedersen 	if (test_bit(ATH6KL_FW_CAPABILITY_RSSI_SCAN_THOLD,
331285b20fc2SThomas Pedersen 		     ar->fw_capabilities)) {
3313ea73cbceSJohannes Berg 		if (request->min_rssi_thold <= NL80211_SCAN_RSSI_THOLD_OFF)
331485b20fc2SThomas Pedersen 			rssi_thold = 0;
3315ea73cbceSJohannes Berg 		else if (request->min_rssi_thold < -127)
331685b20fc2SThomas Pedersen 			rssi_thold = -127;
331785b20fc2SThomas Pedersen 		else
3318ea73cbceSJohannes Berg 			rssi_thold = request->min_rssi_thold;
331985b20fc2SThomas Pedersen 
332085b20fc2SThomas Pedersen 		ret = ath6kl_wmi_set_rssi_filter_cmd(ar->wmi, vif->fw_vif_idx,
332185b20fc2SThomas Pedersen 						     rssi_thold);
332285b20fc2SThomas Pedersen 		if (ret) {
332385b20fc2SThomas Pedersen 			ath6kl_err("failed to set RSSI threshold for scan\n");
332485b20fc2SThomas Pedersen 			return ret;
332585b20fc2SThomas Pedersen 		}
332685b20fc2SThomas Pedersen 	}
332785b20fc2SThomas Pedersen 
332810509f90SKalle Valo 	/* fw uses seconds, also make sure that it's >0 */
33293b06d277SAvraham Stern 	interval = max_t(u16, 1, request->scan_plans[0].interval);
333010509f90SKalle Valo 
333110509f90SKalle Valo 	ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx,
333210509f90SKalle Valo 				  interval, interval,
3333d472b5e4SSubramania Sharma Thandaveswaran 				  vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0);
333410509f90SKalle Valo 
333510509f90SKalle Valo 	/* this also clears IE in fw if it's not set */
333610509f90SKalle Valo 	ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
333710509f90SKalle Valo 				       WMI_FRAME_PROBE_REQ,
333810509f90SKalle Valo 				       request->ie, request->ie_len);
333910509f90SKalle Valo 	if (ret) {
3340f1ff32e8SJoe Perches 		ath6kl_warn("Failed to set probe request IE for scheduled scan: %d\n",
334110509f90SKalle Valo 			    ret);
334210509f90SKalle Valo 		return ret;
334310509f90SKalle Valo 	}
334410509f90SKalle Valo 
3345b1f47e3aSThomas Pedersen 	ret = ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, true);
3346b1f47e3aSThomas Pedersen 	if (ret)
334710509f90SKalle Valo 		return ret;
334810509f90SKalle Valo 
3349b1f47e3aSThomas Pedersen 	set_bit(SCHED_SCANNING, &vif->flags);
335010509f90SKalle Valo 
3351b1f47e3aSThomas Pedersen 	return 0;
335210509f90SKalle Valo }
335310509f90SKalle Valo 
335410509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy,
335510509f90SKalle Valo 				      struct net_device *dev)
335610509f90SKalle Valo {
335710509f90SKalle Valo 	struct ath6kl_vif *vif = netdev_priv(dev);
335810509f90SKalle Valo 	bool stopped;
335910509f90SKalle Valo 
336010509f90SKalle Valo 	stopped = __ath6kl_cfg80211_sscan_stop(vif);
336110509f90SKalle Valo 
336210509f90SKalle Valo 	if (!stopped)
336310509f90SKalle Valo 		return -EIO;
336410509f90SKalle Valo 
336510509f90SKalle Valo 	return 0;
336610509f90SKalle Valo }
336710509f90SKalle Valo 
336806e360acSBala Shanmugam static int ath6kl_cfg80211_set_bitrate(struct wiphy *wiphy,
336906e360acSBala Shanmugam 				       struct net_device *dev,
337006e360acSBala Shanmugam 				       const u8 *addr,
337106e360acSBala Shanmugam 				       const struct cfg80211_bitrate_mask *mask)
337206e360acSBala Shanmugam {
337306e360acSBala Shanmugam 	struct ath6kl *ar = ath6kl_priv(dev);
337406e360acSBala Shanmugam 	struct ath6kl_vif *vif = netdev_priv(dev);
337506e360acSBala Shanmugam 
337606e360acSBala Shanmugam 	return ath6kl_wmi_set_bitrate_mask(ar->wmi, vif->fw_vif_idx,
337706e360acSBala Shanmugam 					   mask);
337806e360acSBala Shanmugam }
337906e360acSBala Shanmugam 
3380279b2862SThomas Pedersen static int ath6kl_cfg80211_set_txe_config(struct wiphy *wiphy,
3381279b2862SThomas Pedersen 					  struct net_device *dev,
3382279b2862SThomas Pedersen 					  u32 rate, u32 pkts, u32 intvl)
3383279b2862SThomas Pedersen {
3384279b2862SThomas Pedersen 	struct ath6kl *ar = ath6kl_priv(dev);
3385279b2862SThomas Pedersen 	struct ath6kl_vif *vif = netdev_priv(dev);
3386279b2862SThomas Pedersen 
3387279b2862SThomas Pedersen 	if (vif->nw_type != INFRA_NETWORK ||
3388279b2862SThomas Pedersen 	    !test_bit(ATH6KL_FW_CAPABILITY_TX_ERR_NOTIFY, ar->fw_capabilities))
3389279b2862SThomas Pedersen 		return -EOPNOTSUPP;
3390279b2862SThomas Pedersen 
3391279b2862SThomas Pedersen 	if (vif->sme_state != SME_CONNECTED)
3392279b2862SThomas Pedersen 		return -ENOTCONN;
3393279b2862SThomas Pedersen 
3394279b2862SThomas Pedersen 	/* save this since the firmware won't report the interval */
3395279b2862SThomas Pedersen 	vif->txe_intvl = intvl;
3396279b2862SThomas Pedersen 
3397279b2862SThomas Pedersen 	return ath6kl_wmi_set_txe_notify(ar->wmi, vif->fw_vif_idx,
3398279b2862SThomas Pedersen 					 rate, pkts, intvl);
3399279b2862SThomas Pedersen }
3400279b2862SThomas Pedersen 
3401f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes
3402f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = {
3403f80574aeSJouni Malinen 	[NL80211_IFTYPE_STATION] = {
3404f80574aeSJouni Malinen 		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3405f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
3406f80574aeSJouni Malinen 		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3407f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
3408f80574aeSJouni Malinen 	},
3409ba1f6fe3SJouni Malinen 	[NL80211_IFTYPE_AP] = {
3410ba1f6fe3SJouni Malinen 		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3411ba1f6fe3SJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
3412ba1f6fe3SJouni Malinen 		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3413ba1f6fe3SJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
3414ba1f6fe3SJouni Malinen 	},
3415f80574aeSJouni Malinen 	[NL80211_IFTYPE_P2P_CLIENT] = {
3416f80574aeSJouni Malinen 		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3417f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
3418f80574aeSJouni Malinen 		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3419f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
3420f80574aeSJouni Malinen 	},
3421f80574aeSJouni Malinen 	[NL80211_IFTYPE_P2P_GO] = {
3422f80574aeSJouni Malinen 		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3423f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
3424f80574aeSJouni Malinen 		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
3425f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
3426f80574aeSJouni Malinen 	},
3427f80574aeSJouni Malinen };
3428f80574aeSJouni Malinen 
3429bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = {
343055055976SVasanthakumar Thiagarajan 	.add_virtual_intf = ath6kl_cfg80211_add_iface,
343155055976SVasanthakumar Thiagarajan 	.del_virtual_intf = ath6kl_cfg80211_del_iface,
3432bdcd8170SKalle Valo 	.change_virtual_intf = ath6kl_cfg80211_change_iface,
3433bdcd8170SKalle Valo 	.scan = ath6kl_cfg80211_scan,
3434bdcd8170SKalle Valo 	.connect = ath6kl_cfg80211_connect,
3435bdcd8170SKalle Valo 	.disconnect = ath6kl_cfg80211_disconnect,
3436bdcd8170SKalle Valo 	.add_key = ath6kl_cfg80211_add_key,
3437bdcd8170SKalle Valo 	.get_key = ath6kl_cfg80211_get_key,
3438bdcd8170SKalle Valo 	.del_key = ath6kl_cfg80211_del_key,
3439bdcd8170SKalle Valo 	.set_default_key = ath6kl_cfg80211_set_default_key,
3440bdcd8170SKalle Valo 	.set_wiphy_params = ath6kl_cfg80211_set_wiphy_params,
3441bdcd8170SKalle Valo 	.set_tx_power = ath6kl_cfg80211_set_txpower,
3442bdcd8170SKalle Valo 	.get_tx_power = ath6kl_cfg80211_get_txpower,
3443bdcd8170SKalle Valo 	.set_power_mgmt = ath6kl_cfg80211_set_power_mgmt,
3444bdcd8170SKalle Valo 	.join_ibss = ath6kl_cfg80211_join_ibss,
3445bdcd8170SKalle Valo 	.leave_ibss = ath6kl_cfg80211_leave_ibss,
3446bdcd8170SKalle Valo 	.get_station = ath6kl_get_station,
3447bdcd8170SKalle Valo 	.set_pmksa = ath6kl_set_pmksa,
3448bdcd8170SKalle Valo 	.del_pmksa = ath6kl_del_pmksa,
3449bdcd8170SKalle Valo 	.flush_pmksa = ath6kl_flush_pmksa,
3450003353b0SKalle Valo 	CFG80211_TESTMODE_CMD(ath6kl_tm_cmd)
3451abcb344bSKalle Valo #ifdef CONFIG_PM
345252d81a68SKalle Valo 	.suspend = __ath6kl_cfg80211_suspend,
345352d81a68SKalle Valo 	.resume = __ath6kl_cfg80211_resume,
3454abcb344bSKalle Valo #endif
34558860020eSJohannes Berg 	.start_ap = ath6kl_start_ap,
34568860020eSJohannes Berg 	.change_beacon = ath6kl_change_beacon,
34578860020eSJohannes Berg 	.stop_ap = ath6kl_stop_ap,
345833e5308dSJouni Malinen 	.del_station = ath6kl_del_station,
345923875136SJouni Malinen 	.change_station = ath6kl_change_station,
346063fa1e0cSJouni Malinen 	.remain_on_channel = ath6kl_remain_on_channel,
346163fa1e0cSJouni Malinen 	.cancel_remain_on_channel = ath6kl_cancel_remain_on_channel,
34628a6c8060SJouni Malinen 	.mgmt_tx = ath6kl_mgmt_tx,
3463ae32c30aSJouni Malinen 	.mgmt_frame_register = ath6kl_mgmt_frame_register,
34649c2e90ffSBen Greear 	.get_antenna = ath6kl_get_antenna,
346510509f90SKalle Valo 	.sched_scan_start = ath6kl_cfg80211_sscan_start,
346610509f90SKalle Valo 	.sched_scan_stop = ath6kl_cfg80211_sscan_stop,
346706e360acSBala Shanmugam 	.set_bitrate_mask = ath6kl_cfg80211_set_bitrate,
3468279b2862SThomas Pedersen 	.set_cqm_txe_config = ath6kl_cfg80211_set_txe_config,
3469bdcd8170SKalle Valo };
3470bdcd8170SKalle Valo 
34717125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif)
3472ec4b7f60SKalle Valo {
347310509f90SKalle Valo 	ath6kl_cfg80211_sscan_disable(vif);
347410509f90SKalle Valo 
3475ec4b7f60SKalle Valo 	switch (vif->sme_state) {
3476c97a31b0SKalle Valo 	case SME_DISCONNECTED:
3477c97a31b0SKalle Valo 		break;
3478ec4b7f60SKalle Valo 	case SME_CONNECTING:
3479ec4b7f60SKalle Valo 		cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0,
3480ec4b7f60SKalle Valo 					NULL, 0,
3481ec4b7f60SKalle Valo 					WLAN_STATUS_UNSPECIFIED_FAILURE,
3482ec4b7f60SKalle Valo 					GFP_KERNEL);
3483ec4b7f60SKalle Valo 		break;
3484ec4b7f60SKalle Valo 	case SME_CONNECTED:
348580279fb7SJohannes Berg 		cfg80211_disconnected(vif->ndev, 0, NULL, 0, true, GFP_KERNEL);
3486ec4b7f60SKalle Valo 		break;
3487ec4b7f60SKalle Valo 	}
3488ec4b7f60SKalle Valo 
348958109df6SVasanthakumar Thiagarajan 	if (vif->ar->state != ATH6KL_STATE_RECOVERY &&
349058109df6SVasanthakumar Thiagarajan 	    (test_bit(CONNECTED, &vif->flags) ||
349158109df6SVasanthakumar Thiagarajan 	    test_bit(CONNECT_PEND, &vif->flags)))
34927125f01dSKalle Valo 		ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx);
3493ec4b7f60SKalle Valo 
3494ec4b7f60SKalle Valo 	vif->sme_state = SME_DISCONNECTED;
34951f405255SKalle Valo 	clear_bit(CONNECTED, &vif->flags);
34961f405255SKalle Valo 	clear_bit(CONNECT_PEND, &vif->flags);
3497ec4b7f60SKalle Valo 
349884caf800SVasanthakumar Thiagarajan 	/* Stop netdev queues, needed during recovery */
349984caf800SVasanthakumar Thiagarajan 	netif_stop_queue(vif->ndev);
350084caf800SVasanthakumar Thiagarajan 	netif_carrier_off(vif->ndev);
350184caf800SVasanthakumar Thiagarajan 
3502ec4b7f60SKalle Valo 	/* disable scanning */
350358109df6SVasanthakumar Thiagarajan 	if (vif->ar->state != ATH6KL_STATE_RECOVERY &&
350458109df6SVasanthakumar Thiagarajan 	    ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF,
35057125f01dSKalle Valo 				      0, 0, 0, 0, 0, 0, 0, 0, 0) != 0)
35067125f01dSKalle Valo 		ath6kl_warn("failed to disable scan during stop\n");
3507ec4b7f60SKalle Valo 
3508ec4b7f60SKalle Valo 	ath6kl_cfg80211_scan_complete_event(vif, true);
3509ec4b7f60SKalle Valo }
3510ec4b7f60SKalle Valo 
35117125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar)
35127125f01dSKalle Valo {
35137125f01dSKalle Valo 	struct ath6kl_vif *vif;
35147125f01dSKalle Valo 
35157125f01dSKalle Valo 	vif = ath6kl_vif_first(ar);
351684caf800SVasanthakumar Thiagarajan 	if (!vif && ar->state != ATH6KL_STATE_RECOVERY) {
35177125f01dSKalle Valo 		/* save the current power mode before enabling power save */
35187125f01dSKalle Valo 		ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode;
35197125f01dSKalle Valo 
35207125f01dSKalle Valo 		if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0)
3521cdeb8602SKalle Valo 			ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n");
35227125f01dSKalle Valo 		return;
35237125f01dSKalle Valo 	}
35247125f01dSKalle Valo 
35257125f01dSKalle Valo 	/*
35267125f01dSKalle Valo 	 * FIXME: we should take ar->list_lock to protect changes in the
35277125f01dSKalle Valo 	 * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop()
35287125f01dSKalle Valo 	 * sleeps.
35297125f01dSKalle Valo 	 */
35307125f01dSKalle Valo 	list_for_each_entry(vif, &ar->vif_list, list)
35317125f01dSKalle Valo 		ath6kl_cfg80211_stop(vif);
35327125f01dSKalle Valo }
35337125f01dSKalle Valo 
35340c0280bdSLuis R. Rodriguez static void ath6kl_cfg80211_reg_notify(struct wiphy *wiphy,
353584841ba2SKalle Valo 				       struct regulatory_request *request)
353684841ba2SKalle Valo {
353784841ba2SKalle Valo 	struct ath6kl *ar = wiphy_priv(wiphy);
353857fbcce3SJohannes Berg 	u32 rates[NUM_NL80211_BANDS];
353984841ba2SKalle Valo 	int ret, i;
354084841ba2SKalle Valo 
354184841ba2SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
3542ff7e6867SKalle Valo 		   "cfg reg_notify %c%c%s%s initiator %d hint_type %d\n",
354384841ba2SKalle Valo 		   request->alpha2[0], request->alpha2[1],
354484841ba2SKalle Valo 		   request->intersect ? " intersect" : "",
354584841ba2SKalle Valo 		   request->processed ? " processed" : "",
3546ff7e6867SKalle Valo 		   request->initiator, request->user_reg_hint_type);
3547ff7e6867SKalle Valo 
3548ff7e6867SKalle Valo 	if (request->user_reg_hint_type != NL80211_USER_REG_HINT_CELL_BASE)
35490c0280bdSLuis R. Rodriguez 		return;
355084841ba2SKalle Valo 
355184841ba2SKalle Valo 	ret = ath6kl_wmi_set_regdomain_cmd(ar->wmi, request->alpha2);
355284841ba2SKalle Valo 	if (ret) {
355384841ba2SKalle Valo 		ath6kl_err("failed to set regdomain: %d\n", ret);
35540c0280bdSLuis R. Rodriguez 		return;
355584841ba2SKalle Valo 	}
355684841ba2SKalle Valo 
355784841ba2SKalle Valo 	/*
355884841ba2SKalle Valo 	 * Firmware will apply the regdomain change only after a scan is
355984841ba2SKalle Valo 	 * issued and it will send a WMI_REGDOMAIN_EVENTID when it has been
356084841ba2SKalle Valo 	 * changed.
356184841ba2SKalle Valo 	 */
356284841ba2SKalle Valo 
356357fbcce3SJohannes Berg 	for (i = 0; i < NUM_NL80211_BANDS; i++)
356484841ba2SKalle Valo 		if (wiphy->bands[i])
356584841ba2SKalle Valo 			rates[i] = (1 << wiphy->bands[i]->n_bitrates) - 1;
356684841ba2SKalle Valo 
356784841ba2SKalle Valo 
356884841ba2SKalle Valo 	ret = ath6kl_wmi_beginscan_cmd(ar->wmi, 0, WMI_LONG_SCAN, false,
356984841ba2SKalle Valo 				       false, 0, ATH6KL_FG_SCAN_INTERVAL,
357084841ba2SKalle Valo 				       0, NULL, false, rates);
357184841ba2SKalle Valo 	if (ret) {
357284841ba2SKalle Valo 		ath6kl_err("failed to start scan for a regdomain change: %d\n",
357384841ba2SKalle Valo 			   ret);
35740c0280bdSLuis R. Rodriguez 		return;
357584841ba2SKalle Valo 	}
357684841ba2SKalle Valo }
357784841ba2SKalle Valo 
3578c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif)
35798dafb70eSVasanthakumar Thiagarajan {
35807baef812SVasanthakumar Thiagarajan 	vif->aggr_cntxt = aggr_init(vif);
35812132c69cSVasanthakumar Thiagarajan 	if (!vif->aggr_cntxt) {
35828dafb70eSVasanthakumar Thiagarajan 		ath6kl_err("failed to initialize aggr\n");
35838dafb70eSVasanthakumar Thiagarajan 		return -ENOMEM;
35848dafb70eSVasanthakumar Thiagarajan 	}
35858dafb70eSVasanthakumar Thiagarajan 
3586de3ad713SVasanthakumar Thiagarajan 	setup_timer(&vif->disconnect_timer, disconnect_timer_handler,
3587108438bcSVasanthakumar Thiagarajan 		    (unsigned long) vif->ndev);
358810509f90SKalle Valo 	setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer,
358910509f90SKalle Valo 		    (unsigned long) vif);
359010509f90SKalle Valo 
3591de3ad713SVasanthakumar Thiagarajan 	set_bit(WMM_ENABLED, &vif->flags);
3592478ac027SVasanthakumar Thiagarajan 	spin_lock_init(&vif->if_lock);
35938dafb70eSVasanthakumar Thiagarajan 
359480abaf9bSVasanthakumar Thiagarajan 	INIT_LIST_HEAD(&vif->mc_filter);
359580abaf9bSVasanthakumar Thiagarajan 
35968dafb70eSVasanthakumar Thiagarajan 	return 0;
35978dafb70eSVasanthakumar Thiagarajan }
35988dafb70eSVasanthakumar Thiagarajan 
3599355b3a98SMohammed Shafi Shajakhan void ath6kl_cfg80211_vif_stop(struct ath6kl_vif *vif, bool wmi_ready)
3600355b3a98SMohammed Shafi Shajakhan {
3601355b3a98SMohammed Shafi Shajakhan 	static u8 bcast_mac[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
3602355b3a98SMohammed Shafi Shajakhan 	bool discon_issued;
3603355b3a98SMohammed Shafi Shajakhan 
3604355b3a98SMohammed Shafi Shajakhan 	netif_stop_queue(vif->ndev);
3605355b3a98SMohammed Shafi Shajakhan 
3606355b3a98SMohammed Shafi Shajakhan 	clear_bit(WLAN_ENABLED, &vif->flags);
3607355b3a98SMohammed Shafi Shajakhan 
3608355b3a98SMohammed Shafi Shajakhan 	if (wmi_ready) {
3609355b3a98SMohammed Shafi Shajakhan 		discon_issued = test_bit(CONNECTED, &vif->flags) ||
3610355b3a98SMohammed Shafi Shajakhan 				test_bit(CONNECT_PEND, &vif->flags);
3611355b3a98SMohammed Shafi Shajakhan 		ath6kl_disconnect(vif);
3612355b3a98SMohammed Shafi Shajakhan 		del_timer(&vif->disconnect_timer);
3613355b3a98SMohammed Shafi Shajakhan 
3614355b3a98SMohammed Shafi Shajakhan 		if (discon_issued)
3615355b3a98SMohammed Shafi Shajakhan 			ath6kl_disconnect_event(vif, DISCONNECT_CMD,
3616355b3a98SMohammed Shafi Shajakhan 						(vif->nw_type & AP_NETWORK) ?
3617355b3a98SMohammed Shafi Shajakhan 						bcast_mac : vif->bssid,
3618355b3a98SMohammed Shafi Shajakhan 						0, NULL, 0);
3619355b3a98SMohammed Shafi Shajakhan 	}
3620355b3a98SMohammed Shafi Shajakhan 
3621355b3a98SMohammed Shafi Shajakhan 	if (vif->scan_req) {
36221d76250bSAvraham Stern 		struct cfg80211_scan_info info = {
36231d76250bSAvraham Stern 			.aborted = true,
36241d76250bSAvraham Stern 		};
36251d76250bSAvraham Stern 
36261d76250bSAvraham Stern 		cfg80211_scan_done(vif->scan_req, &info);
3627355b3a98SMohammed Shafi Shajakhan 		vif->scan_req = NULL;
3628355b3a98SMohammed Shafi Shajakhan 	}
3629355b3a98SMohammed Shafi Shajakhan 
3630355b3a98SMohammed Shafi Shajakhan 	/* need to clean up enhanced bmiss detection fw state */
3631355b3a98SMohammed Shafi Shajakhan 	ath6kl_cfg80211_sta_bmiss_enhance(vif, false);
3632355b3a98SMohammed Shafi Shajakhan }
3633355b3a98SMohammed Shafi Shajakhan 
3634c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif)
36358dafb70eSVasanthakumar Thiagarajan {
363655055976SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
363780abaf9bSVasanthakumar Thiagarajan 	struct ath6kl_mc_filter *mc_filter, *tmp;
363855055976SVasanthakumar Thiagarajan 
36392132c69cSVasanthakumar Thiagarajan 	aggr_module_destroy(vif->aggr_cntxt);
3640108438bcSVasanthakumar Thiagarajan 
364155055976SVasanthakumar Thiagarajan 	ar->avail_idx_map |= BIT(vif->fw_vif_idx);
364255055976SVasanthakumar Thiagarajan 
364355055976SVasanthakumar Thiagarajan 	if (vif->nw_type == ADHOC_NETWORK)
364455055976SVasanthakumar Thiagarajan 		ar->ibss_if_active = false;
364555055976SVasanthakumar Thiagarajan 
364680abaf9bSVasanthakumar Thiagarajan 	list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) {
364780abaf9bSVasanthakumar Thiagarajan 		list_del(&mc_filter->list);
364880abaf9bSVasanthakumar Thiagarajan 		kfree(mc_filter);
364980abaf9bSVasanthakumar Thiagarajan 	}
365080abaf9bSVasanthakumar Thiagarajan 
365127929723SVasanthakumar Thiagarajan 	unregister_netdevice(vif->ndev);
365255055976SVasanthakumar Thiagarajan 
365355055976SVasanthakumar Thiagarajan 	ar->num_vif--;
36548dafb70eSVasanthakumar Thiagarajan }
36558dafb70eSVasanthakumar Thiagarajan 
365613eff531SBen Greear static const char ath6kl_gstrings_sta_stats[][ETH_GSTRING_LEN] = {
365713eff531SBen Greear 	/* Common stats names used by many drivers. */
365813eff531SBen Greear 	"tx_pkts_nic", "tx_bytes_nic", "rx_pkts_nic", "rx_bytes_nic",
365913eff531SBen Greear 
366013eff531SBen Greear 	/* TX stats. */
366113eff531SBen Greear 	"d_tx_ucast_pkts", "d_tx_bcast_pkts",
366213eff531SBen Greear 	"d_tx_ucast_bytes", "d_tx_bcast_bytes",
366313eff531SBen Greear 	"d_tx_rts_ok", "d_tx_error", "d_tx_fail",
366413eff531SBen Greear 	"d_tx_retry", "d_tx_multi_retry", "d_tx_rts_fail",
366513eff531SBen Greear 	"d_tx_tkip_counter_measures",
366613eff531SBen Greear 
366713eff531SBen Greear 	/* RX Stats. */
366813eff531SBen Greear 	"d_rx_ucast_pkts", "d_rx_ucast_rate", "d_rx_bcast_pkts",
366913eff531SBen Greear 	"d_rx_ucast_bytes", "d_rx_bcast_bytes", "d_rx_frag_pkt",
367013eff531SBen Greear 	"d_rx_error", "d_rx_crc_err", "d_rx_keycache_miss",
367113eff531SBen Greear 	"d_rx_decrypt_crc_err", "d_rx_duplicate_frames",
367213eff531SBen Greear 	"d_rx_mic_err", "d_rx_tkip_format_err", "d_rx_ccmp_format_err",
367313eff531SBen Greear 	"d_rx_ccmp_replay_err",
367413eff531SBen Greear 
367513eff531SBen Greear 	/* Misc stats. */
367613eff531SBen Greear 	"d_beacon_miss", "d_num_connects", "d_num_disconnects",
367713eff531SBen Greear 	"d_beacon_avg_rssi", "d_arp_received", "d_arp_matched",
367813eff531SBen Greear 	"d_arp_replied"
367913eff531SBen Greear };
368013eff531SBen Greear 
368113eff531SBen Greear #define ATH6KL_STATS_LEN	ARRAY_SIZE(ath6kl_gstrings_sta_stats)
368213eff531SBen Greear 
368313eff531SBen Greear static int ath6kl_get_sset_count(struct net_device *dev, int sset)
368413eff531SBen Greear {
368513eff531SBen Greear 	int rv = 0;
368613eff531SBen Greear 
368713eff531SBen Greear 	if (sset == ETH_SS_STATS)
368813eff531SBen Greear 		rv += ATH6KL_STATS_LEN;
368913eff531SBen Greear 
369013eff531SBen Greear 	if (rv == 0)
369113eff531SBen Greear 		return -EOPNOTSUPP;
369213eff531SBen Greear 	return rv;
369313eff531SBen Greear }
369413eff531SBen Greear 
369513eff531SBen Greear static void ath6kl_get_stats(struct net_device *dev,
369613eff531SBen Greear 			    struct ethtool_stats *stats,
369713eff531SBen Greear 			    u64 *data)
369813eff531SBen Greear {
369913eff531SBen Greear 	struct ath6kl_vif *vif = netdev_priv(dev);
370013eff531SBen Greear 	struct ath6kl *ar = vif->ar;
370113eff531SBen Greear 	int i = 0;
370213eff531SBen Greear 	struct target_stats *tgt_stats;
370313eff531SBen Greear 
370413eff531SBen Greear 	memset(data, 0, sizeof(u64) * ATH6KL_STATS_LEN);
370513eff531SBen Greear 
370613eff531SBen Greear 	ath6kl_read_tgt_stats(ar, vif);
370713eff531SBen Greear 
370813eff531SBen Greear 	tgt_stats = &vif->target_stats;
370913eff531SBen Greear 
371013eff531SBen Greear 	data[i++] = tgt_stats->tx_ucast_pkt + tgt_stats->tx_bcast_pkt;
371113eff531SBen Greear 	data[i++] = tgt_stats->tx_ucast_byte + tgt_stats->tx_bcast_byte;
371213eff531SBen Greear 	data[i++] = tgt_stats->rx_ucast_pkt + tgt_stats->rx_bcast_pkt;
371313eff531SBen Greear 	data[i++] = tgt_stats->rx_ucast_byte + tgt_stats->rx_bcast_byte;
371413eff531SBen Greear 
371513eff531SBen Greear 	data[i++] = tgt_stats->tx_ucast_pkt;
371613eff531SBen Greear 	data[i++] = tgt_stats->tx_bcast_pkt;
371713eff531SBen Greear 	data[i++] = tgt_stats->tx_ucast_byte;
371813eff531SBen Greear 	data[i++] = tgt_stats->tx_bcast_byte;
371913eff531SBen Greear 	data[i++] = tgt_stats->tx_rts_success_cnt;
372013eff531SBen Greear 	data[i++] = tgt_stats->tx_err;
372113eff531SBen Greear 	data[i++] = tgt_stats->tx_fail_cnt;
372213eff531SBen Greear 	data[i++] = tgt_stats->tx_retry_cnt;
372313eff531SBen Greear 	data[i++] = tgt_stats->tx_mult_retry_cnt;
372413eff531SBen Greear 	data[i++] = tgt_stats->tx_rts_fail_cnt;
372513eff531SBen Greear 	data[i++] = tgt_stats->tkip_cnter_measures_invoked;
372613eff531SBen Greear 
372713eff531SBen Greear 	data[i++] = tgt_stats->rx_ucast_pkt;
372813eff531SBen Greear 	data[i++] = tgt_stats->rx_ucast_rate;
372913eff531SBen Greear 	data[i++] = tgt_stats->rx_bcast_pkt;
373013eff531SBen Greear 	data[i++] = tgt_stats->rx_ucast_byte;
373113eff531SBen Greear 	data[i++] = tgt_stats->rx_bcast_byte;
373213eff531SBen Greear 	data[i++] = tgt_stats->rx_frgment_pkt;
373313eff531SBen Greear 	data[i++] = tgt_stats->rx_err;
373413eff531SBen Greear 	data[i++] = tgt_stats->rx_crc_err;
373513eff531SBen Greear 	data[i++] = tgt_stats->rx_key_cache_miss;
373613eff531SBen Greear 	data[i++] = tgt_stats->rx_decrypt_err;
373713eff531SBen Greear 	data[i++] = tgt_stats->rx_dupl_frame;
373813eff531SBen Greear 	data[i++] = tgt_stats->tkip_local_mic_fail;
373913eff531SBen Greear 	data[i++] = tgt_stats->tkip_fmt_err;
374013eff531SBen Greear 	data[i++] = tgt_stats->ccmp_fmt_err;
374113eff531SBen Greear 	data[i++] = tgt_stats->ccmp_replays;
374213eff531SBen Greear 
374313eff531SBen Greear 	data[i++] = tgt_stats->cs_bmiss_cnt;
374413eff531SBen Greear 	data[i++] = tgt_stats->cs_connect_cnt;
374513eff531SBen Greear 	data[i++] = tgt_stats->cs_discon_cnt;
374613eff531SBen Greear 	data[i++] = tgt_stats->cs_ave_beacon_rssi;
374713eff531SBen Greear 	data[i++] = tgt_stats->arp_received;
374813eff531SBen Greear 	data[i++] = tgt_stats->arp_matched;
374913eff531SBen Greear 	data[i++] = tgt_stats->arp_replied;
375013eff531SBen Greear 
375113eff531SBen Greear 	if (i !=  ATH6KL_STATS_LEN) {
375213eff531SBen Greear 		WARN_ON_ONCE(1);
375313eff531SBen Greear 		ath6kl_err("ethtool stats error, i: %d  STATS_LEN: %d\n",
375413eff531SBen Greear 			   i, (int)ATH6KL_STATS_LEN);
375513eff531SBen Greear 	}
375613eff531SBen Greear }
375713eff531SBen Greear 
375813eff531SBen Greear /* These stats are per NIC, not really per vdev, so we just ignore dev. */
375913eff531SBen Greear static void ath6kl_get_strings(struct net_device *dev, u32 sset, u8 *data)
376013eff531SBen Greear {
376113eff531SBen Greear 	int sz_sta_stats = 0;
376213eff531SBen Greear 
376313eff531SBen Greear 	if (sset == ETH_SS_STATS) {
376413eff531SBen Greear 		sz_sta_stats = sizeof(ath6kl_gstrings_sta_stats);
376513eff531SBen Greear 		memcpy(data, ath6kl_gstrings_sta_stats, sz_sta_stats);
376613eff531SBen Greear 	}
376713eff531SBen Greear }
376813eff531SBen Greear 
376913eff531SBen Greear static const struct ethtool_ops ath6kl_ethtool_ops = {
377013eff531SBen Greear 	.get_drvinfo = cfg80211_get_drvinfo,
377113eff531SBen Greear 	.get_link = ethtool_op_get_link,
377213eff531SBen Greear 	.get_strings = ath6kl_get_strings,
377313eff531SBen Greear 	.get_ethtool_stats = ath6kl_get_stats,
377413eff531SBen Greear 	.get_sset_count = ath6kl_get_sset_count,
377513eff531SBen Greear };
377613eff531SBen Greear 
3777552bff0cSJohannes Berg struct wireless_dev *ath6kl_interface_add(struct ath6kl *ar, const char *name,
37786bab2e19STom Gundersen 					  unsigned char name_assign_type,
377984efbb84SJohannes Berg 					  enum nl80211_iftype type,
378084efbb84SJohannes Berg 					  u8 fw_vif_idx, u8 nw_type)
37818dafb70eSVasanthakumar Thiagarajan {
37828dafb70eSVasanthakumar Thiagarajan 	struct net_device *ndev;
3783108438bcSVasanthakumar Thiagarajan 	struct ath6kl_vif *vif;
37848dafb70eSVasanthakumar Thiagarajan 
37856bab2e19STom Gundersen 	ndev = alloc_netdev(sizeof(*vif), name, name_assign_type, ether_setup);
37868dafb70eSVasanthakumar Thiagarajan 	if (!ndev)
37878dafb70eSVasanthakumar Thiagarajan 		return NULL;
37888dafb70eSVasanthakumar Thiagarajan 
3789108438bcSVasanthakumar Thiagarajan 	vif = netdev_priv(ndev);
3790108438bcSVasanthakumar Thiagarajan 	ndev->ieee80211_ptr = &vif->wdev;
3791108438bcSVasanthakumar Thiagarajan 	vif->wdev.wiphy = ar->wiphy;
3792108438bcSVasanthakumar Thiagarajan 	vif->ar = ar;
3793108438bcSVasanthakumar Thiagarajan 	vif->ndev = ndev;
3794108438bcSVasanthakumar Thiagarajan 	SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy));
3795108438bcSVasanthakumar Thiagarajan 	vif->wdev.netdev = ndev;
3796108438bcSVasanthakumar Thiagarajan 	vif->wdev.iftype = type;
3797334234b5SVasanthakumar Thiagarajan 	vif->fw_vif_idx = fw_vif_idx;
3798d0d670abSKalle Valo 	vif->nw_type = nw_type;
3799d0d670abSKalle Valo 	vif->next_mode = nw_type;
38008f46fccdSRaja Mani 	vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL;
3801ce0dc0cfSRaja Mani 	vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME;
3802eb38987eSRaja Mani 	vif->bg_scan_period = 0;
380357fbcce3SJohannes Berg 	vif->htcap[NL80211_BAND_2GHZ].ht_enable = true;
380457fbcce3SJohannes Berg 	vif->htcap[NL80211_BAND_5GHZ].ht_enable = true;
38058dafb70eSVasanthakumar Thiagarajan 
380655055976SVasanthakumar Thiagarajan 	memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN);
3807c95dcb59SAarthi Thiruvengadam 	if (fw_vif_idx != 0) {
380855055976SVasanthakumar Thiagarajan 		ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) |
380955055976SVasanthakumar Thiagarajan 				     0x2;
3810c95dcb59SAarthi Thiruvengadam 		if (test_bit(ATH6KL_FW_CAPABILITY_CUSTOM_MAC_ADDR,
3811c95dcb59SAarthi Thiruvengadam 			     ar->fw_capabilities))
3812c95dcb59SAarthi Thiruvengadam 			ndev->dev_addr[4] ^= 0x80;
3813c95dcb59SAarthi Thiruvengadam 	}
381455055976SVasanthakumar Thiagarajan 
38158dafb70eSVasanthakumar Thiagarajan 	init_netdev(ndev);
38168dafb70eSVasanthakumar Thiagarajan 
3817e29f25f5SVasanthakumar Thiagarajan 	ath6kl_init_control_info(vif);
38188dafb70eSVasanthakumar Thiagarajan 
3819c25889e8SKalle Valo 	if (ath6kl_cfg80211_vif_init(vif))
38208dafb70eSVasanthakumar Thiagarajan 		goto err;
38218dafb70eSVasanthakumar Thiagarajan 
382213eff531SBen Greear 	netdev_set_default_ethtool_ops(ndev, &ath6kl_ethtool_ops);
382313eff531SBen Greear 
382427929723SVasanthakumar Thiagarajan 	if (register_netdevice(ndev))
38258dafb70eSVasanthakumar Thiagarajan 		goto err;
38268dafb70eSVasanthakumar Thiagarajan 
382755055976SVasanthakumar Thiagarajan 	ar->avail_idx_map &= ~BIT(fw_vif_idx);
382814ee6f6bSVasanthakumar Thiagarajan 	vif->sme_state = SME_DISCONNECTED;
382959c98449SVasanthakumar Thiagarajan 	set_bit(WLAN_ENABLED, &vif->flags);
38308dafb70eSVasanthakumar Thiagarajan 	ar->wlan_pwr_state = WLAN_POWER_STATE_ON;
38318dafb70eSVasanthakumar Thiagarajan 
383255055976SVasanthakumar Thiagarajan 	if (type == NL80211_IFTYPE_ADHOC)
383355055976SVasanthakumar Thiagarajan 		ar->ibss_if_active = true;
383455055976SVasanthakumar Thiagarajan 
383511f6e40dSVasanthakumar Thiagarajan 	spin_lock_bh(&ar->list_lock);
3836990bd915SVasanthakumar Thiagarajan 	list_add_tail(&vif->list, &ar->vif_list);
383711f6e40dSVasanthakumar Thiagarajan 	spin_unlock_bh(&ar->list_lock);
3838990bd915SVasanthakumar Thiagarajan 
383984efbb84SJohannes Berg 	return &vif->wdev;
38408dafb70eSVasanthakumar Thiagarajan 
38418dafb70eSVasanthakumar Thiagarajan err:
384227929723SVasanthakumar Thiagarajan 	aggr_module_destroy(vif->aggr_cntxt);
384327929723SVasanthakumar Thiagarajan 	free_netdev(ndev);
3844bdcd8170SKalle Valo 	return NULL;
3845bdcd8170SKalle Valo }
3846bdcd8170SKalle Valo 
3847964dc9e2SJohannes Berg #ifdef CONFIG_PM
3848964dc9e2SJohannes Berg static const struct wiphy_wowlan_support ath6kl_wowlan_support = {
3849964dc9e2SJohannes Berg 	.flags = WIPHY_WOWLAN_MAGIC_PKT |
3850964dc9e2SJohannes Berg 		 WIPHY_WOWLAN_DISCONNECT |
3851964dc9e2SJohannes Berg 		 WIPHY_WOWLAN_GTK_REKEY_FAILURE  |
3852964dc9e2SJohannes Berg 		 WIPHY_WOWLAN_SUPPORTS_GTK_REKEY |
3853964dc9e2SJohannes Berg 		 WIPHY_WOWLAN_EAP_IDENTITY_REQ   |
3854964dc9e2SJohannes Berg 		 WIPHY_WOWLAN_4WAY_HANDSHAKE,
3855964dc9e2SJohannes Berg 	.n_patterns = WOW_MAX_FILTERS_PER_LIST,
3856964dc9e2SJohannes Berg 	.pattern_min_len = 1,
3857964dc9e2SJohannes Berg 	.pattern_max_len = WOW_PATTERN_SIZE,
3858964dc9e2SJohannes Berg };
3859964dc9e2SJohannes Berg #endif
3860964dc9e2SJohannes Berg 
386146d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar)
386246d33a21SKalle Valo {
386346d33a21SKalle Valo 	struct wiphy *wiphy = ar->wiphy;
3864d92917e4SThomas Pedersen 	bool band_2gig = false, band_5gig = false, ht = false;
386546d33a21SKalle Valo 	int ret;
386646d33a21SKalle Valo 
386746d33a21SKalle Valo 	wiphy->mgmt_stypes = ath6kl_mgmt_stypes;
386846d33a21SKalle Valo 
386946d33a21SKalle Valo 	wiphy->max_remain_on_channel_duration = 5000;
387046d33a21SKalle Valo 
387146d33a21SKalle Valo 	/* set device pointer for wiphy */
387246d33a21SKalle Valo 	set_wiphy_dev(wiphy, ar->dev);
387346d33a21SKalle Valo 
387446d33a21SKalle Valo 	wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
387546d33a21SKalle Valo 				 BIT(NL80211_IFTYPE_ADHOC) |
387646d33a21SKalle Valo 				 BIT(NL80211_IFTYPE_AP);
387746d33a21SKalle Valo 	if (ar->p2p) {
387846d33a21SKalle Valo 		wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) |
387946d33a21SKalle Valo 					  BIT(NL80211_IFTYPE_P2P_CLIENT);
388046d33a21SKalle Valo 	}
388146d33a21SKalle Valo 
388297f2645fSMasahiro Yamada 	if (IS_ENABLED(CONFIG_ATH6KL_REGDOMAIN) &&
3883ff7e6867SKalle Valo 	    test_bit(ATH6KL_FW_CAPABILITY_REGDOMAIN, ar->fw_capabilities)) {
388484841ba2SKalle Valo 		wiphy->reg_notifier = ath6kl_cfg80211_reg_notify;
3885ff7e6867SKalle Valo 		ar->wiphy->features |= NL80211_FEATURE_CELL_BASE_REG_HINTS;
3886ff7e6867SKalle Valo 	}
388784841ba2SKalle Valo 
388846d33a21SKalle Valo 	/* max num of ssids that can be probed during scanning */
38898ab5415dSJouni Malinen 	wiphy->max_scan_ssids = MAX_PROBED_SSIDS;
3890dd45b759SNaveen Singh 
3891dd45b759SNaveen Singh 	/* max num of ssids that can be matched after scan */
3892dd45b759SNaveen Singh 	if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_MATCH_LIST,
3893dd45b759SNaveen Singh 		     ar->fw_capabilities))
3894dd45b759SNaveen Singh 		wiphy->max_match_sets = MAX_PROBED_SSIDS;
3895dd45b759SNaveen Singh 
389646d33a21SKalle Valo 	wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */
3897d92917e4SThomas Pedersen 	switch (ar->hw.cap) {
3898d92917e4SThomas Pedersen 	case WMI_11AN_CAP:
3899d92917e4SThomas Pedersen 		ht = true;
3900d92917e4SThomas Pedersen 	case WMI_11A_CAP:
3901d92917e4SThomas Pedersen 		band_5gig = true;
3902d92917e4SThomas Pedersen 		break;
3903d92917e4SThomas Pedersen 	case WMI_11GN_CAP:
3904d92917e4SThomas Pedersen 		ht = true;
3905d92917e4SThomas Pedersen 	case WMI_11G_CAP:
3906d92917e4SThomas Pedersen 		band_2gig = true;
3907d92917e4SThomas Pedersen 		break;
3908d92917e4SThomas Pedersen 	case WMI_11AGN_CAP:
3909d92917e4SThomas Pedersen 		ht = true;
3910d92917e4SThomas Pedersen 	case WMI_11AG_CAP:
3911d92917e4SThomas Pedersen 		band_2gig = true;
3912d92917e4SThomas Pedersen 		band_5gig = true;
3913d92917e4SThomas Pedersen 		break;
3914d92917e4SThomas Pedersen 	default:
3915d92917e4SThomas Pedersen 		ath6kl_err("invalid phy capability!\n");
3916d92917e4SThomas Pedersen 		return -EINVAL;
3917d92917e4SThomas Pedersen 	}
3918d92917e4SThomas Pedersen 
39197fd1ce7eSVasanthakumar Thiagarajan 	/*
39207fd1ce7eSVasanthakumar Thiagarajan 	 * Even if the fw has HT support, advertise HT cap only when
39217fd1ce7eSVasanthakumar Thiagarajan 	 * the firmware has support to override RSN capability, otherwise
39227fd1ce7eSVasanthakumar Thiagarajan 	 * 4-way handshake would fail.
39237fd1ce7eSVasanthakumar Thiagarajan 	 */
39247fd1ce7eSVasanthakumar Thiagarajan 	if (!(ht &&
39257fd1ce7eSVasanthakumar Thiagarajan 	      test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE,
39267fd1ce7eSVasanthakumar Thiagarajan 		       ar->fw_capabilities))) {
3927d92917e4SThomas Pedersen 		ath6kl_band_2ghz.ht_cap.cap = 0;
3928d92917e4SThomas Pedersen 		ath6kl_band_2ghz.ht_cap.ht_supported = false;
3929d92917e4SThomas Pedersen 		ath6kl_band_5ghz.ht_cap.cap = 0;
3930d92917e4SThomas Pedersen 		ath6kl_band_5ghz.ht_cap.ht_supported = false;
39317fd98524SBen Greear 
39327fd98524SBen Greear 		if (ht)
39337fd98524SBen Greear 			ath6kl_err("Firmware lacks RSN-CAP-OVERRIDE, so HT (802.11n) is disabled.");
3934d92917e4SThomas Pedersen 	}
393506e360acSBala Shanmugam 
3936eba95bceSKalle Valo 	if (test_bit(ATH6KL_FW_CAPABILITY_64BIT_RATES,
3937eba95bceSKalle Valo 		     ar->fw_capabilities)) {
393806e360acSBala Shanmugam 		ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff;
393906e360acSBala Shanmugam 		ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff;
394006e360acSBala Shanmugam 		ath6kl_band_2ghz.ht_cap.mcs.rx_mask[1] = 0xff;
394106e360acSBala Shanmugam 		ath6kl_band_5ghz.ht_cap.mcs.rx_mask[1] = 0xff;
394226ca14d4SBen Greear 		ar->hw.tx_ant = 0x3; /* mask, 2 antenna */
394326ca14d4SBen Greear 		ar->hw.rx_ant = 0x3;
394406e360acSBala Shanmugam 	} else {
394506e360acSBala Shanmugam 		ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff;
394606e360acSBala Shanmugam 		ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff;
39479c2e90ffSBen Greear 		ar->hw.tx_ant = 1;
39489c2e90ffSBen Greear 		ar->hw.rx_ant = 1;
394906e360acSBala Shanmugam 	}
395006e360acSBala Shanmugam 
39519c2e90ffSBen Greear 	wiphy->available_antennas_tx = ar->hw.tx_ant;
39529c2e90ffSBen Greear 	wiphy->available_antennas_rx = ar->hw.rx_ant;
39539c2e90ffSBen Greear 
3954d92917e4SThomas Pedersen 	if (band_2gig)
395557fbcce3SJohannes Berg 		wiphy->bands[NL80211_BAND_2GHZ] = &ath6kl_band_2ghz;
3956d92917e4SThomas Pedersen 	if (band_5gig)
395757fbcce3SJohannes Berg 		wiphy->bands[NL80211_BAND_5GHZ] = &ath6kl_band_5ghz;
3958d92917e4SThomas Pedersen 
395946d33a21SKalle Valo 	wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
396046d33a21SKalle Valo 
396146d33a21SKalle Valo 	wiphy->cipher_suites = cipher_suites;
396246d33a21SKalle Valo 	wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
396346d33a21SKalle Valo 
3964dfb89c56SJohannes Berg #ifdef CONFIG_PM
3965964dc9e2SJohannes Berg 	wiphy->wowlan = &ath6kl_wowlan_support;
3966dfb89c56SJohannes Berg #endif
396746d33a21SKalle Valo 
39688ab5415dSJouni Malinen 	wiphy->max_sched_scan_ssids = MAX_PROBED_SSIDS;
396946d33a21SKalle Valo 
3970f2afdac7SVasanthakumar Thiagarajan 	ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM |
3971f2afdac7SVasanthakumar Thiagarajan 			    WIPHY_FLAG_HAVE_AP_SME |
3972f2afdac7SVasanthakumar Thiagarajan 			    WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL |
3973f2afdac7SVasanthakumar Thiagarajan 			    WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD;
3974f2afdac7SVasanthakumar Thiagarajan 
3975b1f47e3aSThomas Pedersen 	if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_V2, ar->fw_capabilities))
3976ca986ad9SArend Van Spriel 		ar->wiphy->max_sched_scan_reqs = 1;
3977f2afdac7SVasanthakumar Thiagarajan 
397803bdeb0dSVasanthakumar Thiagarajan 	if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT,
397903bdeb0dSVasanthakumar Thiagarajan 		     ar->fw_capabilities))
3980b292219fSJohannes Berg 		ar->wiphy->features |= NL80211_FEATURE_INACTIVITY_TIMER;
398103bdeb0dSVasanthakumar Thiagarajan 
3982f2afdac7SVasanthakumar Thiagarajan 	ar->wiphy->probe_resp_offload =
3983f2afdac7SVasanthakumar Thiagarajan 		NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS |
3984f2afdac7SVasanthakumar Thiagarajan 		NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 |
3985a432e7ccSJouni Malinen 		NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P;
3986f2afdac7SVasanthakumar Thiagarajan 
398746d33a21SKalle Valo 	ret = wiphy_register(wiphy);
398846d33a21SKalle Valo 	if (ret < 0) {
398946d33a21SKalle Valo 		ath6kl_err("couldn't register wiphy device\n");
399046d33a21SKalle Valo 		return ret;
399146d33a21SKalle Valo 	}
399246d33a21SKalle Valo 
3993e5348a1eSVasanthakumar Thiagarajan 	ar->wiphy_registered = true;
3994e5348a1eSVasanthakumar Thiagarajan 
399546d33a21SKalle Valo 	return 0;
399646d33a21SKalle Valo }
399746d33a21SKalle Valo 
399846d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar)
3999bdcd8170SKalle Valo {
4000be98e3a4SVasanthakumar Thiagarajan 	wiphy_unregister(ar->wiphy);
4001e5348a1eSVasanthakumar Thiagarajan 
4002e5348a1eSVasanthakumar Thiagarajan 	ar->wiphy_registered = false;
400345eaa78fSKalle Valo }
400446d33a21SKalle Valo 
400545eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void)
400645eaa78fSKalle Valo {
400745eaa78fSKalle Valo 	struct ath6kl *ar;
400845eaa78fSKalle Valo 	struct wiphy *wiphy;
400945eaa78fSKalle Valo 
401045eaa78fSKalle Valo 	/* create a new wiphy for use with cfg80211 */
401145eaa78fSKalle Valo 	wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl));
401245eaa78fSKalle Valo 
401345eaa78fSKalle Valo 	if (!wiphy) {
401445eaa78fSKalle Valo 		ath6kl_err("couldn't allocate wiphy device\n");
401545eaa78fSKalle Valo 		return NULL;
401645eaa78fSKalle Valo 	}
401745eaa78fSKalle Valo 
401845eaa78fSKalle Valo 	ar = wiphy_priv(wiphy);
401945eaa78fSKalle Valo 	ar->wiphy = wiphy;
402045eaa78fSKalle Valo 
402145eaa78fSKalle Valo 	return ar;
402245eaa78fSKalle Valo }
402345eaa78fSKalle Valo 
402445eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */
402545eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar)
402645eaa78fSKalle Valo {
40271d2a4456SVasanthakumar Thiagarajan 	int i;
40281d2a4456SVasanthakumar Thiagarajan 
40291d2a4456SVasanthakumar Thiagarajan 	for (i = 0; i < AP_MAX_NUM_STA; i++)
40301d2a4456SVasanthakumar Thiagarajan 		kfree(ar->sta_list[i].aggr_conn);
40311d2a4456SVasanthakumar Thiagarajan 
4032be98e3a4SVasanthakumar Thiagarajan 	wiphy_free(ar->wiphy);
4033bdcd8170SKalle Valo }
403445eaa78fSKalle Valo 
4035