cfg80211.c 54.6 KB
Newer Older
K
Kalle Valo 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
/*
 * Copyright (c) 2004-2011 Atheros Communications Inc.
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include "core.h"
#include "cfg80211.h"
#include "debug.h"
K
Kalle Valo 已提交
20
#include "hif-ops.h"
K
Kalle Valo 已提交
21
#include "testmode.h"
K
Kalle Valo 已提交
22

23 24 25 26
static unsigned int ath6kl_p2p;

module_param(ath6kl_p2p, uint, 0644);

K
Kalle Valo 已提交
27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123
#define RATETAB_ENT(_rate, _rateid, _flags) {   \
	.bitrate    = (_rate),                  \
	.flags      = (_flags),                 \
	.hw_value   = (_rateid),                \
}

#define CHAN2G(_channel, _freq, _flags) {   \
	.band           = IEEE80211_BAND_2GHZ,  \
	.hw_value       = (_channel),           \
	.center_freq    = (_freq),              \
	.flags          = (_flags),             \
	.max_antenna_gain   = 0,                \
	.max_power      = 30,                   \
}

#define CHAN5G(_channel, _flags) {		    \
	.band           = IEEE80211_BAND_5GHZ,      \
	.hw_value       = (_channel),               \
	.center_freq    = 5000 + (5 * (_channel)),  \
	.flags          = (_flags),                 \
	.max_antenna_gain   = 0,                    \
	.max_power      = 30,                       \
}

static struct ieee80211_rate ath6kl_rates[] = {
	RATETAB_ENT(10, 0x1, 0),
	RATETAB_ENT(20, 0x2, 0),
	RATETAB_ENT(55, 0x4, 0),
	RATETAB_ENT(110, 0x8, 0),
	RATETAB_ENT(60, 0x10, 0),
	RATETAB_ENT(90, 0x20, 0),
	RATETAB_ENT(120, 0x40, 0),
	RATETAB_ENT(180, 0x80, 0),
	RATETAB_ENT(240, 0x100, 0),
	RATETAB_ENT(360, 0x200, 0),
	RATETAB_ENT(480, 0x400, 0),
	RATETAB_ENT(540, 0x800, 0),
};

#define ath6kl_a_rates     (ath6kl_rates + 4)
#define ath6kl_a_rates_size    8
#define ath6kl_g_rates     (ath6kl_rates + 0)
#define ath6kl_g_rates_size    12

static struct ieee80211_channel ath6kl_2ghz_channels[] = {
	CHAN2G(1, 2412, 0),
	CHAN2G(2, 2417, 0),
	CHAN2G(3, 2422, 0),
	CHAN2G(4, 2427, 0),
	CHAN2G(5, 2432, 0),
	CHAN2G(6, 2437, 0),
	CHAN2G(7, 2442, 0),
	CHAN2G(8, 2447, 0),
	CHAN2G(9, 2452, 0),
	CHAN2G(10, 2457, 0),
	CHAN2G(11, 2462, 0),
	CHAN2G(12, 2467, 0),
	CHAN2G(13, 2472, 0),
	CHAN2G(14, 2484, 0),
};

static struct ieee80211_channel ath6kl_5ghz_a_channels[] = {
	CHAN5G(34, 0), CHAN5G(36, 0),
	CHAN5G(38, 0), CHAN5G(40, 0),
	CHAN5G(42, 0), CHAN5G(44, 0),
	CHAN5G(46, 0), CHAN5G(48, 0),
	CHAN5G(52, 0), CHAN5G(56, 0),
	CHAN5G(60, 0), CHAN5G(64, 0),
	CHAN5G(100, 0), CHAN5G(104, 0),
	CHAN5G(108, 0), CHAN5G(112, 0),
	CHAN5G(116, 0), CHAN5G(120, 0),
	CHAN5G(124, 0), CHAN5G(128, 0),
	CHAN5G(132, 0), CHAN5G(136, 0),
	CHAN5G(140, 0), CHAN5G(149, 0),
	CHAN5G(153, 0), CHAN5G(157, 0),
	CHAN5G(161, 0), CHAN5G(165, 0),
	CHAN5G(184, 0), CHAN5G(188, 0),
	CHAN5G(192, 0), CHAN5G(196, 0),
	CHAN5G(200, 0), CHAN5G(204, 0),
	CHAN5G(208, 0), CHAN5G(212, 0),
	CHAN5G(216, 0),
};

static struct ieee80211_supported_band ath6kl_band_2ghz = {
	.n_channels = ARRAY_SIZE(ath6kl_2ghz_channels),
	.channels = ath6kl_2ghz_channels,
	.n_bitrates = ath6kl_g_rates_size,
	.bitrates = ath6kl_g_rates,
};

static struct ieee80211_supported_band ath6kl_band_5ghz = {
	.n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels),
	.channels = ath6kl_5ghz_a_channels,
	.n_bitrates = ath6kl_a_rates_size,
	.bitrates = ath6kl_a_rates,
};

124 125
#define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */

126
static int ath6kl_set_wpa_version(struct ath6kl_vif *vif,
K
Kalle Valo 已提交
127 128 129 130 131
				  enum nl80211_wpa_versions wpa_version)
{
	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version);

	if (!wpa_version) {
132
		vif->auth_mode = NONE_AUTH;
K
Kalle Valo 已提交
133
	} else if (wpa_version & NL80211_WPA_VERSION_2) {
134
		vif->auth_mode = WPA2_AUTH;
K
Kalle Valo 已提交
135
	} else if (wpa_version & NL80211_WPA_VERSION_1) {
136
		vif->auth_mode = WPA_AUTH;
K
Kalle Valo 已提交
137 138 139 140 141 142 143 144
	} else {
		ath6kl_err("%s: %u not supported\n", __func__, wpa_version);
		return -ENOTSUPP;
	}

	return 0;
}

145
static int ath6kl_set_auth_type(struct ath6kl_vif *vif,
K
Kalle Valo 已提交
146 147 148 149 150 151
				enum nl80211_auth_type auth_type)
{
	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type);

	switch (auth_type) {
	case NL80211_AUTHTYPE_OPEN_SYSTEM:
152
		vif->dot11_auth_mode = OPEN_AUTH;
K
Kalle Valo 已提交
153 154
		break;
	case NL80211_AUTHTYPE_SHARED_KEY:
155
		vif->dot11_auth_mode = SHARED_AUTH;
K
Kalle Valo 已提交
156 157
		break;
	case NL80211_AUTHTYPE_NETWORK_EAP:
158
		vif->dot11_auth_mode = LEAP_AUTH;
K
Kalle Valo 已提交
159 160 161
		break;

	case NL80211_AUTHTYPE_AUTOMATIC:
162
		vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH;
K
Kalle Valo 已提交
163 164 165 166 167 168 169 170 171 172
		break;

	default:
		ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type);
		return -ENOTSUPP;
	}

	return 0;
}

173
static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast)
K
Kalle Valo 已提交
174
{
175 176 177
	u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto;
	u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len :
		&vif->grp_crypto_len;
K
Kalle Valo 已提交
178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n",
		   __func__, cipher, ucast);

	switch (cipher) {
	case 0:
		/* our own hack to use value 0 as no crypto used */
		*ar_cipher = NONE_CRYPT;
		*ar_cipher_len = 0;
		break;
	case WLAN_CIPHER_SUITE_WEP40:
		*ar_cipher = WEP_CRYPT;
		*ar_cipher_len = 5;
		break;
	case WLAN_CIPHER_SUITE_WEP104:
		*ar_cipher = WEP_CRYPT;
		*ar_cipher_len = 13;
		break;
	case WLAN_CIPHER_SUITE_TKIP:
		*ar_cipher = TKIP_CRYPT;
		*ar_cipher_len = 0;
		break;
	case WLAN_CIPHER_SUITE_CCMP:
		*ar_cipher = AES_CRYPT;
		*ar_cipher_len = 0;
		break;
	default:
		ath6kl_err("cipher 0x%x not supported\n", cipher);
		return -ENOTSUPP;
	}

	return 0;
}

212
static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt)
K
Kalle Valo 已提交
213 214 215 216
{
	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt);

	if (key_mgmt == WLAN_AKM_SUITE_PSK) {
217 218 219 220
		if (vif->auth_mode == WPA_AUTH)
			vif->auth_mode = WPA_PSK_AUTH;
		else if (vif->auth_mode == WPA2_AUTH)
			vif->auth_mode = WPA2_PSK_AUTH;
221
	} else if (key_mgmt == 0x00409600) {
222 223 224 225
		if (vif->auth_mode == WPA_AUTH)
			vif->auth_mode = WPA_AUTH_CCKM;
		else if (vif->auth_mode == WPA2_AUTH)
			vif->auth_mode = WPA2_AUTH_CCKM;
K
Kalle Valo 已提交
226
	} else if (key_mgmt != WLAN_AKM_SUITE_8021X) {
227
		vif->auth_mode = NONE_AUTH;
K
Kalle Valo 已提交
228 229 230 231 232
	}
}

static bool ath6kl_cfg80211_ready(struct ath6kl *ar)
{
233 234
	struct ath6kl_vif *vif = ar->vif;

K
Kalle Valo 已提交
235 236 237 238 239
	if (!test_bit(WMI_READY, &ar->flag)) {
		ath6kl_err("wmi is not ready\n");
		return false;
	}

240
	if (!test_bit(WLAN_ENABLED, &vif->flags)) {
K
Kalle Valo 已提交
241 242 243 244 245 246 247
		ath6kl_err("wlan disabled\n");
		return false;
	}

	return true;
}

