main.c 35.1 KB
Newer Older
K
Kalle Valo 已提交
1 2
/*
 * Copyright (c) 2004-2011 Atheros Communications Inc.
3
 * Copyright (c) 2011-2012 Qualcomm Atheros, Inc.
K
Kalle Valo 已提交
4 5 6 7 8 9 10 11 12 13 14 15 16 17
 *
 * 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.
 */

18 19
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

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

26
struct ath6kl_sta *ath6kl_find_sta(struct ath6kl_vif *vif, u8 *node_addr)
K
Kalle Valo 已提交
27
{
28
	struct ath6kl *ar = vif->ar;
K
Kalle Valo 已提交
29 30 31
	struct ath6kl_sta *conn = NULL;
	u8 i, max_conn;

32
	max_conn = (vif->nw_type == AP_NETWORK) ? AP_MAX_NUM_STA : 0;
K
Kalle Valo 已提交
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

	for (i = 0; i < max_conn; i++) {
		if (memcmp(node_addr, ar->sta_list[i].mac, ETH_ALEN) == 0) {
			conn = &ar->sta_list[i];
			break;
		}
	}

	return conn;
}

struct ath6kl_sta *ath6kl_find_sta_by_aid(struct ath6kl *ar, u8 aid)
{
	struct ath6kl_sta *conn = NULL;
	u8 ctr;

	for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) {
		if (ar->sta_list[ctr].aid == aid) {
			conn = &ar->sta_list[ctr];
			break;
		}
	}
	return conn;
}

58 59 60
static void ath6kl_add_new_sta(struct ath6kl_vif *vif, u8 *mac, u16 aid,
			       u8 *wpaie, size_t ielen, u8 keymgmt,
			       u8 ucipher, u8 auth, u8 apsd_info)
K
Kalle Valo 已提交
61
{
62
	struct ath6kl *ar = vif->ar;
K
Kalle Valo 已提交
63 64 65 66 67 68 69
	struct ath6kl_sta *sta;
	u8 free_slot;

	free_slot = aid - 1;

	sta = &ar->sta_list[free_slot];
	memcpy(sta->mac, mac, ETH_ALEN);
70 71
	if (ielen <= ATH6KL_MAX_IE)
		memcpy(sta->wpa_ie, wpaie, ielen);
K
Kalle Valo 已提交
72 73 74 75
	sta->aid = aid;
	sta->keymgmt = keymgmt;
	sta->ucipher = ucipher;
	sta->auth = auth;
76
	sta->apsd_info = apsd_info;
K
Kalle Valo 已提交
77 78 79

	ar->sta_list_index = ar->sta_list_index | (1 << free_slot);
	ar->ap_stats.sta[free_slot].aid = cpu_to_le32(aid);
80
	aggr_conn_init(vif, vif->aggr_cntxt, sta->aggr_conn);
K
Kalle Valo 已提交
81 82 83 84 85
}

static void ath6kl_sta_cleanup(struct ath6kl *ar, u8 i)
{
	struct ath6kl_sta *sta = &ar->sta_list[i];
86
	struct ath6kl_mgmt_buff *entry, *tmp;
K
Kalle Valo 已提交
87 88 89 90

	/* empty the queued pkts in the PS queue if any */
	spin_lock_bh(&sta->psq_lock);
	skb_queue_purge(&sta->psq);
91
	skb_queue_purge(&sta->apsdq);
92 93 94 95 96 97 98 99 100

	if (sta->mgmt_psq_len != 0) {
		list_for_each_entry_safe(entry, tmp, &sta->mgmt_psq, list) {
			kfree(entry);
		}
		INIT_LIST_HEAD(&sta->mgmt_psq);
		sta->mgmt_psq_len = 0;
	}

K
Kalle Valo 已提交
101 102 103 104 105 106 107 108 109 110
	spin_unlock_bh(&sta->psq_lock);

	memset(&ar->ap_stats.sta[sta->aid - 1], 0,
	       sizeof(struct wmi_per_sta_stat));
	memset(sta->mac, 0, ETH_ALEN);
	memset(sta->wpa_ie, 0, ATH6KL_MAX_IE);
	sta->aid = 0;
	sta->sta_flags = 0;

	ar->sta_list_index = ar->sta_list_index & ~(1 << i);
111
	aggr_reset_state(sta->aggr_conn);
K
Kalle Valo 已提交
112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196
}

static u8 ath6kl_remove_sta(struct ath6kl *ar, u8 *mac, u16 reason)
{
	u8 i, removed = 0;

	if (is_zero_ether_addr(mac))
		return removed;

	if (is_broadcast_ether_addr(mac)) {
		ath6kl_dbg(ATH6KL_DBG_TRC, "deleting all station\n");

		for (i = 0; i < AP_MAX_NUM_STA; i++) {
			if (!is_zero_ether_addr(ar->sta_list[i].mac)) {
				ath6kl_sta_cleanup(ar, i);
				removed = 1;
			}
		}
	} else {
		for (i = 0; i < AP_MAX_NUM_STA; i++) {
			if (memcmp(ar->sta_list[i].mac, mac, ETH_ALEN) == 0) {
				ath6kl_dbg(ATH6KL_DBG_TRC,
					   "deleting station %pM aid=%d reason=%d\n",
					   mac, ar->sta_list[i].aid, reason);
				ath6kl_sta_cleanup(ar, i);
				removed = 1;
				break;
			}
		}
	}

	return removed;
}

enum htc_endpoint_id ath6kl_ac2_endpoint_id(void *devt, u8 ac)
{
	struct ath6kl *ar = devt;
	return ar->ac2ep_map[ac];
}

struct ath6kl_cookie *ath6kl_alloc_cookie(struct ath6kl *ar)
{
	struct ath6kl_cookie *cookie;

	cookie = ar->cookie_list;
	if (cookie != NULL) {
		ar->cookie_list = cookie->arc_list_next;
		ar->cookie_count--;
	}

	return cookie;
}

void ath6kl_cookie_init(struct ath6kl *ar)
{
	u32 i;

	ar->cookie_list = NULL;
	ar->cookie_count = 0;

	memset(ar->cookie_mem, 0, sizeof(ar->cookie_mem));

	for (i = 0; i < MAX_COOKIE_NUM; i++)
		ath6kl_free_cookie(ar, &ar->cookie_mem[i]);
}

void ath6kl_cookie_cleanup(struct ath6kl *ar)
{
	ar->cookie_list = NULL;
	ar->cookie_count = 0;
}

void ath6kl_free_cookie(struct ath6kl *ar, struct ath6kl_cookie *cookie)
{
	/* Insert first */

	if (!ar || !cookie)
		return;

	cookie->arc_list_next = ar->cookie_list;
	ar->cookie_list = cookie;
	ar->cookie_count++;
}

/*
197 198
 * Read from the hardware through its diagnostic window. No cooperation
 * from the firmware is required for this.
K
Kalle Valo 已提交
199
 */
200
int ath6kl_diag_read32(struct ath6kl *ar, u32 address, u32 *value)
K
Kalle Valo 已提交
201
{
202
	int ret;
K
Kalle Valo 已提交
203

204
	ret = ath6kl_hif_diag_read32(ar, address, value);
205 206 207 208
	if (ret) {
		ath6kl_warn("failed to read32 through diagnose window: %d\n",
			    ret);
		return ret;
K
Kalle Valo 已提交
209 210
	}

211
	return 0;
K
Kalle Valo 已提交
212 213 214 215 216 217
}

