1bdcd8170SKalle Valo /*
2bdcd8170SKalle Valo  * Copyright (c) 2004-2011 Atheros Communications Inc.
3bdcd8170SKalle Valo  *
4bdcd8170SKalle Valo  * Permission to use, copy, modify, and/or distribute this software for any
5bdcd8170SKalle Valo  * purpose with or without fee is hereby granted, provided that the above
6bdcd8170SKalle Valo  * copyright notice and this permission notice appear in all copies.
7bdcd8170SKalle Valo  *
8bdcd8170SKalle Valo  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9bdcd8170SKalle Valo  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10bdcd8170SKalle Valo  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11bdcd8170SKalle Valo  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12bdcd8170SKalle Valo  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13bdcd8170SKalle Valo  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14bdcd8170SKalle Valo  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15bdcd8170SKalle Valo  */
16bdcd8170SKalle Valo 
176eb07cafSPaul Gortmaker #include <linux/moduleparam.h>
186eb07cafSPaul Gortmaker 
19bdcd8170SKalle Valo #include "core.h"
20bdcd8170SKalle Valo #include "cfg80211.h"
21bdcd8170SKalle Valo #include "debug.h"
22abcb344bSKalle Valo #include "hif-ops.h"
23003353b0SKalle Valo #include "testmode.h"
24bdcd8170SKalle Valo 
256bbc7c35SJouni Malinen static unsigned int ath6kl_p2p;
266bbc7c35SJouni Malinen 
276bbc7c35SJouni Malinen module_param(ath6kl_p2p, uint, 0644);
286bbc7c35SJouni Malinen 
29bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) {   \
30bdcd8170SKalle Valo 	.bitrate    = (_rate),                  \
31bdcd8170SKalle Valo 	.flags      = (_flags),                 \
32bdcd8170SKalle Valo 	.hw_value   = (_rateid),                \
33bdcd8170SKalle Valo }
34bdcd8170SKalle Valo 
35bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) {   \
36bdcd8170SKalle Valo 	.band           = IEEE80211_BAND_2GHZ,  \
37bdcd8170SKalle Valo 	.hw_value       = (_channel),           \
38bdcd8170SKalle Valo 	.center_freq    = (_freq),              \
39bdcd8170SKalle Valo 	.flags          = (_flags),             \
40bdcd8170SKalle Valo 	.max_antenna_gain   = 0,                \
41bdcd8170SKalle Valo 	.max_power      = 30,                   \
42bdcd8170SKalle Valo }
43bdcd8170SKalle Valo 
44bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) {		    \
45bdcd8170SKalle Valo 	.band           = IEEE80211_BAND_5GHZ,      \
46bdcd8170SKalle Valo 	.hw_value       = (_channel),               \
47bdcd8170SKalle Valo 	.center_freq    = 5000 + (5 * (_channel)),  \
48bdcd8170SKalle Valo 	.flags          = (_flags),                 \
49bdcd8170SKalle Valo 	.max_antenna_gain   = 0,                    \
50bdcd8170SKalle Valo 	.max_power      = 30,                       \
51bdcd8170SKalle Valo }
52bdcd8170SKalle Valo 
53bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = {
54bdcd8170SKalle Valo 	RATETAB_ENT(10, 0x1, 0),
55bdcd8170SKalle Valo 	RATETAB_ENT(20, 0x2, 0),
56bdcd8170SKalle Valo 	RATETAB_ENT(55, 0x4, 0),
57bdcd8170SKalle Valo 	RATETAB_ENT(110, 0x8, 0),
58bdcd8170SKalle Valo 	RATETAB_ENT(60, 0x10, 0),
59bdcd8170SKalle Valo 	RATETAB_ENT(90, 0x20, 0),
60bdcd8170SKalle Valo 	RATETAB_ENT(120, 0x40, 0),
61bdcd8170SKalle Valo 	RATETAB_ENT(180, 0x80, 0),
62bdcd8170SKalle Valo 	RATETAB_ENT(240, 0x100, 0),
63bdcd8170SKalle Valo 	RATETAB_ENT(360, 0x200, 0),
64bdcd8170SKalle Valo 	RATETAB_ENT(480, 0x400, 0),
65bdcd8170SKalle Valo 	RATETAB_ENT(540, 0x800, 0),
66bdcd8170SKalle Valo };
67bdcd8170SKalle Valo 
68bdcd8170SKalle Valo #define ath6kl_a_rates     (ath6kl_rates + 4)
69bdcd8170SKalle Valo #define ath6kl_a_rates_size    8
70bdcd8170SKalle Valo #define ath6kl_g_rates     (ath6kl_rates + 0)
71bdcd8170SKalle Valo #define ath6kl_g_rates_size    12
72bdcd8170SKalle Valo 
73bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = {
74bdcd8170SKalle Valo 	CHAN2G(1, 2412, 0),
75bdcd8170SKalle Valo 	CHAN2G(2, 2417, 0),
76bdcd8170SKalle Valo 	CHAN2G(3, 2422, 0),
77bdcd8170SKalle Valo 	CHAN2G(4, 2427, 0),
78bdcd8170SKalle Valo 	CHAN2G(5, 2432, 0),
79bdcd8170SKalle Valo 	CHAN2G(6, 2437, 0),
80bdcd8170SKalle Valo 	CHAN2G(7, 2442, 0),
81bdcd8170SKalle Valo 	CHAN2G(8, 2447, 0),
82bdcd8170SKalle Valo 	CHAN2G(9, 2452, 0),
83bdcd8170SKalle Valo 	CHAN2G(10, 2457, 0),
84bdcd8170SKalle Valo 	CHAN2G(11, 2462, 0),
85bdcd8170SKalle Valo 	CHAN2G(12, 2467, 0),
86bdcd8170SKalle Valo 	CHAN2G(13, 2472, 0),
87bdcd8170SKalle Valo 	CHAN2G(14, 2484, 0),
88bdcd8170SKalle Valo };
89bdcd8170SKalle Valo 
90bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = {
91bdcd8170SKalle Valo 	CHAN5G(34, 0), CHAN5G(36, 0),
92bdcd8170SKalle Valo 	CHAN5G(38, 0), CHAN5G(40, 0),
93bdcd8170SKalle Valo 	CHAN5G(42, 0), CHAN5G(44, 0),
94bdcd8170SKalle Valo 	CHAN5G(46, 0), CHAN5G(48, 0),
95bdcd8170SKalle Valo 	CHAN5G(52, 0), CHAN5G(56, 0),
96bdcd8170SKalle Valo 	CHAN5G(60, 0), CHAN5G(64, 0),
97bdcd8170SKalle Valo 	CHAN5G(100, 0), CHAN5G(104, 0),
98bdcd8170SKalle Valo 	CHAN5G(108, 0), CHAN5G(112, 0),
99bdcd8170SKalle Valo 	CHAN5G(116, 0), CHAN5G(120, 0),
100bdcd8170SKalle Valo 	CHAN5G(124, 0), CHAN5G(128, 0),
101bdcd8170SKalle Valo 	CHAN5G(132, 0), CHAN5G(136, 0),
102bdcd8170SKalle Valo 	CHAN5G(140, 0), CHAN5G(149, 0),
103bdcd8170SKalle Valo 	CHAN5G(153, 0), CHAN5G(157, 0),
104bdcd8170SKalle Valo 	CHAN5G(161, 0), CHAN5G(165, 0),
105bdcd8170SKalle Valo 	CHAN5G(184, 0), CHAN5G(188, 0),
106bdcd8170SKalle Valo 	CHAN5G(192, 0), CHAN5G(196, 0),
107bdcd8170SKalle Valo 	CHAN5G(200, 0), CHAN5G(204, 0),
108bdcd8170SKalle Valo 	CHAN5G(208, 0), CHAN5G(212, 0),
109bdcd8170SKalle Valo 	CHAN5G(216, 0),
110bdcd8170SKalle Valo };
111bdcd8170SKalle Valo 
112bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = {
113bdcd8170SKalle Valo 	.n_channels = ARRAY_SIZE(ath6kl_2ghz_channels),
114bdcd8170SKalle Valo 	.channels = ath6kl_2ghz_channels,
115bdcd8170SKalle Valo 	.n_bitrates = ath6kl_g_rates_size,
116bdcd8170SKalle Valo 	.bitrates = ath6kl_g_rates,
117bdcd8170SKalle Valo };
118bdcd8170SKalle Valo 
119bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = {
120bdcd8170SKalle Valo 	.n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels),
121bdcd8170SKalle Valo 	.channels = ath6kl_5ghz_a_channels,
122bdcd8170SKalle Valo 	.n_bitrates = ath6kl_a_rates_size,
123bdcd8170SKalle Valo 	.bitrates = ath6kl_a_rates,
124bdcd8170SKalle Valo };
125bdcd8170SKalle Valo 
126837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */
127837cb97eSJouni Malinen 
12810509f90SKalle Valo /* returns true if scheduled scan was stopped */
12910509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif)
13010509f90SKalle Valo {
13110509f90SKalle Valo 	struct ath6kl *ar = vif->ar;
13210509f90SKalle Valo 
13310509f90SKalle Valo 	if (ar->state != ATH6KL_STATE_SCHED_SCAN)
13410509f90SKalle Valo 		return false;
13510509f90SKalle Valo 
13610509f90SKalle Valo 	del_timer_sync(&vif->sched_scan_timer);
13710509f90SKalle Valo 
13810509f90SKalle Valo 	ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
13910509f90SKalle Valo 					   ATH6KL_HOST_MODE_AWAKE);
14010509f90SKalle Valo 
14110509f90SKalle Valo 	ar->state = ATH6KL_STATE_ON;
14210509f90SKalle Valo 
14310509f90SKalle Valo 	return true;
14410509f90SKalle Valo }
14510509f90SKalle Valo 
14610509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif)
14710509f90SKalle Valo {
14810509f90SKalle Valo 	struct ath6kl *ar = vif->ar;
14910509f90SKalle Valo 	bool stopped;
15010509f90SKalle Valo 
15110509f90SKalle Valo 	stopped = __ath6kl_cfg80211_sscan_stop(vif);
15210509f90SKalle Valo 
15310509f90SKalle Valo 	if (!stopped)
15410509f90SKalle Valo 		return;
15510509f90SKalle Valo 
15610509f90SKalle Valo 	cfg80211_sched_scan_stopped(ar->wiphy);
15710509f90SKalle Valo }
15810509f90SKalle Valo 
159240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif,
160bdcd8170SKalle Valo 				  enum nl80211_wpa_versions wpa_version)
161bdcd8170SKalle Valo {
162bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version);
163bdcd8170SKalle Valo 
164bdcd8170SKalle Valo 	if (!wpa_version) {
1653450334fSVasanthakumar Thiagarajan 		vif->auth_mode = NONE_AUTH;
166bdcd8170SKalle Valo 	} else if (wpa_version & NL80211_WPA_VERSION_2) {
1673450334fSVasanthakumar Thiagarajan 		vif->auth_mode = WPA2_AUTH;
168bdcd8170SKalle Valo 	} else if (wpa_version & NL80211_WPA_VERSION_1) {
1693450334fSVasanthakumar Thiagarajan 		vif->auth_mode = WPA_AUTH;
170bdcd8170SKalle Valo 	} else {
171bdcd8170SKalle Valo 		ath6kl_err("%s: %u not supported\n", __func__, wpa_version);
172bdcd8170SKalle Valo 		return -ENOTSUPP;
173bdcd8170SKalle Valo 	}
174bdcd8170SKalle Valo 
175bdcd8170SKalle Valo 	return 0;
176bdcd8170SKalle Valo }
177bdcd8170SKalle Valo 
178240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif,
179bdcd8170SKalle Valo 				enum nl80211_auth_type auth_type)
180bdcd8170SKalle Valo {
181bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type);
182bdcd8170SKalle Valo 
183bdcd8170SKalle Valo 	switch (auth_type) {
184bdcd8170SKalle Valo 	case NL80211_AUTHTYPE_OPEN_SYSTEM:
1853450334fSVasanthakumar Thiagarajan 		vif->dot11_auth_mode = OPEN_AUTH;
186bdcd8170SKalle Valo 		break;
187bdcd8170SKalle Valo 	case NL80211_AUTHTYPE_SHARED_KEY:
1883450334fSVasanthakumar Thiagarajan 		vif->dot11_auth_mode = SHARED_AUTH;
189bdcd8170SKalle Valo 		break;
190bdcd8170SKalle Valo 	case NL80211_AUTHTYPE_NETWORK_EAP:
1913450334fSVasanthakumar Thiagarajan 		vif->dot11_auth_mode = LEAP_AUTH;
192bdcd8170SKalle Valo 		break;
193bdcd8170SKalle Valo 
194bdcd8170SKalle Valo 	case NL80211_AUTHTYPE_AUTOMATIC:
1953450334fSVasanthakumar Thiagarajan 		vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH;
196bdcd8170SKalle Valo 		break;
197bdcd8170SKalle Valo 
198bdcd8170SKalle Valo 	default:
199bdcd8170SKalle Valo 		ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type);
200bdcd8170SKalle Valo 		return -ENOTSUPP;
201bdcd8170SKalle Valo 	}
202bdcd8170SKalle Valo 
203bdcd8170SKalle Valo 	return 0;
204bdcd8170SKalle Valo }
205bdcd8170SKalle Valo 
206240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast)
207bdcd8170SKalle Valo {
2083450334fSVasanthakumar Thiagarajan 	u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto;
2093450334fSVasanthakumar Thiagarajan 	u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len :
2103450334fSVasanthakumar Thiagarajan 		&vif->grp_crypto_len;
211bdcd8170SKalle Valo 
212bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n",
213bdcd8170SKalle Valo 		   __func__, cipher, ucast);
214bdcd8170SKalle Valo 
215bdcd8170SKalle Valo 	switch (cipher) {
216bdcd8170SKalle Valo 	case 0:
217bdcd8170SKalle Valo 		/* our own hack to use value 0 as no crypto used */
218bdcd8170SKalle Valo 		*ar_cipher = NONE_CRYPT;
219bdcd8170SKalle Valo 		*ar_cipher_len = 0;
220bdcd8170SKalle Valo 		break;
221bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_WEP40:
222bdcd8170SKalle Valo 		*ar_cipher = WEP_CRYPT;
223bdcd8170SKalle Valo 		*ar_cipher_len = 5;
224bdcd8170SKalle Valo 		break;
225bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_WEP104:
226bdcd8170SKalle Valo 		*ar_cipher = WEP_CRYPT;
227bdcd8170SKalle Valo 		*ar_cipher_len = 13;
228bdcd8170SKalle Valo 		break;
229bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_TKIP:
230bdcd8170SKalle Valo 		*ar_cipher = TKIP_CRYPT;
231bdcd8170SKalle Valo 		*ar_cipher_len = 0;
232bdcd8170SKalle Valo 		break;
233bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_CCMP:
234bdcd8170SKalle Valo 		*ar_cipher = AES_CRYPT;
235bdcd8170SKalle Valo 		*ar_cipher_len = 0;
236bdcd8170SKalle Valo 		break;
2375e07021eSDai Shuibing 	case WLAN_CIPHER_SUITE_SMS4:
2385e07021eSDai Shuibing 		*ar_cipher = WAPI_CRYPT;
2395e07021eSDai Shuibing 		*ar_cipher_len = 0;
2405e07021eSDai Shuibing 		break;
241bdcd8170SKalle Valo 	default:
242bdcd8170SKalle Valo 		ath6kl_err("cipher 0x%x not supported\n", cipher);
243bdcd8170SKalle Valo 		return -ENOTSUPP;
244bdcd8170SKalle Valo 	}
245bdcd8170SKalle Valo 
246bdcd8170SKalle Valo 	return 0;
247bdcd8170SKalle Valo }
248bdcd8170SKalle Valo 
249240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt)
250bdcd8170SKalle Valo {
251bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt);
252bdcd8170SKalle Valo 
253bdcd8170SKalle Valo 	if (key_mgmt == WLAN_AKM_SUITE_PSK) {
2543450334fSVasanthakumar Thiagarajan 		if (vif->auth_mode == WPA_AUTH)
2553450334fSVasanthakumar Thiagarajan 			vif->auth_mode = WPA_PSK_AUTH;
2563450334fSVasanthakumar Thiagarajan 		else if (vif->auth_mode == WPA2_AUTH)
2573450334fSVasanthakumar Thiagarajan 			vif->auth_mode = WPA2_PSK_AUTH;
258837cb97eSJouni Malinen 	} else if (key_mgmt == 0x00409600) {
2593450334fSVasanthakumar Thiagarajan 		if (vif->auth_mode == WPA_AUTH)
2603450334fSVasanthakumar Thiagarajan 			vif->auth_mode = WPA_AUTH_CCKM;
2613450334fSVasanthakumar Thiagarajan 		else if (vif->auth_mode == WPA2_AUTH)
2623450334fSVasanthakumar Thiagarajan 			vif->auth_mode = WPA2_AUTH_CCKM;
263bdcd8170SKalle Valo 	} else if (key_mgmt != WLAN_AKM_SUITE_8021X) {
2643450334fSVasanthakumar Thiagarajan 		vif->auth_mode = NONE_AUTH;
265bdcd8170SKalle Valo 	}
266bdcd8170SKalle Valo }
267bdcd8170SKalle Valo 
268990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif)
269bdcd8170SKalle Valo {
270990bd915SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
27159c98449SVasanthakumar Thiagarajan 
272bdcd8170SKalle Valo 	if (!test_bit(WMI_READY, &ar->flag)) {
273bdcd8170SKalle Valo 		ath6kl_err("wmi is not ready\n");
274bdcd8170SKalle Valo 		return false;
275bdcd8170SKalle Valo 	}
276bdcd8170SKalle Valo 
27759c98449SVasanthakumar Thiagarajan 	if (!test_bit(WLAN_ENABLED, &vif->flags)) {
278bdcd8170SKalle Valo 		ath6kl_err("wlan disabled\n");
279bdcd8170SKalle Valo 		return false;
280bdcd8170SKalle Valo 	}
281bdcd8170SKalle Valo 
282bdcd8170SKalle Valo 	return true;
283bdcd8170SKalle Valo }
284bdcd8170SKalle Valo 
2856981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos)
2866981ffdcSKevin Fang {
2876981ffdcSKevin Fang 	return pos[0] == WLAN_EID_WPA && pos[1] >= 4 &&
2886981ffdcSKevin Fang 		pos[2] == 0x00 && pos[3] == 0x50 &&
2896981ffdcSKevin Fang 		pos[4] == 0xf2 && pos[5] == 0x01;
2906981ffdcSKevin Fang }
2916981ffdcSKevin Fang 
2926981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos)
2936981ffdcSKevin Fang {
2946981ffdcSKevin Fang 	return pos[0] == WLAN_EID_RSN;
2956981ffdcSKevin Fang }
2966981ffdcSKevin Fang 
29763541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos)
29863541212SAarthi Thiruvengadam {
29963541212SAarthi Thiruvengadam 	return (pos[0] == WLAN_EID_VENDOR_SPECIFIC &&
30063541212SAarthi Thiruvengadam 		pos[1] >= 4 &&
30163541212SAarthi Thiruvengadam 		pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 &&
30263541212SAarthi Thiruvengadam 		pos[5] == 0x04);
30363541212SAarthi Thiruvengadam }
30463541212SAarthi Thiruvengadam 
305334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies,
3066981ffdcSKevin Fang 				    size_t ies_len)
3076981ffdcSKevin Fang {
308334234b5SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
3096981ffdcSKevin Fang 	const u8 *pos;
3106981ffdcSKevin Fang 	u8 *buf = NULL;
3116981ffdcSKevin Fang 	size_t len = 0;
3126981ffdcSKevin Fang 	int ret;
3136981ffdcSKevin Fang 
3146981ffdcSKevin Fang 	/*
31563541212SAarthi Thiruvengadam 	 * Clear previously set flag
31663541212SAarthi Thiruvengadam 	 */
31763541212SAarthi Thiruvengadam 
31863541212SAarthi Thiruvengadam 	ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG;
31963541212SAarthi Thiruvengadam 
32063541212SAarthi Thiruvengadam 	/*
3216981ffdcSKevin Fang 	 * Filter out RSN/WPA IE(s)
3226981ffdcSKevin Fang 	 */
3236981ffdcSKevin Fang 
3246981ffdcSKevin Fang 	if (ies && ies_len) {
3256981ffdcSKevin Fang 		buf = kmalloc(ies_len, GFP_KERNEL);
3266981ffdcSKevin Fang 		if (buf == NULL)
3276981ffdcSKevin Fang 			return -ENOMEM;
3286981ffdcSKevin Fang 		pos = ies;
3296981ffdcSKevin Fang 
3306981ffdcSKevin Fang 		while (pos + 1 < ies + ies_len) {
3316981ffdcSKevin Fang 			if (pos + 2 + pos[1] > ies + ies_len)
3326981ffdcSKevin Fang 				break;
3336981ffdcSKevin Fang 			if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) {
3346981ffdcSKevin Fang 				memcpy(buf + len, pos, 2 + pos[1]);
3356981ffdcSKevin Fang 				len += 2 + pos[1];
3366981ffdcSKevin Fang 			}
33763541212SAarthi Thiruvengadam 
33863541212SAarthi Thiruvengadam 			if (ath6kl_is_wps_ie(pos))
33963541212SAarthi Thiruvengadam 				ar->connect_ctrl_flags |= CONNECT_WPS_FLAG;
34063541212SAarthi Thiruvengadam 
3416981ffdcSKevin Fang 			pos += 2 + pos[1];
3426981ffdcSKevin Fang 		}
3436981ffdcSKevin Fang 	}
3446981ffdcSKevin Fang 
345334234b5SVasanthakumar Thiagarajan 	ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
346334234b5SVasanthakumar Thiagarajan 				       WMI_FRAME_ASSOC_REQ, buf, len);
3476981ffdcSKevin Fang 	kfree(buf);
3486981ffdcSKevin Fang 	return ret;
3496981ffdcSKevin Fang }
3506981ffdcSKevin Fang 
35155055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type)
35255055976SVasanthakumar Thiagarajan {
35355055976SVasanthakumar Thiagarajan 	switch (type) {
35455055976SVasanthakumar Thiagarajan 	case NL80211_IFTYPE_STATION:
35555055976SVasanthakumar Thiagarajan 		*nw_type = INFRA_NETWORK;
35655055976SVasanthakumar Thiagarajan 		break;
35755055976SVasanthakumar Thiagarajan 	case NL80211_IFTYPE_ADHOC:
35855055976SVasanthakumar Thiagarajan 		*nw_type = ADHOC_NETWORK;
35955055976SVasanthakumar Thiagarajan 		break;
36055055976SVasanthakumar Thiagarajan 	case NL80211_IFTYPE_AP:
36155055976SVasanthakumar Thiagarajan 		*nw_type = AP_NETWORK;
36255055976SVasanthakumar Thiagarajan 		break;
36355055976SVasanthakumar Thiagarajan 	case NL80211_IFTYPE_P2P_CLIENT:
36455055976SVasanthakumar Thiagarajan 		*nw_type = INFRA_NETWORK;
36555055976SVasanthakumar Thiagarajan 		break;
36655055976SVasanthakumar Thiagarajan 	case NL80211_IFTYPE_P2P_GO:
36755055976SVasanthakumar Thiagarajan 		*nw_type = AP_NETWORK;
36855055976SVasanthakumar Thiagarajan 		break;
36955055976SVasanthakumar Thiagarajan 	default:
37055055976SVasanthakumar Thiagarajan 		ath6kl_err("invalid interface type %u\n", type);
37155055976SVasanthakumar Thiagarajan 		return -ENOTSUPP;
37255055976SVasanthakumar Thiagarajan 	}
37355055976SVasanthakumar Thiagarajan 
37455055976SVasanthakumar Thiagarajan 	return 0;
37555055976SVasanthakumar Thiagarajan }
37655055976SVasanthakumar Thiagarajan 
37755055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type,
37855055976SVasanthakumar Thiagarajan 				   u8 *if_idx, u8 *nw_type)
37955055976SVasanthakumar Thiagarajan {
38055055976SVasanthakumar Thiagarajan 	int i;
38155055976SVasanthakumar Thiagarajan 
38255055976SVasanthakumar Thiagarajan 	if (ath6kl_nliftype_to_drv_iftype(type, nw_type))
38355055976SVasanthakumar Thiagarajan 		return false;
38455055976SVasanthakumar Thiagarajan 
38555055976SVasanthakumar Thiagarajan 	if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) &&
38655055976SVasanthakumar Thiagarajan 	    ar->num_vif))
38755055976SVasanthakumar Thiagarajan 		return false;
38855055976SVasanthakumar Thiagarajan 
38955055976SVasanthakumar Thiagarajan 	if (type == NL80211_IFTYPE_STATION ||
39055055976SVasanthakumar Thiagarajan 	    type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) {
39171f96ee6SKalle Valo 		for (i = 0; i < ar->vif_max; i++) {
39255055976SVasanthakumar Thiagarajan 			if ((ar->avail_idx_map >> i) & BIT(0)) {
39355055976SVasanthakumar Thiagarajan 				*if_idx = i;
39455055976SVasanthakumar Thiagarajan 				return true;
39555055976SVasanthakumar Thiagarajan 			}
39655055976SVasanthakumar Thiagarajan 		}
39755055976SVasanthakumar Thiagarajan 	}
39855055976SVasanthakumar Thiagarajan 
3993226f68aSVasanthakumar Thiagarajan 	if (type == NL80211_IFTYPE_P2P_CLIENT ||
4003226f68aSVasanthakumar Thiagarajan 	    type == NL80211_IFTYPE_P2P_GO) {
40171f96ee6SKalle Valo 		for (i = ar->max_norm_iface; i < ar->vif_max; i++) {
4023226f68aSVasanthakumar Thiagarajan 			if ((ar->avail_idx_map >> i) & BIT(0)) {
4033226f68aSVasanthakumar Thiagarajan 				*if_idx = i;
4043226f68aSVasanthakumar Thiagarajan 				return true;
4053226f68aSVasanthakumar Thiagarajan 			}
4063226f68aSVasanthakumar Thiagarajan 		}
4073226f68aSVasanthakumar Thiagarajan 	}
4083226f68aSVasanthakumar Thiagarajan 
40955055976SVasanthakumar Thiagarajan 	return false;
41055055976SVasanthakumar Thiagarajan }
41155055976SVasanthakumar Thiagarajan 
412bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev,
413bdcd8170SKalle Valo 				   struct cfg80211_connect_params *sme)
414bdcd8170SKalle Valo {
415bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
41659c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
417bdcd8170SKalle Valo 	int status;
4183ca9d1fcSAarthi Thiruvengadam 	u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE;
419bdcd8170SKalle Valo 
42010509f90SKalle Valo 	ath6kl_cfg80211_sscan_disable(vif);
42110509f90SKalle Valo 
42214ee6f6bSVasanthakumar Thiagarajan 	vif->sme_state = SME_CONNECTING;
423bdcd8170SKalle Valo 
424990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
425bdcd8170SKalle Valo 		return -EIO;
426bdcd8170SKalle Valo 
427bdcd8170SKalle Valo 	if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
428bdcd8170SKalle Valo 		ath6kl_err("destroy in progress\n");
429bdcd8170SKalle Valo 		return -EBUSY;
430bdcd8170SKalle Valo 	}
431bdcd8170SKalle Valo 
432bdcd8170SKalle Valo 	if (test_bit(SKIP_SCAN, &ar->flag) &&
433bdcd8170SKalle Valo 	    ((sme->channel && sme->channel->center_freq == 0) ||
434bdcd8170SKalle Valo 	     (sme->bssid && is_zero_ether_addr(sme->bssid)))) {
435bdcd8170SKalle Valo 		ath6kl_err("SkipScan: channel or bssid invalid\n");
436bdcd8170SKalle Valo 		return -EINVAL;
437bdcd8170SKalle Valo 	}
438bdcd8170SKalle Valo 
439bdcd8170SKalle Valo 	if (down_interruptible(&ar->sem)) {
440bdcd8170SKalle Valo 		ath6kl_err("busy, couldn't get access\n");
441bdcd8170SKalle Valo 		return -ERESTARTSYS;
442bdcd8170SKalle Valo 	}
443bdcd8170SKalle Valo 
444bdcd8170SKalle Valo 	if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
445bdcd8170SKalle Valo 		ath6kl_err("busy, destroy in progress\n");
446bdcd8170SKalle Valo 		up(&ar->sem);
447bdcd8170SKalle Valo 		return -EBUSY;
448bdcd8170SKalle Valo 	}
449bdcd8170SKalle Valo 
450bdcd8170SKalle Valo 	if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) {
451bdcd8170SKalle Valo 		/*
452bdcd8170SKalle Valo 		 * sleep until the command queue drains
453bdcd8170SKalle Valo 		 */
454bdcd8170SKalle Valo 		wait_event_interruptible_timeout(ar->event_wq,
455bdcd8170SKalle Valo 			ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0,
456bdcd8170SKalle Valo 			WMI_TIMEOUT);
457bdcd8170SKalle Valo 		if (signal_pending(current)) {
458bdcd8170SKalle Valo 			ath6kl_err("cmd queue drain timeout\n");
459bdcd8170SKalle Valo 			up(&ar->sem);
460bdcd8170SKalle Valo 			return -EINTR;
461bdcd8170SKalle Valo 		}
462bdcd8170SKalle Valo 	}
463bdcd8170SKalle Valo 
464334234b5SVasanthakumar Thiagarajan 	status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len);
465743b4518SDan Carpenter 	if (status) {
466743b4518SDan Carpenter 		up(&ar->sem);
4676981ffdcSKevin Fang 		return status;
468743b4518SDan Carpenter 	}
4696e786cb1SJouni Malinen 
4706e786cb1SJouni Malinen 	if (sme->ie == NULL || sme->ie_len == 0)
471542c519aSRaja Mani 		ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG;
4726981ffdcSKevin Fang 
47359c98449SVasanthakumar Thiagarajan 	if (test_bit(CONNECTED, &vif->flags) &&
4743450334fSVasanthakumar Thiagarajan 	    vif->ssid_len == sme->ssid_len &&
4753450334fSVasanthakumar Thiagarajan 	    !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) {
476cf5333d7SVasanthakumar Thiagarajan 		vif->reconnect_flag = true;
477334234b5SVasanthakumar Thiagarajan 		status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx,
478334234b5SVasanthakumar Thiagarajan 						  vif->req_bssid,
479f74bac54SVasanthakumar Thiagarajan 						  vif->ch_hint);
480bdcd8170SKalle Valo 
481bdcd8170SKalle Valo 		up(&ar->sem);
482bdcd8170SKalle Valo 		if (status) {
483bdcd8170SKalle Valo 			ath6kl_err("wmi_reconnect_cmd failed\n");
484bdcd8170SKalle Valo 			return -EIO;
485bdcd8170SKalle Valo 		}
486bdcd8170SKalle Valo 		return 0;
4873450334fSVasanthakumar Thiagarajan 	} else if (vif->ssid_len == sme->ssid_len &&
4883450334fSVasanthakumar Thiagarajan 		   !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) {
489240d2799SVasanthakumar Thiagarajan 		ath6kl_disconnect(vif);
490bdcd8170SKalle Valo 	}
491bdcd8170SKalle Valo 
4923450334fSVasanthakumar Thiagarajan 	memset(vif->ssid, 0, sizeof(vif->ssid));
4933450334fSVasanthakumar Thiagarajan 	vif->ssid_len = sme->ssid_len;
4943450334fSVasanthakumar Thiagarajan 	memcpy(vif->ssid, sme->ssid, sme->ssid_len);
495bdcd8170SKalle Valo 
496bdcd8170SKalle Valo 	if (sme->channel)
497f74bac54SVasanthakumar Thiagarajan 		vif->ch_hint = sme->channel->center_freq;
498bdcd8170SKalle Valo 
4998c8b65e3SVasanthakumar Thiagarajan 	memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
500bdcd8170SKalle Valo 	if (sme->bssid && !is_broadcast_ether_addr(sme->bssid))
5018c8b65e3SVasanthakumar Thiagarajan 		memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid));
502bdcd8170SKalle Valo 
503240d2799SVasanthakumar Thiagarajan 	ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions);
504bdcd8170SKalle Valo 
505240d2799SVasanthakumar Thiagarajan 	status = ath6kl_set_auth_type(vif, sme->auth_type);
506bdcd8170SKalle Valo 	if (status) {
507bdcd8170SKalle Valo 		up(&ar->sem);
508bdcd8170SKalle Valo 		return status;
509bdcd8170SKalle Valo 	}
510bdcd8170SKalle Valo 
511bdcd8170SKalle Valo 	if (sme->crypto.n_ciphers_pairwise)
512240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true);
513bdcd8170SKalle Valo 	else
514240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, 0, true);
515bdcd8170SKalle Valo 
516240d2799SVasanthakumar Thiagarajan 	ath6kl_set_cipher(vif, sme->crypto.cipher_group, false);
517bdcd8170SKalle Valo 
518bdcd8170SKalle Valo 	if (sme->crypto.n_akm_suites)
519240d2799SVasanthakumar Thiagarajan 		ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]);
520bdcd8170SKalle Valo 
521bdcd8170SKalle Valo 	if ((sme->key_len) &&
5223450334fSVasanthakumar Thiagarajan 	    (vif->auth_mode == NONE_AUTH) &&
5233450334fSVasanthakumar Thiagarajan 	    (vif->prwise_crypto == WEP_CRYPT)) {
524bdcd8170SKalle Valo 		struct ath6kl_key *key = NULL;
525bdcd8170SKalle Valo 
526bdcd8170SKalle Valo 		if (sme->key_idx < WMI_MIN_KEY_INDEX ||
527bdcd8170SKalle Valo 		    sme->key_idx > WMI_MAX_KEY_INDEX) {
528bdcd8170SKalle Valo 			ath6kl_err("key index %d out of bounds\n",
529bdcd8170SKalle Valo 				   sme->key_idx);
530bdcd8170SKalle Valo 			up(&ar->sem);
531bdcd8170SKalle Valo 			return -ENOENT;
532bdcd8170SKalle Valo 		}
533bdcd8170SKalle Valo 
5346f2a73f9SVasanthakumar Thiagarajan 		key = &vif->keys[sme->key_idx];
535bdcd8170SKalle Valo 		key->key_len = sme->key_len;
536bdcd8170SKalle Valo 		memcpy(key->key, sme->key, key->key_len);
5373450334fSVasanthakumar Thiagarajan 		key->cipher = vif->prwise_crypto;
5383450334fSVasanthakumar Thiagarajan 		vif->def_txkey_index = sme->key_idx;
539bdcd8170SKalle Valo 
540334234b5SVasanthakumar Thiagarajan 		ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx,
5413450334fSVasanthakumar Thiagarajan 				      vif->prwise_crypto,
542bdcd8170SKalle Valo 				      GROUP_USAGE | TX_USAGE,
543bdcd8170SKalle Valo 				      key->key_len,
544f4bb9a6fSJouni Malinen 				      NULL, 0,
545bdcd8170SKalle Valo 				      key->key, KEY_OP_INIT_VAL, NULL,
546bdcd8170SKalle Valo 				      NO_SYNC_WMIFLAG);
547bdcd8170SKalle Valo 	}
548bdcd8170SKalle Valo 
549bdcd8170SKalle Valo 	if (!ar->usr_bss_filter) {
55059c98449SVasanthakumar Thiagarajan 		clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
551240d2799SVasanthakumar Thiagarajan 		if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
552240d2799SVasanthakumar Thiagarajan 		    ALL_BSS_FILTER, 0) != 0) {
553bdcd8170SKalle Valo 			ath6kl_err("couldn't set bss filtering\n");
554bdcd8170SKalle Valo 			up(&ar->sem);
555bdcd8170SKalle Valo 			return -EIO;
556bdcd8170SKalle Valo 		}
557bdcd8170SKalle Valo 	}
558bdcd8170SKalle Valo 
559f5938f24SVasanthakumar Thiagarajan 	vif->nw_type = vif->next_mode;
560bdcd8170SKalle Valo 
5613ca9d1fcSAarthi Thiruvengadam 	if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT)
5623ca9d1fcSAarthi Thiruvengadam 		nw_subtype = SUBTYPE_P2PCLIENT;
5633ca9d1fcSAarthi Thiruvengadam 
564bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
565bdcd8170SKalle Valo 		   "%s: connect called with authmode %d dot11 auth %d"
566bdcd8170SKalle Valo 		   " PW crypto %d PW crypto len %d GRP crypto %d"
567bdcd8170SKalle Valo 		   " GRP crypto len %d channel hint %u\n",
568bdcd8170SKalle Valo 		   __func__,
5693450334fSVasanthakumar Thiagarajan 		   vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto,
5703450334fSVasanthakumar Thiagarajan 		   vif->prwise_crypto_len, vif->grp_crypto,
571f74bac54SVasanthakumar Thiagarajan 		   vif->grp_crypto_len, vif->ch_hint);
572bdcd8170SKalle Valo 
573cf5333d7SVasanthakumar Thiagarajan 	vif->reconnect_flag = 0;
574334234b5SVasanthakumar Thiagarajan 	status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type,
5753450334fSVasanthakumar Thiagarajan 					vif->dot11_auth_mode, vif->auth_mode,
5763450334fSVasanthakumar Thiagarajan 					vif->prwise_crypto,
5773450334fSVasanthakumar Thiagarajan 					vif->prwise_crypto_len,
5783450334fSVasanthakumar Thiagarajan 					vif->grp_crypto, vif->grp_crypto_len,
5793450334fSVasanthakumar Thiagarajan 					vif->ssid_len, vif->ssid,
580f74bac54SVasanthakumar Thiagarajan 					vif->req_bssid, vif->ch_hint,
5813ca9d1fcSAarthi Thiruvengadam 					ar->connect_ctrl_flags, nw_subtype);
582bdcd8170SKalle Valo 
583bdcd8170SKalle Valo 	up(&ar->sem);
584bdcd8170SKalle Valo 
585bdcd8170SKalle Valo 	if (status == -EINVAL) {
5863450334fSVasanthakumar Thiagarajan 		memset(vif->ssid, 0, sizeof(vif->ssid));
5873450334fSVasanthakumar Thiagarajan 		vif->ssid_len = 0;
588bdcd8170SKalle Valo 		ath6kl_err("invalid request\n");
589bdcd8170SKalle Valo 		return -ENOENT;
590bdcd8170SKalle Valo 	} else if (status) {
591bdcd8170SKalle Valo 		ath6kl_err("ath6kl_wmi_connect_cmd failed\n");
592bdcd8170SKalle Valo 		return -EIO;
593bdcd8170SKalle Valo 	}
594bdcd8170SKalle Valo 
595bdcd8170SKalle Valo 	if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) &&
5963450334fSVasanthakumar Thiagarajan 	    ((vif->auth_mode == WPA_PSK_AUTH)
5973450334fSVasanthakumar Thiagarajan 	     || (vif->auth_mode == WPA2_PSK_AUTH))) {
598de3ad713SVasanthakumar Thiagarajan 		mod_timer(&vif->disconnect_timer,
599bdcd8170SKalle Valo 			  jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL));
600bdcd8170SKalle Valo 	}
601bdcd8170SKalle Valo 
602bdcd8170SKalle Valo 	ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD;
60359c98449SVasanthakumar Thiagarajan 	set_bit(CONNECT_PEND, &vif->flags);
604bdcd8170SKalle Valo 
605bdcd8170SKalle Valo 	return 0;
606bdcd8170SKalle Valo }
607bdcd8170SKalle Valo 
6085e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss *
6095e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif,
6104eab6f4fSRaja Mani 			 enum network_type nw_type,
6114eab6f4fSRaja Mani 			 const u8 *bssid,
61201cac476SJouni Malinen 			 struct ieee80211_channel *chan,
6135e13fd35SVasanthakumar Thiagarajan 			 const u8 *beacon_ie,
6145e13fd35SVasanthakumar Thiagarajan 			 size_t beacon_ie_len)
61501cac476SJouni Malinen {
616240d2799SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
61701cac476SJouni Malinen 	struct cfg80211_bss *bss;
6184eab6f4fSRaja Mani 	u16 cap_mask, cap_val;
61901cac476SJouni Malinen 	u8 *ie;
62001cac476SJouni Malinen 
6214eab6f4fSRaja Mani 	if (nw_type & ADHOC_NETWORK) {
6224eab6f4fSRaja Mani 		cap_mask = WLAN_CAPABILITY_IBSS;
6234eab6f4fSRaja Mani 		cap_val = WLAN_CAPABILITY_IBSS;
6244eab6f4fSRaja Mani 	} else {
6254eab6f4fSRaja Mani 		cap_mask = WLAN_CAPABILITY_ESS;
6264eab6f4fSRaja Mani 		cap_val = WLAN_CAPABILITY_ESS;
6274eab6f4fSRaja Mani 	}
6284eab6f4fSRaja Mani 
629be98e3a4SVasanthakumar Thiagarajan 	bss = cfg80211_get_bss(ar->wiphy, chan, bssid,
6304eab6f4fSRaja Mani 			       vif->ssid, vif->ssid_len,
6314eab6f4fSRaja Mani 			       cap_mask, cap_val);
63201cac476SJouni Malinen 	if (bss == NULL) {
63301cac476SJouni Malinen 		/*
63401cac476SJouni Malinen 		 * Since cfg80211 may not yet know about the BSS,
63501cac476SJouni Malinen 		 * generate a partial entry until the first BSS info
63601cac476SJouni Malinen 		 * event becomes available.
63701cac476SJouni Malinen 		 *
63801cac476SJouni Malinen 		 * Prepend SSID element since it is not included in the Beacon
63901cac476SJouni Malinen 		 * IEs from the target.
64001cac476SJouni Malinen 		 */
6413450334fSVasanthakumar Thiagarajan 		ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL);
64201cac476SJouni Malinen 		if (ie == NULL)
6435e13fd35SVasanthakumar Thiagarajan 			return NULL;
64401cac476SJouni Malinen 		ie[0] = WLAN_EID_SSID;
6453450334fSVasanthakumar Thiagarajan 		ie[1] = vif->ssid_len;
6463450334fSVasanthakumar Thiagarajan 		memcpy(ie + 2, vif->ssid, vif->ssid_len);
6473450334fSVasanthakumar Thiagarajan 		memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len);
648be98e3a4SVasanthakumar Thiagarajan 		bss = cfg80211_inform_bss(ar->wiphy, chan,
6494eab6f4fSRaja Mani 					  bssid, 0, cap_val, 100,
6503450334fSVasanthakumar Thiagarajan 					  ie, 2 + vif->ssid_len + beacon_ie_len,
65101cac476SJouni Malinen 					  0, GFP_KERNEL);
65201cac476SJouni Malinen 		if (bss)
6534eab6f4fSRaja Mani 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to "
6544eab6f4fSRaja Mani 				   "cfg80211\n", bssid);
65501cac476SJouni Malinen 		kfree(ie);
65601cac476SJouni Malinen 	} else
6575e13fd35SVasanthakumar Thiagarajan 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n");
65801cac476SJouni Malinen 
6595e13fd35SVasanthakumar Thiagarajan 	return bss;
66001cac476SJouni Malinen }
66101cac476SJouni Malinen 
662240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel,
663bdcd8170SKalle Valo 				   u8 *bssid, u16 listen_intvl,
664bdcd8170SKalle Valo 				   u16 beacon_intvl,
665bdcd8170SKalle Valo 				   enum network_type nw_type,
666bdcd8170SKalle Valo 				   u8 beacon_ie_len, u8 assoc_req_len,
667bdcd8170SKalle Valo 				   u8 assoc_resp_len, u8 *assoc_info)
668bdcd8170SKalle Valo {
66901cac476SJouni Malinen 	struct ieee80211_channel *chan;
670240d2799SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
6715e13fd35SVasanthakumar Thiagarajan 	struct cfg80211_bss *bss;
672bdcd8170SKalle Valo 
673bdcd8170SKalle Valo 	/* capinfo + listen interval */
674bdcd8170SKalle Valo 	u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16);
675bdcd8170SKalle Valo 
676bdcd8170SKalle Valo 	/* capinfo + status code +  associd */
677bdcd8170SKalle Valo 	u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16);
678bdcd8170SKalle Valo 
679bdcd8170SKalle Valo 	u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset;
680bdcd8170SKalle Valo 	u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len +
681bdcd8170SKalle Valo 	    assoc_resp_ie_offset;
682bdcd8170SKalle Valo 
683bdcd8170SKalle Valo 	assoc_req_len -= assoc_req_ie_offset;
684bdcd8170SKalle Valo 	assoc_resp_len -= assoc_resp_ie_offset;
685bdcd8170SKalle Valo 
68632c10874SJouni Malinen 	/*
68732c10874SJouni Malinen 	 * Store Beacon interval here; DTIM period will be available only once
68832c10874SJouni Malinen 	 * a Beacon frame from the AP is seen.
68932c10874SJouni Malinen 	 */
690cf5333d7SVasanthakumar Thiagarajan 	vif->assoc_bss_beacon_int = beacon_intvl;
69159c98449SVasanthakumar Thiagarajan 	clear_bit(DTIM_PERIOD_AVAIL, &vif->flags);
69232c10874SJouni Malinen 
693bdcd8170SKalle Valo 	if (nw_type & ADHOC_NETWORK) {
694551959d8SVasanthakumar Thiagarajan 		if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) {
695bdcd8170SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
696bdcd8170SKalle Valo 				   "%s: ath6k not in ibss mode\n", __func__);
697bdcd8170SKalle Valo 			return;
698bdcd8170SKalle Valo 		}
699bdcd8170SKalle Valo 	}
700bdcd8170SKalle Valo 
701bdcd8170SKalle Valo 	if (nw_type & INFRA_NETWORK) {
702551959d8SVasanthakumar Thiagarajan 		if (vif->wdev.iftype != NL80211_IFTYPE_STATION &&
703551959d8SVasanthakumar Thiagarajan 		    vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) {
704bdcd8170SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
705bdcd8170SKalle Valo 				   "%s: ath6k not in station mode\n", __func__);
706bdcd8170SKalle Valo 			return;
707bdcd8170SKalle Valo 		}
708bdcd8170SKalle Valo 	}
709bdcd8170SKalle Valo 
710be98e3a4SVasanthakumar Thiagarajan 	chan = ieee80211_get_channel(ar->wiphy, (int) channel);
711bdcd8170SKalle Valo 
7125e13fd35SVasanthakumar Thiagarajan 	bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan,
7135e13fd35SVasanthakumar Thiagarajan 				       assoc_info, beacon_ie_len);
7145e13fd35SVasanthakumar Thiagarajan 	if (!bss) {
7154eab6f4fSRaja Mani 		ath6kl_err("could not add cfg80211 bss entry\n");
716bdcd8170SKalle Valo 		return;
717bdcd8170SKalle Valo 	}
718bdcd8170SKalle Valo 
7194eab6f4fSRaja Mani 	if (nw_type & ADHOC_NETWORK) {
7204eab6f4fSRaja Mani 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n",
7214eab6f4fSRaja Mani 			   nw_type & ADHOC_CREATOR ? "creator" : "joiner");
7224eab6f4fSRaja Mani 		cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL);
7235e13fd35SVasanthakumar Thiagarajan 		cfg80211_put_bss(bss);
72401cac476SJouni Malinen 		return;
72501cac476SJouni Malinen 	}
72601cac476SJouni Malinen 
72714ee6f6bSVasanthakumar Thiagarajan 	if (vif->sme_state == SME_CONNECTING) {
728bdcd8170SKalle Valo 		/* inform connect result to cfg80211 */
72914ee6f6bSVasanthakumar Thiagarajan 		vif->sme_state = SME_CONNECTED;
730240d2799SVasanthakumar Thiagarajan 		cfg80211_connect_result(vif->ndev, bssid,
731bdcd8170SKalle Valo 					assoc_req_ie, assoc_req_len,
732bdcd8170SKalle Valo 					assoc_resp_ie, assoc_resp_len,
733bdcd8170SKalle Valo 					WLAN_STATUS_SUCCESS, GFP_KERNEL);
7345e13fd35SVasanthakumar Thiagarajan 		cfg80211_put_bss(bss);
73514ee6f6bSVasanthakumar Thiagarajan 	} else if (vif->sme_state == SME_CONNECTED) {
736bdcd8170SKalle Valo 		/* inform roam event to cfg80211 */
7375e13fd35SVasanthakumar Thiagarajan 		cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len,
738bdcd8170SKalle Valo 				    assoc_resp_ie, assoc_resp_len, GFP_KERNEL);
739bdcd8170SKalle Valo 	}
740bdcd8170SKalle Valo }
741bdcd8170SKalle Valo 
742bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy,
743bdcd8170SKalle Valo 				      struct net_device *dev, u16 reason_code)
744bdcd8170SKalle Valo {
745d6d5c06cSKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
7463450334fSVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
747bdcd8170SKalle Valo 
748bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__,
749bdcd8170SKalle Valo 		   reason_code);
750bdcd8170SKalle Valo 
75110509f90SKalle Valo 	ath6kl_cfg80211_sscan_disable(vif);
75210509f90SKalle Valo 
753990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
754bdcd8170SKalle Valo 		return -EIO;
755bdcd8170SKalle Valo 
756bdcd8170SKalle Valo 	if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
757bdcd8170SKalle Valo 		ath6kl_err("busy, destroy in progress\n");
758bdcd8170SKalle Valo 		return -EBUSY;
759bdcd8170SKalle Valo 	}
760bdcd8170SKalle Valo 
761bdcd8170SKalle Valo 	if (down_interruptible(&ar->sem)) {
762bdcd8170SKalle Valo 		ath6kl_err("busy, couldn't get access\n");
763bdcd8170SKalle Valo 		return -ERESTARTSYS;
764bdcd8170SKalle Valo 	}
765bdcd8170SKalle Valo 
766cf5333d7SVasanthakumar Thiagarajan 	vif->reconnect_flag = 0;
767240d2799SVasanthakumar Thiagarajan 	ath6kl_disconnect(vif);
7683450334fSVasanthakumar Thiagarajan 	memset(vif->ssid, 0, sizeof(vif->ssid));
7693450334fSVasanthakumar Thiagarajan 	vif->ssid_len = 0;
770bdcd8170SKalle Valo 
771bdcd8170SKalle Valo 	if (!test_bit(SKIP_SCAN, &ar->flag))
7728c8b65e3SVasanthakumar Thiagarajan 		memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
773bdcd8170SKalle Valo 
774bdcd8170SKalle Valo 	up(&ar->sem);
775bdcd8170SKalle Valo 
77614ee6f6bSVasanthakumar Thiagarajan 	vif->sme_state = SME_DISCONNECTED;
777170826ddSVasanthakumar Thiagarajan 
778bdcd8170SKalle Valo 	return 0;
779bdcd8170SKalle Valo }
780bdcd8170SKalle Valo 
781240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason,
782bdcd8170SKalle Valo 				      u8 *bssid, u8 assoc_resp_len,
783bdcd8170SKalle Valo 				      u8 *assoc_info, u16 proto_reason)
784bdcd8170SKalle Valo {
785240d2799SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
78659c98449SVasanthakumar Thiagarajan 
78714ee6f6bSVasanthakumar Thiagarajan 	if (vif->scan_req) {
78814ee6f6bSVasanthakumar Thiagarajan 		cfg80211_scan_done(vif->scan_req, true);
78914ee6f6bSVasanthakumar Thiagarajan 		vif->scan_req = NULL;
790bdcd8170SKalle Valo 	}
791bdcd8170SKalle Valo 
792f5938f24SVasanthakumar Thiagarajan 	if (vif->nw_type & ADHOC_NETWORK) {
793551959d8SVasanthakumar Thiagarajan 		if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) {
794bdcd8170SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
795bdcd8170SKalle Valo 				   "%s: ath6k not in ibss mode\n", __func__);
796bdcd8170SKalle Valo 			return;
797bdcd8170SKalle Valo 		}
798bdcd8170SKalle Valo 		memset(bssid, 0, ETH_ALEN);
799240d2799SVasanthakumar Thiagarajan 		cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL);
800bdcd8170SKalle Valo 		return;
801bdcd8170SKalle Valo 	}
802bdcd8170SKalle Valo 
803f5938f24SVasanthakumar Thiagarajan 	if (vif->nw_type & INFRA_NETWORK) {
804551959d8SVasanthakumar Thiagarajan 		if (vif->wdev.iftype != NL80211_IFTYPE_STATION &&
805551959d8SVasanthakumar Thiagarajan 		    vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) {
806bdcd8170SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
807bdcd8170SKalle Valo 				   "%s: ath6k not in station mode\n", __func__);
808bdcd8170SKalle Valo 			return;
809bdcd8170SKalle Valo 		}
810bdcd8170SKalle Valo 	}
811bdcd8170SKalle Valo 
8121de547d6SVasanthakumar Thiagarajan 	/*
8131de547d6SVasanthakumar Thiagarajan 	 * Send a disconnect command to target when a disconnect event is
8141de547d6SVasanthakumar Thiagarajan 	 * received with reason code other than 3 (DISCONNECT_CMD - disconnect
8151de547d6SVasanthakumar Thiagarajan 	 * request from host) to make the firmware stop trying to connect even
8161de547d6SVasanthakumar Thiagarajan 	 * after giving disconnect event. There will be one more disconnect
8171de547d6SVasanthakumar Thiagarajan 	 * event for this disconnect command with reason code DISCONNECT_CMD
8181de547d6SVasanthakumar Thiagarajan 	 * which will be notified to cfg80211.
8191de547d6SVasanthakumar Thiagarajan 	 */
820bdcd8170SKalle Valo 
8211de547d6SVasanthakumar Thiagarajan 	if (reason != DISCONNECT_CMD) {
822334234b5SVasanthakumar Thiagarajan 		ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx);
823bdcd8170SKalle Valo 		return;
824bdcd8170SKalle Valo 	}
825bdcd8170SKalle Valo 
82659c98449SVasanthakumar Thiagarajan 	clear_bit(CONNECT_PEND, &vif->flags);
827bdcd8170SKalle Valo 
82814ee6f6bSVasanthakumar Thiagarajan 	if (vif->sme_state == SME_CONNECTING) {
829240d2799SVasanthakumar Thiagarajan 		cfg80211_connect_result(vif->ndev,
830bdcd8170SKalle Valo 				bssid, NULL, 0,
831bdcd8170SKalle Valo 				NULL, 0,
832bdcd8170SKalle Valo 				WLAN_STATUS_UNSPECIFIED_FAILURE,
833bdcd8170SKalle Valo 				GFP_KERNEL);
83414ee6f6bSVasanthakumar Thiagarajan 	} else if (vif->sme_state == SME_CONNECTED) {
835240d2799SVasanthakumar Thiagarajan 		cfg80211_disconnected(vif->ndev, reason,
836bdcd8170SKalle Valo 				NULL, 0, GFP_KERNEL);
837bdcd8170SKalle Valo 	}
838bdcd8170SKalle Valo 
83914ee6f6bSVasanthakumar Thiagarajan 	vif->sme_state = SME_DISCONNECTED;
840bdcd8170SKalle Valo }
841bdcd8170SKalle Valo 
842bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev,
843bdcd8170SKalle Valo 				struct cfg80211_scan_request *request)
844bdcd8170SKalle Valo {
845d6d5c06cSKalle Valo 	struct ath6kl *ar = ath6kl_priv(ndev);
84659c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
8471276c9efSEdward Lu 	s8 n_channels = 0;
8481276c9efSEdward Lu 	u16 *channels = NULL;
849bdcd8170SKalle Valo 	int ret = 0;
850f1f92179SVasanthakumar Thiagarajan 	u32 force_fg_scan = 0;
851bdcd8170SKalle Valo 
852990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
853bdcd8170SKalle Valo 		return -EIO;
854bdcd8170SKalle Valo 
85510509f90SKalle Valo 	ath6kl_cfg80211_sscan_disable(vif);
85610509f90SKalle Valo 
857bdcd8170SKalle Valo 	if (!ar->usr_bss_filter) {
85859c98449SVasanthakumar Thiagarajan 		clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
8591b1e6ee3SJouni Malinen 		ret = ath6kl_wmi_bssfilter_cmd(
860240d2799SVasanthakumar Thiagarajan 			ar->wmi, vif->fw_vif_idx,
86159c98449SVasanthakumar Thiagarajan 			(test_bit(CONNECTED, &vif->flags) ?
8621b1e6ee3SJouni Malinen 			 ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0);
8631b1e6ee3SJouni Malinen 		if (ret) {
864bdcd8170SKalle Valo 			ath6kl_err("couldn't set bss filtering\n");
8651b1e6ee3SJouni Malinen 			return ret;
866bdcd8170SKalle Valo 		}
867bdcd8170SKalle Valo 	}
868bdcd8170SKalle Valo 
869bdcd8170SKalle Valo 	if (request->n_ssids && request->ssids[0].ssid_len) {
870bdcd8170SKalle Valo 		u8 i;
871bdcd8170SKalle Valo 
872bdcd8170SKalle Valo 		if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1))
873bdcd8170SKalle Valo 			request->n_ssids = MAX_PROBED_SSID_INDEX - 1;
874bdcd8170SKalle Valo 
875bdcd8170SKalle Valo 		for (i = 0; i < request->n_ssids; i++)
876334234b5SVasanthakumar Thiagarajan 			ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
877334234b5SVasanthakumar Thiagarajan 						  i + 1, SPECIFIC_SSID_FLAG,
878bdcd8170SKalle Valo 						  request->ssids[i].ssid_len,
879bdcd8170SKalle Valo 						  request->ssids[i].ssid);
880bdcd8170SKalle Valo 	}
881bdcd8170SKalle Valo 
88210509f90SKalle Valo 	/*
88310509f90SKalle Valo 	 * FIXME: we should clear the IE in fw if it's not set so just
88410509f90SKalle Valo 	 * remove the check altogether
88510509f90SKalle Valo 	 */
886b84da8c7SJouni Malinen 	if (request->ie) {
887334234b5SVasanthakumar Thiagarajan 		ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
888334234b5SVasanthakumar Thiagarajan 					       WMI_FRAME_PROBE_REQ,
889b84da8c7SJouni Malinen 					       request->ie, request->ie_len);
890b84da8c7SJouni Malinen 		if (ret) {
891b84da8c7SJouni Malinen 			ath6kl_err("failed to set Probe Request appie for "
892b84da8c7SJouni Malinen 				   "scan");
893b84da8c7SJouni Malinen 			return ret;
894b84da8c7SJouni Malinen 		}
895b84da8c7SJouni Malinen 	}
896b84da8c7SJouni Malinen 
89711869befSJouni Malinen 	/*
89811869befSJouni Malinen 	 * Scan only the requested channels if the request specifies a set of
89911869befSJouni Malinen 	 * channels. If the list is longer than the target supports, do not
90011869befSJouni Malinen 	 * configure the list and instead, scan all available channels.
90111869befSJouni Malinen 	 */
90211869befSJouni Malinen 	if (request->n_channels > 0 &&
90311869befSJouni Malinen 	    request->n_channels <= WMI_MAX_CHANNELS) {
9041276c9efSEdward Lu 		u8 i;
9051276c9efSEdward Lu 
90611869befSJouni Malinen 		n_channels = request->n_channels;
9071276c9efSEdward Lu 
9081276c9efSEdward Lu 		channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL);
9091276c9efSEdward Lu 		if (channels == NULL) {
9101276c9efSEdward Lu 			ath6kl_warn("failed to set scan channels, "
9111276c9efSEdward Lu 				    "scan all channels");
9121276c9efSEdward Lu 			n_channels = 0;
9131276c9efSEdward Lu 		}
9141276c9efSEdward Lu 
9151276c9efSEdward Lu 		for (i = 0; i < n_channels; i++)
9161276c9efSEdward Lu 			channels[i] = request->channels[i]->center_freq;
9171276c9efSEdward Lu 	}
9181276c9efSEdward Lu 
91959c98449SVasanthakumar Thiagarajan 	if (test_bit(CONNECTED, &vif->flags))
920f1f92179SVasanthakumar Thiagarajan 		force_fg_scan = 1;
921f1f92179SVasanthakumar Thiagarajan 
9223ca9d1fcSAarthi Thiruvengadam 	if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX,
9233ca9d1fcSAarthi Thiruvengadam 		    ar->fw_capabilities)) {
9243ca9d1fcSAarthi Thiruvengadam 		/*
9253ca9d1fcSAarthi Thiruvengadam 		 * If capable of doing P2P mgmt operations using
9263ca9d1fcSAarthi Thiruvengadam 		 * station interface, send additional information like
9273ca9d1fcSAarthi Thiruvengadam 		 * supported rates to advertise and xmit rates for
9283ca9d1fcSAarthi Thiruvengadam 		 * probe requests
9293ca9d1fcSAarthi Thiruvengadam 		 */
9303ca9d1fcSAarthi Thiruvengadam 		ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx,
9313ca9d1fcSAarthi Thiruvengadam 						WMI_LONG_SCAN, force_fg_scan,
9323ca9d1fcSAarthi Thiruvengadam 						false, 0, 0, n_channels,
9333ca9d1fcSAarthi Thiruvengadam 						channels, request->no_cck,
9343ca9d1fcSAarthi Thiruvengadam 						request->rates);
9353ca9d1fcSAarthi Thiruvengadam 	} else {
9363ca9d1fcSAarthi Thiruvengadam 		ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx,
9373ca9d1fcSAarthi Thiruvengadam 						WMI_LONG_SCAN, force_fg_scan,
9383ca9d1fcSAarthi Thiruvengadam 						false, 0, 0, n_channels,
939334234b5SVasanthakumar Thiagarajan 						channels);
9403ca9d1fcSAarthi Thiruvengadam 	}
9411b1e6ee3SJouni Malinen 	if (ret)
942bdcd8170SKalle Valo 		ath6kl_err("wmi_startscan_cmd failed\n");
94311869befSJouni Malinen 	else
94414ee6f6bSVasanthakumar Thiagarajan 		vif->scan_req = request;
945bdcd8170SKalle Valo 
9461276c9efSEdward Lu 	kfree(channels);
9471276c9efSEdward Lu 
948bdcd8170SKalle Valo 	return ret;
949bdcd8170SKalle Valo }
950bdcd8170SKalle Valo 
9511c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted)
952bdcd8170SKalle Valo {
953240d2799SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
9546fd1eaceSKalle Valo 	int i;
955bdcd8170SKalle Valo 
9561c17d313SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__,
9571c17d313SKalle Valo 		   aborted ? " aborted" : "");
958bdcd8170SKalle Valo 
95914ee6f6bSVasanthakumar Thiagarajan 	if (!vif->scan_req)
9606fd1eaceSKalle Valo 		return;
9616fd1eaceSKalle Valo 
9621c17d313SKalle Valo 	if (aborted)
9636fd1eaceSKalle Valo 		goto out;
964bdcd8170SKalle Valo 
96514ee6f6bSVasanthakumar Thiagarajan 	if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) {
96614ee6f6bSVasanthakumar Thiagarajan 		for (i = 0; i < vif->scan_req->n_ssids; i++) {
967334234b5SVasanthakumar Thiagarajan 			ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
968334234b5SVasanthakumar Thiagarajan 						  i + 1, DISABLE_SSID_FLAG,
969bdcd8170SKalle Valo 						  0, NULL);
970bdcd8170SKalle Valo 		}
971bdcd8170SKalle Valo 	}
9726fd1eaceSKalle Valo 
9736fd1eaceSKalle Valo out:
974cb93821aSKalle Valo 	cfg80211_scan_done(vif->scan_req, aborted);
97514ee6f6bSVasanthakumar Thiagarajan 	vif->scan_req = NULL;
976bdcd8170SKalle Valo }
977bdcd8170SKalle Valo 
978bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev,
979bdcd8170SKalle Valo 				   u8 key_index, bool pairwise,
980bdcd8170SKalle Valo 				   const u8 *mac_addr,
981bdcd8170SKalle Valo 				   struct key_params *params)
982bdcd8170SKalle Valo {
983d6d5c06cSKalle Valo 	struct ath6kl *ar = ath6kl_priv(ndev);
98459c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
985bdcd8170SKalle Valo 	struct ath6kl_key *key = NULL;
986bdcd8170SKalle Valo 	u8 key_usage;
987bdcd8170SKalle Valo 	u8 key_type;
988bdcd8170SKalle Valo 
989990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
990bdcd8170SKalle Valo 		return -EIO;
991bdcd8170SKalle Valo 
992837cb97eSJouni Malinen 	if (params->cipher == CCKM_KRK_CIPHER_SUITE) {
993837cb97eSJouni Malinen 		if (params->key_len != WMI_KRK_LEN)
994837cb97eSJouni Malinen 			return -EINVAL;
995240d2799SVasanthakumar Thiagarajan 		return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx,
996240d2799SVasanthakumar Thiagarajan 					      params->key);
997837cb97eSJouni Malinen 	}
998837cb97eSJouni Malinen 
999bdcd8170SKalle Valo 	if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
1000bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1001bdcd8170SKalle Valo 			   "%s: key index %d out of bounds\n", __func__,
1002bdcd8170SKalle Valo 			   key_index);
1003bdcd8170SKalle Valo 		return -ENOENT;
1004bdcd8170SKalle Valo 	}
1005bdcd8170SKalle Valo 
10066f2a73f9SVasanthakumar Thiagarajan 	key = &vif->keys[key_index];
1007bdcd8170SKalle Valo 	memset(key, 0, sizeof(struct ath6kl_key));
1008bdcd8170SKalle Valo 
1009bdcd8170SKalle Valo 	if (pairwise)
1010bdcd8170SKalle Valo 		key_usage = PAIRWISE_USAGE;
1011bdcd8170SKalle Valo 	else
1012bdcd8170SKalle Valo 		key_usage = GROUP_USAGE;
1013bdcd8170SKalle Valo 
1014bdcd8170SKalle Valo 	if (params) {
10155e07021eSDai Shuibing 		int seq_len = params->seq_len;
10165e07021eSDai Shuibing 		if (params->cipher == WLAN_CIPHER_SUITE_SMS4 &&
10175e07021eSDai Shuibing 		    seq_len > ATH6KL_KEY_SEQ_LEN) {
10185e07021eSDai Shuibing 			/* Only first half of the WPI PN is configured */
10195e07021eSDai Shuibing 			seq_len = ATH6KL_KEY_SEQ_LEN;
10205e07021eSDai Shuibing 		}
1021bdcd8170SKalle Valo 		if (params->key_len > WLAN_MAX_KEY_LEN ||
10225e07021eSDai Shuibing 		    seq_len > sizeof(key->seq))
1023bdcd8170SKalle Valo 			return -EINVAL;
1024bdcd8170SKalle Valo 
1025bdcd8170SKalle Valo 		key->key_len = params->key_len;
1026bdcd8170SKalle Valo 		memcpy(key->key, params->key, key->key_len);
10275e07021eSDai Shuibing 		key->seq_len = seq_len;
1028bdcd8170SKalle Valo 		memcpy(key->seq, params->seq, key->seq_len);
1029bdcd8170SKalle Valo 		key->cipher = params->cipher;
1030bdcd8170SKalle Valo 	}
1031bdcd8170SKalle Valo 
1032bdcd8170SKalle Valo 	switch (key->cipher) {
1033bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_WEP40:
1034bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_WEP104:
1035bdcd8170SKalle Valo 		key_type = WEP_CRYPT;
1036bdcd8170SKalle Valo 		break;
1037bdcd8170SKalle Valo 
1038bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_TKIP:
1039bdcd8170SKalle Valo 		key_type = TKIP_CRYPT;
1040bdcd8170SKalle Valo 		break;
1041bdcd8170SKalle Valo 
1042bdcd8170SKalle Valo 	case WLAN_CIPHER_SUITE_CCMP:
1043bdcd8170SKalle Valo 		key_type = AES_CRYPT;
1044bdcd8170SKalle Valo 		break;
10455e07021eSDai Shuibing 	case WLAN_CIPHER_SUITE_SMS4:
10465e07021eSDai Shuibing 		key_type = WAPI_CRYPT;
10475e07021eSDai Shuibing 		break;
1048bdcd8170SKalle Valo 
1049bdcd8170SKalle Valo 	default:
1050bdcd8170SKalle Valo 		return -ENOTSUPP;
1051bdcd8170SKalle Valo 	}
1052bdcd8170SKalle Valo 
10533450334fSVasanthakumar Thiagarajan 	if (((vif->auth_mode == WPA_PSK_AUTH)
10543450334fSVasanthakumar Thiagarajan 	     || (vif->auth_mode == WPA2_PSK_AUTH))
1055bdcd8170SKalle Valo 	    && (key_usage & GROUP_USAGE))
1056de3ad713SVasanthakumar Thiagarajan 		del_timer(&vif->disconnect_timer);
1057bdcd8170SKalle Valo 
1058bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1059bdcd8170SKalle Valo 		   "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n",
1060bdcd8170SKalle Valo 		   __func__, key_index, key->key_len, key_type,
1061bdcd8170SKalle Valo 		   key_usage, key->seq_len);
1062bdcd8170SKalle Valo 
1063f5938f24SVasanthakumar Thiagarajan 	if (vif->nw_type == AP_NETWORK && !pairwise &&
10644703290aSJouni Malinen 	    (key_type == TKIP_CRYPT || key_type == AES_CRYPT ||
10654703290aSJouni Malinen 	     key_type == WAPI_CRYPT) && params) {
10669a5b1318SJouni Malinen 		ar->ap_mode_bkey.valid = true;
10679a5b1318SJouni Malinen 		ar->ap_mode_bkey.key_index = key_index;
10689a5b1318SJouni Malinen 		ar->ap_mode_bkey.key_type = key_type;
10699a5b1318SJouni Malinen 		ar->ap_mode_bkey.key_len = key->key_len;
10709a5b1318SJouni Malinen 		memcpy(ar->ap_mode_bkey.key, key->key, key->key_len);
107159c98449SVasanthakumar Thiagarajan 		if (!test_bit(CONNECTED, &vif->flags)) {
10729a5b1318SJouni Malinen 			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group "
10739a5b1318SJouni Malinen 				   "key configuration until AP mode has been "
10749a5b1318SJouni Malinen 				   "started\n");
10759a5b1318SJouni Malinen 			/*
10769a5b1318SJouni Malinen 			 * The key will be set in ath6kl_connect_ap_mode() once
10779a5b1318SJouni Malinen 			 * the connected event is received from the target.
10789a5b1318SJouni Malinen 			 */
10799a5b1318SJouni Malinen 			return 0;
10809a5b1318SJouni Malinen 		}
10819a5b1318SJouni Malinen 	}
10829a5b1318SJouni Malinen 
1083f5938f24SVasanthakumar Thiagarajan 	if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT &&
108459c98449SVasanthakumar Thiagarajan 	    !test_bit(CONNECTED, &vif->flags)) {
1085151411e8SJouni Malinen 		/*
1086151411e8SJouni Malinen 		 * Store the key locally so that it can be re-configured after
1087151411e8SJouni Malinen 		 * the AP mode has properly started
1088151411e8SJouni Malinen 		 * (ath6kl_install_statioc_wep_keys).
1089151411e8SJouni Malinen 		 */
1090151411e8SJouni Malinen 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration "
1091151411e8SJouni Malinen 			   "until AP mode has been started\n");
10926f2a73f9SVasanthakumar Thiagarajan 		vif->wep_key_list[key_index].key_len = key->key_len;
10936f2a73f9SVasanthakumar Thiagarajan 		memcpy(vif->wep_key_list[key_index].key, key->key,
10946f2a73f9SVasanthakumar Thiagarajan 		       key->key_len);
1095151411e8SJouni Malinen 		return 0;
1096151411e8SJouni Malinen 	}
1097151411e8SJouni Malinen 
10987cefa44fSVasanthakumar Thiagarajan 	return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index,
1099bdcd8170SKalle Valo 				     key_type, key_usage, key->key_len,
1100f4bb9a6fSJouni Malinen 				     key->seq, key->seq_len, key->key,
1101f4bb9a6fSJouni Malinen 				     KEY_OP_INIT_VAL,
1102bdcd8170SKalle Valo 				     (u8 *) mac_addr, SYNC_BOTH_WMIFLAG);
1103bdcd8170SKalle Valo }
1104bdcd8170SKalle Valo 
1105bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev,
1106bdcd8170SKalle Valo 				   u8 key_index, bool pairwise,
1107bdcd8170SKalle Valo 				   const u8 *mac_addr)
1108bdcd8170SKalle Valo {
1109d6d5c06cSKalle Valo 	struct ath6kl *ar = ath6kl_priv(ndev);
11106f2a73f9SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
1111bdcd8170SKalle Valo 
1112bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
1113bdcd8170SKalle Valo 
1114990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1115bdcd8170SKalle Valo 		return -EIO;
1116bdcd8170SKalle Valo 
1117bdcd8170SKalle Valo 	if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
1118bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1119bdcd8170SKalle Valo 			   "%s: key index %d out of bounds\n", __func__,
1120bdcd8170SKalle Valo 			   key_index);
1121bdcd8170SKalle Valo 		return -ENOENT;
1122bdcd8170SKalle Valo 	}
1123bdcd8170SKalle Valo 
11246f2a73f9SVasanthakumar Thiagarajan 	if (!vif->keys[key_index].key_len) {
1125bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1126bdcd8170SKalle Valo 			   "%s: index %d is empty\n", __func__, key_index);
1127bdcd8170SKalle Valo 		return 0;
1128bdcd8170SKalle Valo 	}
1129bdcd8170SKalle Valo 
11306f2a73f9SVasanthakumar Thiagarajan 	vif->keys[key_index].key_len = 0;
1131bdcd8170SKalle Valo 
1132334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index);
1133bdcd8170SKalle Valo }
1134bdcd8170SKalle Valo 
1135bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev,
1136bdcd8170SKalle Valo 				   u8 key_index, bool pairwise,
1137bdcd8170SKalle Valo 				   const u8 *mac_addr, void *cookie,
1138bdcd8170SKalle Valo 				   void (*callback) (void *cookie,
1139bdcd8170SKalle Valo 						     struct key_params *))
1140bdcd8170SKalle Valo {
11416f2a73f9SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
1142bdcd8170SKalle Valo 	struct ath6kl_key *key = NULL;
1143bdcd8170SKalle Valo 	struct key_params params;
1144bdcd8170SKalle Valo 
1145bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
1146bdcd8170SKalle Valo 
1147990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1148bdcd8170SKalle Valo 		return -EIO;
1149bdcd8170SKalle Valo 
1150bdcd8170SKalle Valo 	if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
1151bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1152bdcd8170SKalle Valo 			   "%s: key index %d out of bounds\n", __func__,
1153bdcd8170SKalle Valo 			   key_index);
1154bdcd8170SKalle Valo 		return -ENOENT;
1155bdcd8170SKalle Valo 	}
1156bdcd8170SKalle Valo 
11576f2a73f9SVasanthakumar Thiagarajan 	key = &vif->keys[key_index];
1158bdcd8170SKalle Valo 	memset(&params, 0, sizeof(params));
1159bdcd8170SKalle Valo 	params.cipher = key->cipher;
1160bdcd8170SKalle Valo 	params.key_len = key->key_len;
1161bdcd8170SKalle Valo 	params.seq_len = key->seq_len;
1162bdcd8170SKalle Valo 	params.seq = key->seq;
1163bdcd8170SKalle Valo 	params.key = key->key;
1164bdcd8170SKalle Valo 
1165bdcd8170SKalle Valo 	callback(cookie, &params);
1166bdcd8170SKalle Valo 
1167bdcd8170SKalle Valo 	return key->key_len ? 0 : -ENOENT;
1168bdcd8170SKalle Valo }
1169bdcd8170SKalle Valo 
1170bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy,
1171bdcd8170SKalle Valo 					   struct net_device *ndev,
1172bdcd8170SKalle Valo 					   u8 key_index, bool unicast,
1173bdcd8170SKalle Valo 					   bool multicast)
1174bdcd8170SKalle Valo {
1175d6d5c06cSKalle Valo 	struct ath6kl *ar = ath6kl_priv(ndev);
117659c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
1177bdcd8170SKalle Valo 	struct ath6kl_key *key = NULL;
1178bdcd8170SKalle Valo 	u8 key_usage;
1179229ed6b5SEdward Lu 	enum crypto_type key_type = NONE_CRYPT;
1180bdcd8170SKalle Valo 
1181bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);
1182bdcd8170SKalle Valo 
1183990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1184bdcd8170SKalle Valo 		return -EIO;
1185bdcd8170SKalle Valo 
1186bdcd8170SKalle Valo 	if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
1187bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1188bdcd8170SKalle Valo 			   "%s: key index %d out of bounds\n",
1189bdcd8170SKalle Valo 			   __func__, key_index);
1190bdcd8170SKalle Valo 		return -ENOENT;
1191bdcd8170SKalle Valo 	}
1192bdcd8170SKalle Valo 
11936f2a73f9SVasanthakumar Thiagarajan 	if (!vif->keys[key_index].key_len) {
1194bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n",
1195bdcd8170SKalle Valo 			   __func__, key_index);
1196bdcd8170SKalle Valo 		return -EINVAL;
1197bdcd8170SKalle Valo 	}
1198bdcd8170SKalle Valo 
11993450334fSVasanthakumar Thiagarajan 	vif->def_txkey_index = key_index;
12006f2a73f9SVasanthakumar Thiagarajan 	key = &vif->keys[vif->def_txkey_index];
1201bdcd8170SKalle Valo 	key_usage = GROUP_USAGE;
12023450334fSVasanthakumar Thiagarajan 	if (vif->prwise_crypto == WEP_CRYPT)
1203bdcd8170SKalle Valo 		key_usage |= TX_USAGE;
1204229ed6b5SEdward Lu 	if (unicast)
12053450334fSVasanthakumar Thiagarajan 		key_type = vif->prwise_crypto;
1206229ed6b5SEdward Lu 	if (multicast)
12073450334fSVasanthakumar Thiagarajan 		key_type = vif->grp_crypto;
1208bdcd8170SKalle Valo 
1209f5938f24SVasanthakumar Thiagarajan 	if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags))
12109a5b1318SJouni Malinen 		return 0; /* Delay until AP mode has been started */
12119a5b1318SJouni Malinen 
1212f3e61eceSJouni Malinen 	return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx,
1213334234b5SVasanthakumar Thiagarajan 				     vif->def_txkey_index,
1214229ed6b5SEdward Lu 				     key_type, key_usage,
1215f4bb9a6fSJouni Malinen 				     key->key_len, key->seq, key->seq_len,
1216f4bb9a6fSJouni Malinen 				     key->key,
1217bdcd8170SKalle Valo 				     KEY_OP_INIT_VAL, NULL,
1218bdcd8170SKalle Valo 				     SYNC_BOTH_WMIFLAG);
1219bdcd8170SKalle Valo }
1220bdcd8170SKalle Valo 
1221240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid,
1222bdcd8170SKalle Valo 				       bool ismcast)
1223bdcd8170SKalle Valo {
1224bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1225bdcd8170SKalle Valo 		   "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast);
1226bdcd8170SKalle Valo 
1227240d2799SVasanthakumar Thiagarajan 	cfg80211_michael_mic_failure(vif->ndev, vif->bssid,
1228bdcd8170SKalle Valo 				     (ismcast ? NL80211_KEYTYPE_GROUP :
1229bdcd8170SKalle Valo 				      NL80211_KEYTYPE_PAIRWISE), keyid, NULL,
1230bdcd8170SKalle Valo 				     GFP_KERNEL);
1231bdcd8170SKalle Valo }
1232bdcd8170SKalle Valo 
1233bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
1234bdcd8170SKalle Valo {
1235bdcd8170SKalle Valo 	struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1236990bd915SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif;
1237bdcd8170SKalle Valo 	int ret;
1238bdcd8170SKalle Valo 
1239bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__,
1240bdcd8170SKalle Valo 		   changed);
1241bdcd8170SKalle Valo 
1242990bd915SVasanthakumar Thiagarajan 	vif = ath6kl_vif_first(ar);
1243990bd915SVasanthakumar Thiagarajan 	if (!vif)
1244990bd915SVasanthakumar Thiagarajan 		return -EIO;
1245990bd915SVasanthakumar Thiagarajan 
1246990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1247bdcd8170SKalle Valo 		return -EIO;
1248bdcd8170SKalle Valo 
1249bdcd8170SKalle Valo 	if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
1250bdcd8170SKalle Valo 		ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold);
1251bdcd8170SKalle Valo 		if (ret != 0) {
1252bdcd8170SKalle Valo 			ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n");
1253bdcd8170SKalle Valo 			return -EIO;
1254bdcd8170SKalle Valo 		}
1255bdcd8170SKalle Valo 	}
1256bdcd8170SKalle Valo 
1257bdcd8170SKalle Valo 	return 0;
1258bdcd8170SKalle Valo }
1259bdcd8170SKalle Valo 
1260bdcd8170SKalle Valo /*
1261bdcd8170SKalle Valo  * The type nl80211_tx_power_setting replaces the following
1262bdcd8170SKalle Valo  * data type from 2.6.36 onwards
1263bdcd8170SKalle Valo */
1264bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy,
1265bdcd8170SKalle Valo 				       enum nl80211_tx_power_setting type,
1266b992a285SLuis R. Rodriguez 				       int mbm)
1267bdcd8170SKalle Valo {
1268bdcd8170SKalle Valo 	struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1269990bd915SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif;
1270bdcd8170SKalle Valo 	u8 ath6kl_dbm;
1271b992a285SLuis R. Rodriguez 	int dbm = MBM_TO_DBM(mbm);
1272bdcd8170SKalle Valo 
1273bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__,
1274bdcd8170SKalle Valo 		   type, dbm);
1275bdcd8170SKalle Valo 
1276990bd915SVasanthakumar Thiagarajan 	vif = ath6kl_vif_first(ar);
1277990bd915SVasanthakumar Thiagarajan 	if (!vif)
1278990bd915SVasanthakumar Thiagarajan 		return -EIO;
1279990bd915SVasanthakumar Thiagarajan 
1280990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1281bdcd8170SKalle Valo 		return -EIO;
1282bdcd8170SKalle Valo 
1283bdcd8170SKalle Valo 	switch (type) {
1284bdcd8170SKalle Valo 	case NL80211_TX_POWER_AUTOMATIC:
1285bdcd8170SKalle Valo 		return 0;
1286bdcd8170SKalle Valo 	case NL80211_TX_POWER_LIMITED:
1287bdcd8170SKalle Valo 		ar->tx_pwr = ath6kl_dbm = dbm;
1288bdcd8170SKalle Valo 		break;
1289bdcd8170SKalle Valo 	default:
1290bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n",
1291bdcd8170SKalle Valo 			   __func__, type);
1292bdcd8170SKalle Valo 		return -EOPNOTSUPP;
1293bdcd8170SKalle Valo 	}
1294bdcd8170SKalle Valo 
1295990bd915SVasanthakumar Thiagarajan 	ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, ath6kl_dbm);
1296bdcd8170SKalle Valo 
1297bdcd8170SKalle Valo 	return 0;
1298bdcd8170SKalle Valo }
1299bdcd8170SKalle Valo 
1300bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm)
1301bdcd8170SKalle Valo {
1302bdcd8170SKalle Valo 	struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1303990bd915SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif;
1304bdcd8170SKalle Valo 
1305990bd915SVasanthakumar Thiagarajan 	vif = ath6kl_vif_first(ar);
1306990bd915SVasanthakumar Thiagarajan 	if (!vif)
1307990bd915SVasanthakumar Thiagarajan 		return -EIO;
1308990bd915SVasanthakumar Thiagarajan 
1309990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1310bdcd8170SKalle Valo 		return -EIO;
1311bdcd8170SKalle Valo 
131259c98449SVasanthakumar Thiagarajan 	if (test_bit(CONNECTED, &vif->flags)) {
1313bdcd8170SKalle Valo 		ar->tx_pwr = 0;
1314bdcd8170SKalle Valo 
1315990bd915SVasanthakumar Thiagarajan 		if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) {
1316bdcd8170SKalle Valo 			ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n");
1317bdcd8170SKalle Valo 			return -EIO;
1318bdcd8170SKalle Valo 		}
1319bdcd8170SKalle Valo 
1320bdcd8170SKalle Valo 		wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0,
1321bdcd8170SKalle Valo 						 5 * HZ);
1322bdcd8170SKalle Valo 
1323bdcd8170SKalle Valo 		if (signal_pending(current)) {
1324bdcd8170SKalle Valo 			ath6kl_err("target did not respond\n");
1325bdcd8170SKalle Valo 			return -EINTR;
1326bdcd8170SKalle Valo 		}
1327bdcd8170SKalle Valo 	}
1328bdcd8170SKalle Valo 
1329bdcd8170SKalle Valo 	*dbm = ar->tx_pwr;
1330bdcd8170SKalle Valo 	return 0;
1331bdcd8170SKalle Valo }
1332bdcd8170SKalle Valo 
1333bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy,
1334bdcd8170SKalle Valo 					  struct net_device *dev,
1335bdcd8170SKalle Valo 					  bool pmgmt, int timeout)
1336bdcd8170SKalle Valo {
1337bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
1338bdcd8170SKalle Valo 	struct wmi_power_mode_cmd mode;
1339334234b5SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
1340bdcd8170SKalle Valo 
1341bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n",
1342bdcd8170SKalle Valo 		   __func__, pmgmt, timeout);
1343bdcd8170SKalle Valo 
1344990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1345bdcd8170SKalle Valo 		return -EIO;
1346bdcd8170SKalle Valo 
1347bdcd8170SKalle Valo 	if (pmgmt) {
1348bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__);
1349bdcd8170SKalle Valo 		mode.pwr_mode = REC_POWER;
1350bdcd8170SKalle Valo 	} else {
1351bdcd8170SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__);
1352bdcd8170SKalle Valo 		mode.pwr_mode = MAX_PERF_POWER;
1353bdcd8170SKalle Valo 	}
1354bdcd8170SKalle Valo 
1355334234b5SVasanthakumar Thiagarajan 	if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx,
1356334234b5SVasanthakumar Thiagarajan 	     mode.pwr_mode) != 0) {
1357bdcd8170SKalle Valo 		ath6kl_err("wmi_powermode_cmd failed\n");
1358bdcd8170SKalle Valo 		return -EIO;
1359bdcd8170SKalle Valo 	}
1360bdcd8170SKalle Valo 
1361bdcd8170SKalle Valo 	return 0;
1362bdcd8170SKalle Valo }
1363bdcd8170SKalle Valo 
136455055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy,
136555055976SVasanthakumar Thiagarajan 						    char *name,
136655055976SVasanthakumar Thiagarajan 						    enum nl80211_iftype type,
136755055976SVasanthakumar Thiagarajan 						    u32 *flags,
136855055976SVasanthakumar Thiagarajan 						    struct vif_params *params)
136955055976SVasanthakumar Thiagarajan {
137055055976SVasanthakumar Thiagarajan 	struct ath6kl *ar = wiphy_priv(wiphy);
137155055976SVasanthakumar Thiagarajan 	struct net_device *ndev;
137255055976SVasanthakumar Thiagarajan 	u8 if_idx, nw_type;
137355055976SVasanthakumar Thiagarajan 
137471f96ee6SKalle Valo 	if (ar->num_vif == ar->vif_max) {
137555055976SVasanthakumar Thiagarajan 		ath6kl_err("Reached maximum number of supported vif\n");
137655055976SVasanthakumar Thiagarajan 		return ERR_PTR(-EINVAL);
137755055976SVasanthakumar Thiagarajan 	}
137855055976SVasanthakumar Thiagarajan 
137955055976SVasanthakumar Thiagarajan 	if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) {
138055055976SVasanthakumar Thiagarajan 		ath6kl_err("Not a supported interface type\n");
138155055976SVasanthakumar Thiagarajan 		return ERR_PTR(-EINVAL);
138255055976SVasanthakumar Thiagarajan 	}
138355055976SVasanthakumar Thiagarajan 
138455055976SVasanthakumar Thiagarajan 	ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type);
138555055976SVasanthakumar Thiagarajan 	if (!ndev)
138655055976SVasanthakumar Thiagarajan 		return ERR_PTR(-ENOMEM);
138755055976SVasanthakumar Thiagarajan 
138855055976SVasanthakumar Thiagarajan 	ar->num_vif++;
138955055976SVasanthakumar Thiagarajan 
139055055976SVasanthakumar Thiagarajan 	return ndev;
139155055976SVasanthakumar Thiagarajan }
139255055976SVasanthakumar Thiagarajan 
139355055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy,
139455055976SVasanthakumar Thiagarajan 				     struct net_device *ndev)
139555055976SVasanthakumar Thiagarajan {
139655055976SVasanthakumar Thiagarajan 	struct ath6kl *ar = wiphy_priv(wiphy);
139755055976SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
139855055976SVasanthakumar Thiagarajan 
139911f6e40dSVasanthakumar Thiagarajan 	spin_lock_bh(&ar->list_lock);
140055055976SVasanthakumar Thiagarajan 	list_del(&vif->list);
140111f6e40dSVasanthakumar Thiagarajan 	spin_unlock_bh(&ar->list_lock);
140255055976SVasanthakumar Thiagarajan 
140355055976SVasanthakumar Thiagarajan 	ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag));
140455055976SVasanthakumar Thiagarajan 
140555055976SVasanthakumar Thiagarajan 	ath6kl_deinit_if_data(vif);
140655055976SVasanthakumar Thiagarajan 
140755055976SVasanthakumar Thiagarajan 	return 0;
140855055976SVasanthakumar Thiagarajan }
140955055976SVasanthakumar Thiagarajan 
1410bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy,
1411bdcd8170SKalle Valo 					struct net_device *ndev,
1412bdcd8170SKalle Valo 					enum nl80211_iftype type, u32 *flags,
1413bdcd8170SKalle Valo 					struct vif_params *params)
1414bdcd8170SKalle Valo {
1415f5938f24SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(ndev);
1416bdcd8170SKalle Valo 
1417bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type);
1418bdcd8170SKalle Valo 
1419bdcd8170SKalle Valo 	switch (type) {
1420bdcd8170SKalle Valo 	case NL80211_IFTYPE_STATION:
1421f5938f24SVasanthakumar Thiagarajan 		vif->next_mode = INFRA_NETWORK;
1422bdcd8170SKalle Valo 		break;
1423bdcd8170SKalle Valo 	case NL80211_IFTYPE_ADHOC:
1424f5938f24SVasanthakumar Thiagarajan 		vif->next_mode = ADHOC_NETWORK;
1425bdcd8170SKalle Valo 		break;
14266e4604c8SJouni Malinen 	case NL80211_IFTYPE_AP:
1427f5938f24SVasanthakumar Thiagarajan 		vif->next_mode = AP_NETWORK;
14286e4604c8SJouni Malinen 		break;
14296b5e5d25SJouni Malinen 	case NL80211_IFTYPE_P2P_CLIENT:
1430f5938f24SVasanthakumar Thiagarajan 		vif->next_mode = INFRA_NETWORK;
14316b5e5d25SJouni Malinen 		break;
14326b5e5d25SJouni Malinen 	case NL80211_IFTYPE_P2P_GO:
1433f5938f24SVasanthakumar Thiagarajan 		vif->next_mode = AP_NETWORK;
14346b5e5d25SJouni Malinen 		break;
1435bdcd8170SKalle Valo 	default:
1436bdcd8170SKalle Valo 		ath6kl_err("invalid interface type %u\n", type);
1437bdcd8170SKalle Valo 		return -EOPNOTSUPP;
1438bdcd8170SKalle Valo 	}
1439bdcd8170SKalle Valo 
1440551959d8SVasanthakumar Thiagarajan 	vif->wdev.iftype = type;
1441bdcd8170SKalle Valo 
1442bdcd8170SKalle Valo 	return 0;
1443bdcd8170SKalle Valo }
1444bdcd8170SKalle Valo 
1445bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy,
1446bdcd8170SKalle Valo 				     struct net_device *dev,
1447bdcd8170SKalle Valo 				     struct cfg80211_ibss_params *ibss_param)
1448bdcd8170SKalle Valo {
1449bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
145059c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
1451bdcd8170SKalle Valo 	int status;
1452bdcd8170SKalle Valo 
1453990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1454bdcd8170SKalle Valo 		return -EIO;
1455bdcd8170SKalle Valo 
14563450334fSVasanthakumar Thiagarajan 	vif->ssid_len = ibss_param->ssid_len;
14573450334fSVasanthakumar Thiagarajan 	memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len);
1458bdcd8170SKalle Valo 
1459bdcd8170SKalle Valo 	if (ibss_param->channel)
1460f74bac54SVasanthakumar Thiagarajan 		vif->ch_hint = ibss_param->channel->center_freq;
1461bdcd8170SKalle Valo 
1462bdcd8170SKalle Valo 	if (ibss_param->channel_fixed) {
1463bdcd8170SKalle Valo 		/*
1464bdcd8170SKalle Valo 		 * TODO: channel_fixed: The channel should be fixed, do not
1465bdcd8170SKalle Valo 		 * search for IBSSs to join on other channels. Target
1466bdcd8170SKalle Valo 		 * firmware does not support this feature, needs to be
1467bdcd8170SKalle Valo 		 * updated.
1468bdcd8170SKalle Valo 		 */
1469bdcd8170SKalle Valo 		return -EOPNOTSUPP;
1470bdcd8170SKalle Valo 	}
1471bdcd8170SKalle Valo 
14728c8b65e3SVasanthakumar Thiagarajan 	memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
1473bdcd8170SKalle Valo 	if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid))
14748c8b65e3SVasanthakumar Thiagarajan 		memcpy(vif->req_bssid, ibss_param->bssid,
14758c8b65e3SVasanthakumar Thiagarajan 		       sizeof(vif->req_bssid));
1476bdcd8170SKalle Valo 
1477240d2799SVasanthakumar Thiagarajan 	ath6kl_set_wpa_version(vif, 0);
1478bdcd8170SKalle Valo 
1479240d2799SVasanthakumar Thiagarajan 	status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM);
1480bdcd8170SKalle Valo 	if (status)
1481bdcd8170SKalle Valo 		return status;
1482bdcd8170SKalle Valo 
1483bdcd8170SKalle Valo 	if (ibss_param->privacy) {
1484240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true);
1485240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false);
1486bdcd8170SKalle Valo 	} else {
1487240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, 0, true);
1488240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, 0, false);
1489bdcd8170SKalle Valo 	}
1490bdcd8170SKalle Valo 
1491f5938f24SVasanthakumar Thiagarajan 	vif->nw_type = vif->next_mode;
1492bdcd8170SKalle Valo 
1493bdcd8170SKalle Valo 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
1494bdcd8170SKalle Valo 		   "%s: connect called with authmode %d dot11 auth %d"
1495bdcd8170SKalle Valo 		   " PW crypto %d PW crypto len %d GRP crypto %d"
1496bdcd8170SKalle Valo 		   " GRP crypto len %d channel hint %u\n",
1497bdcd8170SKalle Valo 		   __func__,
14983450334fSVasanthakumar Thiagarajan 		   vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto,
14993450334fSVasanthakumar Thiagarajan 		   vif->prwise_crypto_len, vif->grp_crypto,
1500f74bac54SVasanthakumar Thiagarajan 		   vif->grp_crypto_len, vif->ch_hint);
1501bdcd8170SKalle Valo 
1502334234b5SVasanthakumar Thiagarajan 	status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type,
15033450334fSVasanthakumar Thiagarajan 					vif->dot11_auth_mode, vif->auth_mode,
15043450334fSVasanthakumar Thiagarajan 					vif->prwise_crypto,
15053450334fSVasanthakumar Thiagarajan 					vif->prwise_crypto_len,
15063450334fSVasanthakumar Thiagarajan 					vif->grp_crypto, vif->grp_crypto_len,
15073450334fSVasanthakumar Thiagarajan 					vif->ssid_len, vif->ssid,
1508f74bac54SVasanthakumar Thiagarajan 					vif->req_bssid, vif->ch_hint,
15093ca9d1fcSAarthi Thiruvengadam 					ar->connect_ctrl_flags, SUBTYPE_NONE);
151059c98449SVasanthakumar Thiagarajan 	set_bit(CONNECT_PEND, &vif->flags);
1511bdcd8170SKalle Valo 
1512bdcd8170SKalle Valo 	return 0;
1513bdcd8170SKalle Valo }
1514bdcd8170SKalle Valo 
1515bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy,
1516bdcd8170SKalle Valo 				      struct net_device *dev)
1517bdcd8170SKalle Valo {
15183450334fSVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
1519bdcd8170SKalle Valo 
1520990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
1521bdcd8170SKalle Valo 		return -EIO;
1522bdcd8170SKalle Valo 
1523240d2799SVasanthakumar Thiagarajan 	ath6kl_disconnect(vif);
15243450334fSVasanthakumar Thiagarajan 	memset(vif->ssid, 0, sizeof(vif->ssid));
15253450334fSVasanthakumar Thiagarajan 	vif->ssid_len = 0;
1526bdcd8170SKalle Valo 
1527bdcd8170SKalle Valo 	return 0;
1528bdcd8170SKalle Valo }
1529bdcd8170SKalle Valo 
1530bdcd8170SKalle Valo static const u32 cipher_suites[] = {
1531bdcd8170SKalle Valo 	WLAN_CIPHER_SUITE_WEP40,
1532bdcd8170SKalle Valo 	WLAN_CIPHER_SUITE_WEP104,
1533bdcd8170SKalle Valo 	WLAN_CIPHER_SUITE_TKIP,
1534bdcd8170SKalle Valo 	WLAN_CIPHER_SUITE_CCMP,
1535837cb97eSJouni Malinen 	CCKM_KRK_CIPHER_SUITE,
15365e07021eSDai Shuibing 	WLAN_CIPHER_SUITE_SMS4,
1537bdcd8170SKalle Valo };
1538bdcd8170SKalle Valo 
1539bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate)
1540bdcd8170SKalle Valo {
1541bdcd8170SKalle Valo 	static const s32 legacy[] = { 1000, 2000, 5500, 11000,
1542bdcd8170SKalle Valo 		6000, 9000, 12000, 18000, 24000,
1543bdcd8170SKalle Valo 		36000, 48000, 54000
1544bdcd8170SKalle Valo 	};
1545bdcd8170SKalle Valo 	u8 i;
1546bdcd8170SKalle Valo 
1547bdcd8170SKalle Valo 	for (i = 0; i < ARRAY_SIZE(legacy); i++)
1548bdcd8170SKalle Valo 		if (rate == legacy[i])
1549bdcd8170SKalle Valo 			return true;
1550bdcd8170SKalle Valo 
1551bdcd8170SKalle Valo 	return false;
1552bdcd8170SKalle Valo }
1553bdcd8170SKalle Valo 
1554bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi)
1555bdcd8170SKalle Valo {
1556bdcd8170SKalle Valo 	static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000,
1557bdcd8170SKalle Valo 		52000, 58500, 65000, 72200
1558bdcd8170SKalle Valo 	};
1559bdcd8170SKalle Valo 	u8 i;
1560bdcd8170SKalle Valo 
1561bdcd8170SKalle Valo 	for (i = 0; i < ARRAY_SIZE(ht20); i++) {
1562bdcd8170SKalle Valo 		if (rate == ht20[i]) {
1563bdcd8170SKalle Valo 			if (i == ARRAY_SIZE(ht20) - 1)
1564bdcd8170SKalle Valo 				/* last rate uses sgi */
1565bdcd8170SKalle Valo 				*sgi = true;
1566bdcd8170SKalle Valo 			else
1567bdcd8170SKalle Valo 				*sgi = false;
1568bdcd8170SKalle Valo 
1569bdcd8170SKalle Valo 			*mcs = i;
1570bdcd8170SKalle Valo 			return true;
1571bdcd8170SKalle Valo 		}
1572bdcd8170SKalle Valo 	}
1573bdcd8170SKalle Valo 	return false;
1574bdcd8170SKalle Valo }
1575bdcd8170SKalle Valo 
1576bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi)
1577bdcd8170SKalle Valo {
1578bdcd8170SKalle Valo 	static const s32 ht40[] = { 13500, 27000, 40500, 54000,
1579bdcd8170SKalle Valo 		81000, 108000, 121500, 135000,
1580bdcd8170SKalle Valo 		150000
1581bdcd8170SKalle Valo 	};
1582bdcd8170SKalle Valo 	u8 i;
1583bdcd8170SKalle Valo 
1584bdcd8170SKalle Valo 	for (i = 0; i < ARRAY_SIZE(ht40); i++) {
1585bdcd8170SKalle Valo 		if (rate == ht40[i]) {
1586bdcd8170SKalle Valo 			if (i == ARRAY_SIZE(ht40) - 1)
1587bdcd8170SKalle Valo 				/* last rate uses sgi */
1588bdcd8170SKalle Valo 				*sgi = true;
1589bdcd8170SKalle Valo 			else
1590bdcd8170SKalle Valo 				*sgi = false;
1591bdcd8170SKalle Valo 
1592bdcd8170SKalle Valo 			*mcs = i;
1593bdcd8170SKalle Valo 			return true;
1594bdcd8170SKalle Valo 		}
1595bdcd8170SKalle Valo 	}
1596bdcd8170SKalle Valo 
1597bdcd8170SKalle Valo 	return false;
1598bdcd8170SKalle Valo }
1599bdcd8170SKalle Valo 
1600bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev,
1601bdcd8170SKalle Valo 			      u8 *mac, struct station_info *sinfo)
1602bdcd8170SKalle Valo {
1603bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
160459c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
1605bdcd8170SKalle Valo 	long left;
1606bdcd8170SKalle Valo 	bool sgi;
1607bdcd8170SKalle Valo 	s32 rate;
1608bdcd8170SKalle Valo 	int ret;
1609bdcd8170SKalle Valo 	u8 mcs;
1610bdcd8170SKalle Valo 
16118c8b65e3SVasanthakumar Thiagarajan 	if (memcmp(mac, vif->bssid, ETH_ALEN) != 0)
1612bdcd8170SKalle Valo 		return -ENOENT;
1613bdcd8170SKalle Valo 
1614bdcd8170SKalle Valo 	if (down_interruptible(&ar->sem))
1615bdcd8170SKalle Valo 		return -EBUSY;
1616bdcd8170SKalle Valo 
1617b95907a7SVasanthakumar Thiagarajan 	set_bit(STATS_UPDATE_PEND, &vif->flags);
1618bdcd8170SKalle Valo 
1619334234b5SVasanthakumar Thiagarajan 	ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx);
1620bdcd8170SKalle Valo 
1621bdcd8170SKalle Valo 	if (ret != 0) {
1622bdcd8170SKalle Valo 		up(&ar->sem);
1623bdcd8170SKalle Valo 		return -EIO;
1624bdcd8170SKalle Valo 	}
1625bdcd8170SKalle Valo 
1626bdcd8170SKalle Valo 	left = wait_event_interruptible_timeout(ar->event_wq,
1627bdcd8170SKalle Valo 						!test_bit(STATS_UPDATE_PEND,
1628b95907a7SVasanthakumar Thiagarajan 							  &vif->flags),
1629bdcd8170SKalle Valo 						WMI_TIMEOUT);
1630bdcd8170SKalle Valo 
1631bdcd8170SKalle Valo 	up(&ar->sem);
1632bdcd8170SKalle Valo 
1633bdcd8170SKalle Valo 	if (left == 0)
1634bdcd8170SKalle Valo 		return -ETIMEDOUT;
1635bdcd8170SKalle Valo 	else if (left < 0)
1636bdcd8170SKalle Valo 		return left;
1637bdcd8170SKalle Valo 
1638b95907a7SVasanthakumar Thiagarajan 	if (vif->target_stats.rx_byte) {
1639b95907a7SVasanthakumar Thiagarajan 		sinfo->rx_bytes = vif->target_stats.rx_byte;
1640bdcd8170SKalle Valo 		sinfo->filled |= STATION_INFO_RX_BYTES;
1641b95907a7SVasanthakumar Thiagarajan 		sinfo->rx_packets = vif->target_stats.rx_pkt;
1642bdcd8170SKalle Valo 		sinfo->filled |= STATION_INFO_RX_PACKETS;
1643bdcd8170SKalle Valo 	}
1644bdcd8170SKalle Valo 
1645b95907a7SVasanthakumar Thiagarajan 	if (vif->target_stats.tx_byte) {
1646b95907a7SVasanthakumar Thiagarajan 		sinfo->tx_bytes = vif->target_stats.tx_byte;
1647bdcd8170SKalle Valo 		sinfo->filled |= STATION_INFO_TX_BYTES;
1648b95907a7SVasanthakumar Thiagarajan 		sinfo->tx_packets = vif->target_stats.tx_pkt;
1649bdcd8170SKalle Valo 		sinfo->filled |= STATION_INFO_TX_PACKETS;
1650bdcd8170SKalle Valo 	}
1651bdcd8170SKalle Valo 
1652b95907a7SVasanthakumar Thiagarajan 	sinfo->signal = vif->target_stats.cs_rssi;
1653bdcd8170SKalle Valo 	sinfo->filled |= STATION_INFO_SIGNAL;
1654bdcd8170SKalle Valo 
1655b95907a7SVasanthakumar Thiagarajan 	rate = vif->target_stats.tx_ucast_rate;
1656bdcd8170SKalle Valo 
1657bdcd8170SKalle Valo 	if (is_rate_legacy(rate)) {
1658bdcd8170SKalle Valo 		sinfo->txrate.legacy = rate / 100;
1659bdcd8170SKalle Valo 	} else if (is_rate_ht20(rate, &mcs, &sgi)) {
1660bdcd8170SKalle Valo 		if (sgi) {
1661bdcd8170SKalle Valo 			sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
1662bdcd8170SKalle Valo 			sinfo->txrate.mcs = mcs - 1;
1663bdcd8170SKalle Valo 		} else {
1664bdcd8170SKalle Valo 			sinfo->txrate.mcs = mcs;
1665bdcd8170SKalle Valo 		}
1666bdcd8170SKalle Valo 
1667bdcd8170SKalle Valo 		sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
1668bdcd8170SKalle Valo 	} else if (is_rate_ht40(rate, &mcs, &sgi)) {
1669bdcd8170SKalle Valo 		if (sgi) {
1670bdcd8170SKalle Valo 			sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
1671bdcd8170SKalle Valo 			sinfo->txrate.mcs = mcs - 1;
1672bdcd8170SKalle Valo 		} else {
1673bdcd8170SKalle Valo 			sinfo->txrate.mcs = mcs;
1674bdcd8170SKalle Valo 		}
1675bdcd8170SKalle Valo 
1676bdcd8170SKalle Valo 		sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH;
1677bdcd8170SKalle Valo 		sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
1678bdcd8170SKalle Valo 	} else {
16799a730834SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
16809a730834SKalle Valo 			   "invalid rate from stats: %d\n", rate);
16819a730834SKalle Valo 		ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE);
1682bdcd8170SKalle Valo 		return 0;
1683bdcd8170SKalle Valo 	}
1684bdcd8170SKalle Valo 
1685bdcd8170SKalle Valo 	sinfo->filled |= STATION_INFO_TX_BITRATE;
1686bdcd8170SKalle Valo 
168759c98449SVasanthakumar Thiagarajan 	if (test_bit(CONNECTED, &vif->flags) &&
168859c98449SVasanthakumar Thiagarajan 	    test_bit(DTIM_PERIOD_AVAIL, &vif->flags) &&
1689f5938f24SVasanthakumar Thiagarajan 	    vif->nw_type == INFRA_NETWORK) {
169032c10874SJouni Malinen 		sinfo->filled |= STATION_INFO_BSS_PARAM;
169132c10874SJouni Malinen 		sinfo->bss_param.flags = 0;
1692cf5333d7SVasanthakumar Thiagarajan 		sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period;
1693cf5333d7SVasanthakumar Thiagarajan 		sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int;
169432c10874SJouni Malinen 	}
169532c10874SJouni Malinen 
1696bdcd8170SKalle Valo 	return 0;
1697bdcd8170SKalle Valo }
1698bdcd8170SKalle Valo 
1699bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev,
1700bdcd8170SKalle Valo 			    struct cfg80211_pmksa *pmksa)
1701bdcd8170SKalle Valo {
1702bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(netdev);
1703334234b5SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(netdev);
1704334234b5SVasanthakumar Thiagarajan 
1705334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid,
1706bdcd8170SKalle Valo 				       pmksa->pmkid, true);
1707bdcd8170SKalle Valo }
1708bdcd8170SKalle Valo 
1709bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev,
1710bdcd8170SKalle Valo 			    struct cfg80211_pmksa *pmksa)
1711bdcd8170SKalle Valo {
1712bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(netdev);
1713334234b5SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(netdev);
1714334234b5SVasanthakumar Thiagarajan 
1715334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid,
1716bdcd8170SKalle Valo 				       pmksa->pmkid, false);
1717bdcd8170SKalle Valo }
1718bdcd8170SKalle Valo 
1719bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev)
1720bdcd8170SKalle Valo {
1721bdcd8170SKalle Valo 	struct ath6kl *ar = ath6kl_priv(netdev);
172259c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(netdev);
172359c98449SVasanthakumar Thiagarajan 
172459c98449SVasanthakumar Thiagarajan 	if (test_bit(CONNECTED, &vif->flags))
1725334234b5SVasanthakumar Thiagarajan 		return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx,
1726334234b5SVasanthakumar Thiagarajan 					       vif->bssid, NULL, false);
1727bdcd8170SKalle Valo 	return 0;
1728bdcd8170SKalle Valo }
1729bdcd8170SKalle Valo 
17306cb3c714SRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow)
17316cb3c714SRaja Mani {
17326cb3c714SRaja Mani 	struct ath6kl_vif *vif;
17336cb3c714SRaja Mani 	int ret, pos, left;
17346cb3c714SRaja Mani 	u32 filter = 0;
17356cb3c714SRaja Mani 	u16 i;
17366cb3c714SRaja Mani 	u8 mask[WOW_MASK_SIZE];
17376cb3c714SRaja Mani 
17386cb3c714SRaja Mani 	vif = ath6kl_vif_first(ar);
17396cb3c714SRaja Mani 	if (!vif)
17406cb3c714SRaja Mani 		return -EIO;
17416cb3c714SRaja Mani 
17426cb3c714SRaja Mani 	if (!ath6kl_cfg80211_ready(vif))
17436cb3c714SRaja Mani 		return -EIO;
17446cb3c714SRaja Mani 
17456cb3c714SRaja Mani 	if (!test_bit(CONNECTED, &vif->flags))
17466cb3c714SRaja Mani 		return -EINVAL;
17476cb3c714SRaja Mani 
17486cb3c714SRaja Mani 	/* Clear existing WOW patterns */
17496cb3c714SRaja Mani 	for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++)
17506cb3c714SRaja Mani 		ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx,
17516cb3c714SRaja Mani 					       WOW_LIST_ID, i);
17526cb3c714SRaja Mani 	/* Configure new WOW patterns */
17536cb3c714SRaja Mani 	for (i = 0; i < wow->n_patterns; i++) {
17546cb3c714SRaja Mani 
17556cb3c714SRaja Mani 		/*
17566cb3c714SRaja Mani 		 * Convert given nl80211 specific mask value to equivalent
17576cb3c714SRaja Mani 		 * driver specific mask value and send it to the chip along
17586cb3c714SRaja Mani 		 * with patterns. For example, If the mask value defined in
17596cb3c714SRaja Mani 		 * struct cfg80211_wowlan is 0xA (equivalent binary is 1010),
17606cb3c714SRaja Mani 		 * then equivalent driver specific mask value is
17616cb3c714SRaja Mani 		 * "0xFF 0x00 0xFF 0x00".
17626cb3c714SRaja Mani 		 */
17636cb3c714SRaja Mani 		memset(&mask, 0, sizeof(mask));
17646cb3c714SRaja Mani 		for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) {
17656cb3c714SRaja Mani 			if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8)))
17666cb3c714SRaja Mani 				mask[pos] = 0xFF;
17676cb3c714SRaja Mani 		}
17686cb3c714SRaja Mani 		/*
17696cb3c714SRaja Mani 		 * Note: Pattern's offset is not passed as part of wowlan
17706cb3c714SRaja Mani 		 * parameter from CFG layer. So it's always passed as ZERO
17716cb3c714SRaja Mani 		 * to the firmware. It means, given WOW patterns are always
17726cb3c714SRaja Mani 		 * matched from the first byte of received pkt in the firmware.
17736cb3c714SRaja Mani 		 */
17746cb3c714SRaja Mani 		ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi,
17756cb3c714SRaja Mani 					vif->fw_vif_idx, WOW_LIST_ID,
17766cb3c714SRaja Mani 					wow->patterns[i].pattern_len,
17776cb3c714SRaja Mani 					0 /* pattern offset */,
17786cb3c714SRaja Mani 					wow->patterns[i].pattern, mask);
17796cb3c714SRaja Mani 		if (ret)
17806cb3c714SRaja Mani 			return ret;
17816cb3c714SRaja Mani 	}
17826cb3c714SRaja Mani 
17836cb3c714SRaja Mani 	if (wow->disconnect)
17846cb3c714SRaja Mani 		filter |= WOW_FILTER_OPTION_NWK_DISASSOC;
17856cb3c714SRaja Mani 
17866cb3c714SRaja Mani 	if (wow->magic_pkt)
17876cb3c714SRaja Mani 		filter |= WOW_FILTER_OPTION_MAGIC_PACKET;
17886cb3c714SRaja Mani 
17896cb3c714SRaja Mani 	if (wow->gtk_rekey_failure)
17906cb3c714SRaja Mani 		filter |= WOW_FILTER_OPTION_GTK_ERROR;
17916cb3c714SRaja Mani 
17926cb3c714SRaja Mani 	if (wow->eap_identity_req)
17936cb3c714SRaja Mani 		filter |= WOW_FILTER_OPTION_EAP_REQ;
17946cb3c714SRaja Mani 
17956cb3c714SRaja Mani 	if (wow->four_way_handshake)
17966cb3c714SRaja Mani 		filter |= WOW_FILTER_OPTION_8021X_4WAYHS;
17976cb3c714SRaja Mani 
17986cb3c714SRaja Mani 	ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx,
17996cb3c714SRaja Mani 					  ATH6KL_WOW_MODE_ENABLE,
18006cb3c714SRaja Mani 					  filter,
18016cb3c714SRaja Mani 					  WOW_HOST_REQ_DELAY);
18026cb3c714SRaja Mani 	if (ret)
18036cb3c714SRaja Mani 		return ret;
18046cb3c714SRaja Mani 
18056cb3c714SRaja Mani 	ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
18066cb3c714SRaja Mani 						 ATH6KL_HOST_MODE_ASLEEP);
18076cb3c714SRaja Mani 	if (ret)
18086cb3c714SRaja Mani 		return ret;
18096cb3c714SRaja Mani 
18106cb3c714SRaja Mani 	if (ar->tx_pending[ar->ctrl_ep]) {
18116cb3c714SRaja Mani 		left = wait_event_interruptible_timeout(ar->event_wq,
18126cb3c714SRaja Mani 				ar->tx_pending[ar->ctrl_ep] == 0, WMI_TIMEOUT);
18136cb3c714SRaja Mani 		if (left == 0) {
18146cb3c714SRaja Mani 			ath6kl_warn("clear wmi ctrl data timeout\n");
18156cb3c714SRaja Mani 			ret = -ETIMEDOUT;
18166cb3c714SRaja Mani 		} else if (left < 0) {
18176cb3c714SRaja Mani 			ath6kl_warn("clear wmi ctrl data failed: %d\n", left);
18186cb3c714SRaja Mani 			ret = left;
18196cb3c714SRaja Mani 		}
18206cb3c714SRaja Mani 	}
18216cb3c714SRaja Mani 
18226cb3c714SRaja Mani 	return ret;
18236cb3c714SRaja Mani }
18246cb3c714SRaja Mani 
18256cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar)
18266cb3c714SRaja Mani {
18276cb3c714SRaja Mani 	struct ath6kl_vif *vif;
18286cb3c714SRaja Mani 	int ret;
18296cb3c714SRaja Mani 
18306cb3c714SRaja Mani 	vif = ath6kl_vif_first(ar);
18316cb3c714SRaja Mani 	if (!vif)
18326cb3c714SRaja Mani 		return -EIO;
18336cb3c714SRaja Mani 
18346cb3c714SRaja Mani 	ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
18356cb3c714SRaja Mani 						 ATH6KL_HOST_MODE_AWAKE);
18366cb3c714SRaja Mani 	return ret;
18376cb3c714SRaja Mani }
18386cb3c714SRaja Mani 
183952d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar,
18400f60e9f4SRaja Mani 			    enum ath6kl_cfg_suspend_mode mode,
18410f60e9f4SRaja Mani 			    struct cfg80211_wowlan *wow)
184252d81a68SKalle Valo {
184352d81a68SKalle Valo 	int ret;
184452d81a68SKalle Valo 
184552d81a68SKalle Valo 	switch (mode) {
1846d7c44e0bSRaja Mani 	case ATH6KL_CFG_SUSPEND_WOW:
1847d7c44e0bSRaja Mani 
1848d7c44e0bSRaja Mani 		ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n");
1849d7c44e0bSRaja Mani 
1850d7c44e0bSRaja Mani 		/* Flush all non control pkts in TX path */
1851d7c44e0bSRaja Mani 		ath6kl_tx_data_cleanup(ar);
1852d7c44e0bSRaja Mani 
1853d7c44e0bSRaja Mani 		ret = ath6kl_wow_suspend(ar, wow);
1854d7c44e0bSRaja Mani 		if (ret) {
1855d7c44e0bSRaja Mani 			ath6kl_err("wow suspend failed: %d\n", ret);
1856d7c44e0bSRaja Mani 			return ret;
1857d7c44e0bSRaja Mani 		}
1858d7c44e0bSRaja Mani 		ar->state = ATH6KL_STATE_WOW;
1859d7c44e0bSRaja Mani 		break;
1860d7c44e0bSRaja Mani 
186152d81a68SKalle Valo 	case ATH6KL_CFG_SUSPEND_DEEPSLEEP:
1862524441e3SRaja Mani 
18637125f01dSKalle Valo 		ath6kl_cfg80211_stop_all(ar);
1864524441e3SRaja Mani 
186552d81a68SKalle Valo 		/* save the current power mode before enabling power save */
186652d81a68SKalle Valo 		ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode;
186752d81a68SKalle Valo 
186852d81a68SKalle Valo 		ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER);
186952d81a68SKalle Valo 		if (ret) {
187052d81a68SKalle Valo 			ath6kl_warn("wmi powermode command failed during suspend: %d\n",
187152d81a68SKalle Valo 				    ret);
187252d81a68SKalle Valo 		}
187352d81a68SKalle Valo 
187476a9fbe2SKalle Valo 		ar->state = ATH6KL_STATE_DEEPSLEEP;
187576a9fbe2SKalle Valo 
187652d81a68SKalle Valo 		break;
1877b4b2a0b1SKalle Valo 
1878b4b2a0b1SKalle Valo 	case ATH6KL_CFG_SUSPEND_CUTPOWER:
1879524441e3SRaja Mani 
18807125f01dSKalle Valo 		ath6kl_cfg80211_stop_all(ar);
1881524441e3SRaja Mani 
1882b4b2a0b1SKalle Valo 		if (ar->state == ATH6KL_STATE_OFF) {
1883b4b2a0b1SKalle Valo 			ath6kl_dbg(ATH6KL_DBG_SUSPEND,
1884b4b2a0b1SKalle Valo 				   "suspend hw off, no action for cutpower\n");
1885b4b2a0b1SKalle Valo 			break;
1886b4b2a0b1SKalle Valo 		}
1887b4b2a0b1SKalle Valo 
1888b4b2a0b1SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n");
1889b4b2a0b1SKalle Valo 
1890b4b2a0b1SKalle Valo 		ret = ath6kl_init_hw_stop(ar);
1891b4b2a0b1SKalle Valo 		if (ret) {
1892b4b2a0b1SKalle Valo 			ath6kl_warn("failed to stop hw during suspend: %d\n",
1893b4b2a0b1SKalle Valo 				    ret);
1894b4b2a0b1SKalle Valo 		}
1895b4b2a0b1SKalle Valo 
1896b4b2a0b1SKalle Valo 		ar->state = ATH6KL_STATE_CUTPOWER;
1897b4b2a0b1SKalle Valo 
1898b4b2a0b1SKalle Valo 		break;
1899b4b2a0b1SKalle Valo 
190010509f90SKalle Valo 	case ATH6KL_CFG_SUSPEND_SCHED_SCAN:
190110509f90SKalle Valo 		/*
190210509f90SKalle Valo 		 * Nothing needed for schedule scan, firmware is already in
190310509f90SKalle Valo 		 * wow mode and sleeping most of the time.
190410509f90SKalle Valo 		 */
190510509f90SKalle Valo 		break;
190610509f90SKalle Valo 
1907b4b2a0b1SKalle Valo 	default:
1908b4b2a0b1SKalle Valo 		break;
190952d81a68SKalle Valo 	}
191052d81a68SKalle Valo 
191152d81a68SKalle Valo 	return 0;
191252d81a68SKalle Valo }
191352d81a68SKalle Valo 
191452d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar)
191552d81a68SKalle Valo {
191676a9fbe2SKalle Valo 	int ret;
191776a9fbe2SKalle Valo 
191876a9fbe2SKalle Valo 	switch (ar->state) {
1919d7c44e0bSRaja Mani 	case  ATH6KL_STATE_WOW:
1920d7c44e0bSRaja Mani 		ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n");
1921d7c44e0bSRaja Mani 
1922d7c44e0bSRaja Mani 		ret = ath6kl_wow_resume(ar);
1923d7c44e0bSRaja Mani 		if (ret) {
1924d7c44e0bSRaja Mani 			ath6kl_warn("wow mode resume failed: %d\n", ret);
1925d7c44e0bSRaja Mani 			return ret;
1926d7c44e0bSRaja Mani 		}
1927d7c44e0bSRaja Mani 
1928d7c44e0bSRaja Mani 		ar->state = ATH6KL_STATE_ON;
1929d7c44e0bSRaja Mani 		break;
1930d7c44e0bSRaja Mani 
193176a9fbe2SKalle Valo 	case ATH6KL_STATE_DEEPSLEEP:
193252d81a68SKalle Valo 		if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) {
193376a9fbe2SKalle Valo 			ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0,
193476a9fbe2SKalle Valo 						       ar->wmi->saved_pwr_mode);
193576a9fbe2SKalle Valo 			if (ret) {
193676a9fbe2SKalle Valo 				ath6kl_warn("wmi powermode command failed during resume: %d\n",
193776a9fbe2SKalle Valo 					    ret);
193876a9fbe2SKalle Valo 			}
193976a9fbe2SKalle Valo 		}
194076a9fbe2SKalle Valo 
194176a9fbe2SKalle Valo 		ar->state = ATH6KL_STATE_ON;
194276a9fbe2SKalle Valo 
194376a9fbe2SKalle Valo 		break;
194476a9fbe2SKalle Valo 
1945b4b2a0b1SKalle Valo 	case ATH6KL_STATE_CUTPOWER:
1946b4b2a0b1SKalle Valo 		ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n");
1947b4b2a0b1SKalle Valo 
1948b4b2a0b1SKalle Valo 		ret = ath6kl_init_hw_start(ar);
1949b4b2a0b1SKalle Valo 		if (ret) {
1950b4b2a0b1SKalle Valo 			ath6kl_warn("Failed to boot hw in resume: %d\n", ret);
1951b4b2a0b1SKalle Valo 			return ret;
1952b4b2a0b1SKalle Valo 		}
1953d7c44e0bSRaja Mani 		break;
1954b4b2a0b1SKalle Valo 
195510509f90SKalle Valo 	case ATH6KL_STATE_SCHED_SCAN:
195610509f90SKalle Valo 		break;
195710509f90SKalle Valo 
195876a9fbe2SKalle Valo 	default:
195976a9fbe2SKalle Valo 		break;
196052d81a68SKalle Valo 	}
196152d81a68SKalle Valo 
196252d81a68SKalle Valo 	return 0;
196352d81a68SKalle Valo }
196452d81a68SKalle Valo 
1965abcb344bSKalle Valo #ifdef CONFIG_PM
196652d81a68SKalle Valo 
196752d81a68SKalle Valo /* hif layer decides what suspend mode to use */
196852d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy,
1969abcb344bSKalle Valo 				 struct cfg80211_wowlan *wow)
1970abcb344bSKalle Valo {
1971abcb344bSKalle Valo 	struct ath6kl *ar = wiphy_priv(wiphy);
1972abcb344bSKalle Valo 
19730f60e9f4SRaja Mani 	return ath6kl_hif_suspend(ar, wow);
1974abcb344bSKalle Valo }
1975aa6cffc1SChilam Ng 
197652d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy)
1977aa6cffc1SChilam Ng {
1978aa6cffc1SChilam Ng 	struct ath6kl *ar = wiphy_priv(wiphy);
1979aa6cffc1SChilam Ng 
1980aa6cffc1SChilam Ng 	return ath6kl_hif_resume(ar);
1981aa6cffc1SChilam Ng }
1982a918fb3cSRaja Mani 
1983a918fb3cSRaja Mani /*
1984a918fb3cSRaja Mani  * FIXME: WOW suspend mode is selected if the host sdio controller supports
1985a918fb3cSRaja Mani  * both sdio irq wake up and keep power. The target pulls sdio data line to
1986a918fb3cSRaja Mani  * wake up the host when WOW pattern matches. This causes sdio irq handler
1987a918fb3cSRaja Mani  * is being called in the host side which internally hits ath6kl's RX path.
1988a918fb3cSRaja Mani  *
1989a918fb3cSRaja Mani  * Since sdio interrupt is not disabled, RX path executes even before
1990a918fb3cSRaja Mani  * the host executes the actual resume operation from PM module.
1991a918fb3cSRaja Mani  *
1992a918fb3cSRaja Mani  * In the current scenario, WOW resume should happen before start processing
1993a918fb3cSRaja Mani  * any data from the target. So It's required to perform WOW resume in RX path.
1994a918fb3cSRaja Mani  * Ideally we should perform WOW resume only in the actual platform
1995a918fb3cSRaja Mani  * resume path. This area needs bit rework to avoid WOW resume in RX path.
1996a918fb3cSRaja Mani  *
1997a918fb3cSRaja Mani  * ath6kl_check_wow_status() is called from ath6kl_rx().
1998a918fb3cSRaja Mani  */
1999a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar)
2000a918fb3cSRaja Mani {
2001a918fb3cSRaja Mani 	if (ar->state == ATH6KL_STATE_WOW)
2002a918fb3cSRaja Mani 		ath6kl_cfg80211_resume(ar);
2003a918fb3cSRaja Mani }
2004a918fb3cSRaja Mani 
2005a918fb3cSRaja Mani #else
2006a918fb3cSRaja Mani 
2007a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar)
2008a918fb3cSRaja Mani {
2009a918fb3cSRaja Mani }
2010abcb344bSKalle Valo #endif
2011abcb344bSKalle Valo 
20126a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev,
20136a7c9badSJouni Malinen 			      struct ieee80211_channel *chan,
20146a7c9badSJouni Malinen 			      enum nl80211_channel_type channel_type)
20156a7c9badSJouni Malinen {
2016cf5333d7SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
20176a7c9badSJouni Malinen 
2018990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
20196a7c9badSJouni Malinen 		return -EIO;
20206a7c9badSJouni Malinen 
20216a7c9badSJouni Malinen 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n",
20226a7c9badSJouni Malinen 		   __func__, chan->center_freq, chan->hw_value);
2023cf5333d7SVasanthakumar Thiagarajan 	vif->next_chan = chan->center_freq;
20246a7c9badSJouni Malinen 
20256a7c9badSJouni Malinen 	return 0;
20266a7c9badSJouni Malinen }
20276a7c9badSJouni Malinen 
20288bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos)
20298bdfbf40SJouni Malinen {
20308bdfbf40SJouni Malinen 	return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
20318bdfbf40SJouni Malinen 		pos[2] == 0x50 && pos[3] == 0x6f &&
20328bdfbf40SJouni Malinen 		pos[4] == 0x9a && pos[5] == 0x09;
20338bdfbf40SJouni Malinen }
20348bdfbf40SJouni Malinen 
2035334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif,
2036334234b5SVasanthakumar Thiagarajan 					const u8 *ies, size_t ies_len)
20378bdfbf40SJouni Malinen {
2038334234b5SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
20398bdfbf40SJouni Malinen 	const u8 *pos;
20408bdfbf40SJouni Malinen 	u8 *buf = NULL;
20418bdfbf40SJouni Malinen 	size_t len = 0;
20428bdfbf40SJouni Malinen 	int ret;
20438bdfbf40SJouni Malinen 
20448bdfbf40SJouni Malinen 	/*
20458bdfbf40SJouni Malinen 	 * Filter out P2P IE(s) since they will be included depending on
20468bdfbf40SJouni Malinen 	 * the Probe Request frame in ath6kl_send_go_probe_resp().
20478bdfbf40SJouni Malinen 	 */
20488bdfbf40SJouni Malinen 
20498bdfbf40SJouni Malinen 	if (ies && ies_len) {
20508bdfbf40SJouni Malinen 		buf = kmalloc(ies_len, GFP_KERNEL);
20518bdfbf40SJouni Malinen 		if (buf == NULL)
20528bdfbf40SJouni Malinen 			return -ENOMEM;
20538bdfbf40SJouni Malinen 		pos = ies;
20548bdfbf40SJouni Malinen 		while (pos + 1 < ies + ies_len) {
20558bdfbf40SJouni Malinen 			if (pos + 2 + pos[1] > ies + ies_len)
20568bdfbf40SJouni Malinen 				break;
20578bdfbf40SJouni Malinen 			if (!ath6kl_is_p2p_ie(pos)) {
20588bdfbf40SJouni Malinen 				memcpy(buf + len, pos, 2 + pos[1]);
20598bdfbf40SJouni Malinen 				len += 2 + pos[1];
20608bdfbf40SJouni Malinen 			}
20618bdfbf40SJouni Malinen 			pos += 2 + pos[1];
20628bdfbf40SJouni Malinen 		}
20638bdfbf40SJouni Malinen 	}
20648bdfbf40SJouni Malinen 
2065334234b5SVasanthakumar Thiagarajan 	ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
2066334234b5SVasanthakumar Thiagarajan 				       WMI_FRAME_PROBE_RESP, buf, len);
20678bdfbf40SJouni Malinen 	kfree(buf);
20688bdfbf40SJouni Malinen 	return ret;
20698bdfbf40SJouni Malinen }
20708bdfbf40SJouni Malinen 
20716a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev,
20726a7c9badSJouni Malinen 			    struct beacon_parameters *info, bool add)
20736a7c9badSJouni Malinen {
20746a7c9badSJouni Malinen 	struct ath6kl *ar = ath6kl_priv(dev);
20753450334fSVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
20766a7c9badSJouni Malinen 	struct ieee80211_mgmt *mgmt;
20776a7c9badSJouni Malinen 	u8 *ies;
20786a7c9badSJouni Malinen 	int ies_len;
20796a7c9badSJouni Malinen 	struct wmi_connect_cmd p;
20806a7c9badSJouni Malinen 	int res;
2081be5abaafSVasanthakumar Thiagarajan 	int i, ret;
20826a7c9badSJouni Malinen 
20836a7c9badSJouni Malinen 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add);
20846a7c9badSJouni Malinen 
2085990bd915SVasanthakumar Thiagarajan 	if (!ath6kl_cfg80211_ready(vif))
20866a7c9badSJouni Malinen 		return -EIO;
20876a7c9badSJouni Malinen 
2088f5938f24SVasanthakumar Thiagarajan 	if (vif->next_mode != AP_NETWORK)
20896a7c9badSJouni Malinen 		return -EOPNOTSUPP;
20906a7c9badSJouni Malinen 
20916a7c9badSJouni Malinen 	if (info->beacon_ies) {
2092334234b5SVasanthakumar Thiagarajan 		res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
2093334234b5SVasanthakumar Thiagarajan 					       WMI_FRAME_BEACON,
20946a7c9badSJouni Malinen 					       info->beacon_ies,
20956a7c9badSJouni Malinen 					       info->beacon_ies_len);
20966a7c9badSJouni Malinen 		if (res)
20976a7c9badSJouni Malinen 			return res;
20986a7c9badSJouni Malinen 	}
20996a7c9badSJouni Malinen 	if (info->proberesp_ies) {
2100334234b5SVasanthakumar Thiagarajan 		res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies,
21016a7c9badSJouni Malinen 						   info->proberesp_ies_len);
21026a7c9badSJouni Malinen 		if (res)
21036a7c9badSJouni Malinen 			return res;
21046a7c9badSJouni Malinen 	}
21056a7c9badSJouni Malinen 	if (info->assocresp_ies) {
2106334234b5SVasanthakumar Thiagarajan 		res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
2107334234b5SVasanthakumar Thiagarajan 					       WMI_FRAME_ASSOC_RESP,
21086a7c9badSJouni Malinen 					       info->assocresp_ies,
21096a7c9badSJouni Malinen 					       info->assocresp_ies_len);
21106a7c9badSJouni Malinen 		if (res)
21116a7c9badSJouni Malinen 			return res;
21126a7c9badSJouni Malinen 	}
21136a7c9badSJouni Malinen 
21146a7c9badSJouni Malinen 	if (!add)
21156a7c9badSJouni Malinen 		return 0;
21166a7c9badSJouni Malinen 
21179a5b1318SJouni Malinen 	ar->ap_mode_bkey.valid = false;
21189a5b1318SJouni Malinen 
21196a7c9badSJouni Malinen 	/* TODO:
21206a7c9badSJouni Malinen 	 * info->interval
21216a7c9badSJouni Malinen 	 * info->dtim_period
21226a7c9badSJouni Malinen 	 */
21236a7c9badSJouni Malinen 
21246a7c9badSJouni Malinen 	if (info->head == NULL)
21256a7c9badSJouni Malinen 		return -EINVAL;
21266a7c9badSJouni Malinen 	mgmt = (struct ieee80211_mgmt *) info->head;
21276a7c9badSJouni Malinen 	ies = mgmt->u.beacon.variable;
21286a7c9badSJouni Malinen 	if (ies > info->head + info->head_len)
21296a7c9badSJouni Malinen 		return -EINVAL;
21306a7c9badSJouni Malinen 	ies_len = info->head + info->head_len - ies;
21316a7c9badSJouni Malinen 
21326a7c9badSJouni Malinen 	if (info->ssid == NULL)
21336a7c9badSJouni Malinen 		return -EINVAL;
21343450334fSVasanthakumar Thiagarajan 	memcpy(vif->ssid, info->ssid, info->ssid_len);
21353450334fSVasanthakumar Thiagarajan 	vif->ssid_len = info->ssid_len;
21366a7c9badSJouni Malinen 	if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE)
21376a7c9badSJouni Malinen 		return -EOPNOTSUPP; /* TODO */
21386a7c9badSJouni Malinen 
2139be5abaafSVasanthakumar Thiagarajan 	ret = ath6kl_set_auth_type(vif, info->auth_type);
2140be5abaafSVasanthakumar Thiagarajan 	if (ret)
2141be5abaafSVasanthakumar Thiagarajan 		return ret;
21426a7c9badSJouni Malinen 
21436a7c9badSJouni Malinen 	memset(&p, 0, sizeof(p));
21446a7c9badSJouni Malinen 
21456a7c9badSJouni Malinen 	for (i = 0; i < info->crypto.n_akm_suites; i++) {
21466a7c9badSJouni Malinen 		switch (info->crypto.akm_suites[i]) {
21476a7c9badSJouni Malinen 		case WLAN_AKM_SUITE_8021X:
21486a7c9badSJouni Malinen 			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1)
21496a7c9badSJouni Malinen 				p.auth_mode |= WPA_AUTH;
21506a7c9badSJouni Malinen 			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2)
21516a7c9badSJouni Malinen 				p.auth_mode |= WPA2_AUTH;
21526a7c9badSJouni Malinen 			break;
21536a7c9badSJouni Malinen 		case WLAN_AKM_SUITE_PSK:
21546a7c9badSJouni Malinen 			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1)
21556a7c9badSJouni Malinen 				p.auth_mode |= WPA_PSK_AUTH;
21566a7c9badSJouni Malinen 			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2)
21576a7c9badSJouni Malinen 				p.auth_mode |= WPA2_PSK_AUTH;
21586a7c9badSJouni Malinen 			break;
21596a7c9badSJouni Malinen 		}
21606a7c9badSJouni Malinen 	}
21616a7c9badSJouni Malinen 	if (p.auth_mode == 0)
21626a7c9badSJouni Malinen 		p.auth_mode = NONE_AUTH;
21633450334fSVasanthakumar Thiagarajan 	vif->auth_mode = p.auth_mode;
21646a7c9badSJouni Malinen 
21656a7c9badSJouni Malinen 	for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) {
21666a7c9badSJouni Malinen 		switch (info->crypto.ciphers_pairwise[i]) {
21676a7c9badSJouni Malinen 		case WLAN_CIPHER_SUITE_WEP40:
21686a7c9badSJouni Malinen 		case WLAN_CIPHER_SUITE_WEP104:
21696a7c9badSJouni Malinen 			p.prwise_crypto_type |= WEP_CRYPT;
21706a7c9badSJouni Malinen 			break;
21716a7c9badSJouni Malinen 		case WLAN_CIPHER_SUITE_TKIP:
21726a7c9badSJouni Malinen 			p.prwise_crypto_type |= TKIP_CRYPT;
21736a7c9badSJouni Malinen 			break;
21746a7c9badSJouni Malinen 		case WLAN_CIPHER_SUITE_CCMP:
21756a7c9badSJouni Malinen 			p.prwise_crypto_type |= AES_CRYPT;
21766a7c9badSJouni Malinen 			break;
2177b8214df1SDai Shuibing 		case WLAN_CIPHER_SUITE_SMS4:
2178b8214df1SDai Shuibing 			p.prwise_crypto_type |= WAPI_CRYPT;
2179b8214df1SDai Shuibing 			break;
21806a7c9badSJouni Malinen 		}
21816a7c9badSJouni Malinen 	}
2182229ed6b5SEdward Lu 	if (p.prwise_crypto_type == 0) {
21836a7c9badSJouni Malinen 		p.prwise_crypto_type = NONE_CRYPT;
2184240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, 0, true);
2185229ed6b5SEdward Lu 	} else if (info->crypto.n_ciphers_pairwise == 1)
2186240d2799SVasanthakumar Thiagarajan 		ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true);
21876a7c9badSJouni Malinen 
21886a7c9badSJouni Malinen 	switch (info->crypto.cipher_group) {
21896a7c9badSJouni Malinen 	case WLAN_CIPHER_SUITE_WEP40:
21906a7c9badSJouni Malinen 	case WLAN_CIPHER_SUITE_WEP104:
21916a7c9badSJouni Malinen 		p.grp_crypto_type = WEP_CRYPT;
21926a7c9badSJouni Malinen 		break;
21936a7c9badSJouni Malinen 	case WLAN_CIPHER_SUITE_TKIP:
21946a7c9badSJouni Malinen 		p.grp_crypto_type = TKIP_CRYPT;
21956a7c9badSJouni Malinen 		break;
21966a7c9badSJouni Malinen 	case WLAN_CIPHER_SUITE_CCMP:
21976a7c9badSJouni Malinen 		p.grp_crypto_type = AES_CRYPT;
21986a7c9badSJouni Malinen 		break;
2199b8214df1SDai Shuibing 	case WLAN_CIPHER_SUITE_SMS4:
2200b8214df1SDai Shuibing 		p.grp_crypto_type = WAPI_CRYPT;
2201b8214df1SDai Shuibing 		break;
22026a7c9badSJouni Malinen 	default:
22036a7c9badSJouni Malinen 		p.grp_crypto_type = NONE_CRYPT;
22046a7c9badSJouni Malinen 		break;
22056a7c9badSJouni Malinen 	}
2206240d2799SVasanthakumar Thiagarajan 	ath6kl_set_cipher(vif, info->crypto.cipher_group, false);
22076a7c9badSJouni Malinen 
22086a7c9badSJouni Malinen 	p.nw_type = AP_NETWORK;
2209f5938f24SVasanthakumar Thiagarajan 	vif->nw_type = vif->next_mode;
22106a7c9badSJouni Malinen 
22113450334fSVasanthakumar Thiagarajan 	p.ssid_len = vif->ssid_len;
22123450334fSVasanthakumar Thiagarajan 	memcpy(p.ssid, vif->ssid, vif->ssid_len);
22133450334fSVasanthakumar Thiagarajan 	p.dot11_auth_mode = vif->dot11_auth_mode;
2214cf5333d7SVasanthakumar Thiagarajan 	p.ch = cpu_to_le16(vif->next_chan);
22156a7c9badSJouni Malinen 
22163ca9d1fcSAarthi Thiruvengadam 	if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) {
22173ca9d1fcSAarthi Thiruvengadam 		p.nw_subtype = SUBTYPE_P2PGO;
22183ca9d1fcSAarthi Thiruvengadam 	} else {
22193ca9d1fcSAarthi Thiruvengadam 		/*
22203ca9d1fcSAarthi Thiruvengadam 		 * Due to firmware limitation, it is not possible to
22213ca9d1fcSAarthi Thiruvengadam 		 * do P2P mgmt operations in AP mode
22223ca9d1fcSAarthi Thiruvengadam 		 */
22233ca9d1fcSAarthi Thiruvengadam 		p.nw_subtype = SUBTYPE_NONE;
22243ca9d1fcSAarthi Thiruvengadam 	}
22253ca9d1fcSAarthi Thiruvengadam 
2226334234b5SVasanthakumar Thiagarajan 	res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p);
22279a5b1318SJouni Malinen 	if (res < 0)
22289a5b1318SJouni Malinen 		return res;
22299a5b1318SJouni Malinen 
22309a5b1318SJouni Malinen 	return 0;
22316a7c9badSJouni Malinen }
22326a7c9badSJouni Malinen 
22336a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev,
22346a7c9badSJouni Malinen 			     struct beacon_parameters *info)
22356a7c9badSJouni Malinen {
22366a7c9badSJouni Malinen 	return ath6kl_ap_beacon(wiphy, dev, info, true);
22376a7c9badSJouni Malinen }
22386a7c9badSJouni Malinen 
22396a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev,
22406a7c9badSJouni Malinen 			     struct beacon_parameters *info)
22416a7c9badSJouni Malinen {
22426a7c9badSJouni Malinen 	return ath6kl_ap_beacon(wiphy, dev, info, false);
22436a7c9badSJouni Malinen }
22446a7c9badSJouni Malinen 
22456a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev)
22466a7c9badSJouni Malinen {
22476a7c9badSJouni Malinen 	struct ath6kl *ar = ath6kl_priv(dev);
224859c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
22496a7c9badSJouni Malinen 
2250f5938f24SVasanthakumar Thiagarajan 	if (vif->nw_type != AP_NETWORK)
22516a7c9badSJouni Malinen 		return -EOPNOTSUPP;
225259c98449SVasanthakumar Thiagarajan 	if (!test_bit(CONNECTED, &vif->flags))
22536a7c9badSJouni Malinen 		return -ENOTCONN;
22546a7c9badSJouni Malinen 
2255334234b5SVasanthakumar Thiagarajan 	ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx);
225659c98449SVasanthakumar Thiagarajan 	clear_bit(CONNECTED, &vif->flags);
22576a7c9badSJouni Malinen 
22586a7c9badSJouni Malinen 	return 0;
22596a7c9badSJouni Malinen }
22606a7c9badSJouni Malinen 
226123875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev,
226223875136SJouni Malinen 				 u8 *mac, struct station_parameters *params)
226323875136SJouni Malinen {
226423875136SJouni Malinen 	struct ath6kl *ar = ath6kl_priv(dev);
2265f5938f24SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
226623875136SJouni Malinen 
2267f5938f24SVasanthakumar Thiagarajan 	if (vif->nw_type != AP_NETWORK)
226823875136SJouni Malinen 		return -EOPNOTSUPP;
226923875136SJouni Malinen 
227023875136SJouni Malinen 	/* Use this only for authorizing/unauthorizing a station */
227123875136SJouni Malinen 	if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
227223875136SJouni Malinen 		return -EOPNOTSUPP;
227323875136SJouni Malinen 
227423875136SJouni Malinen 	if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED))
2275334234b5SVasanthakumar Thiagarajan 		return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx,
2276334234b5SVasanthakumar Thiagarajan 					      WMI_AP_MLME_AUTHORIZE, mac, 0);
2277334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx,
2278334234b5SVasanthakumar Thiagarajan 				      WMI_AP_MLME_UNAUTHORIZE, mac, 0);
227923875136SJouni Malinen }
228023875136SJouni Malinen 
228163fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy,
228263fa1e0cSJouni Malinen 				    struct net_device *dev,
228363fa1e0cSJouni Malinen 				    struct ieee80211_channel *chan,
228463fa1e0cSJouni Malinen 				    enum nl80211_channel_type channel_type,
228563fa1e0cSJouni Malinen 				    unsigned int duration,
228663fa1e0cSJouni Malinen 				    u64 *cookie)
228763fa1e0cSJouni Malinen {
228863fa1e0cSJouni Malinen 	struct ath6kl *ar = ath6kl_priv(dev);
2289334234b5SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
22901052261eSJouni Malinen 	u32 id;
229163fa1e0cSJouni Malinen 
229263fa1e0cSJouni Malinen 	/* TODO: if already pending or ongoing remain-on-channel,
229363fa1e0cSJouni Malinen 	 * return -EBUSY */
22941052261eSJouni Malinen 	id = ++vif->last_roc_id;
22951052261eSJouni Malinen 	if (id == 0) {
22961052261eSJouni Malinen 		/* Do not use 0 as the cookie value */
22971052261eSJouni Malinen 		id = ++vif->last_roc_id;
22981052261eSJouni Malinen 	}
22991052261eSJouni Malinen 	*cookie = id;
230063fa1e0cSJouni Malinen 
2301334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx,
2302334234b5SVasanthakumar Thiagarajan 					     chan->center_freq, duration);
230363fa1e0cSJouni Malinen }
230463fa1e0cSJouni Malinen 
230563fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy,
230663fa1e0cSJouni Malinen 					   struct net_device *dev,
230763fa1e0cSJouni Malinen 					   u64 cookie)
230863fa1e0cSJouni Malinen {
230963fa1e0cSJouni Malinen 	struct ath6kl *ar = ath6kl_priv(dev);
2310334234b5SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
231163fa1e0cSJouni Malinen 
23121052261eSJouni Malinen 	if (cookie != vif->last_roc_id)
231363fa1e0cSJouni Malinen 		return -ENOENT;
23141052261eSJouni Malinen 	vif->last_cancel_roc_id = cookie;
231563fa1e0cSJouni Malinen 
2316334234b5SVasanthakumar Thiagarajan 	return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx);
231763fa1e0cSJouni Malinen }
231863fa1e0cSJouni Malinen 
2319334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif,
2320334234b5SVasanthakumar Thiagarajan 				     const u8 *buf, size_t len,
2321334234b5SVasanthakumar Thiagarajan 				     unsigned int freq)
23228bdfbf40SJouni Malinen {
2323334234b5SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
23248bdfbf40SJouni Malinen 	const u8 *pos;
23258bdfbf40SJouni Malinen 	u8 *p2p;
23268bdfbf40SJouni Malinen 	int p2p_len;
23278bdfbf40SJouni Malinen 	int ret;
23288bdfbf40SJouni Malinen 	const struct ieee80211_mgmt *mgmt;
23298bdfbf40SJouni Malinen 
23308bdfbf40SJouni Malinen 	mgmt = (const struct ieee80211_mgmt *) buf;
23318bdfbf40SJouni Malinen 
23328bdfbf40SJouni Malinen 	/* Include P2P IE(s) from the frame generated in user space. */
23338bdfbf40SJouni Malinen 
23348bdfbf40SJouni Malinen 	p2p = kmalloc(len, GFP_KERNEL);
23358bdfbf40SJouni Malinen 	if (p2p == NULL)
23368bdfbf40SJouni Malinen 		return -ENOMEM;
23378bdfbf40SJouni Malinen 	p2p_len = 0;
23388bdfbf40SJouni Malinen 
23398bdfbf40SJouni Malinen 	pos = mgmt->u.probe_resp.variable;
23408bdfbf40SJouni Malinen 	while (pos + 1 < buf + len) {
23418bdfbf40SJouni Malinen 		if (pos + 2 + pos[1] > buf + len)
23428bdfbf40SJouni Malinen 			break;
23438bdfbf40SJouni Malinen 		if (ath6kl_is_p2p_ie(pos)) {
23448bdfbf40SJouni Malinen 			memcpy(p2p + p2p_len, pos, 2 + pos[1]);
23458bdfbf40SJouni Malinen 			p2p_len += 2 + pos[1];
23468bdfbf40SJouni Malinen 		}
23478bdfbf40SJouni Malinen 		pos += 2 + pos[1];
23488bdfbf40SJouni Malinen 	}
23498bdfbf40SJouni Malinen 
2350334234b5SVasanthakumar Thiagarajan 	ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq,
2351334234b5SVasanthakumar Thiagarajan 						 mgmt->da, p2p, p2p_len);
23528bdfbf40SJouni Malinen 	kfree(p2p);
23538bdfbf40SJouni Malinen 	return ret;
23548bdfbf40SJouni Malinen }
23558bdfbf40SJouni Malinen 
23568a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev,
23578a6c8060SJouni Malinen 			  struct ieee80211_channel *chan, bool offchan,
23588a6c8060SJouni Malinen 			  enum nl80211_channel_type channel_type,
23598a6c8060SJouni Malinen 			  bool channel_type_valid, unsigned int wait,
2360e247bd90SJohannes Berg 			  const u8 *buf, size_t len, bool no_cck,
2361e247bd90SJohannes Berg 			  bool dont_wait_for_ack, u64 *cookie)
23628a6c8060SJouni Malinen {
23638a6c8060SJouni Malinen 	struct ath6kl *ar = ath6kl_priv(dev);
236459c98449SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
23658a6c8060SJouni Malinen 	u32 id;
23668bdfbf40SJouni Malinen 	const struct ieee80211_mgmt *mgmt;
23678bdfbf40SJouni Malinen 
23688bdfbf40SJouni Malinen 	mgmt = (const struct ieee80211_mgmt *) buf;
23698bdfbf40SJouni Malinen 	if (buf + len >= mgmt->u.probe_resp.variable &&
2370f5938f24SVasanthakumar Thiagarajan 	    vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) &&
23718bdfbf40SJouni Malinen 	    ieee80211_is_probe_resp(mgmt->frame_control)) {
23728bdfbf40SJouni Malinen 		/*
23738bdfbf40SJouni Malinen 		 * Send Probe Response frame in AP mode using a separate WMI
23748bdfbf40SJouni Malinen 		 * command to allow the target to fill in the generic IEs.
23758bdfbf40SJouni Malinen 		 */
23768bdfbf40SJouni Malinen 		*cookie = 0; /* TX status not supported */
2377334234b5SVasanthakumar Thiagarajan 		return ath6kl_send_go_probe_resp(vif, buf, len,
23788bdfbf40SJouni Malinen 						 chan->center_freq);
23798bdfbf40SJouni Malinen 	}
23808a6c8060SJouni Malinen 
2381cf5333d7SVasanthakumar Thiagarajan 	id = vif->send_action_id++;
23828a6c8060SJouni Malinen 	if (id == 0) {
23838a6c8060SJouni Malinen 		/*
23848a6c8060SJouni Malinen 		 * 0 is a reserved value in the WMI command and shall not be
23858a6c8060SJouni Malinen 		 * used for the command.
23868a6c8060SJouni Malinen 		 */
2387cf5333d7SVasanthakumar Thiagarajan 		id = vif->send_action_id++;
23888a6c8060SJouni Malinen 	}
23898a6c8060SJouni Malinen 
23908a6c8060SJouni Malinen 	*cookie = id;
23913ca9d1fcSAarthi Thiruvengadam 
23923ca9d1fcSAarthi Thiruvengadam 	if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX,
23933ca9d1fcSAarthi Thiruvengadam 		    ar->fw_capabilities)) {
23943ca9d1fcSAarthi Thiruvengadam 		/*
23953ca9d1fcSAarthi Thiruvengadam 		 * If capable of doing P2P mgmt operations using
23963ca9d1fcSAarthi Thiruvengadam 		 * station interface, send additional information like
23973ca9d1fcSAarthi Thiruvengadam 		 * supported rates to advertise and xmit rates for
23983ca9d1fcSAarthi Thiruvengadam 		 * probe requests
23993ca9d1fcSAarthi Thiruvengadam 		 */
24003ca9d1fcSAarthi Thiruvengadam 		return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id,
24013ca9d1fcSAarthi Thiruvengadam 						chan->center_freq, wait,
24023ca9d1fcSAarthi Thiruvengadam 						buf, len, no_cck);
24033ca9d1fcSAarthi Thiruvengadam 	} else {
2404334234b5SVasanthakumar Thiagarajan 		return ath6kl_wmi_send_action_cmd(ar->wmi, vif->fw_vif_idx, id,
2405334234b5SVasanthakumar Thiagarajan 						  chan->center_freq, wait,
24068a6c8060SJouni Malinen 						  buf, len);
24078a6c8060SJouni Malinen 	}
24083ca9d1fcSAarthi Thiruvengadam }
24098a6c8060SJouni Malinen 
2410ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy,
2411ae32c30aSJouni Malinen 				       struct net_device *dev,
2412ae32c30aSJouni Malinen 				       u16 frame_type, bool reg)
2413ae32c30aSJouni Malinen {
2414cf5333d7SVasanthakumar Thiagarajan 	struct ath6kl_vif *vif = netdev_priv(dev);
2415ae32c30aSJouni Malinen 
2416ae32c30aSJouni Malinen 	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n",
2417ae32c30aSJouni Malinen 		   __func__, frame_type, reg);
2418ae32c30aSJouni Malinen 	if (frame_type == IEEE80211_STYPE_PROBE_REQ) {
2419ae32c30aSJouni Malinen 		/*
2420ae32c30aSJouni Malinen 		 * Note: This notification callback is not allowed to sleep, so
2421ae32c30aSJouni Malinen 		 * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we
2422ae32c30aSJouni Malinen 		 * hardcode target to report Probe Request frames all the time.
2423ae32c30aSJouni Malinen 		 */
2424cf5333d7SVasanthakumar Thiagarajan 		vif->probe_req_report = reg;
2425ae32c30aSJouni Malinen 	}
2426ae32c30aSJouni Malinen }
2427ae32c30aSJouni Malinen 
242810509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy,
242910509f90SKalle Valo 			struct net_device *dev,
243010509f90SKalle Valo 			struct cfg80211_sched_scan_request *request)
243110509f90SKalle Valo {
243210509f90SKalle Valo 	struct ath6kl *ar = ath6kl_priv(dev);
243310509f90SKalle Valo 	struct ath6kl_vif *vif = netdev_priv(dev);
243410509f90SKalle Valo 	u16 interval;
243510509f90SKalle Valo 	int ret;
243610509f90SKalle Valo 	u8 i;
243710509f90SKalle Valo 
243810509f90SKalle Valo 	if (ar->state != ATH6KL_STATE_ON)
243910509f90SKalle Valo 		return -EIO;
244010509f90SKalle Valo 
244110509f90SKalle Valo 	if (vif->sme_state != SME_DISCONNECTED)
244210509f90SKalle Valo 		return -EBUSY;
244310509f90SKalle Valo 
244410509f90SKalle Valo 	for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) {
244510509f90SKalle Valo 		ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
244610509f90SKalle Valo 					  i, DISABLE_SSID_FLAG,
244710509f90SKalle Valo 					  0, NULL);
244810509f90SKalle Valo 	}
244910509f90SKalle Valo 
245010509f90SKalle Valo 	/* fw uses seconds, also make sure that it's >0 */
245110509f90SKalle Valo 	interval = max_t(u16, 1, request->interval / 1000);
245210509f90SKalle Valo 
245310509f90SKalle Valo 	ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx,
245410509f90SKalle Valo 				  interval, interval,
245510509f90SKalle Valo 				  10, 0, 0, 0, 3, 0, 0, 0);
245610509f90SKalle Valo 
245710509f90SKalle Valo 	if (request->n_ssids && request->ssids[0].ssid_len) {
245810509f90SKalle Valo 		for (i = 0; i < request->n_ssids; i++) {
245910509f90SKalle Valo 			ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
246010509f90SKalle Valo 						  i, SPECIFIC_SSID_FLAG,
246110509f90SKalle Valo 						  request->ssids[i].ssid_len,
246210509f90SKalle Valo 						  request->ssids[i].ssid);
246310509f90SKalle Valo 		}
246410509f90SKalle Valo 	}
246510509f90SKalle Valo 
246610509f90SKalle Valo 	ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx,
246710509f90SKalle Valo 					  ATH6KL_WOW_MODE_ENABLE,
246810509f90SKalle Valo 					  WOW_FILTER_SSID,
246910509f90SKalle Valo 					  WOW_HOST_REQ_DELAY);
247010509f90SKalle Valo 	if (ret) {
247110509f90SKalle Valo 		ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret);
247210509f90SKalle Valo 		return ret;
247310509f90SKalle Valo 	}
247410509f90SKalle Valo 
247510509f90SKalle Valo 	/* this also clears IE in fw if it's not set */
247610509f90SKalle Valo 	ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
247710509f90SKalle Valo 				       WMI_FRAME_PROBE_REQ,
247810509f90SKalle Valo 				       request->ie, request->ie_len);
247910509f90SKalle Valo 	if (ret) {
248010509f90SKalle Valo 		ath6kl_warn("Failed to set probe request IE for scheduled scan: %d",
248110509f90SKalle Valo 			    ret);
248210509f90SKalle Valo 		return ret;
248310509f90SKalle Valo 	}
248410509f90SKalle Valo 
248510509f90SKalle Valo 	ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx,
248610509f90SKalle Valo 						 ATH6KL_HOST_MODE_ASLEEP);
248710509f90SKalle Valo 	if (ret) {
248810509f90SKalle Valo 		ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n",
248910509f90SKalle Valo 			    ret);
249010509f90SKalle Valo 		return ret;
249110509f90SKalle Valo 	}
249210509f90SKalle Valo 
249310509f90SKalle Valo 	ar->state = ATH6KL_STATE_SCHED_SCAN;
249410509f90SKalle Valo 
249510509f90SKalle Valo 	return ret;
249610509f90SKalle Valo }
249710509f90SKalle Valo 
249810509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy,
249910509f90SKalle Valo 				      struct net_device *dev)
250010509f90SKalle Valo {
250110509f90SKalle Valo 	struct ath6kl_vif *vif = netdev_priv(dev);
250210509f90SKalle Valo 	bool stopped;
250310509f90SKalle Valo 
250410509f90SKalle Valo 	stopped = __ath6kl_cfg80211_sscan_stop(vif);
250510509f90SKalle Valo 
250610509f90SKalle Valo 	if (!stopped)
250710509f90SKalle Valo 		return -EIO;
250810509f90SKalle Valo 
250910509f90SKalle Valo 	return 0;
251010509f90SKalle Valo }
251110509f90SKalle Valo 
2512f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes
2513f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = {
2514f80574aeSJouni Malinen 	[NL80211_IFTYPE_STATION] = {
2515f80574aeSJouni Malinen 		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
2516f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
2517f80574aeSJouni Malinen 		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
2518f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
2519f80574aeSJouni Malinen 	},
2520f80574aeSJouni Malinen 	[NL80211_IFTYPE_P2P_CLIENT] = {
2521f80574aeSJouni Malinen 		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
2522f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
2523f80574aeSJouni Malinen 		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
2524f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
2525f80574aeSJouni Malinen 	},
2526f80574aeSJouni Malinen 	[NL80211_IFTYPE_P2P_GO] = {
2527f80574aeSJouni Malinen 		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
2528f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
2529f80574aeSJouni Malinen 		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
2530f80574aeSJouni Malinen 		BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
2531f80574aeSJouni Malinen 	},
2532f80574aeSJouni Malinen };
2533f80574aeSJouni Malinen 
2534bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = {
253555055976SVasanthakumar Thiagarajan 	.add_virtual_intf = ath6kl_cfg80211_add_iface,
253655055976SVasanthakumar Thiagarajan 	.del_virtual_intf = ath6kl_cfg80211_del_iface,
2537bdcd8170SKalle Valo 	.change_virtual_intf = ath6kl_cfg80211_change_iface,
2538bdcd8170SKalle Valo 	.scan = ath6kl_cfg80211_scan,
2539bdcd8170SKalle Valo 	.connect = ath6kl_cfg80211_connect,
2540bdcd8170SKalle Valo 	.disconnect = ath6kl_cfg80211_disconnect,
2541bdcd8170SKalle Valo 	.add_key = ath6kl_cfg80211_add_key,
2542bdcd8170SKalle Valo 	.get_key = ath6kl_cfg80211_get_key,
2543bdcd8170SKalle Valo 	.del_key = ath6kl_cfg80211_del_key,
2544bdcd8170SKalle Valo 	.set_default_key = ath6kl_cfg80211_set_default_key,
2545bdcd8170SKalle Valo 	.set_wiphy_params = ath6kl_cfg80211_set_wiphy_params,
2546bdcd8170SKalle Valo 	.set_tx_power = ath6kl_cfg80211_set_txpower,
2547bdcd8170SKalle Valo 	.get_tx_power = ath6kl_cfg80211_get_txpower,
2548bdcd8170SKalle Valo 	.set_power_mgmt = ath6kl_cfg80211_set_power_mgmt,
2549bdcd8170SKalle Valo 	.join_ibss = ath6kl_cfg80211_join_ibss,
2550bdcd8170SKalle Valo 	.leave_ibss = ath6kl_cfg80211_leave_ibss,
2551bdcd8170SKalle Valo 	.get_station = ath6kl_get_station,
2552bdcd8170SKalle Valo 	.set_pmksa = ath6kl_set_pmksa,
2553bdcd8170SKalle Valo 	.del_pmksa = ath6kl_del_pmksa,
2554bdcd8170SKalle Valo 	.flush_pmksa = ath6kl_flush_pmksa,
2555003353b0SKalle Valo 	CFG80211_TESTMODE_CMD(ath6kl_tm_cmd)
2556abcb344bSKalle Valo #ifdef CONFIG_PM
255752d81a68SKalle Valo 	.suspend = __ath6kl_cfg80211_suspend,
255852d81a68SKalle Valo 	.resume = __ath6kl_cfg80211_resume,
2559abcb344bSKalle Valo #endif
25606a7c9badSJouni Malinen 	.set_channel = ath6kl_set_channel,
25616a7c9badSJouni Malinen 	.add_beacon = ath6kl_add_beacon,
25626a7c9badSJouni Malinen 	.set_beacon = ath6kl_set_beacon,
25636a7c9badSJouni Malinen 	.del_beacon = ath6kl_del_beacon,
256423875136SJouni Malinen 	.change_station = ath6kl_change_station,
256563fa1e0cSJouni Malinen 	.remain_on_channel = ath6kl_remain_on_channel,
256663fa1e0cSJouni Malinen 	.cancel_remain_on_channel = ath6kl_cancel_remain_on_channel,
25678a6c8060SJouni Malinen 	.mgmt_tx = ath6kl_mgmt_tx,
2568ae32c30aSJouni Malinen 	.mgmt_frame_register = ath6kl_mgmt_frame_register,
256910509f90SKalle Valo 	.sched_scan_start = ath6kl_cfg80211_sscan_start,
257010509f90SKalle Valo 	.sched_scan_stop = ath6kl_cfg80211_sscan_stop,
2571bdcd8170SKalle Valo };
2572bdcd8170SKalle Valo 
25737125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif)
2574ec4b7f60SKalle Valo {
257510509f90SKalle Valo 	ath6kl_cfg80211_sscan_disable(vif);
257610509f90SKalle Valo 
2577ec4b7f60SKalle Valo 	switch (vif->sme_state) {
2578c97a31b0SKalle Valo 	case SME_DISCONNECTED:
2579c97a31b0SKalle Valo 		break;
2580ec4b7f60SKalle Valo 	case SME_CONNECTING:
2581ec4b7f60SKalle Valo 		cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0,
2582ec4b7f60SKalle Valo 					NULL, 0,
2583ec4b7f60SKalle Valo 					WLAN_STATUS_UNSPECIFIED_FAILURE,
2584ec4b7f60SKalle Valo 					GFP_KERNEL);
2585ec4b7f60SKalle Valo 		break;
2586ec4b7f60SKalle Valo 	case SME_CONNECTED:
2587ec4b7f60SKalle Valo 		cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL);
2588ec4b7f60SKalle Valo 		break;
2589ec4b7f60SKalle Valo 	}
2590ec4b7f60SKalle Valo 
2591ec4b7f60SKalle Valo 	if (test_bit(CONNECTED, &vif->flags) ||
2592ec4b7f60SKalle Valo 	    test_bit(CONNECT_PEND, &vif->flags))
25937125f01dSKalle Valo 		ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx);
2594ec4b7f60SKalle Valo 
2595ec4b7f60SKalle Valo 	vif->sme_state = SME_DISCONNECTED;
25961f405255SKalle Valo 	clear_bit(CONNECTED, &vif->flags);
25971f405255SKalle Valo 	clear_bit(CONNECT_PEND, &vif->flags);
2598ec4b7f60SKalle Valo 
2599ec4b7f60SKalle Valo 	/* disable scanning */
26007125f01dSKalle Valo 	if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF,
26017125f01dSKalle Valo 				      0, 0, 0, 0, 0, 0, 0, 0, 0) != 0)
26027125f01dSKalle Valo 		ath6kl_warn("failed to disable scan during stop\n");
2603ec4b7f60SKalle Valo 
2604ec4b7f60SKalle Valo 	ath6kl_cfg80211_scan_complete_event(vif, true);
2605ec4b7f60SKalle Valo }
2606ec4b7f60SKalle Valo 
26077125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar)
26087125f01dSKalle Valo {
26097125f01dSKalle Valo 	struct ath6kl_vif *vif;
26107125f01dSKalle Valo 
26117125f01dSKalle Valo 	vif = ath6kl_vif_first(ar);
26127125f01dSKalle Valo 	if (!vif) {
26137125f01dSKalle Valo 		/* save the current power mode before enabling power save */
26147125f01dSKalle Valo 		ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode;
26157125f01dSKalle Valo 
26167125f01dSKalle Valo 		if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0)
26177125f01dSKalle Valo 			ath6kl_warn("ath6kl_deep_sleep_enable: "
26187125f01dSKalle Valo 				    "wmi_powermode_cmd failed\n");
26197125f01dSKalle Valo 		return;
26207125f01dSKalle Valo 	}
26217125f01dSKalle Valo 
26227125f01dSKalle Valo 	/*
26237125f01dSKalle Valo 	 * FIXME: we should take ar->list_lock to protect changes in the
26247125f01dSKalle Valo 	 * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop()
26257125f01dSKalle Valo 	 * sleeps.
26267125f01dSKalle Valo 	 */
26277125f01dSKalle Valo 	list_for_each_entry(vif, &ar->vif_list, list)
26287125f01dSKalle Valo 		ath6kl_cfg80211_stop(vif);
26297125f01dSKalle Valo }
26307125f01dSKalle Valo 
26318dafb70eSVasanthakumar Thiagarajan struct ath6kl *ath6kl_core_alloc(struct device *dev)
2632bdcd8170SKalle Valo {
26336bbc7c35SJouni Malinen 	struct ath6kl *ar;
2634be98e3a4SVasanthakumar Thiagarajan 	struct wiphy *wiphy;
26358dafb70eSVasanthakumar Thiagarajan 	u8 ctr;
2636bdcd8170SKalle Valo 
2637bdcd8170SKalle Valo 	/* create a new wiphy for use with cfg80211 */
2638be98e3a4SVasanthakumar Thiagarajan 	wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl));
26398dafb70eSVasanthakumar Thiagarajan 
2640be98e3a4SVasanthakumar Thiagarajan 	if (!wiphy) {
2641bdcd8170SKalle Valo 		ath6kl_err("couldn't allocate wiphy device\n");
2642bdcd8170SKalle Valo 		return NULL;
2643bdcd8170SKalle Valo 	}
2644bdcd8170SKalle Valo 
2645be98e3a4SVasanthakumar Thiagarajan 	ar = wiphy_priv(wiphy);
26466bbc7c35SJouni Malinen 	ar->p2p = !!ath6kl_p2p;
2647be98e3a4SVasanthakumar Thiagarajan 	ar->wiphy = wiphy;
26488dafb70eSVasanthakumar Thiagarajan 	ar->dev = dev;
26498dafb70eSVasanthakumar Thiagarajan 
265071f96ee6SKalle Valo 	ar->vif_max = 1;
265171f96ee6SKalle Valo 
26523226f68aSVasanthakumar Thiagarajan 	ar->max_norm_iface = 1;
26533226f68aSVasanthakumar Thiagarajan 
26548dafb70eSVasanthakumar Thiagarajan 	spin_lock_init(&ar->lock);
26558dafb70eSVasanthakumar Thiagarajan 	spin_lock_init(&ar->mcastpsq_lock);
2656990bd915SVasanthakumar Thiagarajan 	spin_lock_init(&ar->list_lock);
26578dafb70eSVasanthakumar Thiagarajan 
26588dafb70eSVasanthakumar Thiagarajan 	init_waitqueue_head(&ar->event_wq);
26598dafb70eSVasanthakumar Thiagarajan 	sema_init(&ar->sem, 1);
26608dafb70eSVasanthakumar Thiagarajan 
26618dafb70eSVasanthakumar Thiagarajan 	INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue);
2662990bd915SVasanthakumar Thiagarajan 	INIT_LIST_HEAD(&ar->vif_list);
26638dafb70eSVasanthakumar Thiagarajan 
26648dafb70eSVasanthakumar Thiagarajan 	clear_bit(WMI_ENABLED, &ar->flag);
26658dafb70eSVasanthakumar Thiagarajan 	clear_bit(SKIP_SCAN, &ar->flag);
26668dafb70eSVasanthakumar Thiagarajan 	clear_bit(DESTROY_IN_PROGRESS, &ar->flag);
26678dafb70eSVasanthakumar Thiagarajan 
26688dafb70eSVasanthakumar Thiagarajan 	ar->listen_intvl_t = A_DEFAULT_LISTEN_INTERVAL;
26698dafb70eSVasanthakumar Thiagarajan 	ar->listen_intvl_b = 0;
26708dafb70eSVasanthakumar Thiagarajan 	ar->tx_pwr = 0;
26718dafb70eSVasanthakumar Thiagarajan 
26728dafb70eSVasanthakumar Thiagarajan 	ar->intra_bss = 1;
26738dafb70eSVasanthakumar Thiagarajan 	ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD;
26748dafb70eSVasanthakumar Thiagarajan 
267576a9fbe2SKalle Valo 	ar->state = ATH6KL_STATE_OFF;
267676a9fbe2SKalle Valo 
26778dafb70eSVasanthakumar Thiagarajan 	memset((u8 *)ar->sta_list, 0,
26788dafb70eSVasanthakumar Thiagarajan 	       AP_MAX_NUM_STA * sizeof(struct ath6kl_sta));
26798dafb70eSVasanthakumar Thiagarajan 
26808dafb70eSVasanthakumar Thiagarajan 	/* Init the PS queues */
26818dafb70eSVasanthakumar Thiagarajan 	for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) {
26828dafb70eSVasanthakumar Thiagarajan 		spin_lock_init(&ar->sta_list[ctr].psq_lock);
26838dafb70eSVasanthakumar Thiagarajan 		skb_queue_head_init(&ar->sta_list[ctr].psq);
26848dafb70eSVasanthakumar Thiagarajan 	}
26858dafb70eSVasanthakumar Thiagarajan 
26868dafb70eSVasanthakumar Thiagarajan 	skb_queue_head_init(&ar->mcastpsq);
26878dafb70eSVasanthakumar Thiagarajan 
26888dafb70eSVasanthakumar Thiagarajan 	memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3);
26898dafb70eSVasanthakumar Thiagarajan 
26908dafb70eSVasanthakumar Thiagarajan 	return ar;
26918dafb70eSVasanthakumar Thiagarajan }
26928dafb70eSVasanthakumar Thiagarajan 
26938dafb70eSVasanthakumar Thiagarajan int ath6kl_register_ieee80211_hw(struct ath6kl *ar)
26948dafb70eSVasanthakumar Thiagarajan {
26958dafb70eSVasanthakumar Thiagarajan 	struct wiphy *wiphy = ar->wiphy;
26968dafb70eSVasanthakumar Thiagarajan 	int ret;
26976bbc7c35SJouni Malinen 
2698be98e3a4SVasanthakumar Thiagarajan 	wiphy->mgmt_stypes = ath6kl_mgmt_stypes;
2699f80574aeSJouni Malinen 
2700be98e3a4SVasanthakumar Thiagarajan 	wiphy->max_remain_on_channel_duration = 5000;
270163fa1e0cSJouni Malinen 
2702bdcd8170SKalle Valo 	/* set device pointer for wiphy */
27038dafb70eSVasanthakumar Thiagarajan 	set_wiphy_dev(wiphy, ar->dev);
2704bdcd8170SKalle Valo 
2705be98e3a4SVasanthakumar Thiagarajan 	wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
27068dafb70eSVasanthakumar Thiagarajan 				 BIT(NL80211_IFTYPE_ADHOC) |
27078dafb70eSVasanthakumar Thiagarajan 				 BIT(NL80211_IFTYPE_AP);
27086bbc7c35SJouni Malinen 	if (ar->p2p) {
2709be98e3a4SVasanthakumar Thiagarajan 		wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) |
27106bbc7c35SJouni Malinen 					  BIT(NL80211_IFTYPE_P2P_CLIENT);
27116bbc7c35SJouni Malinen 	}
27128dafb70eSVasanthakumar Thiagarajan 
2713bdcd8170SKalle Valo 	/* max num of ssids that can be probed during scanning */
2714be98e3a4SVasanthakumar Thiagarajan 	wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX;
2715be98e3a4SVasanthakumar Thiagarajan 	wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */
2716be98e3a4SVasanthakumar Thiagarajan 	wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz;
2717be98e3a4SVasanthakumar Thiagarajan 	wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz;
2718be98e3a4SVasanthakumar Thiagarajan 	wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
2719bdcd8170SKalle Valo 
2720be98e3a4SVasanthakumar Thiagarajan 	wiphy->cipher_suites = cipher_suites;
2721be98e3a4SVasanthakumar Thiagarajan 	wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
2722bdcd8170SKalle Valo 
2723eae9e066SRaja Mani 	wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT |
2724eae9e066SRaja Mani 			      WIPHY_WOWLAN_DISCONNECT |
2725eae9e066SRaja Mani 			      WIPHY_WOWLAN_GTK_REKEY_FAILURE  |
2726eae9e066SRaja Mani 			      WIPHY_WOWLAN_SUPPORTS_GTK_REKEY |
2727eae9e066SRaja Mani 			      WIPHY_WOWLAN_EAP_IDENTITY_REQ   |
2728eae9e066SRaja Mani 			      WIPHY_WOWLAN_4WAY_HANDSHAKE;
2729eae9e066SRaja Mani 	wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST;
2730eae9e066SRaja Mani 	wiphy->wowlan.pattern_min_len = 1;
2731eae9e066SRaja Mani 	wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE;
2732eae9e066SRaja Mani 
273310509f90SKalle Valo 	wiphy->max_sched_scan_ssids = 10;
273410509f90SKalle Valo 
2735be98e3a4SVasanthakumar Thiagarajan 	ret = wiphy_register(wiphy);
2736bdcd8170SKalle Valo 	if (ret < 0) {
2737bdcd8170SKalle Valo 		ath6kl_err("couldn't register wiphy device\n");
27388dafb70eSVasanthakumar Thiagarajan 		return ret;
27398dafb70eSVasanthakumar Thiagarajan 	}
27408dafb70eSVasanthakumar Thiagarajan 
27418dafb70eSVasanthakumar Thiagarajan 	return 0;
27428dafb70eSVasanthakumar Thiagarajan }
27438dafb70eSVasanthakumar Thiagarajan 
2744108438bcSVasanthakumar Thiagarajan static int ath6kl_init_if_data(struct ath6kl_vif *vif)
27458dafb70eSVasanthakumar Thiagarajan {
27462132c69cSVasanthakumar Thiagarajan 	vif->aggr_cntxt = aggr_init(vif->ndev);
27472132c69cSVasanthakumar Thiagarajan 	if (!vif->aggr_cntxt) {
27488dafb70eSVasanthakumar Thiagarajan 		ath6kl_err("failed to initialize aggr\n");
27498dafb70eSVasanthakumar Thiagarajan 		return -ENOMEM;
27508dafb70eSVasanthakumar Thiagarajan 	}
27518dafb70eSVasanthakumar Thiagarajan 
2752de3ad713SVasanthakumar Thiagarajan 	setup_timer(&vif->disconnect_timer, disconnect_timer_handler,
2753108438bcSVasanthakumar Thiagarajan 		    (unsigned long) vif->ndev);
275410509f90SKalle Valo 	setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer,
275510509f90SKalle Valo 		    (unsigned long) vif);
275610509f90SKalle Valo 
2757de3ad713SVasanthakumar Thiagarajan 	set_bit(WMM_ENABLED, &vif->flags);
2758478ac027SVasanthakumar Thiagarajan 	spin_lock_init(&vif->if_lock);
27598dafb70eSVasanthakumar Thiagarajan 
27608dafb70eSVasanthakumar Thiagarajan 	return 0;
27618dafb70eSVasanthakumar Thiagarajan }
27628dafb70eSVasanthakumar Thiagarajan 
2763108438bcSVasanthakumar Thiagarajan void ath6kl_deinit_if_data(struct ath6kl_vif *vif)
27648dafb70eSVasanthakumar Thiagarajan {
276555055976SVasanthakumar Thiagarajan 	struct ath6kl *ar = vif->ar;
276655055976SVasanthakumar Thiagarajan 
27672132c69cSVasanthakumar Thiagarajan 	aggr_module_destroy(vif->aggr_cntxt);
2768108438bcSVasanthakumar Thiagarajan 
276955055976SVasanthakumar Thiagarajan 	ar->avail_idx_map |= BIT(vif->fw_vif_idx);
277055055976SVasanthakumar Thiagarajan 
277155055976SVasanthakumar Thiagarajan 	if (vif->nw_type == ADHOC_NETWORK)
277255055976SVasanthakumar Thiagarajan 		ar->ibss_if_active = false;
277355055976SVasanthakumar Thiagarajan 
277427929723SVasanthakumar Thiagarajan 	unregister_netdevice(vif->ndev);
277555055976SVasanthakumar Thiagarajan 
277655055976SVasanthakumar Thiagarajan 	ar->num_vif--;
27778dafb70eSVasanthakumar Thiagarajan }
27788dafb70eSVasanthakumar Thiagarajan 
27798dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name,
278055055976SVasanthakumar Thiagarajan 					enum nl80211_iftype type, u8 fw_vif_idx,
278155055976SVasanthakumar Thiagarajan 					u8 nw_type)
27828dafb70eSVasanthakumar Thiagarajan {
27838dafb70eSVasanthakumar Thiagarajan 	struct net_device *ndev;
2784108438bcSVasanthakumar Thiagarajan 	struct ath6kl_vif *vif;
27858dafb70eSVasanthakumar Thiagarajan 
278655055976SVasanthakumar Thiagarajan 	ndev = alloc_netdev(sizeof(*vif), name, ether_setup);
27878dafb70eSVasanthakumar Thiagarajan 	if (!ndev)
27888dafb70eSVasanthakumar Thiagarajan 		return NULL;
27898dafb70eSVasanthakumar Thiagarajan 
2790108438bcSVasanthakumar Thiagarajan 	vif = netdev_priv(ndev);
2791108438bcSVasanthakumar Thiagarajan 	ndev->ieee80211_ptr = &vif->wdev;
2792108438bcSVasanthakumar Thiagarajan 	vif->wdev.wiphy = ar->wiphy;
2793108438bcSVasanthakumar Thiagarajan 	vif->ar = ar;
2794108438bcSVasanthakumar Thiagarajan 	vif->ndev = ndev;
2795108438bcSVasanthakumar Thiagarajan 	SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy));
2796108438bcSVasanthakumar Thiagarajan 	vif->wdev.netdev = ndev;
2797108438bcSVasanthakumar Thiagarajan 	vif->wdev.iftype = type;
2798334234b5SVasanthakumar Thiagarajan 	vif->fw_vif_idx = fw_vif_idx;
279955055976SVasanthakumar Thiagarajan 	vif->nw_type = vif->next_mode = nw_type;
28008dafb70eSVasanthakumar Thiagarajan 
280155055976SVasanthakumar Thiagarajan 	memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN);
280255055976SVasanthakumar Thiagarajan 	if (fw_vif_idx != 0)
280355055976SVasanthakumar Thiagarajan 		ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) |
280455055976SVasanthakumar Thiagarajan 				     0x2;
280555055976SVasanthakumar Thiagarajan 
28068dafb70eSVasanthakumar Thiagarajan 	init_netdev(ndev);
28078dafb70eSVasanthakumar Thiagarajan 
2808e29f25f5SVasanthakumar Thiagarajan 	ath6kl_init_control_info(vif);
28098dafb70eSVasanthakumar Thiagarajan 
28108dafb70eSVasanthakumar Thiagarajan 	/* TODO: Pass interface specific pointer instead of ar */
2811108438bcSVasanthakumar Thiagarajan 	if (ath6kl_init_if_data(vif))
28128dafb70eSVasanthakumar Thiagarajan 		goto err;
28138dafb70eSVasanthakumar Thiagarajan 
281427929723SVasanthakumar Thiagarajan 	if (register_netdevice(ndev))
28158dafb70eSVasanthakumar Thiagarajan 		goto err;
28168dafb70eSVasanthakumar Thiagarajan 
281755055976SVasanthakumar Thiagarajan 	ar->avail_idx_map &= ~BIT(fw_vif_idx);
281814ee6f6bSVasanthakumar Thiagarajan 	vif->sme_state = SME_DISCONNECTED;
281959c98449SVasanthakumar Thiagarajan 	set_bit(WLAN_ENABLED, &vif->flags);
28208dafb70eSVasanthakumar Thiagarajan 	ar->wlan_pwr_state = WLAN_POWER_STATE_ON;
282159c98449SVasanthakumar Thiagarajan 	set_bit(NETDEV_REGISTERED, &vif->flags);
28228dafb70eSVasanthakumar Thiagarajan 
282355055976SVasanthakumar Thiagarajan 	if (type == NL80211_IFTYPE_ADHOC)
282455055976SVasanthakumar Thiagarajan 		ar->ibss_if_active = true;
282555055976SVasanthakumar Thiagarajan 
282611f6e40dSVasanthakumar Thiagarajan 	spin_lock_bh(&ar->list_lock);
2827990bd915SVasanthakumar Thiagarajan 	list_add_tail(&vif->list, &ar->vif_list);
282811f6e40dSVasanthakumar Thiagarajan 	spin_unlock_bh(&ar->list_lock);
2829990bd915SVasanthakumar Thiagarajan 
28308dafb70eSVasanthakumar Thiagarajan 	return ndev;
28318dafb70eSVasanthakumar Thiagarajan 
28328dafb70eSVasanthakumar Thiagarajan err:
283327929723SVasanthakumar Thiagarajan 	aggr_module_destroy(vif->aggr_cntxt);
283427929723SVasanthakumar Thiagarajan 	free_netdev(ndev);
2835bdcd8170SKalle Valo 	return NULL;
2836bdcd8170SKalle Valo }
2837bdcd8170SKalle Valo 
28388dafb70eSVasanthakumar Thiagarajan void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar)
2839bdcd8170SKalle Valo {
2840be98e3a4SVasanthakumar Thiagarajan 	wiphy_unregister(ar->wiphy);
2841be98e3a4SVasanthakumar Thiagarajan 	wiphy_free(ar->wiphy);
2842bdcd8170SKalle Valo }
2843