248 249 250 251 252 253 254 255 256 257 258 259
static bool ath6kl_is_wpa_ie(const u8 *pos)
{
	return pos[0] == WLAN_EID_WPA && pos[1] >= 4 &&
		pos[2] == 0x00 && pos[3] == 0x50 &&
		pos[4] == 0xf2 && pos[5] == 0x01;
}

static bool ath6kl_is_rsn_ie(const u8 *pos)
{
	return pos[0] == WLAN_EID_RSN;
}

260 261
static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies,
				    size_t ies_len)
262
{
263
	struct ath6kl *ar = vif->ar;
264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289
	const u8 *pos;
	u8 *buf = NULL;
	size_t len = 0;
	int ret;

	/*
	 * Filter out RSN/WPA IE(s)
	 */

	if (ies && ies_len) {
		buf = kmalloc(ies_len, GFP_KERNEL);
		if (buf == NULL)
			return -ENOMEM;
		pos = ies;

		while (pos + 1 < ies + ies_len) {
			if (pos + 2 + pos[1] > ies + ies_len)
				break;
			if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) {
				memcpy(buf + len, pos, 2 + pos[1]);
				len += 2 + pos[1];
			}
			pos += 2 + pos[1];
		}
	}

290 291
	ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
				       WMI_FRAME_ASSOC_REQ, buf, len);
292 293 294 295
	kfree(buf);
	return ret;
}

K
Kalle Valo 已提交
296 297 298 299
static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev,
				   struct cfg80211_connect_params *sme)
{
	struct ath6kl *ar = ath6kl_priv(dev);
300
	struct ath6kl_vif *vif = netdev_priv(dev);
K
Kalle Valo 已提交
301 302
	int status;

303
	vif->sme_state = SME_CONNECTING;
K
Kalle Valo 已提交
304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
		ath6kl_err("destroy in progress\n");
		return -EBUSY;
	}

	if (test_bit(SKIP_SCAN, &ar->flag) &&
	    ((sme->channel && sme->channel->center_freq == 0) ||
	     (sme->bssid && is_zero_ether_addr(sme->bssid)))) {
		ath6kl_err("SkipScan: channel or bssid invalid\n");
		return -EINVAL;
	}

	if (down_interruptible(&ar->sem)) {
		ath6kl_err("busy, couldn't get access\n");
		return -ERESTARTSYS;
	}

	if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
		ath6kl_err("busy, destroy in progress\n");
		up(&ar->sem);
		return -EBUSY;
	}

	if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) {
		/*
		 * sleep until the command queue drains
		 */
		wait_event_interruptible_timeout(ar->event_wq,
			ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0,
			WMI_TIMEOUT);
		if (signal_pending(current)) {
			ath6kl_err("cmd queue drain timeout\n");
			up(&ar->sem);
			return -EINTR;
		}
	}

345
	if (sme->ie && (sme->ie_len > 0)) {
346
		status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len);
347 348 349 350
		if (status)
			return status;
	}

351
	if (test_bit(CONNECTED, &vif->flags) &&
352 353
	    vif->ssid_len == sme->ssid_len &&
	    !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) {
354
		vif->reconnect_flag = true;
355 356
		status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx,
						  vif->req_bssid,
357
						  vif->ch_hint);
K
Kalle Valo 已提交
358 359 360 361 362 363 364

		up(&ar->sem);
		if (status) {
			ath6kl_err("wmi_reconnect_cmd failed\n");
			return -EIO;
		}
		return 0;
365 366
	} else if (vif->ssid_len == sme->ssid_len &&
		   !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) {
367
		ath6kl_disconnect(vif);
K
Kalle Valo 已提交
368 369
	}

370 371 372
	memset(vif->ssid, 0, sizeof(vif->ssid));
	vif->ssid_len = sme->ssid_len;
	memcpy(vif->ssid, sme->ssid, sme->ssid_len);
K
Kalle Valo 已提交
373 374

	if (sme->channel)
375
		vif->ch_hint = sme->channel->center_freq;
K
Kalle Valo 已提交
376

377
	memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
K
Kalle Valo 已提交
378
	if (sme->bssid && !is_broadcast_ether_addr(sme->bssid))
379
		memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid));
K
Kalle Valo 已提交
380

381
	ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions);
K
Kalle Valo 已提交
382

383
	status = ath6kl_set_auth_type(vif, sme->auth_type);
K
Kalle Valo 已提交
384 385 386 387 388 389
	if (status) {
		up(&ar->sem);
		return status;
	}

	if (sme->crypto.n_ciphers_pairwise)
390
		ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true);
K
Kalle Valo 已提交
391
	else
392
		ath6kl_set_cipher(vif, 0, true);
K
Kalle Valo 已提交
393

394
	ath6kl_set_cipher(vif, sme->crypto.cipher_group, false);
K
Kalle Valo 已提交
395 396

	if (sme->crypto.n_akm_suites)
397
		ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]);
K
Kalle Valo 已提交
398 399

	if ((sme->key_len) &&
400 401
	    (vif->auth_mode == NONE_AUTH) &&
	    (vif->prwise_crypto == WEP_CRYPT)) {
K
Kalle Valo 已提交
402 403 404 405 406 407 408 409 410 411
		struct ath6kl_key *key = NULL;

		if (sme->key_idx < WMI_MIN_KEY_INDEX ||
		    sme->key_idx > WMI_MAX_KEY_INDEX) {
			ath6kl_err("key index %d out of bounds\n",
				   sme->key_idx);
			up(&ar->sem);
			return -ENOENT;
		}

412
		key = &vif->keys[sme->key_idx];
K
Kalle Valo 已提交
413 414
		key->key_len = sme->key_len;
		memcpy(key->key, sme->key, key->key_len);
415 416
		key->cipher = vif->prwise_crypto;
		vif->def_txkey_index = sme->key_idx;
K
Kalle Valo 已提交
417

418
		ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx,
419
				      vif->prwise_crypto,
K
Kalle Valo 已提交
420 421 422 423 424 425 426 427
				      GROUP_USAGE | TX_USAGE,
				      key->key_len,
				      NULL,
				      key->key, KEY_OP_INIT_VAL, NULL,
				      NO_SYNC_WMIFLAG);
	}

	if (!ar->usr_bss_filter) {
428
		clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
429 430
		if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
		    ALL_BSS_FILTER, 0) != 0) {
K
Kalle Valo 已提交
431 432 433 434 435 436
			ath6kl_err("couldn't set bss filtering\n");
			up(&ar->sem);
			return -EIO;
		}
	}

437
	vif->nw_type = vif->next_mode;
K
Kalle Valo 已提交
438 439 440 441 442 443

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
		   "%s: connect called with authmode %d dot11 auth %d"
		   " PW crypto %d PW crypto len %d GRP crypto %d"
		   " GRP crypto len %d channel hint %u\n",
		   __func__,
444 445
		   vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto,
		   vif->prwise_crypto_len, vif->grp_crypto,
446
		   vif->grp_crypto_len, vif->ch_hint);
K
Kalle Valo 已提交
447

448
	vif->reconnect_flag = 0;
449
	status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type,
450 451 452 453 454
					vif->dot11_auth_mode, vif->auth_mode,
					vif->prwise_crypto,
					vif->prwise_crypto_len,
					vif->grp_crypto, vif->grp_crypto_len,
					vif->ssid_len, vif->ssid,
455
					vif->req_bssid, vif->ch_hint,
K
Kalle Valo 已提交
456 457 458 459 460
					ar->connect_ctrl_flags);

	up(&ar->sem);

	if (status == -EINVAL) {
461 462
		memset(vif->ssid, 0, sizeof(vif->ssid));
		vif->ssid_len = 0;
K
Kalle Valo 已提交
463 464 465 466 467 468 469 470
		ath6kl_err("invalid request\n");
		return -ENOENT;
	} else if (status) {
		ath6kl_err("ath6kl_wmi_connect_cmd failed\n");
		return -EIO;
	}

	if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) &&
471 472
	    ((vif->auth_mode == WPA_PSK_AUTH)
	     || (vif->auth_mode == WPA2_PSK_AUTH))) {
473
		mod_timer(&vif->disconnect_timer,
K
Kalle Valo 已提交
474 475 476 477
			  jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL));
	}

	ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD;
478
	set_bit(CONNECT_PEND, &vif->flags);
K
Kalle Valo 已提交
479 480 481 482

	return 0;
}

483
static int ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, const u8 *bssid,
484 485 486
				    struct ieee80211_channel *chan,
				    const u8 *beacon_ie, size_t beacon_ie_len)
{
487
	struct ath6kl *ar = vif->ar;
488 489 490
	struct cfg80211_bss *bss;
	u8 *ie;

491
	bss = cfg80211_get_bss(ar->wiphy, chan, bssid,
492
			       vif->ssid, vif->ssid_len, WLAN_CAPABILITY_ESS,
493 494 495 496 497 498 499 500 501 502
			       WLAN_CAPABILITY_ESS);
	if (bss == NULL) {
		/*
		 * Since cfg80211 may not yet know about the BSS,
		 * generate a partial entry until the first BSS info
		 * event becomes available.
		 *
		 * Prepend SSID element since it is not included in the Beacon
		 * IEs from the target.
		 */
503
		ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL);
504 505 506
		if (ie == NULL)
			return -ENOMEM;
		ie[0] = WLAN_EID_SSID;
507 508 509
		ie[1] = vif->ssid_len;
		memcpy(ie + 2, vif->ssid, vif->ssid_len);
		memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len);