/*
 * Write to the ATH6KL through its diagnostic window. No cooperation from
 * the Target is required for this.
 */
218
int ath6kl_diag_write32(struct ath6kl *ar, u32 address, __le32 value)
K
Kalle Valo 已提交
219
{
220
	int ret;
K
Kalle Valo 已提交
221

222 223
	ret = ath6kl_hif_diag_write32(ar, address, value);

224 225 226 227
	if (ret) {
		ath6kl_err("failed to write 0x%x during diagnose window to 0x%d\n",
			   address, value);
		return ret;
K
Kalle Valo 已提交
228 229
	}

230
	return 0;
K
Kalle Valo 已提交
231 232
}

233
int ath6kl_diag_read(struct ath6kl *ar, u32 address, void *data, u32 length)
K
Kalle Valo 已提交
234
{
235 236
	u32 count, *buf = data;
	int ret;
K
Kalle Valo 已提交
237

238 239 240 241 242 243 244
	if (WARN_ON(length % 4))
		return -EINVAL;

	for (count = 0; count < length / 4; count++, address += 4) {
		ret = ath6kl_diag_read32(ar, address, &buf[count]);
		if (ret)
			return ret;
K
Kalle Valo 已提交
245 246
	}

247 248 249 250 251
	return 0;
}

int ath6kl_diag_write(struct ath6kl *ar, u32 address, void *data, u32 length)
{
252 253
	u32 count;
	__le32 *buf = data;
254 255 256 257 258 259 260 261 262 263 264 265
	int ret;

	if (WARN_ON(length % 4))
		return -EINVAL;

	for (count = 0; count < length / 4; count++, address += 4) {
		ret = ath6kl_diag_write32(ar, address, buf[count]);
		if (ret)
			return ret;
	}

	return 0;
K
Kalle Valo 已提交
266 267
}

268 269 270 271 272
int ath6kl_read_fwlogs(struct ath6kl *ar)
{
	struct ath6kl_dbglog_hdr debug_hdr;
	struct ath6kl_dbglog_buf debug_buf;
	u32 address, length, dropped, firstbuf, debug_hdr_addr;
273
	int ret, loop;
274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295
	u8 *buf;

	buf = kmalloc(ATH6KL_FWLOG_PAYLOAD_SIZE, GFP_KERNEL);
	if (!buf)
		return -ENOMEM;

	address = TARG_VTOP(ar->target_type,
			    ath6kl_get_hi_item_addr(ar,
						    HI_ITEM(hi_dbglog_hdr)));

	ret = ath6kl_diag_read32(ar, address, &debug_hdr_addr);
	if (ret)
		goto out;

	/* Get the contents of the ring buffer */
	if (debug_hdr_addr == 0) {
		ath6kl_warn("Invalid address for debug_hdr_addr\n");
		ret = -EINVAL;
		goto out;
	}

	address = TARG_VTOP(ar->target_type, debug_hdr_addr);
296 297 298
	ret = ath6kl_diag_read(ar, address, &debug_hdr, sizeof(debug_hdr));
	if (ret)
		goto out;
299 300 301 302 303

	address = TARG_VTOP(ar->target_type,
			    le32_to_cpu(debug_hdr.dbuf_addr));
	firstbuf = address;
	dropped = le32_to_cpu(debug_hdr.dropped);
304 305 306
	ret = ath6kl_diag_read(ar, address, &debug_buf, sizeof(debug_buf));
	if (ret)
		goto out;
307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328

	loop = 100;

	do {
		address = TARG_VTOP(ar->target_type,
				    le32_to_cpu(debug_buf.buffer_addr));
		length = le32_to_cpu(debug_buf.length);

		if (length != 0 && (le32_to_cpu(debug_buf.length) <=
				    le32_to_cpu(debug_buf.bufsize))) {
			length = ALIGN(length, 4);

			ret = ath6kl_diag_read(ar, address,
					       buf, length);
			if (ret)
				goto out;

			ath6kl_debug_fwlog_event(ar, buf, length);
		}

		address = TARG_VTOP(ar->target_type,
				    le32_to_cpu(debug_buf.next));
329 330
		ret = ath6kl_diag_read(ar, address, &debug_buf,
				       sizeof(debug_buf));
331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347
		if (ret)
			goto out;

		loop--;

		if (WARN_ON(loop == 0)) {
			ret = -ETIMEDOUT;
			goto out;
		}
	} while (address != firstbuf);

out:
	kfree(buf);

	return ret;
}

348 349 350 351
/* FIXME: move to a better place, target.h? */
#define AR6003_RESET_CONTROL_ADDRESS 0x00004000
#define AR6004_RESET_CONTROL_ADDRESS 0x00004000

352 353
void ath6kl_reset_device(struct ath6kl *ar, u32 target_type,
			 bool wait_fot_compltn, bool cold_reset)
K
Kalle Valo 已提交
354 355 356
{
	int status = 0;
	u32 address;
357
	__le32 data;
K
Kalle Valo 已提交
358

359
	if (target_type != TARGET_TYPE_AR6003 &&
360
	    target_type != TARGET_TYPE_AR6004)
K
Kalle Valo 已提交
361 362
		return;

363 364
	data = cold_reset ? cpu_to_le32(RESET_CONTROL_COLD_RST) :
			    cpu_to_le32(RESET_CONTROL_MBOX_RST);
K
Kalle Valo 已提交
365

366 367 368 369 370 371 372 373 374
	switch (target_type) {
	case TARGET_TYPE_AR6003:
		address = AR6003_RESET_CONTROL_ADDRESS;
		break;
	case TARGET_TYPE_AR6004:
		address = AR6004_RESET_CONTROL_ADDRESS;
		break;
	}

375
	status = ath6kl_diag_write32(ar, address, data);
K
Kalle Valo 已提交
376 377 378 379 380

	if (status)
		ath6kl_err("failed to reset target\n");
}

381
static void ath6kl_install_static_wep_keys(struct ath6kl_vif *vif)
K
Kalle Valo 已提交
382 383 384 385
{
	u8 index;
	u8 keyusage;

386
	for (index = 0; index <= WMI_MAX_KEY_INDEX; index++) {
387
		if (vif->wep_key_list[index].key_len) {
K
Kalle Valo 已提交
388
			keyusage = GROUP_USAGE;
389
			if (index == vif->def_txkey_index)
K
Kalle Valo 已提交
390 391
				keyusage |= TX_USAGE;

392
			ath6kl_wmi_addkey_cmd(vif->ar->wmi, vif->fw_vif_idx,
K
Kalle Valo 已提交
393 394 395
					      index,
					      WEP_CRYPT,
					      keyusage,
396
					      vif->wep_key_list[index].key_len,
397
					      NULL, 0,
398
					      vif->wep_key_list[index].key,
K
Kalle Valo 已提交
399 400 401 402 403 404
					      KEY_OP_INIT_VAL, NULL,
					      NO_SYNC_WMIFLAG);
		}
	}
}