510
		bss = cfg80211_inform_bss(ar->wiphy, chan,
511
					  bssid, 0, WLAN_CAPABILITY_ESS, 100,
512
					  ie, 2 + vif->ssid_len + beacon_ie_len,
513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530
					  0, GFP_KERNEL);
		if (bss)
			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added dummy bss for "
				   "%pM prior to indicating connect/roamed "
				   "event\n", bssid);
		kfree(ie);
	} else
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss "
			   "entry\n");

	if (bss == NULL)
		return -ENOMEM;

	cfg80211_put_bss(bss);

	return 0;
}

531
void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel,
K
Kalle Valo 已提交
532 533 534 535 536 537
				   u8 *bssid, u16 listen_intvl,
				   u16 beacon_intvl,
				   enum network_type nw_type,
				   u8 beacon_ie_len, u8 assoc_req_len,
				   u8 assoc_resp_len, u8 *assoc_info)
{
538
	struct ieee80211_channel *chan;
539
	struct ath6kl *ar = vif->ar;
K
Kalle Valo 已提交
540 541 542 543 544 545 546 547 548 549 550 551 552 553

	/* capinfo + listen interval */
	u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16);

	/* capinfo + status code +  associd */
	u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16);

	u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset;
	u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len +
	    assoc_resp_ie_offset;

	assoc_req_len -= assoc_req_ie_offset;
	assoc_resp_len -= assoc_resp_ie_offset;

554 555 556 557
	/*
	 * Store Beacon interval here; DTIM period will be available only once
	 * a Beacon frame from the AP is seen.
	 */
558
	vif->assoc_bss_beacon_int = beacon_intvl;
559
	clear_bit(DTIM_PERIOD_AVAIL, &vif->flags);
560

K
Kalle Valo 已提交
561 562 563 564 565 566 567 568 569
	if (nw_type & ADHOC_NETWORK) {
		if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) {
			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
				   "%s: ath6k not in ibss mode\n", __func__);
			return;
		}
	}

	if (nw_type & INFRA_NETWORK) {
570 571
		if (ar->wdev->iftype != NL80211_IFTYPE_STATION &&
		    ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) {
K
Kalle Valo 已提交
572 573 574 575 576 577
			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
				   "%s: ath6k not in station mode\n", __func__);
			return;
		}
	}

578
	chan = ieee80211_get_channel(ar->wiphy, (int) channel);
K
Kalle Valo 已提交
579 580


581
	if (nw_type & ADHOC_NETWORK) {
582
		cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL);
K
Kalle Valo 已提交
583 584 585
		return;
	}

586
	if (ath6kl_add_bss_if_needed(vif, bssid, chan, assoc_info,
587 588 589
				     beacon_ie_len) < 0) {
		ath6kl_err("could not add cfg80211 bss entry for "
			   "connect/roamed notification\n");
K
Kalle Valo 已提交
590 591 592
		return;
	}

593
	if (vif->sme_state == SME_CONNECTING) {
K
Kalle Valo 已提交
594
		/* inform connect result to cfg80211 */
595
		vif->sme_state = SME_CONNECTED;
596
		cfg80211_connect_result(vif->ndev, bssid,
K
Kalle Valo 已提交
597 598 599
					assoc_req_ie, assoc_req_len,
					assoc_resp_ie, assoc_resp_len,
					WLAN_STATUS_SUCCESS, GFP_KERNEL);
600
	} else if (vif->sme_state == SME_CONNECTED) {
K
Kalle Valo 已提交
601
		/* inform roam event to cfg80211 */
602
		cfg80211_roamed(vif->ndev, chan, bssid,
K
Kalle Valo 已提交
603 604 605 606 607 608 609 610 611
				assoc_req_ie, assoc_req_len,
				assoc_resp_ie, assoc_resp_len, GFP_KERNEL);
	}
}

static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy,
				      struct net_device *dev, u16 reason_code)
{
	struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev);
612
	struct ath6kl_vif *vif = netdev_priv(dev);
K
Kalle Valo 已提交
613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__,
		   reason_code);

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
		ath6kl_err("busy, destroy in progress\n");
		return -EBUSY;
	}

	if (down_interruptible(&ar->sem)) {
		ath6kl_err("busy, couldn't get access\n");
		return -ERESTARTSYS;
	}

630
	vif->reconnect_flag = 0;
631
	ath6kl_disconnect(vif);
632 633
	memset(vif->ssid, 0, sizeof(vif->ssid));
	vif->ssid_len = 0;
K
Kalle Valo 已提交
634 635

	if (!test_bit(SKIP_SCAN, &ar->flag))
636
		memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
K
Kalle Valo 已提交
637 638 639

	up(&ar->sem);

640
	vif->sme_state = SME_DISCONNECTED;
641

K
Kalle Valo 已提交
642 643 644
	return 0;
}

645
void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason,
K
Kalle Valo 已提交
646 647 648
				      u8 *bssid, u8 assoc_resp_len,
				      u8 *assoc_info, u16 proto_reason)
{
649
	struct ath6kl *ar = vif->ar;
650

651 652 653
	if (vif->scan_req) {
		cfg80211_scan_done(vif->scan_req, true);
		vif->scan_req = NULL;
K
Kalle Valo 已提交
654 655
	}

656
	if (vif->nw_type & ADHOC_NETWORK) {
K
Kalle Valo 已提交
657 658 659 660 661 662
		if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) {
			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
				   "%s: ath6k not in ibss mode\n", __func__);
			return;
		}
		memset(bssid, 0, ETH_ALEN);
663
		cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL);
K
Kalle Valo 已提交
664 665 666
		return;
	}

667
	if (vif->nw_type & INFRA_NETWORK) {
668 669
		if (ar->wdev->iftype != NL80211_IFTYPE_STATION &&
		    ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) {
K
Kalle Valo 已提交
670 671 672 673 674 675
			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
				   "%s: ath6k not in station mode\n", __func__);
			return;
		}
	}

676 677 678 679 680 681 682 683
	/*
	 * Send a disconnect command to target when a disconnect event is
	 * received with reason code other than 3 (DISCONNECT_CMD - disconnect
	 * request from host) to make the firmware stop trying to connect even
	 * after giving disconnect event. There will be one more disconnect
	 * event for this disconnect command with reason code DISCONNECT_CMD
	 * which will be notified to cfg80211.
	 */
K
Kalle Valo 已提交
684

685
	if (reason != DISCONNECT_CMD) {
686
		ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx);
K
Kalle Valo 已提交
687 688 689
		return;
	}

690
	clear_bit(CONNECT_PEND, &vif->flags);
K
Kalle Valo 已提交
691

692
	if (vif->sme_state == SME_CONNECTING) {
693
		cfg80211_connect_result(vif->ndev,
694 695 696 697
				bssid, NULL, 0,
				NULL, 0,
				WLAN_STATUS_UNSPECIFIED_FAILURE,
				GFP_KERNEL);
698
	} else if (vif->sme_state == SME_CONNECTED) {
699
		cfg80211_disconnected(vif->ndev, reason,
700
				NULL, 0, GFP_KERNEL);
K
Kalle Valo 已提交
701 702
	}

703
	vif->sme_state = SME_DISCONNECTED;
K
Kalle Valo 已提交
704 705 706 707 708 709
}

static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev,
				struct cfg80211_scan_request *request)
{
	struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev);
710
	struct ath6kl_vif *vif = netdev_priv(ndev);
711 712
	s8 n_channels = 0;
	u16 *channels = NULL;
K
Kalle Valo 已提交
713
	int ret = 0;
714
	u32 force_fg_scan = 0;
K
Kalle Valo 已提交
715 716 717 718 719

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	if (!ar->usr_bss_filter) {
720
		clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
721
		ret = ath6kl_wmi_bssfilter_cmd(
722
			ar->wmi, vif->fw_vif_idx,
723
			(test_bit(CONNECTED, &vif->flags) ?
724 725
			 ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0);
		if (ret) {
K
Kalle Valo 已提交
726
			ath6kl_err("couldn't set bss filtering\n");
727
			return ret;
K
Kalle Valo 已提交
728 729 730 731 732 733 734 735 736 737
		}
	}

	if (request->n_ssids && request->ssids[0].ssid_len) {
		u8 i;

		if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1))
			request->n_ssids = MAX_PROBED_SSID_INDEX - 1;

		for (i = 0; i < request->n_ssids; i++)
738 739
			ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
						  i + 1, SPECIFIC_SSID_FLAG,
K
Kalle Valo 已提交
740 741 742 743
						  request->ssids[i].ssid_len,
						  request->ssids[i].ssid);
	}

744
	if (request->ie) {
745 746
		ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
					       WMI_FRAME_PROBE_REQ,
747 748 749 750 751 752 753 754
					       request->ie, request->ie_len);
		if (ret) {
			ath6kl_err("failed to set Probe Request appie for "
				   "scan");
			return ret;
		}
	}

755 756 757 758 759 760 761
	/*
	 * Scan only the requested channels if the request specifies a set of
	 * channels. If the list is longer than the target supports, do not
	 * configure the list and instead, scan all available channels.
	 */
	if (request->n_channels > 0 &&
	    request->n_channels <= WMI_MAX_CHANNELS) {
762 763
		u8 i;

764
		n_channels = request->n_channels;
765 766 767 768 769 770 771 772 773 774 775 776

		channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL);
		if (channels == NULL) {
			ath6kl_warn("failed to set scan channels, "
				    "scan all channels");
			n_channels = 0;
		}

		for (i = 0; i < n_channels; i++)
			channels[i] = request->channels[i]->center_freq;
	}

777
	if (test_bit(CONNECTED, &vif->flags))
778 779
		force_fg_scan = 1;

780 781 782
	ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, WMI_LONG_SCAN,
				       force_fg_scan, false, 0, 0, n_channels,
				       channels);
783
	if (ret)
K
Kalle Valo 已提交
784
		ath6kl_err("wmi_startscan_cmd failed\n");
785
	else
786
		vif->scan_req = request;
K
Kalle Valo 已提交
787

788 789
	kfree(channels);

K
Kalle Valo 已提交
790 791 792
	return ret;
}

793
void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, int status)
K
Kalle Valo 已提交
794
{
795
	struct ath6kl *ar = vif->ar;
796
	int i;
K
Kalle Valo 已提交
797 798 799

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status %d\n", __func__, status);

800
	if (!vif->scan_req)
801 802 803
		return;

	if ((status == -ECANCELED) || (status == -EBUSY)) {
804
		cfg80211_scan_done(vif->scan_req, true);
805 806 807
		goto out;
	}

808
	cfg80211_scan_done(vif->scan_req, false);
809

810 811
	if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) {
		for (i = 0; i < vif->scan_req->n_ssids; i++) {
812 813
			ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx,
						  i + 1, DISABLE_SSID_FLAG,
814
						  0, NULL);
K
Kalle Valo 已提交
815 816
		}
	}
817 818

out:
819
	vif->scan_req = NULL;
K
Kalle Valo 已提交
820 821 822 823 824 825 826 827
}

static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev,
				   u8 key_index, bool pairwise,
				   const u8 *mac_addr,
				   struct key_params *params)
{
	struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev);
828
	struct ath6kl_vif *vif = netdev_priv(ndev);
K
Kalle Valo 已提交
829 830 831 832 833 834 835 836
	struct ath6kl_key *key = NULL;
	u8 key_usage;
	u8 key_type;
	int status = 0;

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

837 838 839
	if (params->cipher == CCKM_KRK_CIPHER_SUITE) {
		if (params->key_len != WMI_KRK_LEN)
			return -EINVAL;
840 841
		return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx,
					      params->key);
842 843
	}

K
Kalle Valo 已提交
844 845 846 847 848 849 850
	if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
			   "%s: key index %d out of bounds\n", __func__,
			   key_index);
		return -ENOENT;
	}

851
	key = &vif->keys[key_index];
K
Kalle Valo 已提交
852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888
	memset(key, 0, sizeof(struct ath6kl_key));

	if (pairwise)
		key_usage = PAIRWISE_USAGE;
	else
		key_usage = GROUP_USAGE;

	if (params) {
		if (params->key_len > WLAN_MAX_KEY_LEN ||
		    params->seq_len > sizeof(key->seq))
			return -EINVAL;

		key->key_len = params->key_len;
		memcpy(key->key, params->key, key->key_len);
		key->seq_len = params->seq_len;
		memcpy(key->seq, params->seq, key->seq_len);
		key->cipher = params->cipher;
	}

	switch (key->cipher) {
	case WLAN_CIPHER_SUITE_WEP40:
	case WLAN_CIPHER_SUITE_WEP104:
		key_type = WEP_CRYPT;
		break;

	case WLAN_CIPHER_SUITE_TKIP:
		key_type = TKIP_CRYPT;
		break;

	case WLAN_CIPHER_SUITE_CCMP:
		key_type = AES_CRYPT;
		break;

	default:
		return -ENOTSUPP;
	}

889 890
	if (((vif->auth_mode == WPA_PSK_AUTH)
	     || (vif->auth_mode == WPA2_PSK_AUTH))
K
Kalle Valo 已提交
891
	    && (key_usage & GROUP_USAGE))
892
		del_timer(&vif->disconnect_timer);
K
Kalle Valo 已提交
893 894 895 896 897 898

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
		   "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n",
		   __func__, key_index, key->key_len, key_type,
		   key_usage, key->seq_len);

899
	vif->def_txkey_index = key_index;
900

901
	if (vif->nw_type == AP_NETWORK && !pairwise &&
902 903 904 905 906 907
	    (key_type == TKIP_CRYPT || key_type == AES_CRYPT) && params) {
		ar->ap_mode_bkey.valid = true;
		ar->ap_mode_bkey.key_index = key_index;
		ar->ap_mode_bkey.key_type = key_type;
		ar->ap_mode_bkey.key_len = key->key_len;
		memcpy(ar->ap_mode_bkey.key, key->key, key->key_len);
908
		if (!test_bit(CONNECTED, &vif->flags)) {
909 910 911 912 913 914 915 916 917 918 919
			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group "
				   "key configuration until AP mode has been "
				   "started\n");
			/*
			 * The key will be set in ath6kl_connect_ap_mode() once
			 * the connected event is received from the target.
			 */
			return 0;
		}
	}

920
	if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT &&
921
	    !test_bit(CONNECTED, &vif->flags)) {
922 923 924 925 926 927 928
		/*
		 * Store the key locally so that it can be re-configured after
		 * the AP mode has properly started
		 * (ath6kl_install_statioc_wep_keys).
		 */
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration "
			   "until AP mode has been started\n");
929 930 931
		vif->wep_key_list[key_index].key_len = key->key_len;
		memcpy(vif->wep_key_list[key_index].key, key->key,
		       key->key_len);
932 933 934
		return 0;
	}

935 936
	status = ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx,
				       vif->def_txkey_index,
K
Kalle Valo 已提交
937 938 939 940 941 942 943 944 945 946 947 948 949 950 951
				       key_type, key_usage, key->key_len,
				       key->seq, key->key, KEY_OP_INIT_VAL,
				       (u8 *) mac_addr, SYNC_BOTH_WMIFLAG);

	if (status)
		return -EIO;

	return 0;
}

static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev,
				   u8 key_index, bool pairwise,
				   const u8 *mac_addr)
{
	struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev);
952
	struct ath6kl_vif *vif = netdev_priv(ndev);
K
Kalle Valo 已提交
953 954 955 956 957 958 959 960 961 962 963 964 965

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
			   "%s: key index %d out of bounds\n", __func__,
			   key_index);
		return -ENOENT;
	}

966
	if (!vif->keys[key_index].key_len) {
K
Kalle Valo 已提交
967 968 969 970 971
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
			   "%s: index %d is empty\n", __func__, key_index);
		return 0;
	}

972
	vif->keys[key_index].key_len = 0;
K
Kalle Valo 已提交
973

974
	return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index);
K
Kalle Valo 已提交
975 976 977 978 979 980 981 982 983
}

static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev,
				   u8 key_index, bool pairwise,
				   const u8 *mac_addr, void *cookie,
				   void (*callback) (void *cookie,
						     struct key_params *))
{
	struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev);
984
	struct ath6kl_vif *vif = netdev_priv(ndev);
K
Kalle Valo 已提交
985 986 987 988 989 990 991 992 993 994 995 996 997 998 999
	struct ath6kl_key *key = NULL;
	struct key_params params;

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
			   "%s: key index %d out of bounds\n", __func__,
			   key_index);
		return -ENOENT;
	}

1000
	key = &vif->keys[key_index];
K
Kalle Valo 已提交
1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018
	memset(&params, 0, sizeof(params));
	params.cipher = key->cipher;
	params.key_len = key->key_len;
	params.seq_len = key->seq_len;
	params.seq = key->seq;
	params.key = key->key;

	callback(cookie, &params);

	return key->key_len ? 0 : -ENOENT;
}

static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy,
					   struct net_device *ndev,
					   u8 key_index, bool unicast,
					   bool multicast)
{
	struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev);
1019
	struct ath6kl_vif *vif = netdev_priv(ndev);
K
Kalle Valo 已提交
1020 1021 1022
	struct ath6kl_key *key = NULL;
	int status = 0;
	u8 key_usage;
1023
	enum crypto_type key_type = NONE_CRYPT;
K
Kalle Valo 已提交
1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index);

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) {
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
			   "%s: key index %d out of bounds\n",
			   __func__, key_index);
		return -ENOENT;
	}

1037
	if (!vif->keys[key_index].key_len) {
K
Kalle Valo 已提交
1038 1039 1040 1041 1042
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n",
			   __func__, key_index);
		return -EINVAL;
	}

1043
	vif->def_txkey_index = key_index;
1044
	key = &vif->keys[vif->def_txkey_index];
K
Kalle Valo 已提交
1045
	key_usage = GROUP_USAGE;
1046
	if (vif->prwise_crypto == WEP_CRYPT)
K
Kalle Valo 已提交
1047
		key_usage |= TX_USAGE;
1048
	if (unicast)
1049
		key_type = vif->prwise_crypto;
1050
	if (multicast)
1051
		key_type = vif->grp_crypto;
K
Kalle Valo 已提交
1052

1053
	if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags))
1054 1055
		return 0; /* Delay until AP mode has been started */