405
void ath6kl_connect_ap_mode_bss(struct ath6kl_vif *vif, u16 channel)
K
Kalle Valo 已提交
406
{
407
	struct ath6kl *ar = vif->ar;
K
Kalle Valo 已提交
408
	struct ath6kl_req_key *ik;
409 410
	int res;
	u8 key_rsc[ATH6KL_KEY_SEQ_LEN];
K
Kalle Valo 已提交
411

412
	ik = &ar->ap_mode_bkey;
K
Kalle Valo 已提交
413

414
	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "AP mode started on %u MHz\n", channel);
415

416
	switch (vif->auth_mode) {
417
	case NONE_AUTH:
418
		if (vif->prwise_crypto == WEP_CRYPT)
419
			ath6kl_install_static_wep_keys(vif);
420 421 422
		if (!ik->valid || ik->key_type != WAPI_CRYPT)
			break;
		/* for WAPI, we need to set the delayed group key, continue: */
423 424 425 426
	case WPA_PSK_AUTH:
	case WPA2_PSK_AUTH:
	case (WPA_PSK_AUTH | WPA2_PSK_AUTH):
		if (!ik->valid)
K
Kalle Valo 已提交
427
			break;
428

429 430
		ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
			   "Delayed addkey for the initial group key for AP mode\n");
431 432
		memset(key_rsc, 0, sizeof(key_rsc));
		res = ath6kl_wmi_addkey_cmd(
433
			ar->wmi, vif->fw_vif_idx, ik->key_index, ik->key_type,
434 435
			GROUP_USAGE, ik->key_len, key_rsc, ATH6KL_KEY_SEQ_LEN,
			ik->key,
436 437
			KEY_OP_INIT_VAL, NULL, SYNC_BOTH_WMIFLAG);
		if (res) {
438 439
			ath6kl_dbg(ATH6KL_DBG_WLAN_CFG,
				   "Delayed addkey failed: %d\n", res);
K
Kalle Valo 已提交
440
		}
441
		break;
K
Kalle Valo 已提交
442 443
	}

444
	if (ar->last_ch != channel)
445
		/* we actually don't know the phymode, default to HT20 */
446
		ath6kl_cfg80211_ch_switch_notify(vif, channel, WMI_11G_HT20);
447

448
	ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, NONE_BSS_FILTER, 0);
449
	set_bit(CONNECTED, &vif->flags);
450
	netif_carrier_on(vif->ndev);
451 452
}

453
void ath6kl_connect_ap_mode_sta(struct ath6kl_vif *vif, u16 aid, u8 *mac_addr,
454
				u8 keymgmt, u8 ucipher, u8 auth,
455
				u8 assoc_req_len, u8 *assoc_info, u8 apsd_info)
456 457 458 459 460 461
{
	u8 *ies = NULL, *wpa_ie = NULL, *pos;
	size_t ies_len = 0;
	struct station_info sinfo;

	ath6kl_dbg(ATH6KL_DBG_TRC, "new station %pM aid=%d\n", mac_addr, aid);
K
Kalle Valo 已提交
462

463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493
	if (assoc_req_len > sizeof(struct ieee80211_hdr_3addr)) {
		struct ieee80211_mgmt *mgmt =
			(struct ieee80211_mgmt *) assoc_info;
		if (ieee80211_is_assoc_req(mgmt->frame_control) &&
		    assoc_req_len >= sizeof(struct ieee80211_hdr_3addr) +
		    sizeof(mgmt->u.assoc_req)) {
			ies = mgmt->u.assoc_req.variable;
			ies_len = assoc_info + assoc_req_len - ies;
		} else if (ieee80211_is_reassoc_req(mgmt->frame_control) &&
			   assoc_req_len >= sizeof(struct ieee80211_hdr_3addr)
			   + sizeof(mgmt->u.reassoc_req)) {
			ies = mgmt->u.reassoc_req.variable;
			ies_len = assoc_info + assoc_req_len - ies;
		}
	}

	pos = ies;
	while (pos && pos + 1 < ies + ies_len) {
		if (pos + 2 + pos[1] > ies + ies_len)
			break;
		if (pos[0] == WLAN_EID_RSN)
			wpa_ie = pos; /* RSN IE */
		else if (pos[0] == WLAN_EID_VENDOR_SPECIFIC &&
			 pos[1] >= 4 &&
			 pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2) {
			if (pos[5] == 0x01)
				wpa_ie = pos; /* WPA IE */
			else if (pos[5] == 0x04) {
				wpa_ie = pos; /* WPS IE */
				break; /* overrides WPA/RSN IE */
			}
494 495 496 497 498 499 500 501 502 503 504 505
		} else if (pos[0] == 0x44 && wpa_ie == NULL) {
			/*
			 * Note: WAPI Parameter Set IE re-uses Element ID that
			 * was officially allocated for BSS AC Access Delay. As
			 * such, we need to be a bit more careful on when
			 * parsing the frame. However, BSS AC Access Delay
			 * element is not supposed to be included in
			 * (Re)Association Request frames, so this should not
			 * cause problems.
			 */
			wpa_ie = pos; /* WAPI IE */
			break;
506 507 508 509
		}
		pos += 2 + pos[1];
	}

510
	ath6kl_add_new_sta(vif, mac_addr, aid, wpa_ie,
511
			   wpa_ie ? 2 + wpa_ie[1] : 0,
512
			   keymgmt, ucipher, auth, apsd_info);
K
Kalle Valo 已提交
513 514 515 516 517

	/* send event to application */
	memset(&sinfo, 0, sizeof(sinfo));

	/* TODO: sinfo.generation */
518 519 520 521 522

	sinfo.assoc_req_ies = ies;
	sinfo.assoc_req_ies_len = ies_len;
	sinfo.filled |= STATION_INFO_ASSOC_REQ_IES;

523
	cfg80211_new_sta(vif->ndev, mac_addr, &sinfo, GFP_KERNEL);
K
Kalle Valo 已提交
524

525
	netif_wake_queue(vif->ndev);
K
Kalle Valo 已提交
526 527 528 529 530
}

void disconnect_timer_handler(unsigned long ptr)
{
	struct net_device *dev = (struct net_device *)ptr;
531
	struct ath6kl_vif *vif = netdev_priv(dev);
K
Kalle Valo 已提交
532

533
	ath6kl_init_profile_info(vif);
534
	ath6kl_disconnect(vif);
K
Kalle Valo 已提交
535 536
}

537
void ath6kl_disconnect(struct ath6kl_vif *vif)
K
Kalle Valo 已提交
538
{
539 540
	if (test_bit(CONNECTED, &vif->flags) ||
	    test_bit(CONNECT_PEND, &vif->flags)) {
541
		ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx);
K
Kalle Valo 已提交
542 543 544 545 546
		/*
		 * Disconnect command is issued, clear the connect pending
		 * flag. The connected flag will be cleared in
		 * disconnect event notification.
		 */
547
		clear_bit(CONNECT_PEND, &vif->flags);
K
Kalle Valo 已提交
548 549 550 551 552
	}
}

/* WMI Event handlers */

553 554
void ath6kl_ready_event(void *devt, u8 *datap, u32 sw_ver, u32 abi_ver,
			enum wmi_phy_cap cap)
K
Kalle Valo 已提交
555 556 557
{
	struct ath6kl *ar = devt;

558
	memcpy(ar->mac_addr, datap, ETH_ALEN);
559 560 561 562

	ath6kl_dbg(ATH6KL_DBG_BOOT,
		   "ready event mac addr %pM sw_ver 0x%x abi_ver 0x%x cap 0x%x\n",
		   ar->mac_addr, sw_ver, abi_ver, cap);
K
Kalle Valo 已提交
563 564 565

	ar->version.wlan_ver = sw_ver;
	ar->version.abi_ver = abi_ver;
566
	ar->hw.cap = cap;
K
Kalle Valo 已提交
567

568 569 570 571 572 573 574 575 576
	if (strlen(ar->wiphy->fw_version) == 0) {
		snprintf(ar->wiphy->fw_version,
			 sizeof(ar->wiphy->fw_version),
			 "%u.%u.%u.%u",
			 (ar->version.wlan_ver & 0xf0000000) >> 28,
			 (ar->version.wlan_ver & 0x0f000000) >> 24,
			 (ar->version.wlan_ver & 0x00ff0000) >> 16,
			 (ar->version.wlan_ver & 0x0000ffff));
	}
K
Kalle Valo 已提交
577 578 579 580 581 582

	/* indicate to the waiting thread that the ready event was received */
	set_bit(WMI_READY, &ar->flag);
	wake_up(&ar->event_wq);
}

583
void ath6kl_scan_complete_evt(struct ath6kl_vif *vif, int status)
K
Kalle Valo 已提交
584
{
585
	struct ath6kl *ar = vif->ar;
586
	bool aborted = false;
587

588 589 590 591
	if (status != WMI_SCAN_STATUS_SUCCESS)
		aborted = true;

	ath6kl_cfg80211_scan_complete_event(vif, aborted);
K
Kalle Valo 已提交
592

593
	if (!ar->usr_bss_filter) {
594
		clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
595 596
		ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
					 NONE_BSS_FILTER, 0);
597
	}
K
Kalle Valo 已提交
598

K
Kalle Valo 已提交
599
	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "scan complete: %d\n", status);
K
Kalle Valo 已提交
600 601
}

602 603 604 605 606 607 608 609 610
static int ath6kl_commit_ch_switch(struct ath6kl_vif *vif, u16 channel)
{

	struct ath6kl *ar = vif->ar;

	vif->profile.ch = cpu_to_le16(channel);

	switch (vif->nw_type) {
	case AP_NETWORK:
611 612 613 614 615 616 617 618 619 620 621 622
		/*
		 * reconfigure any saved RSN IE capabilites in the beacon /
		 * probe response to stay in sync with the supplicant.
		 */
		if (vif->rsn_capab &&
		    test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE,
			     ar->fw_capabilities))
			ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx,
					      WLAN_EID_RSN, WMI_RSN_IE_CAPB,
					      (const u8 *) &vif->rsn_capab,
					      sizeof(vif->rsn_capab));

623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644
		return ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx,
						    &vif->profile);
	default:
		ath6kl_err("won't switch channels nw_type=%d\n", vif->nw_type);
		return -ENOTSUPP;
	}
}

static void ath6kl_check_ch_switch(struct ath6kl *ar, u16 channel)
{

	struct ath6kl_vif *vif;
	int res = 0;

	if (!ar->want_ch_switch)
		return;

	spin_lock_bh(&ar->list_lock);
	list_for_each_entry(vif, &ar->vif_list, list) {
		if (ar->want_ch_switch & (1 << vif->fw_vif_idx))
			res = ath6kl_commit_ch_switch(vif, channel);

645 646 647
		/* if channel switch failed, oh well we tried */
		ar->want_ch_switch &= ~(1 << vif->fw_vif_idx);

648 649 650 651 652 653 654
		if (res)
			ath6kl_err("channel switch failed nw_type %d res %d\n",
				   vif->nw_type, res);
	}
	spin_unlock_bh(&ar->list_lock);
}

655
void ath6kl_connect_event(struct ath6kl_vif *vif, u16 channel, u8 *bssid,
K
Kalle Valo 已提交
656 657 658 659 660
			  u16 listen_int, u16 beacon_int,
			  enum network_type net_type, u8 beacon_ie_len,
			  u8 assoc_req_len, u8 assoc_resp_len,
			  u8 *assoc_info)
{
661
	struct ath6kl *ar = vif->ar;
662

663
	ath6kl_cfg80211_connect_event(vif, channel, bssid,
K
Kalle Valo 已提交
664 665 666 667 668
				      listen_int, beacon_int,
				      net_type, beacon_ie_len,
				      assoc_req_len, assoc_resp_len,
				      assoc_info);

669
	memcpy(vif->bssid, bssid, sizeof(vif->bssid));
670
	vif->bss_ch = channel;
K
Kalle Valo 已提交
671

672
	if ((vif->nw_type == INFRA_NETWORK)) {
673
		ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx,
674
					      vif->listen_intvl_t, 0);
675 676
		ath6kl_check_ch_switch(ar, channel);
	}
K
Kalle Valo 已提交
677

678
	netif_wake_queue(vif->ndev);
K
Kalle Valo 已提交
679 680

	/* Update connect & link status atomically */
681
	spin_lock_bh(&vif->if_lock);
682 683
	set_bit(CONNECTED, &vif->flags);
	clear_bit(CONNECT_PEND, &vif->flags);
684
	netif_carrier_on(vif->ndev);
685
	spin_unlock_bh(&vif->if_lock);
K
Kalle Valo 已提交
686

687
	aggr_reset_state(vif->aggr_cntxt->aggr_conn);
688
	vif->reconnect_flag = 0;
K
Kalle Valo 已提交
689

690
	if ((vif->nw_type == ADHOC_NETWORK) && ar->ibss_ps_enable) {
K
Kalle Valo 已提交
691 692 693 694 695
		memset(ar->node_map, 0, sizeof(ar->node_map));
		ar->node_num = 0;
		ar->next_ep_id = ENDPOINT_2;
	}

696
	if (!ar->usr_bss_filter) {
697
		set_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags);
698 699
		ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
					 CURRENT_BSS_FILTER, 0);
700
	}
K
Kalle Valo 已提交
701 702
}

703
void ath6kl_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, bool ismcast)
K
Kalle Valo 已提交
704 705
{
	struct ath6kl_sta *sta;
706
	struct ath6kl *ar = vif->ar;
K
Kalle Valo 已提交
707
	u8 tsc[6];
708

K
Kalle Valo 已提交
709 710 711 712
	/*
	 * For AP case, keyid will have aid of STA which sent pkt with
	 * MIC error. Use this aid to get MAC & send it to hostapd.
	 */
713
	if (vif->nw_type == AP_NETWORK) {
K
Kalle Valo 已提交
714 715 716 717 718 719 720 721
		sta = ath6kl_find_sta_by_aid(ar, (keyid >> 2));
		if (!sta)
			return;

		ath6kl_dbg(ATH6KL_DBG_TRC,
			   "ap tkip mic error received from aid=%d\n", keyid);

		memset(tsc, 0, sizeof(tsc)); /* FIX: get correct TSC */
722
		cfg80211_michael_mic_failure(vif->ndev, sta->mac,
K
Kalle Valo 已提交
723 724 725
					     NL80211_KEYTYPE_PAIRWISE, keyid,
					     tsc, GFP_KERNEL);
	} else
726
		ath6kl_cfg80211_tkip_micerr_event(vif, keyid, ismcast);
K
Kalle Valo 已提交
727 728 729

}