1056 1057
	status = ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx,
				       vif->def_txkey_index,
1058
				       key_type, key_usage,
K
Kalle Valo 已提交
1059 1060 1061 1062 1063 1064 1065 1066 1067
				       key->key_len, key->seq, key->key,
				       KEY_OP_INIT_VAL, NULL,
				       SYNC_BOTH_WMIFLAG);
	if (status)
		return -EIO;

	return 0;
}

1068
void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid,
K
Kalle Valo 已提交
1069 1070 1071 1072 1073
				       bool ismcast)
{
	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
		   "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast);

1074
	cfg80211_michael_mic_failure(vif->ndev, vif->bssid,
K
Kalle Valo 已提交
1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138
				     (ismcast ? NL80211_KEYTYPE_GROUP :
				      NL80211_KEYTYPE_PAIRWISE), keyid, NULL,
				     GFP_KERNEL);
}

static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
{
	struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
	int ret;

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__,
		   changed);

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
		ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold);
		if (ret != 0) {
			ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n");
			return -EIO;
		}
	}

	return 0;
}

/*
 * The type nl80211_tx_power_setting replaces the following
 * data type from 2.6.36 onwards
*/
static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy,
				       enum nl80211_tx_power_setting type,
				       int dbm)
{
	struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
	u8 ath6kl_dbm;

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__,
		   type, dbm);

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	switch (type) {
	case NL80211_TX_POWER_AUTOMATIC:
		return 0;
	case NL80211_TX_POWER_LIMITED:
		ar->tx_pwr = ath6kl_dbm = dbm;
		break;
	default:
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n",
			   __func__, type);
		return -EOPNOTSUPP;
	}

	ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, ath6kl_dbm);

	return 0;
}

static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm)
{
	struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy);
1139
	struct ath6kl_vif *vif = ar->vif;
K
Kalle Valo 已提交
1140 1141 1142 1143

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

1144
	if (test_bit(CONNECTED, &vif->flags)) {
K
Kalle Valo 已提交
1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170
		ar->tx_pwr = 0;

		if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi) != 0) {
			ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n");
			return -EIO;
		}

		wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0,
						 5 * HZ);

		if (signal_pending(current)) {
			ath6kl_err("target did not respond\n");
			return -EINTR;
		}
	}

	*dbm = ar->tx_pwr;
	return 0;
}

static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy,
					  struct net_device *dev,
					  bool pmgmt, int timeout)
{
	struct ath6kl *ar = ath6kl_priv(dev);
	struct wmi_power_mode_cmd mode;
1171
	struct ath6kl_vif *vif = netdev_priv(dev);
K
Kalle Valo 已提交
1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n",
		   __func__, pmgmt, timeout);

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	if (pmgmt) {
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__);
		mode.pwr_mode = REC_POWER;
	} else {
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__);
		mode.pwr_mode = MAX_PERF_POWER;
	}

1187 1188
	if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx,
	     mode.pwr_mode) != 0) {
K
Kalle Valo 已提交
1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202
		ath6kl_err("wmi_powermode_cmd failed\n");
		return -EIO;
	}

	return 0;
}

static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy,
					struct net_device *ndev,
					enum nl80211_iftype type, u32 *flags,
					struct vif_params *params)
{
	struct ath6kl *ar = ath6kl_priv(ndev);
	struct wireless_dev *wdev = ar->wdev;
1203
	struct ath6kl_vif *vif = netdev_priv(ndev);
K
Kalle Valo 已提交
1204 1205 1206 1207 1208 1209 1210 1211

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type);

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	switch (type) {
	case NL80211_IFTYPE_STATION:
1212
		vif->next_mode = INFRA_NETWORK;
K
Kalle Valo 已提交
1213 1214
		break;
	case NL80211_IFTYPE_ADHOC:
1215
		vif->next_mode = ADHOC_NETWORK;
K
Kalle Valo 已提交
1216
		break;
1217
	case NL80211_IFTYPE_AP:
1218
		vif->next_mode = AP_NETWORK;
1219
		break;
1220
	case NL80211_IFTYPE_P2P_CLIENT:
1221
		vif->next_mode = INFRA_NETWORK;
1222 1223
		break;
	case NL80211_IFTYPE_P2P_GO:
1224
		vif->next_mode = AP_NETWORK;
1225
		break;
K
Kalle Valo 已提交
1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240
	default:
		ath6kl_err("invalid interface type %u\n", type);
		return -EOPNOTSUPP;
	}

	wdev->iftype = type;

	return 0;
}

static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy,
				     struct net_device *dev,
				     struct cfg80211_ibss_params *ibss_param)
{
	struct ath6kl *ar = ath6kl_priv(dev);
1241
	struct ath6kl_vif *vif = netdev_priv(dev);
K
Kalle Valo 已提交
1242 1243 1244 1245 1246
	int status;

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

1247 1248
	vif->ssid_len = ibss_param->ssid_len;
	memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len);
K
Kalle Valo 已提交
1249 1250

	if (ibss_param->channel)
1251
		vif->ch_hint = ibss_param->channel->center_freq;
K
Kalle Valo 已提交
1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262

	if (ibss_param->channel_fixed) {
		/*
		 * TODO: channel_fixed: The channel should be fixed, do not
		 * search for IBSSs to join on other channels. Target
		 * firmware does not support this feature, needs to be
		 * updated.
		 */
		return -EOPNOTSUPP;
	}

1263
	memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
K
Kalle Valo 已提交
1264
	if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid))
1265 1266
		memcpy(vif->req_bssid, ibss_param->bssid,
		       sizeof(vif->req_bssid));
K
Kalle Valo 已提交
1267

1268
	ath6kl_set_wpa_version(vif, 0);
K
Kalle Valo 已提交
1269

1270
	status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM);
K
Kalle Valo 已提交
1271 1272 1273 1274
	if (status)
		return status;

	if (ibss_param->privacy) {
1275 1276
		ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true);
		ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false);
K
Kalle Valo 已提交
1277
	} else {
1278 1279
		ath6kl_set_cipher(vif, 0, true);
		ath6kl_set_cipher(vif, 0, false);
K
Kalle Valo 已提交
1280 1281
	}

1282
	vif->nw_type = vif->next_mode;
K
Kalle Valo 已提交
1283 1284 1285 1286 1287 1288

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
		   "%s: connect called with authmode %d dot11 auth %d"
		   " PW crypto %d PW crypto len %d GRP crypto %d"
		   " GRP crypto len %d channel hint %u\n",
		   __func__,
1289 1290
		   vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto,
		   vif->prwise_crypto_len, vif->grp_crypto,
1291
		   vif->grp_crypto_len, vif->ch_hint);
K
Kalle Valo 已提交
1292

1293
	status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type,
1294 1295 1296 1297 1298
					vif->dot11_auth_mode, vif->auth_mode,
					vif->prwise_crypto,
					vif->prwise_crypto_len,
					vif->grp_crypto, vif->grp_crypto_len,
					vif->ssid_len, vif->ssid,
1299
					vif->req_bssid, vif->ch_hint,
K
Kalle Valo 已提交
1300
					ar->connect_ctrl_flags);
1301
	set_bit(CONNECT_PEND, &vif->flags);
K
Kalle Valo 已提交
1302 1303 1304 1305 1306 1307 1308 1309

	return 0;
}

static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy,
				      struct net_device *dev)
{
	struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev);
1310
	struct ath6kl_vif *vif = netdev_priv(dev);
K
Kalle Valo 已提交
1311 1312 1313 1314

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

1315
	ath6kl_disconnect(vif);
1316 1317
	memset(vif->ssid, 0, sizeof(vif->ssid));
	vif->ssid_len = 0;
K
Kalle Valo 已提交
1318 1319 1320 1321 1322 1323 1324 1325 1326

	return 0;
}

static const u32 cipher_suites[] = {
	WLAN_CIPHER_SUITE_WEP40,
	WLAN_CIPHER_SUITE_WEP104,
	WLAN_CIPHER_SUITE_TKIP,
	WLAN_CIPHER_SUITE_CCMP,
1327
	CCKM_KRK_CIPHER_SUITE,
K
Kalle Valo 已提交
1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394
};

static bool is_rate_legacy(s32 rate)
{
	static const s32 legacy[] = { 1000, 2000, 5500, 11000,
		6000, 9000, 12000, 18000, 24000,
		36000, 48000, 54000
	};
	u8 i;

	for (i = 0; i < ARRAY_SIZE(legacy); i++)
		if (rate == legacy[i])
			return true;

	return false;
}

static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi)
{
	static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000,
		52000, 58500, 65000, 72200
	};
	u8 i;

	for (i = 0; i < ARRAY_SIZE(ht20); i++) {
		if (rate == ht20[i]) {
			if (i == ARRAY_SIZE(ht20) - 1)
				/* last rate uses sgi */
				*sgi = true;
			else
				*sgi = false;

			*mcs = i;
			return true;
		}
	}
	return false;
}

static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi)
{
	static const s32 ht40[] = { 13500, 27000, 40500, 54000,
		81000, 108000, 121500, 135000,
		150000
	};
	u8 i;

	for (i = 0; i < ARRAY_SIZE(ht40); i++) {
		if (rate == ht40[i]) {
			if (i == ARRAY_SIZE(ht40) - 1)
				/* last rate uses sgi */
				*sgi = true;
			else
				*sgi = false;

			*mcs = i;
			return true;
		}
	}

	return false;
}