730
static void ath6kl_update_target_stats(struct ath6kl_vif *vif, u8 *ptr, u32 len)
K
Kalle Valo 已提交
731 732 733
{
	struct wmi_target_stats *tgt_stats =
		(struct wmi_target_stats *) ptr;
734
	struct ath6kl *ar = vif->ar;
735
	struct target_stats *stats = &vif->target_stats;
K
Kalle Valo 已提交
736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830
	struct tkip_ccmp_stats *ccmp_stats;
	u8 ac;

	if (len < sizeof(*tgt_stats))
		return;

	ath6kl_dbg(ATH6KL_DBG_TRC, "updating target stats\n");

	stats->tx_pkt += le32_to_cpu(tgt_stats->stats.tx.pkt);
	stats->tx_byte += le32_to_cpu(tgt_stats->stats.tx.byte);
	stats->tx_ucast_pkt += le32_to_cpu(tgt_stats->stats.tx.ucast_pkt);
	stats->tx_ucast_byte += le32_to_cpu(tgt_stats->stats.tx.ucast_byte);
	stats->tx_mcast_pkt += le32_to_cpu(tgt_stats->stats.tx.mcast_pkt);
	stats->tx_mcast_byte += le32_to_cpu(tgt_stats->stats.tx.mcast_byte);
	stats->tx_bcast_pkt  += le32_to_cpu(tgt_stats->stats.tx.bcast_pkt);
	stats->tx_bcast_byte += le32_to_cpu(tgt_stats->stats.tx.bcast_byte);
	stats->tx_rts_success_cnt +=
		le32_to_cpu(tgt_stats->stats.tx.rts_success_cnt);

	for (ac = 0; ac < WMM_NUM_AC; ac++)
		stats->tx_pkt_per_ac[ac] +=
			le32_to_cpu(tgt_stats->stats.tx.pkt_per_ac[ac]);

	stats->tx_err += le32_to_cpu(tgt_stats->stats.tx.err);
	stats->tx_fail_cnt += le32_to_cpu(tgt_stats->stats.tx.fail_cnt);
	stats->tx_retry_cnt += le32_to_cpu(tgt_stats->stats.tx.retry_cnt);
	stats->tx_mult_retry_cnt +=
		le32_to_cpu(tgt_stats->stats.tx.mult_retry_cnt);
	stats->tx_rts_fail_cnt +=
		le32_to_cpu(tgt_stats->stats.tx.rts_fail_cnt);
	stats->tx_ucast_rate =
	    ath6kl_wmi_get_rate(a_sle32_to_cpu(tgt_stats->stats.tx.ucast_rate));

	stats->rx_pkt += le32_to_cpu(tgt_stats->stats.rx.pkt);
	stats->rx_byte += le32_to_cpu(tgt_stats->stats.rx.byte);
	stats->rx_ucast_pkt += le32_to_cpu(tgt_stats->stats.rx.ucast_pkt);
	stats->rx_ucast_byte += le32_to_cpu(tgt_stats->stats.rx.ucast_byte);
	stats->rx_mcast_pkt += le32_to_cpu(tgt_stats->stats.rx.mcast_pkt);
	stats->rx_mcast_byte += le32_to_cpu(tgt_stats->stats.rx.mcast_byte);
	stats->rx_bcast_pkt += le32_to_cpu(tgt_stats->stats.rx.bcast_pkt);
	stats->rx_bcast_byte += le32_to_cpu(tgt_stats->stats.rx.bcast_byte);
	stats->rx_frgment_pkt += le32_to_cpu(tgt_stats->stats.rx.frgment_pkt);
	stats->rx_err += le32_to_cpu(tgt_stats->stats.rx.err);
	stats->rx_crc_err += le32_to_cpu(tgt_stats->stats.rx.crc_err);
	stats->rx_key_cache_miss +=
		le32_to_cpu(tgt_stats->stats.rx.key_cache_miss);
	stats->rx_decrypt_err += le32_to_cpu(tgt_stats->stats.rx.decrypt_err);
	stats->rx_dupl_frame += le32_to_cpu(tgt_stats->stats.rx.dupl_frame);
	stats->rx_ucast_rate =
	    ath6kl_wmi_get_rate(a_sle32_to_cpu(tgt_stats->stats.rx.ucast_rate));

	ccmp_stats = &tgt_stats->stats.tkip_ccmp_stats;

	stats->tkip_local_mic_fail +=
		le32_to_cpu(ccmp_stats->tkip_local_mic_fail);
	stats->tkip_cnter_measures_invoked +=
		le32_to_cpu(ccmp_stats->tkip_cnter_measures_invoked);
	stats->tkip_fmt_err += le32_to_cpu(ccmp_stats->tkip_fmt_err);

	stats->ccmp_fmt_err += le32_to_cpu(ccmp_stats->ccmp_fmt_err);
	stats->ccmp_replays += le32_to_cpu(ccmp_stats->ccmp_replays);

	stats->pwr_save_fail_cnt +=
		le32_to_cpu(tgt_stats->pm_stats.pwr_save_failure_cnt);
	stats->noise_floor_calib =
		a_sle32_to_cpu(tgt_stats->noise_floor_calib);

	stats->cs_bmiss_cnt +=
		le32_to_cpu(tgt_stats->cserv_stats.cs_bmiss_cnt);
	stats->cs_low_rssi_cnt +=
		le32_to_cpu(tgt_stats->cserv_stats.cs_low_rssi_cnt);
	stats->cs_connect_cnt +=
		le16_to_cpu(tgt_stats->cserv_stats.cs_connect_cnt);
	stats->cs_discon_cnt +=
		le16_to_cpu(tgt_stats->cserv_stats.cs_discon_cnt);

	stats->cs_ave_beacon_rssi =
		a_sle16_to_cpu(tgt_stats->cserv_stats.cs_ave_beacon_rssi);

	stats->cs_last_roam_msec =
		tgt_stats->cserv_stats.cs_last_roam_msec;
	stats->cs_snr = tgt_stats->cserv_stats.cs_snr;
	stats->cs_rssi = a_sle16_to_cpu(tgt_stats->cserv_stats.cs_rssi);

	stats->lq_val = le32_to_cpu(tgt_stats->lq_val);

	stats->wow_pkt_dropped +=
		le32_to_cpu(tgt_stats->wow_stats.wow_pkt_dropped);
	stats->wow_host_pkt_wakeups +=
		tgt_stats->wow_stats.wow_host_pkt_wakeups;
	stats->wow_host_evt_wakeups +=
		tgt_stats->wow_stats.wow_host_evt_wakeups;
	stats->wow_evt_discarded +=
		le16_to_cpu(tgt_stats->wow_stats.wow_evt_discarded);

831 832 833 834
	stats->arp_received = le32_to_cpu(tgt_stats->arp_stats.arp_received);
	stats->arp_replied = le32_to_cpu(tgt_stats->arp_stats.arp_replied);
	stats->arp_matched = le32_to_cpu(tgt_stats->arp_stats.arp_matched);

835 836
	if (test_bit(STATS_UPDATE_PEND, &vif->flags)) {
		clear_bit(STATS_UPDATE_PEND, &vif->flags);
K
Kalle Valo 已提交
837 838 839 840 841 842 843 844 845
		wake_up(&ar->event_wq);
	}
}

static void ath6kl_add_le32(__le32 *var, __le32 val)
{
	*var = cpu_to_le32(le32_to_cpu(*var) + le32_to_cpu(val));
}

846
void ath6kl_tgt_stats_event(struct ath6kl_vif *vif, u8 *ptr, u32 len)
K
Kalle Valo 已提交
847 848
{
	struct wmi_ap_mode_stat *p = (struct wmi_ap_mode_stat *) ptr;
849
	struct ath6kl *ar = vif->ar;
K
Kalle Valo 已提交
850 851 852 853
	struct wmi_ap_mode_stat *ap = &ar->ap_stats;
	struct wmi_per_sta_stat *st_ap, *st_p;
	u8 ac;

854
	if (vif->nw_type == AP_NETWORK) {
K
Kalle Valo 已提交
855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872
		if (len < sizeof(*p))
			return;

		for (ac = 0; ac < AP_MAX_NUM_STA; ac++) {
			st_ap = &ap->sta[ac];
			st_p = &p->sta[ac];

			ath6kl_add_le32(&st_ap->tx_bytes, st_p->tx_bytes);
			ath6kl_add_le32(&st_ap->tx_pkts, st_p->tx_pkts);
			ath6kl_add_le32(&st_ap->tx_error, st_p->tx_error);
			ath6kl_add_le32(&st_ap->tx_discard, st_p->tx_discard);
			ath6kl_add_le32(&st_ap->rx_bytes, st_p->rx_bytes);
			ath6kl_add_le32(&st_ap->rx_pkts, st_p->rx_pkts);
			ath6kl_add_le32(&st_ap->rx_error, st_p->rx_error);
			ath6kl_add_le32(&st_ap->rx_discard, st_p->rx_discard);
		}

	} else {
873
		ath6kl_update_target_stats(vif, ptr, len);
K
Kalle Valo 已提交
874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891
	}
}

void ath6kl_wakeup_event(void *dev)
{
	struct ath6kl *ar = (struct ath6kl *) dev;

	wake_up(&ar->event_wq);
}

void ath6kl_txpwr_rx_evt(void *devt, u8 tx_pwr)
{
	struct ath6kl *ar = (struct ath6kl *) devt;

	ar->tx_pwr = tx_pwr;
	wake_up(&ar->event_wq);
}

892
void ath6kl_pspoll_event(struct ath6kl_vif *vif, u8 aid)
K
Kalle Valo 已提交
893 894 895 896
{
	struct ath6kl_sta *conn;
	struct sk_buff *skb;
	bool psq_empty = false;
897
	struct ath6kl *ar = vif->ar;
898
	struct ath6kl_mgmt_buff *mgmt_buf;
K
Kalle Valo 已提交
899 900 901 902 903 904 905 906 907 908

	conn = ath6kl_find_sta_by_aid(ar, aid);

	if (!conn)
		return;
	/*
	 * Send out a packet queued on ps queue. When the ps queue
	 * becomes empty update the PVB for this station.
	 */
	spin_lock_bh(&conn->psq_lock);
909
	psq_empty  = skb_queue_empty(&conn->psq) && (conn->mgmt_psq_len == 0);
K
Kalle Valo 已提交
910 911 912 913 914 915 916
	spin_unlock_bh(&conn->psq_lock);

	if (psq_empty)
		/* TODO: Send out a NULL data frame */
		return;

	spin_lock_bh(&conn->psq_lock);
917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933
	if (conn->mgmt_psq_len > 0) {
		mgmt_buf = list_first_entry(&conn->mgmt_psq,
					struct ath6kl_mgmt_buff, list);
		list_del(&mgmt_buf->list);
		conn->mgmt_psq_len--;
		spin_unlock_bh(&conn->psq_lock);

		conn->sta_flags |= STA_PS_POLLED;
		ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx,
					 mgmt_buf->id, mgmt_buf->freq,
					 mgmt_buf->wait, mgmt_buf->buf,
					 mgmt_buf->len, mgmt_buf->no_cck);
		conn->sta_flags &= ~STA_PS_POLLED;
		kfree(mgmt_buf);
	} else {
		skb = skb_dequeue(&conn->psq);
		spin_unlock_bh(&conn->psq_lock);
K
Kalle Valo 已提交
934

935 936 937 938
		conn->sta_flags |= STA_PS_POLLED;
		ath6kl_data_tx(skb, vif->ndev);
		conn->sta_flags &= ~STA_PS_POLLED;
	}
K
Kalle Valo 已提交
939 940

	spin_lock_bh(&conn->psq_lock);
941
	psq_empty  = skb_queue_empty(&conn->psq) && (conn->mgmt_psq_len == 0);
K
Kalle Valo 已提交
942 943 944
	spin_unlock_bh(&conn->psq_lock);

	if (psq_empty)
945
		ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, conn->aid, 0);
K
Kalle Valo 已提交
946 947
}

948
void ath6kl_dtimexpiry_event(struct ath6kl_vif *vif)
K
Kalle Valo 已提交
949 950 951
{
	bool mcastq_empty = false;
	struct sk_buff *skb;
952
	struct ath6kl *ar = vif->ar;
K
Kalle Valo 已提交
953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973

	/*
	 * If there are no associated STAs, ignore the DTIM expiry event.
	 * There can be potential race conditions where the last associated
	 * STA may disconnect & before the host could clear the 'Indicate
	 * DTIM' request to the firmware, the firmware would have just
	 * indicated a DTIM expiry event. The race is between 'clear DTIM
	 * expiry cmd' going from the host to the firmware & the DTIM
	 * expiry event happening from the firmware to the host.
	 */
	if (!ar->sta_list_index)
		return;

	spin_lock_bh(&ar->mcastpsq_lock);
	mcastq_empty = skb_queue_empty(&ar->mcastpsq);
	spin_unlock_bh(&ar->mcastpsq_lock);

	if (mcastq_empty)
		return;

	/* set the STA flag to dtim_expired for the frame to go out */
974
	set_bit(DTIM_EXPIRED, &vif->flags);
K
Kalle Valo 已提交
975 976 977 978 979

	spin_lock_bh(&ar->mcastpsq_lock);
	while ((skb = skb_dequeue(&ar->mcastpsq)) != NULL) {
		spin_unlock_bh(&ar->mcastpsq_lock);

980
		ath6kl_data_tx(skb, vif->ndev);
K
Kalle Valo 已提交
981 982 983 984 985

		spin_lock_bh(&ar->mcastpsq_lock);
	}
	spin_unlock_bh(&ar->mcastpsq_lock);

986
	clear_bit(DTIM_EXPIRED, &vif->flags);
K
Kalle Valo 已提交
987 988

	/* clear the LSB of the BitMapCtl field of the TIM IE */
989
	ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, MCAST_AID, 0);
K
Kalle Valo 已提交
990 991
}