static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev,
			      u8 *mac, struct station_info *sinfo)
{
	struct ath6kl *ar = ath6kl_priv(dev);
1395
	struct ath6kl_vif *vif = netdev_priv(dev);
K
Kalle Valo 已提交
1396 1397 1398 1399 1400 1401
	long left;
	bool sgi;
	s32 rate;
	int ret;
	u8 mcs;

1402
	if (memcmp(mac, vif->bssid, ETH_ALEN) != 0)
K
Kalle Valo 已提交
1403 1404 1405 1406 1407
		return -ENOENT;

	if (down_interruptible(&ar->sem))
		return -EBUSY;

1408
	set_bit(STATS_UPDATE_PEND, &vif->flags);
K
Kalle Valo 已提交
1409

1410
	ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx);
K
Kalle Valo 已提交
1411 1412 1413 1414 1415 1416 1417 1418

	if (ret != 0) {
		up(&ar->sem);
		return -EIO;
	}

	left = wait_event_interruptible_timeout(ar->event_wq,
						!test_bit(STATS_UPDATE_PEND,
1419
							  &vif->flags),
K
Kalle Valo 已提交
1420 1421 1422 1423 1424 1425 1426 1427 1428
						WMI_TIMEOUT);

	up(&ar->sem);

	if (left == 0)
		return -ETIMEDOUT;
	else if (left < 0)
		return left;

1429 1430
	if (vif->target_stats.rx_byte) {
		sinfo->rx_bytes = vif->target_stats.rx_byte;
K
Kalle Valo 已提交
1431
		sinfo->filled |= STATION_INFO_RX_BYTES;
1432
		sinfo->rx_packets = vif->target_stats.rx_pkt;
K
Kalle Valo 已提交
1433 1434 1435
		sinfo->filled |= STATION_INFO_RX_PACKETS;
	}

1436 1437
	if (vif->target_stats.tx_byte) {
		sinfo->tx_bytes = vif->target_stats.tx_byte;
K
Kalle Valo 已提交
1438
		sinfo->filled |= STATION_INFO_TX_BYTES;
1439
		sinfo->tx_packets = vif->target_stats.tx_pkt;
K
Kalle Valo 已提交
1440 1441 1442
		sinfo->filled |= STATION_INFO_TX_PACKETS;
	}

1443
	sinfo->signal = vif->target_stats.cs_rssi;
K
Kalle Valo 已提交
1444 1445
	sinfo->filled |= STATION_INFO_SIGNAL;

1446
	rate = vif->target_stats.tx_ucast_rate;
K
Kalle Valo 已提交
1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469

	if (is_rate_legacy(rate)) {
		sinfo->txrate.legacy = rate / 100;
	} else if (is_rate_ht20(rate, &mcs, &sgi)) {
		if (sgi) {
			sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
			sinfo->txrate.mcs = mcs - 1;
		} else {
			sinfo->txrate.mcs = mcs;
		}

		sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
	} else if (is_rate_ht40(rate, &mcs, &sgi)) {
		if (sgi) {
			sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
			sinfo->txrate.mcs = mcs - 1;
		} else {
			sinfo->txrate.mcs = mcs;
		}

		sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH;
		sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
	} else {
1470 1471 1472
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
			   "invalid rate from stats: %d\n", rate);
		ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE);
K
Kalle Valo 已提交
1473 1474 1475 1476 1477
		return 0;
	}

	sinfo->filled |= STATION_INFO_TX_BITRATE;

1478 1479
	if (test_bit(CONNECTED, &vif->flags) &&
	    test_bit(DTIM_PERIOD_AVAIL, &vif->flags) &&
1480
	    vif->nw_type == INFRA_NETWORK) {
1481 1482
		sinfo->filled |= STATION_INFO_BSS_PARAM;
		sinfo->bss_param.flags = 0;
1483 1484
		sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period;
		sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int;
1485 1486
	}

K
Kalle Valo 已提交
1487 1488 1489 1490 1491 1492 1493
	return 0;
}

static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev,
			    struct cfg80211_pmksa *pmksa)
{
	struct ath6kl *ar = ath6kl_priv(netdev);
1494 1495 1496
	struct ath6kl_vif *vif = netdev_priv(netdev);

	return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid,
K
Kalle Valo 已提交
1497 1498 1499 1500 1501 1502 1503
				       pmksa->pmkid, true);
}

static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev,
			    struct cfg80211_pmksa *pmksa)
{
	struct ath6kl *ar = ath6kl_priv(netdev);
1504 1505 1506
	struct ath6kl_vif *vif = netdev_priv(netdev);

	return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid,
K
Kalle Valo 已提交
1507 1508 1509 1510 1511 1512
				       pmksa->pmkid, false);
}

static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev)
{
	struct ath6kl *ar = ath6kl_priv(netdev);
1513 1514 1515
	struct ath6kl_vif *vif = netdev_priv(netdev);

	if (test_bit(CONNECTED, &vif->flags))
1516 1517
		return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx,
					       vif->bssid, NULL, false);
K
Kalle Valo 已提交
1518 1519 1520
	return 0;
}

K
Kalle Valo 已提交
1521 1522 1523 1524 1525 1526 1527 1528
#ifdef CONFIG_PM
static int ar6k_cfg80211_suspend(struct wiphy *wiphy,
				 struct cfg80211_wowlan *wow)
{
	struct ath6kl *ar = wiphy_priv(wiphy);

	return ath6kl_hif_suspend(ar);
}
1529 1530 1531 1532 1533 1534 1535

static int ar6k_cfg80211_resume(struct wiphy *wiphy)
{
	struct ath6kl *ar = wiphy_priv(wiphy);

	return ath6kl_hif_resume(ar);
}
K
Kalle Valo 已提交
1536 1537
#endif

1538 1539 1540 1541 1542
static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev,
			      struct ieee80211_channel *chan,
			      enum nl80211_channel_type channel_type)
{
	struct ath6kl *ar = ath6kl_priv(dev);
1543
	struct ath6kl_vif *vif = netdev_priv(dev);
1544 1545 1546 1547 1548 1549

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n",
		   __func__, chan->center_freq, chan->hw_value);
1550
	vif->next_chan = chan->center_freq;
1551 1552 1553 1554

	return 0;
}

1555 1556 1557 1558 1559 1560 1561
static bool ath6kl_is_p2p_ie(const u8 *pos)
{
	return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
		pos[2] == 0x50 && pos[3] == 0x6f &&
		pos[4] == 0x9a && pos[5] == 0x09;
}

1562 1563
static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif,
					const u8 *ies, size_t ies_len)
1564
{
1565
	struct ath6kl *ar = vif->ar;
1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591
	const u8 *pos;
	u8 *buf = NULL;
	size_t len = 0;
	int ret;

	/*
	 * Filter out P2P IE(s) since they will be included depending on
	 * the Probe Request frame in ath6kl_send_go_probe_resp().
	 */

	if (ies && ies_len) {
		buf = kmalloc(ies_len, GFP_KERNEL);
		if (buf == NULL)
			return -ENOMEM;
		pos = ies;
		while (pos + 1 < ies + ies_len) {
			if (pos + 2 + pos[1] > ies + ies_len)
				break;
			if (!ath6kl_is_p2p_ie(pos)) {
				memcpy(buf + len, pos, 2 + pos[1]);
				len += 2 + pos[1];
			}
			pos += 2 + pos[1];
		}
	}

1592 1593
	ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
				       WMI_FRAME_PROBE_RESP, buf, len);
1594 1595 1596 1597
	kfree(buf);
	return ret;
}

1598 1599 1600 1601
static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev,
			    struct beacon_parameters *info, bool add)
{
	struct ath6kl *ar = ath6kl_priv(dev);
1602
	struct ath6kl_vif *vif = netdev_priv(dev);
1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614
	struct ieee80211_mgmt *mgmt;
	u8 *ies;
	int ies_len;
	struct wmi_connect_cmd p;
	int res;
	int i;

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add);

	if (!ath6kl_cfg80211_ready(ar))
		return -EIO;

1615
	if (vif->next_mode != AP_NETWORK)
1616 1617 1618
		return -EOPNOTSUPP;

	if (info->beacon_ies) {
1619 1620
		res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
					       WMI_FRAME_BEACON,
1621 1622 1623 1624 1625 1626
					       info->beacon_ies,
					       info->beacon_ies_len);
		if (res)
			return res;
	}
	if (info->proberesp_ies) {
1627
		res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies,
1628
						   info->proberesp_ies_len);
1629 1630 1631 1632
		if (res)
			return res;
	}
	if (info->assocresp_ies) {
1633 1634
		res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx,
					       WMI_FRAME_ASSOC_RESP,
1635 1636 1637 1638 1639 1640 1641 1642 1643
					       info->assocresp_ies,
					       info->assocresp_ies_len);
		if (res)
			return res;
	}

	if (!add)
		return 0;

1644 1645
	ar->ap_mode_bkey.valid = false;

1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660
	/* TODO:
	 * info->interval
	 * info->dtim_period
	 */

	if (info->head == NULL)
		return -EINVAL;
	mgmt = (struct ieee80211_mgmt *) info->head;
	ies = mgmt->u.beacon.variable;
	if (ies > info->head + info->head_len)
		return -EINVAL;
	ies_len = info->head + info->head_len - ies;

	if (info->ssid == NULL)
		return -EINVAL;