992
void ath6kl_disconnect_event(struct ath6kl_vif *vif, u8 reason, u8 *bssid,
K
Kalle Valo 已提交
993 994 995
			     u8 assoc_resp_len, u8 *assoc_info,
			     u16 prot_reason_status)
{
996
	struct ath6kl *ar = vif->ar;
997

998
	if (vif->nw_type == AP_NETWORK) {
999 1000
		/* disconnect due to other STA vif switching channels */
		if (reason == BSS_DISCONNECTED &&
1001
		    prot_reason_status == WMI_AP_REASON_STA_ROAM) {
1002
			ar->want_ch_switch |= 1 << vif->fw_vif_idx;
1003 1004 1005
			/* bail back to this channel if STA vif fails connect */
			ar->last_ch = le16_to_cpu(vif->profile.ch);
		}
1006

1007 1008 1009 1010 1011 1012 1013
		if (prot_reason_status == WMI_AP_REASON_MAX_STA) {
			/* send max client reached notification to user space */
			cfg80211_conn_failed(vif->ndev, bssid,
					     NL80211_CONN_FAIL_MAX_CLIENTS,
					     GFP_KERNEL);
		}

1014 1015 1016 1017 1018 1019 1020
		if (prot_reason_status == WMI_AP_REASON_ACL) {
			/* send blocked client notification to user space */
			cfg80211_conn_failed(vif->ndev, bssid,
					     NL80211_CONN_FAIL_BLOCKED_CLIENT,
					     GFP_KERNEL);
		}

K
Kalle Valo 已提交
1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031
		if (!ath6kl_remove_sta(ar, bssid, prot_reason_status))
			return;

		/* if no more associated STAs, empty the mcast PS q */
		if (ar->sta_list_index == 0) {
			spin_lock_bh(&ar->mcastpsq_lock);
			skb_queue_purge(&ar->mcastpsq);
			spin_unlock_bh(&ar->mcastpsq_lock);

			/* clear the LSB of the TIM IE's BitMapCtl field */
			if (test_bit(WMI_READY, &ar->flag))
1032 1033
				ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx,
						       MCAST_AID, 0);
K
Kalle Valo 已提交
1034 1035 1036 1037
		}

		if (!is_broadcast_ether_addr(bssid)) {
			/* send event to application */
1038
			cfg80211_del_sta(vif->ndev, bssid, GFP_KERNEL);
K
Kalle Valo 已提交
1039 1040
		}

1041
		if (memcmp(vif->ndev->dev_addr, bssid, ETH_ALEN) == 0) {
1042
			memset(vif->wep_key_list, 0, sizeof(vif->wep_key_list));
1043
			clear_bit(CONNECTED, &vif->flags);
1044
		}
K
Kalle Valo 已提交
1045 1046 1047
		return;
	}

1048
	ath6kl_cfg80211_disconnect_event(vif, reason, bssid,
1049 1050
					 assoc_resp_len, assoc_info,
					 prot_reason_status);
K
Kalle Valo 已提交
1051

1052
	aggr_reset_state(vif->aggr_cntxt->aggr_conn);
K
Kalle Valo 已提交
1053

1054
	del_timer(&vif->disconnect_timer);
K
Kalle Valo 已提交
1055

K
Kalle Valo 已提交
1056
	ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "disconnect reason is %d\n", reason);
K
Kalle Valo 已提交
1057 1058 1059 1060 1061 1062 1063 1064

	/*
	 * If the event is due to disconnect cmd from the host, only they
	 * the target would stop trying to connect. Under any other
	 * condition, target would keep trying to connect.
	 */
	if (reason == DISCONNECT_CMD) {
		if (!ar->usr_bss_filter && test_bit(WMI_READY, &ar->flag))
1065 1066
			ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx,
						 NONE_BSS_FILTER, 0);
K
Kalle Valo 已提交
1067
	} else {
1068
		set_bit(CONNECT_PEND, &vif->flags);
K
Kalle Valo 已提交
1069
		if (((reason == ASSOC_FAILED) &&
1070
		     (prot_reason_status == 0x11)) ||
1071 1072
		    ((reason == ASSOC_FAILED) && (prot_reason_status == 0x0) &&
		     (vif->reconnect_flag == 1))) {
1073
			set_bit(CONNECTED, &vif->flags);
K
Kalle Valo 已提交
1074 1075 1076 1077
			return;
		}
	}

1078 1079 1080
	/* restart disconnected concurrent vifs waiting for new channel */
	ath6kl_check_ch_switch(ar, ar->last_ch);

K
Kalle Valo 已提交
1081
	/* update connect & link status atomically */
1082
	spin_lock_bh(&vif->if_lock);
1083
	clear_bit(CONNECTED, &vif->flags);
1084
	netif_carrier_off(vif->ndev);
1085
	spin_unlock_bh(&vif->if_lock);
K
Kalle Valo 已提交
1086

1087 1088
	if ((reason != CSERV_DISCONNECT) || (vif->reconnect_flag != 1))
		vif->reconnect_flag = 0;
K
Kalle Valo 已提交
1089 1090 1091 1092

	if (reason != CSERV_DISCONNECT)
		ar->user_key_ctrl = 0;

1093
	netif_stop_queue(vif->ndev);
1094
	memset(vif->bssid, 0, sizeof(vif->bssid));
1095
	vif->bss_ch = 0;
K
Kalle Valo 已提交
1096 1097 1098 1099

	ath6kl_tx_data_cleanup(ar);
}

1100 1101 1102 1103
struct ath6kl_vif *ath6kl_vif_first(struct ath6kl *ar)
{
	struct ath6kl_vif *vif;

1104
	spin_lock_bh(&ar->list_lock);
1105
	if (list_empty(&ar->vif_list)) {
1106
		spin_unlock_bh(&ar->list_lock);
1107 1108 1109 1110 1111
		return NULL;
	}

	vif = list_first_entry(&ar->vif_list, struct ath6kl_vif, list);

1112
	spin_unlock_bh(&ar->list_lock);
1113 1114 1115 1116

	return vif;
}

K
Kalle Valo 已提交
1117 1118
static int ath6kl_open(struct net_device *dev)
{
1119
	struct ath6kl_vif *vif = netdev_priv(dev);
K
Kalle Valo 已提交
1120

1121
	set_bit(WLAN_ENABLED, &vif->flags);
K
Kalle Valo 已提交
1122

1123
	if (test_bit(CONNECTED, &vif->flags)) {
K
Kalle Valo 已提交
1124 1125 1126 1127 1128 1129 1130 1131 1132 1133
		netif_carrier_on(dev);
		netif_wake_queue(dev);
	} else
		netif_carrier_off(dev);

	return 0;
}

static int ath6kl_close(struct net_device *dev)
{
1134
	struct ath6kl_vif *vif = netdev_priv(dev);
K
Kalle Valo 已提交
1135 1136 1137

	netif_stop_queue(dev);

1138
	ath6kl_cfg80211_stop(vif);
K
Kalle Valo 已提交
1139

1140 1141
	clear_bit(WLAN_ENABLED, &vif->flags);

K
Kalle Valo 已提交
1142 1143 1144 1145 1146
	return 0;
}

static struct net_device_stats *ath6kl_get_stats(struct net_device *dev)
{
1147
	struct ath6kl_vif *vif = netdev_priv(dev);
K
Kalle Valo 已提交
1148

1149
	return &vif->net_stats;
K
Kalle Valo 已提交
1150 1151
}

K
Kalle Valo 已提交
1152 1153
static int ath6kl_set_features(struct net_device *dev,
			       netdev_features_t features)
1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184
{
	struct ath6kl_vif *vif = netdev_priv(dev);
	struct ath6kl *ar = vif->ar;
	int err = 0;

	if ((features & NETIF_F_RXCSUM) &&
	    (ar->rx_meta_ver != WMI_META_VERSION_2)) {
		ar->rx_meta_ver = WMI_META_VERSION_2;
		err = ath6kl_wmi_set_rx_frame_format_cmd(ar->wmi,
							 vif->fw_vif_idx,
							 ar->rx_meta_ver, 0, 0);
		if (err) {
			dev->features = features & ~NETIF_F_RXCSUM;
			return err;
		}
	} else if (!(features & NETIF_F_RXCSUM) &&
		   (ar->rx_meta_ver == WMI_META_VERSION_2)) {
		ar->rx_meta_ver = 0;
		err = ath6kl_wmi_set_rx_frame_format_cmd(ar->wmi,
							 vif->fw_vif_idx,
							 ar->rx_meta_ver, 0, 0);
		if (err) {
			dev->features = features | NETIF_F_RXCSUM;
			return err;
		}

	}

	return err;
}

1185 1186 1187
static void ath6kl_set_multicast_list(struct net_device *ndev)
{
	struct ath6kl_vif *vif = netdev_priv(ndev);
1188
	bool mc_all_on = false;
1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199
	int mc_count = netdev_mc_count(ndev);
	struct netdev_hw_addr *ha;
	bool found;
	struct ath6kl_mc_filter *mc_filter, *tmp;
	struct list_head mc_filter_new;
	int ret;

	if (!test_bit(WMI_READY, &vif->ar->flag) ||
	    !test_bit(WLAN_ENABLED, &vif->flags))
		return;

1200
	/* Enable multicast-all filter. */
1201 1202 1203 1204
	mc_all_on = !!(ndev->flags & IFF_PROMISC) ||
		    !!(ndev->flags & IFF_ALLMULTI) ||
		    !!(mc_count > ATH6K_MAX_MC_FILTERS_PER_LIST);

1205 1206 1207 1208
	if (mc_all_on)
		set_bit(NETDEV_MCAST_ALL_ON, &vif->flags);
	else
		clear_bit(NETDEV_MCAST_ALL_ON, &vif->flags);
1209

1210 1211 1212 1213
	if (test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER,
		     vif->ar->fw_capabilities)) {
		mc_all_on = mc_all_on || (vif->ar->state == ATH6KL_STATE_ON);
	}
1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226

	if (!(ndev->flags & IFF_MULTICAST)) {
		mc_all_on = false;
		set_bit(NETDEV_MCAST_ALL_OFF, &vif->flags);
	} else {
		clear_bit(NETDEV_MCAST_ALL_OFF, &vif->flags);
	}

	/* Enable/disable "multicast-all" filter*/
	ath6kl_dbg(ATH6KL_DBG_TRC, "%s multicast-all filter\n",
		   mc_all_on ? "enabling" : "disabling");

	ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, vif->fw_vif_idx,
1227
						  mc_all_on);
1228 1229 1230
	if (ret) {
		ath6kl_warn("Failed to %s multicast-all receive\n",
			    mc_all_on ? "enable" : "disable");
1231 1232 1233
		return;
	}

1234 1235 1236 1237
	if (test_bit(NETDEV_MCAST_ALL_ON, &vif->flags))
		return;

	/* Keep the driver and firmware mcast list in sync. */
1238 1239 1240 1241
	list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) {
		found = false;
		netdev_for_each_mc_addr(ha, ndev) {
			if (memcmp(ha->addr, mc_filter->hw_addr,
1242
				   ATH6KL_MCAST_FILTER_MAC_ADDR_SIZE) == 0) {
1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260
				found = true;
				break;
			}
		}

		if (!found) {
			/*
			 * Delete the filter which was previously set
			 * but not in the new request.
			 */
			ath6kl_dbg(ATH6KL_DBG_TRC,
				   "Removing %pM from multicast filter\n",
				   mc_filter->hw_addr);
			ret = ath6kl_wmi_add_del_mcast_filter_cmd(vif->ar->wmi,
					vif->fw_vif_idx, mc_filter->hw_addr,
					false);
			if (ret) {
				ath6kl_warn("Failed to remove multicast filter:%pM\n",
1261
					    mc_filter->hw_addr);
1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275
				return;
			}

			list_del(&mc_filter->list);
			kfree(mc_filter);
		}
	}

	INIT_LIST_HEAD(&mc_filter_new);

	netdev_for_each_mc_addr(ha, ndev) {
		found = false;
		list_for_each_entry(mc_filter, &vif->mc_filter, list) {
			if (memcmp(ha->addr, mc_filter->hw_addr,
1276
				   ATH6KL_MCAST_FILTER_MAC_ADDR_SIZE) == 0) {
1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300
				found = true;
				break;
			}
		}

		if (!found) {
			mc_filter = kzalloc(sizeof(struct ath6kl_mc_filter),
					    GFP_ATOMIC);
			if (!mc_filter) {
				WARN_ON(1);
				goto out;
			}

			memcpy(mc_filter->hw_addr, ha->addr,
			       ATH6KL_MCAST_FILTER_MAC_ADDR_SIZE);
			/* Set the multicast filter */
			ath6kl_dbg(ATH6KL_DBG_TRC,
				   "Adding %pM to multicast filter list\n",
				   mc_filter->hw_addr);
			ret = ath6kl_wmi_add_del_mcast_filter_cmd(vif->ar->wmi,
					vif->fw_vif_idx, mc_filter->hw_addr,
					true);
			if (ret) {
				ath6kl_warn("Failed to add multicast filter :%pM\n",
1301
					    mc_filter->hw_addr);
1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313
				kfree(mc_filter);
				goto out;
			}

			list_add_tail(&mc_filter->list, &mc_filter_new);
		}
	}

out:
	list_splice_tail(&mc_filter_new, &vif->mc_filter);
}

1314
static const struct net_device_ops ath6kl_netdev_ops = {
K
Kalle Valo 已提交
1315 1316 1317 1318
	.ndo_open               = ath6kl_open,
	.ndo_stop               = ath6kl_close,
	.ndo_start_xmit         = ath6kl_data_tx,
	.ndo_get_stats          = ath6kl_get_stats,
1319
	.ndo_set_features       = ath6kl_set_features,
1320
	.ndo_set_rx_mode	= ath6kl_set_multicast_list,
K
Kalle Valo 已提交
1321 1322 1323 1324 1325
};

void init_netdev(struct net_device *dev)
{
	dev->netdev_ops = &ath6kl_netdev_ops;
1326
	dev->destructor = free_netdev;
K
Kalle Valo 已提交
1327 1328 1329 1330 1331
	dev->watchdog_timeo = ATH6KL_TX_TIMEOUT;

	dev->needed_headroom = ETH_HLEN;
	dev->needed_headroom += sizeof(struct ath6kl_llc_snap_hdr) +
				sizeof(struct wmi_data_hdr) + HTC_HDR_LENGTH
1332
				+ WMI_MAX_TX_META_SZ + ATH6KL_HTC_ALIGN_BYTES;
K
Kalle Valo 已提交
1333

1334 1335
	dev->hw_features |= NETIF_F_IP_CSUM | NETIF_F_RXCSUM;

K
Kalle Valo 已提交
1336 1337
	return;
}