1661 1662
	memcpy(vif->ssid, info->ssid, info->ssid_len);
	vif->ssid_len = info->ssid_len;
1663 1664 1665
	if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE)
		return -EOPNOTSUPP; /* TODO */

1666
	vif->dot11_auth_mode = OPEN_AUTH;
1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687

	memset(&p, 0, sizeof(p));

	for (i = 0; i < info->crypto.n_akm_suites; i++) {
		switch (info->crypto.akm_suites[i]) {
		case WLAN_AKM_SUITE_8021X:
			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1)
				p.auth_mode |= WPA_AUTH;
			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2)
				p.auth_mode |= WPA2_AUTH;
			break;
		case WLAN_AKM_SUITE_PSK:
			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1)
				p.auth_mode |= WPA_PSK_AUTH;
			if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2)
				p.auth_mode |= WPA2_PSK_AUTH;
			break;
		}
	}
	if (p.auth_mode == 0)
		p.auth_mode = NONE_AUTH;
1688
	vif->auth_mode = p.auth_mode;
1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703

	for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) {
		switch (info->crypto.ciphers_pairwise[i]) {
		case WLAN_CIPHER_SUITE_WEP40:
		case WLAN_CIPHER_SUITE_WEP104:
			p.prwise_crypto_type |= WEP_CRYPT;
			break;
		case WLAN_CIPHER_SUITE_TKIP:
			p.prwise_crypto_type |= TKIP_CRYPT;
			break;
		case WLAN_CIPHER_SUITE_CCMP:
			p.prwise_crypto_type |= AES_CRYPT;
			break;
		}
	}
1704
	if (p.prwise_crypto_type == 0) {
1705
		p.prwise_crypto_type = NONE_CRYPT;
1706
		ath6kl_set_cipher(vif, 0, true);
1707
	} else if (info->crypto.n_ciphers_pairwise == 1)
1708
		ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true);
1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724

	switch (info->crypto.cipher_group) {
	case WLAN_CIPHER_SUITE_WEP40:
	case WLAN_CIPHER_SUITE_WEP104:
		p.grp_crypto_type = WEP_CRYPT;
		break;
	case WLAN_CIPHER_SUITE_TKIP:
		p.grp_crypto_type = TKIP_CRYPT;
		break;
	case WLAN_CIPHER_SUITE_CCMP:
		p.grp_crypto_type = AES_CRYPT;
		break;
	default:
		p.grp_crypto_type = NONE_CRYPT;
		break;
	}
1725
	ath6kl_set_cipher(vif, info->crypto.cipher_group, false);
1726 1727

	p.nw_type = AP_NETWORK;
1728
	vif->nw_type = vif->next_mode;
1729

1730 1731 1732
	p.ssid_len = vif->ssid_len;
	memcpy(p.ssid, vif->ssid, vif->ssid_len);
	p.dot11_auth_mode = vif->dot11_auth_mode;
1733
	p.ch = cpu_to_le16(vif->next_chan);
1734

1735
	res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p);
1736 1737 1738 1739
	if (res < 0)
		return res;

	return 0;
1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756
}

static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev,
			     struct beacon_parameters *info)
{
	return ath6kl_ap_beacon(wiphy, dev, info, true);
}

static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev,
			     struct beacon_parameters *info)
{
	return ath6kl_ap_beacon(wiphy, dev, info, false);
}

static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev)
{
	struct ath6kl *ar = ath6kl_priv(dev);
1757
	struct ath6kl_vif *vif = netdev_priv(dev);
1758

1759
	if (vif->nw_type != AP_NETWORK)
1760
		return -EOPNOTSUPP;
1761
	if (!test_bit(CONNECTED, &vif->flags))
1762 1763
		return -ENOTCONN;

1764
	ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx);
1765
	clear_bit(CONNECTED, &vif->flags);
1766 1767 1768 1769

	return 0;
}

1770 1771 1772 1773
static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev,
				 u8 *mac, struct station_parameters *params)
{
	struct ath6kl *ar = ath6kl_priv(dev);
1774
	struct ath6kl_vif *vif = netdev_priv(dev);
1775

1776
	if (vif->nw_type != AP_NETWORK)
1777 1778 1779 1780 1781 1782 1783
		return -EOPNOTSUPP;

	/* Use this only for authorizing/unauthorizing a station */
	if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
		return -EOPNOTSUPP;

	if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED))
1784 1785 1786 1787
		return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx,
					      WMI_AP_MLME_AUTHORIZE, mac, 0);
	return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx,
				      WMI_AP_MLME_UNAUTHORIZE, mac, 0);
1788 1789
}

1790 1791 1792 1793 1794 1795 1796 1797
static int ath6kl_remain_on_channel(struct wiphy *wiphy,
				    struct net_device *dev,
				    struct ieee80211_channel *chan,
				    enum nl80211_channel_type channel_type,
				    unsigned int duration,
				    u64 *cookie)
{
	struct ath6kl *ar = ath6kl_priv(dev);
1798
	struct ath6kl_vif *vif = netdev_priv(dev);
1799 1800 1801 1802 1803

	/* TODO: if already pending or ongoing remain-on-channel,
	 * return -EBUSY */
	*cookie = 1; /* only a single pending request is supported */

1804 1805
	return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx,
					     chan->center_freq, duration);
1806 1807 1808 1809 1810 1811 1812
}

static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy,
					   struct net_device *dev,
					   u64 cookie)
{
	struct ath6kl *ar = ath6kl_priv(dev);
1813
	struct ath6kl_vif *vif = netdev_priv(dev);
1814 1815 1816 1817

	if (cookie != 1)
		return -ENOENT;

1818
	return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx);
1819 1820
}

1821 1822 1823
static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif,
				     const u8 *buf, size_t len,
				     unsigned int freq)
1824
{
1825
	struct ath6kl *ar = vif->ar;
1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851
	const u8 *pos;
	u8 *p2p;
	int p2p_len;
	int ret;
	const struct ieee80211_mgmt *mgmt;

	mgmt = (const struct ieee80211_mgmt *) buf;

	/* Include P2P IE(s) from the frame generated in user space. */

	p2p = kmalloc(len, GFP_KERNEL);
	if (p2p == NULL)
		return -ENOMEM;
	p2p_len = 0;

	pos = mgmt->u.probe_resp.variable;
	while (pos + 1 < buf + len) {
		if (pos + 2 + pos[1] > buf + len)
			break;
		if (ath6kl_is_p2p_ie(pos)) {
			memcpy(p2p + p2p_len, pos, 2 + pos[1]);
			p2p_len += 2 + pos[1];
		}
		pos += 2 + pos[1];
	}

1852 1853
	ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq,
						 mgmt->da, p2p, p2p_len);
1854 1855 1856 1857
	kfree(p2p);
	return ret;
}

J
Jouni Malinen 已提交
1858 1859 1860 1861
static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev,
			  struct ieee80211_channel *chan, bool offchan,
			  enum nl80211_channel_type channel_type,
			  bool channel_type_valid, unsigned int wait,
1862 1863
			  const u8 *buf, size_t len, bool no_cck,
			  bool dont_wait_for_ack, u64 *cookie)
J
Jouni Malinen 已提交
1864 1865
{
	struct ath6kl *ar = ath6kl_priv(dev);
1866
	struct ath6kl_vif *vif = netdev_priv(dev);
J
Jouni Malinen 已提交
1867
	u32 id;
1868 1869 1870 1871
	const struct ieee80211_mgmt *mgmt;

	mgmt = (const struct ieee80211_mgmt *) buf;
	if (buf + len >= mgmt->u.probe_resp.variable &&
1872
	    vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) &&
1873 1874 1875 1876 1877 1878
	    ieee80211_is_probe_resp(mgmt->frame_control)) {
		/*
		 * Send Probe Response frame in AP mode using a separate WMI
		 * command to allow the target to fill in the generic IEs.
		 */
		*cookie = 0; /* TX status not supported */
1879
		return ath6kl_send_go_probe_resp(vif, buf, len,
1880 1881
						 chan->center_freq);
	}
J
Jouni Malinen 已提交
1882

1883
	id = vif->send_action_id++;
J
Jouni Malinen 已提交
1884 1885 1886 1887 1888
	if (id == 0) {
		/*
		 * 0 is a reserved value in the WMI command and shall not be
		 * used for the command.
		 */
1889
		id = vif->send_action_id++;
J
Jouni Malinen 已提交
1890 1891 1892
	}

	*cookie = id;
1893 1894
	return ath6kl_wmi_send_action_cmd(ar->wmi, vif->fw_vif_idx, id,
					  chan->center_freq, wait,
J
Jouni Malinen 已提交
1895 1896 1897
					  buf, len);
}

1898 1899 1900 1901
static void ath6kl_mgmt_frame_register(struct wiphy *wiphy,
				       struct net_device *dev,
				       u16 frame_type, bool reg)
{
1902
	struct ath6kl_vif *vif = netdev_priv(dev);
1903 1904 1905 1906 1907 1908 1909 1910 1911

	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n",
		   __func__, frame_type, reg);
	if (frame_type == IEEE80211_STYPE_PROBE_REQ) {
		/*
		 * Note: This notification callback is not allowed to sleep, so
		 * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we
		 * hardcode target to report Probe Request frames all the time.
		 */
1912
		vif->probe_req_report = reg;
1913 1914 1915
	}
}

1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937
static const struct ieee80211_txrx_stypes
ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = {
	[NL80211_IFTYPE_STATION] = {
		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
		BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
		BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
	},
	[NL80211_IFTYPE_P2P_CLIENT] = {
		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
		BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
		BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
	},
	[NL80211_IFTYPE_P2P_GO] = {
		.tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
		BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
		BIT(IEEE80211_STYPE_PROBE_REQ >> 4)
	},
};

K
Kalle Valo 已提交
1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956
static struct cfg80211_ops ath6kl_cfg80211_ops = {
	.change_virtual_intf = ath6kl_cfg80211_change_iface,
	.scan = ath6kl_cfg80211_scan,
	.connect = ath6kl_cfg80211_connect,
	.disconnect = ath6kl_cfg80211_disconnect,
	.add_key = ath6kl_cfg80211_add_key,
	.get_key = ath6kl_cfg80211_get_key,
	.del_key = ath6kl_cfg80211_del_key,
	.set_default_key = ath6kl_cfg80211_set_default_key,
	.set_wiphy_params = ath6kl_cfg80211_set_wiphy_params,
	.set_tx_power = ath6kl_cfg80211_set_txpower,
	.get_tx_power = ath6kl_cfg80211_get_txpower,
	.set_power_mgmt = ath6kl_cfg80211_set_power_mgmt,
	.join_ibss = ath6kl_cfg80211_join_ibss,
	.leave_ibss = ath6kl_cfg80211_leave_ibss,
	.get_station = ath6kl_get_station,
	.set_pmksa = ath6kl_set_pmksa,
	.del_pmksa = ath6kl_del_pmksa,
	.flush_pmksa = ath6kl_flush_pmksa,
K
Kalle Valo 已提交
1957
	CFG80211_TESTMODE_CMD(ath6kl_tm_cmd)
K
Kalle Valo 已提交
1958 1959
#ifdef CONFIG_PM
	.suspend = ar6k_cfg80211_suspend,
1960
	.resume = ar6k_cfg80211_resume,
K
Kalle Valo 已提交
1961
#endif
1962 1963 1964 1965
	.set_channel = ath6kl_set_channel,
	.add_beacon = ath6kl_add_beacon,
	.set_beacon = ath6kl_set_beacon,
	.del_beacon = ath6kl_del_beacon,
1966
	.change_station = ath6kl_change_station,
1967 1968
	.remain_on_channel = ath6kl_remain_on_channel,
	.cancel_remain_on_channel = ath6kl_cancel_remain_on_channel,
J
Jouni Malinen 已提交
1969
	.mgmt_tx = ath6kl_mgmt_tx,
1970
	.mgmt_frame_register = ath6kl_mgmt_frame_register,
K
Kalle Valo 已提交
1971 1972
};

1973
struct ath6kl *ath6kl_core_alloc(struct device *dev)
K
Kalle Valo 已提交
1974
{
1975
	struct ath6kl *ar;
1976
	struct wiphy *wiphy;
1977
	u8 ctr;
K
Kalle Valo 已提交
1978 1979

	/* create a new wiphy for use with cfg80211 */
1980
	wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl));
1981

1982
	if (!wiphy) {
K
Kalle Valo 已提交
1983 1984 1985 1986
		ath6kl_err("couldn't allocate wiphy device\n");
		return NULL;
	}

1987
	ar = wiphy_priv(wiphy);
1988
	ar->p2p = !!ath6kl_p2p;
1989
	ar->wiphy = wiphy;
1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033
	ar->dev = dev;

	spin_lock_init(&ar->lock);
	spin_lock_init(&ar->mcastpsq_lock);

	init_waitqueue_head(&ar->event_wq);
	sema_init(&ar->sem, 1);

	INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue);

	clear_bit(WMI_ENABLED, &ar->flag);
	clear_bit(SKIP_SCAN, &ar->flag);
	clear_bit(DESTROY_IN_PROGRESS, &ar->flag);

	ar->listen_intvl_t = A_DEFAULT_LISTEN_INTERVAL;
	ar->listen_intvl_b = 0;
	ar->tx_pwr = 0;

	ar->intra_bss = 1;
	memset(&ar->sc_params, 0, sizeof(ar->sc_params));
	ar->sc_params.short_scan_ratio = WMI_SHORTSCANRATIO_DEFAULT;
	ar->sc_params.scan_ctrl_flags = DEFAULT_SCAN_CTRL_FLAGS;
	ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD;

	memset((u8 *)ar->sta_list, 0,
	       AP_MAX_NUM_STA * sizeof(struct ath6kl_sta));

	/* Init the PS queues */
	for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) {
		spin_lock_init(&ar->sta_list[ctr].psq_lock);
		skb_queue_head_init(&ar->sta_list[ctr].psq);
	}

	skb_queue_head_init(&ar->mcastpsq);

	memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3);

	return ar;
}

int ath6kl_register_ieee80211_hw(struct ath6kl *ar)
{
	struct wiphy *wiphy = ar->wiphy;
	int ret;
2034

2035
	wiphy->mgmt_stypes = ath6kl_mgmt_stypes;
2036

2037
	wiphy->max_remain_on_channel_duration = 5000;
2038

K
Kalle Valo 已提交
2039
	/* set device pointer for wiphy */
2040
	set_wiphy_dev(wiphy, ar->dev);
K
Kalle Valo 已提交
2041

2042
	wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
2043 2044
				 BIT(NL80211_IFTYPE_ADHOC) |
				 BIT(NL80211_IFTYPE_AP);
2045
	if (ar->p2p) {
2046
		wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) |
2047
					  BIT(NL80211_IFTYPE_P2P_CLIENT);
2048
	}
2049

K
Kalle Valo 已提交
2050
	/* max num of ssids that can be probed during scanning */
2051 2052 2053 2054 2055
	wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX;
	wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */
	wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz;
	wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz;
	wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
K
Kalle Valo 已提交
2056

2057 2058
	wiphy->cipher_suites = cipher_suites;
	wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
K
Kalle Valo 已提交
2059

2060
	ret = wiphy_register(wiphy);
K
Kalle Valo 已提交
2061 2062
	if (ret < 0) {
		ath6kl_err("couldn't register wiphy device\n");
2063
		return ret;
K
Kalle Valo 已提交
2064 2065
	}

2066
	return 0;
K
Kalle Valo 已提交
2067 2068
}

2069
static int ath6kl_init_if_data(struct ath6kl_vif *vif)
K
Kalle Valo 已提交
2070
{
2071 2072
	vif->aggr_cntxt = aggr_init(vif->ndev);
	if (!vif->aggr_cntxt) {
2073 2074 2075 2076
		ath6kl_err("failed to initialize aggr\n");
		return -ENOMEM;
	}

2077
	setup_timer(&vif->disconnect_timer, disconnect_timer_handler,
2078
		    (unsigned long) vif->ndev);
2079
	set_bit(WMM_ENABLED, &vif->flags);
2080
	spin_lock_init(&vif->if_lock);
K
Kalle Valo 已提交
2081

2082 2083 2084
	return 0;
}

2085
void ath6kl_deinit_if_data(struct ath6kl_vif *vif)
2086
{
2087
	aggr_module_destroy(vif->aggr_cntxt);
2088

2089
	vif->aggr_cntxt = NULL;
2090

2091
	if (test_bit(NETDEV_REGISTERED, &vif->flags)) {
2092
		unregister_netdev(vif->ndev);
2093
		clear_bit(NETDEV_REGISTERED, &vif->flags);
2094 2095
	}

2096
	free_netdev(vif->ndev);
2097 2098 2099
}

struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name,
2100
					enum nl80211_iftype type, u8 fw_vif_idx)
2101 2102
{
	struct net_device *ndev;
2103
	struct ath6kl_vif *vif;
2104

2105
	ndev = alloc_netdev(sizeof(*vif), "wlan%d", ether_setup);
2106 2107 2108
	if (!ndev)
		return NULL;

2109 2110 2111 2112 2113 2114 2115 2116 2117
	vif = netdev_priv(ndev);
	ndev->ieee80211_ptr = &vif->wdev;
	vif->wdev.wiphy = ar->wiphy;
	vif->ar = ar;
	ar->vif = vif;
	vif->ndev = ndev;
	SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy));
	vif->wdev.netdev = ndev;
	vif->wdev.iftype = type;
2118
	vif->fw_vif_idx = fw_vif_idx;
2119
	ar->wdev = &vif->wdev;
2120 2121 2122

	init_netdev(ndev);

2123
	ath6kl_init_control_info(vif);
2124 2125

	/* TODO: Pass interface specific pointer instead of ar */
2126
	if (ath6kl_init_if_data(vif))
2127 2128 2129 2130 2131
		goto err;

	if (register_netdev(ndev))
		goto err;

2132
	vif->sme_state = SME_DISCONNECTED;
2133
	set_bit(WLAN_ENABLED, &vif->flags);
2134
	ar->wlan_pwr_state = WLAN_POWER_STATE_ON;
2135
	set_bit(NETDEV_REGISTERED, &vif->flags);
2136 2137 2138 2139

	return ndev;

err:
2140
	ath6kl_deinit_if_data(vif);
2141 2142 2143 2144 2145 2146

	return NULL;
}

void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar)
{
2147 2148
	wiphy_unregister(ar->wiphy);
	wiphy_free(ar->wiphy);
K
Kalle Valo 已提交
2149
}