main.c revision 31024d99003486c90c793dea58b55f7920f0488b
1bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/*
2bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc.
3bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo *
4bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * Permission to use, copy, modify, and/or distribute this software for any
5bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * purpose with or without fee is hereby granted, provided that the above
6bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * copyright notice and this permission notice appear in all copies.
7bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo *
8bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo */
16bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
17bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo#include "core.h"
18bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo#include "hif-ops.h"
19bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo#include "cfg80211.h"
20bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo#include "target.h"
21bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo#include "debug.h"
22bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
23bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostruct ath6kl_sta *ath6kl_find_sta(struct ath6kl *ar, u8 *node_addr)
24bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
25bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl_sta *conn = NULL;
26bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u8 i, max_conn;
27bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
28bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	max_conn = (ar->nw_type == AP_NETWORK) ? AP_MAX_NUM_STA : 0;
29bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
30bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	for (i = 0; i < max_conn; i++) {
31bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (memcmp(node_addr, ar->sta_list[i].mac, ETH_ALEN) == 0) {
32bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			conn = &ar->sta_list[i];
33bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			break;
34bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
35bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
36bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
37bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return conn;
38bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
39bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
40bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostruct ath6kl_sta *ath6kl_find_sta_by_aid(struct ath6kl *ar, u8 aid)
41bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
42bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl_sta *conn = NULL;
43bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u8 ctr;
44bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
45bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) {
46bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (ar->sta_list[ctr].aid == aid) {
47bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			conn = &ar->sta_list[ctr];
48bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			break;
49bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
50bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
51bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return conn;
52bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
53bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
54bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic void ath6kl_add_new_sta(struct ath6kl *ar, u8 *mac, u16 aid, u8 *wpaie,
55bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			u8 ielen, u8 keymgmt, u8 ucipher, u8 auth)
56bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
57bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl_sta *sta;
58bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u8 free_slot;
59bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
60bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	free_slot = aid - 1;
61bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
62bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	sta = &ar->sta_list[free_slot];
63bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memcpy(sta->mac, mac, ETH_ALEN);
64bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memcpy(sta->wpa_ie, wpaie, ielen);
65bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	sta->aid = aid;
66bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	sta->keymgmt = keymgmt;
67bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	sta->ucipher = ucipher;
68bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	sta->auth = auth;
69bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
70bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->sta_list_index = ar->sta_list_index | (1 << free_slot);
71bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->ap_stats.sta[free_slot].aid = cpu_to_le32(aid);
72bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
73bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
74bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic void ath6kl_sta_cleanup(struct ath6kl *ar, u8 i)
75bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
76bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl_sta *sta = &ar->sta_list[i];
77bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
78bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* empty the queued pkts in the PS queue if any */
79bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_lock_bh(&sta->psq_lock);
80bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	skb_queue_purge(&sta->psq);
81bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_unlock_bh(&sta->psq_lock);
82bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
83bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memset(&ar->ap_stats.sta[sta->aid - 1], 0,
84bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	       sizeof(struct wmi_per_sta_stat));
85bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memset(sta->mac, 0, ETH_ALEN);
86bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memset(sta->wpa_ie, 0, ATH6KL_MAX_IE);
87bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	sta->aid = 0;
88bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	sta->sta_flags = 0;
89bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
90bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->sta_list_index = ar->sta_list_index & ~(1 << i);
91bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
92bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
93bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
94bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic u8 ath6kl_remove_sta(struct ath6kl *ar, u8 *mac, u16 reason)
95bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
96bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u8 i, removed = 0;
97bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
98bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (is_zero_ether_addr(mac))
99bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return removed;
100bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
101bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (is_broadcast_ether_addr(mac)) {
102bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_dbg(ATH6KL_DBG_TRC, "deleting all station\n");
103bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
104bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		for (i = 0; i < AP_MAX_NUM_STA; i++) {
105bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (!is_zero_ether_addr(ar->sta_list[i].mac)) {
106bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6kl_sta_cleanup(ar, i);
107bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				removed = 1;
108bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			}
109bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
110bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	} else {
111bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		for (i = 0; i < AP_MAX_NUM_STA; i++) {
112bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (memcmp(ar->sta_list[i].mac, mac, ETH_ALEN) == 0) {
113bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6kl_dbg(ATH6KL_DBG_TRC,
114bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					   "deleting station %pM aid=%d reason=%d\n",
115bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					   mac, ar->sta_list[i].aid, reason);
116bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6kl_sta_cleanup(ar, i);
117bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				removed = 1;
118bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				break;
119bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			}
120bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
121bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
122bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
123bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return removed;
124bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
125bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
126bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valoenum htc_endpoint_id ath6kl_ac2_endpoint_id(void *devt, u8 ac)
127bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
128bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl *ar = devt;
129bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return ar->ac2ep_map[ac];
130bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
131bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
132bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostruct ath6kl_cookie *ath6kl_alloc_cookie(struct ath6kl *ar)
133bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
134bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl_cookie *cookie;
135bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
136bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	cookie = ar->cookie_list;
137bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (cookie != NULL) {
138bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ar->cookie_list = cookie->arc_list_next;
139bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ar->cookie_count--;
140bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
141bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
142bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return cookie;
143bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
144bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
145bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_cookie_init(struct ath6kl *ar)
146bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
147bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u32 i;
148bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
149bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->cookie_list = NULL;
150bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->cookie_count = 0;
151bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
152bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memset(ar->cookie_mem, 0, sizeof(ar->cookie_mem));
153bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
154bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	for (i = 0; i < MAX_COOKIE_NUM; i++)
155bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_free_cookie(ar, &ar->cookie_mem[i]);
156bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
157bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
158bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_cookie_cleanup(struct ath6kl *ar)
159bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
160bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->cookie_list = NULL;
161bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->cookie_count = 0;
162bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
163bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
164bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_free_cookie(struct ath6kl *ar, struct ath6kl_cookie *cookie)
165bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
166bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* Insert first */
167bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
168bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (!ar || !cookie)
169bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
170bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
171bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	cookie->arc_list_next = ar->cookie_list;
172bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->cookie_list = cookie;
173bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->cookie_count++;
174bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
175bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
176bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/* set the window address register (using 4-byte register access ). */
177bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic int ath6kl_set_addrwin_reg(struct ath6kl *ar, u32 reg_addr, u32 addr)
178bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
179bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	int status;
180bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u8 addr_val[4];
181bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	s32 i;
182bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
183bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/*
184bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * Write bytes 1,2,3 of the register to set the upper address bytes,
185bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * the LSB is written last to initiate the access cycle
186bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 */
187bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
188bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	for (i = 1; i <= 3; i++) {
189bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		/*
190bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * Fill the buffer with the address byte value we want to
191bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * hit 4 times.
192bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 */
193bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		memset(addr_val, ((u8 *)&addr)[i], 4);
194bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
195bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		/*
196bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * Hit each byte of the register address with a 4-byte
197bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * write operation to the same address, this is a harmless
198bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * operation.
199bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 */
200bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		status = hif_read_write_sync(ar, reg_addr + i, addr_val,
201bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					     4, HIF_WR_SYNC_BYTE_FIX);
202bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (status)
203bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			break;
204bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
205bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
206bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (status) {
207bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_err("failed to write initial bytes of 0x%x to window reg: 0x%X\n",
208bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			   addr, reg_addr);
209bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return status;
210bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
211bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
212bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/*
213bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * Write the address register again, this time write the whole
214bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * 4-byte value. The effect here is that the LSB write causes the
215bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * cycle to start, the extra 3 byte write to bytes 1,2,3 has no
216bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * effect since we are writing the same values again
217bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 */
218bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	status = hif_read_write_sync(ar, reg_addr, (u8 *)(&addr),
219bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				     4, HIF_WR_SYNC_BYTE_INC);
220bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
221bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (status) {
222bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_err("failed to write 0x%x to window reg: 0x%X\n",
223bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			   addr, reg_addr);
224bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return status;
225bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
226bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
227bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return 0;
228bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
229bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
230bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/*
231bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * Read from the ATH6KL through its diagnostic window. No cooperation from
232bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * the Target is required for this.
233bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo */
234bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valoint ath6kl_read_reg_diag(struct ath6kl *ar, u32 *address, u32 *data)
235bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
236bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	int status;
237bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
238bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* set window register to start read cycle */
239bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	status = ath6kl_set_addrwin_reg(ar, WINDOW_READ_ADDR_ADDRESS,
240bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					*address);
241bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
242bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (status)
243bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return status;
244bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
245bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* read the data */
246bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	status = hif_read_write_sync(ar, WINDOW_DATA_ADDRESS, (u8 *)data,
247bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				     sizeof(u32), HIF_RD_SYNC_BYTE_INC);
248bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (status) {
249bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_err("failed to read from window data addr\n");
250bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return status;
251bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
252bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
253bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return status;
254bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
255bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
256bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
257bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/*
258bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * Write to the ATH6KL through its diagnostic window. No cooperation from
259bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * the Target is required for this.
260bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo */
261bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic int ath6kl_write_reg_diag(struct ath6kl *ar, u32 *address, u32 *data)
262bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
263bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	int status;
264bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
265bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* set write data */
266bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	status = hif_read_write_sync(ar, WINDOW_DATA_ADDRESS, (u8 *)data,
267bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				     sizeof(u32), HIF_WR_SYNC_BYTE_INC);
268bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (status) {
269bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_err("failed to write 0x%x to window data addr\n", *data);
270bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return status;
271bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
272bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
273bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* set window register, which starts the write cycle */
274bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return ath6kl_set_addrwin_reg(ar, WINDOW_WRITE_ADDR_ADDRESS,
275bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				      *address);
276bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
277bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
278bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valoint ath6kl_access_datadiag(struct ath6kl *ar, u32 address,
279bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			   u8 *data, u32 length, bool read)
280bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
281bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u32 count;
282bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	int status = 0;
283bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
284bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	for (count = 0; count < length; count += 4, address += 4) {
285bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (read) {
286bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			status = ath6kl_read_reg_diag(ar, &address,
287bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						      (u32 *) &data[count]);
288bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (status)
289bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				break;
290bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		} else {
291bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			status = ath6kl_write_reg_diag(ar, &address,
292bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						       (u32 *) &data[count]);
293bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (status)
294bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				break;
295bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
296bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
297bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
298bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return status;
299bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
300bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
30131024d99003486c90c793dea58b55f7920f0488bKevin Fang/* FIXME: move to a better place, target.h? */
30231024d99003486c90c793dea58b55f7920f0488bKevin Fang#define AR6003_RESET_CONTROL_ADDRESS 0x00004000
30331024d99003486c90c793dea58b55f7920f0488bKevin Fang#define AR6004_RESET_CONTROL_ADDRESS 0x00004000
30431024d99003486c90c793dea58b55f7920f0488bKevin Fang
305bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic void ath6kl_reset_device(struct ath6kl *ar, u32 target_type,
306bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				bool wait_fot_compltn, bool cold_reset)
307bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
308bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	int status = 0;
309bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u32 address;
310bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u32 data;
311bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
31231024d99003486c90c793dea58b55f7920f0488bKevin Fang	if (target_type != TARGET_TYPE_AR6003 &&
31331024d99003486c90c793dea58b55f7920f0488bKevin Fang		target_type != TARGET_TYPE_AR6004)
314bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
315bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
316bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	data = cold_reset ? RESET_CONTROL_COLD_RST : RESET_CONTROL_MBOX_RST;
317bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
31831024d99003486c90c793dea58b55f7920f0488bKevin Fang	switch (target_type) {
31931024d99003486c90c793dea58b55f7920f0488bKevin Fang	case TARGET_TYPE_AR6003:
32031024d99003486c90c793dea58b55f7920f0488bKevin Fang		address = AR6003_RESET_CONTROL_ADDRESS;
32131024d99003486c90c793dea58b55f7920f0488bKevin Fang		break;
32231024d99003486c90c793dea58b55f7920f0488bKevin Fang	case TARGET_TYPE_AR6004:
32331024d99003486c90c793dea58b55f7920f0488bKevin Fang		address = AR6004_RESET_CONTROL_ADDRESS;
32431024d99003486c90c793dea58b55f7920f0488bKevin Fang		break;
32531024d99003486c90c793dea58b55f7920f0488bKevin Fang	default:
32631024d99003486c90c793dea58b55f7920f0488bKevin Fang		address = AR6003_RESET_CONTROL_ADDRESS;
32731024d99003486c90c793dea58b55f7920f0488bKevin Fang		break;
32831024d99003486c90c793dea58b55f7920f0488bKevin Fang	}
32931024d99003486c90c793dea58b55f7920f0488bKevin Fang
330bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	status = ath6kl_write_reg_diag(ar, &address, &data);
331bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
332bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (status)
333bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_err("failed to reset target\n");
334bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
335bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
336bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_stop_endpoint(struct net_device *dev, bool keep_profile,
337bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			  bool get_dbglogs)
338bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
339bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl *ar = ath6kl_priv(dev);
340bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	static u8 bcast_mac[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
341bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	bool discon_issued;
342bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
343bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	netif_stop_queue(dev);
344bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
345bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* disable the target and the interrupts associated with it */
346bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (test_bit(WMI_READY, &ar->flag)) {
347bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		discon_issued = (test_bit(CONNECTED, &ar->flag) ||
348bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				 test_bit(CONNECT_PEND, &ar->flag));
349bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_disconnect(ar);
350bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (!keep_profile)
351bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_init_profile_info(ar);
352bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
353bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		del_timer(&ar->disconnect_timer);
354bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
355bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		clear_bit(WMI_READY, &ar->flag);
356bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_wmi_shutdown(ar->wmi);
357bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		clear_bit(WMI_ENABLED, &ar->flag);
358bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ar->wmi = NULL;
359bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
360bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		/*
361bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * After wmi_shudown all WMI events will be dropped. We
362bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * need to cleanup the buffers allocated in AP mode and
363bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * give disconnect notification to stack, which usually
364bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * happens in the disconnect_event. Simulate the disconnect
365bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * event by calling the function directly. Sometimes
366bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * disconnect_event will be received when the debug logs
367bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * are collected.
368bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 */
369bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (discon_issued)
370bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_disconnect_event(ar, DISCONNECT_CMD,
371bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						(ar->nw_type & AP_NETWORK) ?
372bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						bcast_mac : ar->bssid,
373bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						0, NULL, 0);
374bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
375bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ar->user_key_ctrl = 0;
376bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
377bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	} else {
378bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_dbg(ATH6KL_DBG_TRC,
379bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			   "%s: wmi is not ready 0x%p 0x%p\n",
380bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			   __func__, ar, ar->wmi);
381bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
382bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		/* Shut down WMI if we have started it */
383bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (test_bit(WMI_ENABLED, &ar->flag)) {
384bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_dbg(ATH6KL_DBG_TRC,
385bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				   "%s: shut down wmi\n", __func__);
386bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_wmi_shutdown(ar->wmi);
387bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			clear_bit(WMI_ENABLED, &ar->flag);
388bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ar->wmi = NULL;
389bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
390bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
391bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
392bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (ar->htc_target) {
393bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_dbg(ATH6KL_DBG_TRC, "%s: shut down htc\n", __func__);
394ad226ec22b92d7f0f834015149b1d1118e017f16Kalle Valo		ath6kl_htc_stop(ar->htc_target);
395bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
396bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
397bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/*
398bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * Try to reset the device if we can. The driver may have been
399bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * configure NOT to reset the target during a debug session.
400bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 */
401bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_dbg(ATH6KL_DBG_TRC,
402bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		   "attempting to reset target on instance destroy\n");
403bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_reset_device(ar, ar->target_type, true, true);
404bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
405bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
406bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic void ath6kl_install_static_wep_keys(struct ath6kl *ar)
407bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
408bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u8 index;
409bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u8 keyusage;
410bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
411bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	for (index = WMI_MIN_KEY_INDEX; index <= WMI_MAX_KEY_INDEX; index++) {
412bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (ar->wep_key_list[index].key_len) {
413bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			keyusage = GROUP_USAGE;
414bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (index == ar->def_txkey_index)
415bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				keyusage |= TX_USAGE;
416bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
417bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_wmi_addkey_cmd(ar->wmi,
418bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      index,
419bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      WEP_CRYPT,
420bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      keyusage,
421bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      ar->wep_key_list[index].key_len,
422bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      NULL,
423bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      ar->wep_key_list[index].key,
424bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      KEY_OP_INIT_VAL, NULL,
425bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      NO_SYNC_WMIFLAG);
426bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
427bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
428bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
429bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
430bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic void ath6kl_connect_ap_mode(struct ath6kl *ar, u16 channel, u8 *bssid,
431bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				   u16 listen_int, u16 beacon_int,
432bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				   u8 assoc_resp_len, u8 *assoc_info)
433bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
434bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct net_device *dev = ar->net_dev;
435bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct station_info sinfo;
436bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl_req_key *ik;
437bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	enum crypto_type keyType = NONE_CRYPT;
438bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
439bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (memcmp(dev->dev_addr, bssid, ETH_ALEN) == 0) {
440bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ik = &ar->ap_mode_bkey;
441bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
442bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		switch (ar->auth_mode) {
443bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		case NONE_AUTH:
444bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (ar->prwise_crypto == WEP_CRYPT)
445bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6kl_install_static_wep_keys(ar);
446bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			break;
447bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		case WPA_PSK_AUTH:
448bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		case WPA2_PSK_AUTH:
449bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		case (WPA_PSK_AUTH|WPA2_PSK_AUTH):
450bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			switch (ik->ik_type) {
451bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			case ATH6KL_CIPHER_TKIP:
452bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				keyType = TKIP_CRYPT;
453bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				break;
454bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			case ATH6KL_CIPHER_AES_CCM:
455bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				keyType = AES_CRYPT;
456bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				break;
457bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			default:
458bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				goto skip_key;
459bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			}
460bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_wmi_addkey_cmd(ar->wmi, ik->ik_keyix, keyType,
461bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      GROUP_USAGE, ik->ik_keylen,
462bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      (u8 *)&ik->ik_keyrsc,
463bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      ik->ik_keydata,
464bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      KEY_OP_INIT_VAL, ik->ik_macaddr,
465bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      SYNC_BOTH_WMIFLAG);
466bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			break;
467bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
468bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valoskip_key:
469bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		set_bit(CONNECTED, &ar->flag);
470bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
471bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
472bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
473bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_dbg(ATH6KL_DBG_TRC, "new station %pM aid=%d\n",
474bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		   bssid, channel);
475bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
476bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_add_new_sta(ar, bssid, channel, assoc_info, assoc_resp_len,
477bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			   listen_int & 0xFF, beacon_int,
478bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			   (listen_int >> 8) & 0xFF);
479bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
480bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* send event to application */
481bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memset(&sinfo, 0, sizeof(sinfo));
482bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
483bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* TODO: sinfo.generation */
484bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* TODO: need to deliver (Re)AssocReq IEs somehow.. change in
485bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * cfg80211 needed, e.g., by adding those into sinfo
486bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 */
487bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	cfg80211_new_sta(ar->net_dev, bssid, &sinfo, GFP_KERNEL);
488bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
489bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	netif_wake_queue(ar->net_dev);
490bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
491bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return;
492bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
493bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
494bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/* Functions for Tx credit handling */
495bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6k_credit_init(struct htc_credit_state_info *cred_info,
496bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		       struct list_head *ep_list,
497bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		       int tot_credits)
498bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
499bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct htc_endpoint_credit_dist *cur_ep_dist;
500bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	int count;
501bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
502bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	cred_info->cur_free_credits = tot_credits;
503bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	cred_info->total_avail_credits = tot_credits;
504bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
505bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	list_for_each_entry(cur_ep_dist, ep_list, list) {
506bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (cur_ep_dist->endpoint == ENDPOINT_0)
507bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			continue;
508bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
509bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		cur_ep_dist->cred_min = cur_ep_dist->cred_per_msg;
510bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
511bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (tot_credits > 4)
512bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if ((cur_ep_dist->svc_id == WMI_DATA_BK_SVC) ||
513bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			    (cur_ep_dist->svc_id == WMI_DATA_BE_SVC)) {
514bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6kl_deposit_credit_to_ep(cred_info,
515bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						cur_ep_dist,
516bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						cur_ep_dist->cred_min);
517bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				cur_ep_dist->dist_flags |= HTC_EP_ACTIVE;
518bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			}
519bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
520bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (cur_ep_dist->svc_id == WMI_CONTROL_SVC) {
521bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_deposit_credit_to_ep(cred_info, cur_ep_dist,
522bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						    cur_ep_dist->cred_min);
523bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			/*
524bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * Control service is always marked active, it
525bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * never goes inactive EVER.
526bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 */
527bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			cur_ep_dist->dist_flags |= HTC_EP_ACTIVE;
528bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		} else if (cur_ep_dist->svc_id == WMI_DATA_BK_SVC)
529bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			/* this is the lowest priority data endpoint */
530bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			cred_info->lowestpri_ep_dist = cur_ep_dist->list;
531bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
532bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		/*
533bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * Streams have to be created (explicit | implicit) for all
534bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * kinds of traffic. BE endpoints are also inactive in the
535bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * beginning. When BE traffic starts it creates implicit
536bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * streams that redistributes credits.
537bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 *
538bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * Note: all other endpoints have minimums set but are
539bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * initially given NO credits. credits will be distributed
540bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * as traffic activity demands
541bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 */
542bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
543bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
544bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	WARN_ON(cred_info->cur_free_credits <= 0);
545bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
546bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	list_for_each_entry(cur_ep_dist, ep_list, list) {
547bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (cur_ep_dist->endpoint == ENDPOINT_0)
548bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			continue;
549bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
550bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (cur_ep_dist->svc_id == WMI_CONTROL_SVC)
551bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			cur_ep_dist->cred_norm = cur_ep_dist->cred_per_msg;
552bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		else {
553bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			/*
554bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * For the remaining data endpoints, we assume that
555bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * each cred_per_msg are the same. We use a simple
556bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * calculation here, we take the remaining credits
557bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * and determine how many max messages this can
558bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * cover and then set each endpoint's normal value
559bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * equal to 3/4 this amount.
560bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 */
561bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			count = (cred_info->cur_free_credits /
562bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				 cur_ep_dist->cred_per_msg)
563bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				* cur_ep_dist->cred_per_msg;
564bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			count = (count * 3) >> 2;
565bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			count = max(count, cur_ep_dist->cred_per_msg);
566bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			cur_ep_dist->cred_norm = count;
567bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
568bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
569bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
570bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
571bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
572bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/* initialize and setup credit distribution */
573bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valoint ath6k_setup_credit_dist(void *htc_handle,
574bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			    struct htc_credit_state_info *cred_info)
575bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
576bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u16 servicepriority[5];
577bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
578bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memset(cred_info, 0, sizeof(struct htc_credit_state_info));
579bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
580bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	servicepriority[0] = WMI_CONTROL_SVC;  /* highest */
581bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	servicepriority[1] = WMI_DATA_VO_SVC;
582bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	servicepriority[2] = WMI_DATA_VI_SVC;
583bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	servicepriority[3] = WMI_DATA_BE_SVC;
584bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	servicepriority[4] = WMI_DATA_BK_SVC; /* lowest */
585bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
586bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* set priority list */
587ad226ec22b92d7f0f834015149b1d1118e017f16Kalle Valo	ath6kl_htc_set_credit_dist(htc_handle, cred_info, servicepriority, 5);
588bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
589bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return 0;
590bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
591bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
592bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/* reduce an ep's credits back to a set limit */
593bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic void ath6k_reduce_credits(struct htc_credit_state_info *cred_info,
594bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				 struct htc_endpoint_credit_dist  *ep_dist,
595bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				 int limit)
596bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
597bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	int credits;
598bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
599bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ep_dist->cred_assngd = limit;
600bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
601bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (ep_dist->credits <= limit)
602bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
603bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
604bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	credits = ep_dist->credits - limit;
605bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ep_dist->credits -= credits;
606bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	cred_info->cur_free_credits += credits;
607bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
608bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
609bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic void ath6k_credit_update(struct htc_credit_state_info *cred_info,
610bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				struct list_head *epdist_list)
611bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
612bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct htc_endpoint_credit_dist *cur_dist_list;
613bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
614bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	list_for_each_entry(cur_dist_list, epdist_list, list) {
615bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (cur_dist_list->endpoint == ENDPOINT_0)
616bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			continue;
617bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
618bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (cur_dist_list->cred_to_dist > 0) {
619bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			cur_dist_list->credits +=
620bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					cur_dist_list->cred_to_dist;
621bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			cur_dist_list->cred_to_dist = 0;
622bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (cur_dist_list->credits >
623bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			    cur_dist_list->cred_assngd)
624bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6k_reduce_credits(cred_info,
625bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						cur_dist_list,
626bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						cur_dist_list->cred_assngd);
627bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
628bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (cur_dist_list->credits >
629bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			    cur_dist_list->cred_norm)
630bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6k_reduce_credits(cred_info, cur_dist_list,
631bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						     cur_dist_list->cred_norm);
632bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
633bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (!(cur_dist_list->dist_flags & HTC_EP_ACTIVE)) {
634bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				if (cur_dist_list->txq_depth == 0)
635bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					ath6k_reduce_credits(cred_info,
636bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo							     cur_dist_list, 0);
637bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			}
638bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
639bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
640bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
641bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
642bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/*
643bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * HTC has an endpoint that needs credits, ep_dist is the endpoint in
644bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * question.
645bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo */
646bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6k_seek_credits(struct htc_credit_state_info *cred_info,
647bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			struct htc_endpoint_credit_dist *ep_dist)
648bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
649bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct htc_endpoint_credit_dist *curdist_list;
650bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	int credits = 0;
651bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	int need;
652bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
653bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (ep_dist->svc_id == WMI_CONTROL_SVC)
654bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		goto out;
655bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
656bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if ((ep_dist->svc_id == WMI_DATA_VI_SVC) ||
657bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	    (ep_dist->svc_id == WMI_DATA_VO_SVC))
658bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if ((ep_dist->cred_assngd >= ep_dist->cred_norm))
659bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			goto out;
660bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
661bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/*
662bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * For all other services, we follow a simple algorithm of:
663bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 *
664bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * 1. checking the free pool for credits
665bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * 2. checking lower priority endpoints for credits to take
666bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 */
667bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
668bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	credits = min(cred_info->cur_free_credits, ep_dist->seek_cred);
669bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
670bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (credits >= ep_dist->seek_cred)
671bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		goto out;
672bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
673bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/*
674bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * We don't have enough in the free pool, try taking away from
675bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * lower priority services The rule for taking away credits:
676bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 *
677bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 *   1. Only take from lower priority endpoints
678bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 *   2. Only take what is allocated above the minimum (never
679bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 *      starve an endpoint completely)
680bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 *   3. Only take what you need.
681bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 */
682bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
683bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	list_for_each_entry_reverse(curdist_list,
684bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				    &cred_info->lowestpri_ep_dist,
685bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				    list) {
686bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (curdist_list == ep_dist)
687bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			break;
688bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
689bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		need = ep_dist->seek_cred - cred_info->cur_free_credits;
690bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
691bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if ((curdist_list->cred_assngd - need) >=
692bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		     curdist_list->cred_min) {
693bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			/*
694bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * The current one has been allocated more than
695bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * it's minimum and it has enough credits assigned
696bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * above it's minimum to fulfill our need try to
697bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * take away just enough to fulfill our need.
698bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 */
699bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6k_reduce_credits(cred_info, curdist_list,
700bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					curdist_list->cred_assngd - need);
701bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
702bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (cred_info->cur_free_credits >=
703bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			    ep_dist->seek_cred)
704bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				break;
705bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
706bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
707bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (curdist_list->endpoint == ENDPOINT_0)
708bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			break;
709bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
710bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
711bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	credits = min(cred_info->cur_free_credits, ep_dist->seek_cred);
712bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
713bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valoout:
714bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* did we find some credits? */
715bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (credits)
716bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_deposit_credit_to_ep(cred_info, ep_dist, credits);
717bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
718bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ep_dist->seek_cred = 0;
719bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
720bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
721bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/* redistribute credits based on activity change */
722bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic void ath6k_redistribute_credits(struct htc_credit_state_info *info,
723bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				       struct list_head *ep_dist_list)
724bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
725bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct htc_endpoint_credit_dist *curdist_list;
726bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
727bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	list_for_each_entry(curdist_list, ep_dist_list, list) {
728bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (curdist_list->endpoint == ENDPOINT_0)
729bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			continue;
730bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
731bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if ((curdist_list->svc_id == WMI_DATA_BK_SVC)  ||
732bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		    (curdist_list->svc_id == WMI_DATA_BE_SVC))
733bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			curdist_list->dist_flags |= HTC_EP_ACTIVE;
734bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
735bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if ((curdist_list->svc_id != WMI_CONTROL_SVC) &&
736bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		    !(curdist_list->dist_flags & HTC_EP_ACTIVE)) {
737bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (curdist_list->txq_depth == 0)
738bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6k_reduce_credits(info,
739bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						curdist_list, 0);
740bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			else
741bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6k_reduce_credits(info,
742bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						curdist_list,
743bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						curdist_list->cred_min);
744bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
745bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
746bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
747bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
748bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/*
749bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo *
750bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * This function is invoked whenever endpoints require credit
751bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * distributions. A lock is held while this function is invoked, this
752bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * function shall NOT block. The ep_dist_list is a list of distribution
753bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * structures in prioritized order as defined by the call to the
754bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo * htc_set_credit_dist() api.
755bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo */
756bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6k_credit_distribute(struct htc_credit_state_info *cred_info,
757bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			     struct list_head *ep_dist_list,
758bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			     enum htc_credit_dist_reason reason)
759bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
760bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	switch (reason) {
761bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	case HTC_CREDIT_DIST_SEND_COMPLETE:
762bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6k_credit_update(cred_info, ep_dist_list);
763bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		break;
764bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	case HTC_CREDIT_DIST_ACTIVITY_CHANGE:
765bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6k_redistribute_credits(cred_info, ep_dist_list);
766bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		break;
767bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	default:
768bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		break;
769bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
770bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
771bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	WARN_ON(cred_info->cur_free_credits > cred_info->total_avail_credits);
772bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	WARN_ON(cred_info->cur_free_credits < 0);
773bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
774bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
775bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid disconnect_timer_handler(unsigned long ptr)
776bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
777bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct net_device *dev = (struct net_device *)ptr;
778bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl *ar = ath6kl_priv(dev);
779bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
780bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_init_profile_info(ar);
781bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_disconnect(ar);
782bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
783bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
784bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_disconnect(struct ath6kl *ar)
785bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
786bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (test_bit(CONNECTED, &ar->flag) ||
787bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	    test_bit(CONNECT_PEND, &ar->flag)) {
788bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_wmi_disconnect_cmd(ar->wmi);
789bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		/*
790bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * Disconnect command is issued, clear the connect pending
791bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * flag. The connected flag will be cleared in
792bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * disconnect event notification.
793bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 */
794bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		clear_bit(CONNECT_PEND, &ar->flag);
795bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
796bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
797bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
798bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo/* WMI Event handlers */
799bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
800bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic const char *get_hw_id_string(u32 id)
801bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
802bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	switch (id) {
803bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	case AR6003_REV1_VERSION:
804bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return "1.0";
805bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	case AR6003_REV2_VERSION:
806bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return "2.0";
807bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	case AR6003_REV3_VERSION:
808bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return "2.1.1";
809bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	default:
810bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return "unknown";
811bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
812bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
813bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
814bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_ready_event(void *devt, u8 *datap, u32 sw_ver, u32 abi_ver)
815bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
816bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl *ar = devt;
817bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct net_device *dev = ar->net_dev;
818bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
819bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memcpy(dev->dev_addr, datap, ETH_ALEN);
820bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_dbg(ATH6KL_DBG_TRC, "%s: mac addr = %pM\n",
821bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		   __func__, dev->dev_addr);
822bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
823bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->version.wlan_ver = sw_ver;
824bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->version.abi_ver = abi_ver;
825bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
826bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	snprintf(ar->wdev->wiphy->fw_version,
827bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 sizeof(ar->wdev->wiphy->fw_version),
828bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 "%u.%u.%u.%u",
829bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 (ar->version.wlan_ver & 0xf0000000) >> 28,
830bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 (ar->version.wlan_ver & 0x0f000000) >> 24,
831bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 (ar->version.wlan_ver & 0x00ff0000) >> 16,
832bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 (ar->version.wlan_ver & 0x0000ffff));
833bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
834bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* indicate to the waiting thread that the ready event was received */
835bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	set_bit(WMI_READY, &ar->flag);
836bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	wake_up(&ar->event_wq);
837bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
838bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_info("hw %s fw %s\n",
839bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		    get_hw_id_string(ar->wdev->wiphy->hw_version),
840bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		    ar->wdev->wiphy->fw_version);
841bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
842bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
843bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_scan_complete_evt(struct ath6kl *ar, int status)
844bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
845bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_cfg80211_scan_complete_event(ar, status);
846bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
847bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (!ar->usr_bss_filter)
848bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_wmi_bssfilter_cmd(ar->wmi, NONE_BSS_FILTER, 0);
849bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
850bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_dbg(ATH6KL_DBG_WLAN_SCAN, "scan complete: %d\n", status);
851bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
852bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
853bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_connect_event(struct ath6kl *ar, u16 channel, u8 *bssid,
854bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			  u16 listen_int, u16 beacon_int,
855bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			  enum network_type net_type, u8 beacon_ie_len,
856bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			  u8 assoc_req_len, u8 assoc_resp_len,
857bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			  u8 *assoc_info)
858bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
859bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	unsigned long flags;
860bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
861bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (ar->nw_type == AP_NETWORK) {
862bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_connect_ap_mode(ar, channel, bssid, listen_int,
863bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				       beacon_int, assoc_resp_len,
864bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				       assoc_info);
865bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
866bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
867bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
868bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_cfg80211_connect_event(ar, channel, bssid,
869bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				      listen_int, beacon_int,
870bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				      net_type, beacon_ie_len,
871bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				      assoc_req_len, assoc_resp_len,
872bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				      assoc_info);
873bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
874bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memcpy(ar->bssid, bssid, sizeof(ar->bssid));
875bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->bss_ch = channel;
876bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
877bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if ((ar->nw_type == INFRA_NETWORK))
878bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_wmi_listeninterval_cmd(ar->wmi, ar->listen_intvl_t,
879bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      ar->listen_intvl_b);
880bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
881bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	netif_wake_queue(ar->net_dev);
882bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
883bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* Update connect & link status atomically */
884bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_lock_irqsave(&ar->lock, flags);
885bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	set_bit(CONNECTED, &ar->flag);
886bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	clear_bit(CONNECT_PEND, &ar->flag);
887bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	netif_carrier_on(ar->net_dev);
888bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_unlock_irqrestore(&ar->lock, flags);
889bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
890bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	aggr_reset_state(ar->aggr_cntxt);
891bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->reconnect_flag = 0;
892bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
893bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if ((ar->nw_type == ADHOC_NETWORK) && ar->ibss_ps_enable) {
894bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		memset(ar->node_map, 0, sizeof(ar->node_map));
895bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ar->node_num = 0;
896bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ar->next_ep_id = ENDPOINT_2;
897bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
898bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
899bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (!ar->usr_bss_filter)
900bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_wmi_bssfilter_cmd(ar->wmi, NONE_BSS_FILTER, 0);
901bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
902bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
903bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_tkip_micerr_event(struct ath6kl *ar, u8 keyid, bool ismcast)
904bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
905bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl_sta *sta;
906bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u8 tsc[6];
907bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/*
908bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * For AP case, keyid will have aid of STA which sent pkt with
909bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * MIC error. Use this aid to get MAC & send it to hostapd.
910bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 */
911bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (ar->nw_type == AP_NETWORK) {
912bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		sta = ath6kl_find_sta_by_aid(ar, (keyid >> 2));
913bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (!sta)
914bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			return;
915bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
916bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_dbg(ATH6KL_DBG_TRC,
917bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			   "ap tkip mic error received from aid=%d\n", keyid);
918bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
919bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		memset(tsc, 0, sizeof(tsc)); /* FIX: get correct TSC */
920bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		cfg80211_michael_mic_failure(ar->net_dev, sta->mac,
921bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					     NL80211_KEYTYPE_PAIRWISE, keyid,
922bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					     tsc, GFP_KERNEL);
923bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	} else
924bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_cfg80211_tkip_micerr_event(ar, keyid, ismcast);
925bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
926bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
927bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
928bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic void ath6kl_update_target_stats(struct ath6kl *ar, u8 *ptr, u32 len)
929bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
930bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct wmi_target_stats *tgt_stats =
931bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		(struct wmi_target_stats *) ptr;
932bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct target_stats *stats = &ar->target_stats;
933bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct tkip_ccmp_stats *ccmp_stats;
934bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct bss *conn_bss = NULL;
935bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct cserv_stats *c_stats;
936bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u8 ac;
937bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
938bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (len < sizeof(*tgt_stats))
939bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
940bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
941bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* update the RSSI of the connected bss */
942bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (test_bit(CONNECTED, &ar->flag)) {
943bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		conn_bss = ath6kl_wmi_find_node(ar->wmi, ar->bssid);
944bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (conn_bss) {
945bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			c_stats = &tgt_stats->cserv_stats;
946bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			conn_bss->ni_rssi =
947bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				a_sle16_to_cpu(c_stats->cs_ave_beacon_rssi);
948bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			conn_bss->ni_snr =
949bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				tgt_stats->cserv_stats.cs_ave_beacon_snr;
950bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_wmi_node_return(ar->wmi, conn_bss);
951bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
952bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
953bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
954bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_dbg(ATH6KL_DBG_TRC, "updating target stats\n");
955bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
956bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_pkt += le32_to_cpu(tgt_stats->stats.tx.pkt);
957bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_byte += le32_to_cpu(tgt_stats->stats.tx.byte);
958bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_ucast_pkt += le32_to_cpu(tgt_stats->stats.tx.ucast_pkt);
959bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_ucast_byte += le32_to_cpu(tgt_stats->stats.tx.ucast_byte);
960bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_mcast_pkt += le32_to_cpu(tgt_stats->stats.tx.mcast_pkt);
961bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_mcast_byte += le32_to_cpu(tgt_stats->stats.tx.mcast_byte);
962bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_bcast_pkt  += le32_to_cpu(tgt_stats->stats.tx.bcast_pkt);
963bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_bcast_byte += le32_to_cpu(tgt_stats->stats.tx.bcast_byte);
964bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_rts_success_cnt +=
965bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le32_to_cpu(tgt_stats->stats.tx.rts_success_cnt);
966bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
967bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	for (ac = 0; ac < WMM_NUM_AC; ac++)
968bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		stats->tx_pkt_per_ac[ac] +=
969bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			le32_to_cpu(tgt_stats->stats.tx.pkt_per_ac[ac]);
970bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
971bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_err += le32_to_cpu(tgt_stats->stats.tx.err);
972bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_fail_cnt += le32_to_cpu(tgt_stats->stats.tx.fail_cnt);
973bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_retry_cnt += le32_to_cpu(tgt_stats->stats.tx.retry_cnt);
974bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_mult_retry_cnt +=
975bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le32_to_cpu(tgt_stats->stats.tx.mult_retry_cnt);
976bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_rts_fail_cnt +=
977bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le32_to_cpu(tgt_stats->stats.tx.rts_fail_cnt);
978bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tx_ucast_rate =
979bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	    ath6kl_wmi_get_rate(a_sle32_to_cpu(tgt_stats->stats.tx.ucast_rate));
980bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
981bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_pkt += le32_to_cpu(tgt_stats->stats.rx.pkt);
982bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_byte += le32_to_cpu(tgt_stats->stats.rx.byte);
983bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_ucast_pkt += le32_to_cpu(tgt_stats->stats.rx.ucast_pkt);
984bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_ucast_byte += le32_to_cpu(tgt_stats->stats.rx.ucast_byte);
985bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_mcast_pkt += le32_to_cpu(tgt_stats->stats.rx.mcast_pkt);
986bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_mcast_byte += le32_to_cpu(tgt_stats->stats.rx.mcast_byte);
987bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_bcast_pkt += le32_to_cpu(tgt_stats->stats.rx.bcast_pkt);
988bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_bcast_byte += le32_to_cpu(tgt_stats->stats.rx.bcast_byte);
989bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_frgment_pkt += le32_to_cpu(tgt_stats->stats.rx.frgment_pkt);
990bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_err += le32_to_cpu(tgt_stats->stats.rx.err);
991bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_crc_err += le32_to_cpu(tgt_stats->stats.rx.crc_err);
992bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_key_cache_miss +=
993bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le32_to_cpu(tgt_stats->stats.rx.key_cache_miss);
994bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_decrypt_err += le32_to_cpu(tgt_stats->stats.rx.decrypt_err);
995bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_dupl_frame += le32_to_cpu(tgt_stats->stats.rx.dupl_frame);
996bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->rx_ucast_rate =
997bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	    ath6kl_wmi_get_rate(a_sle32_to_cpu(tgt_stats->stats.rx.ucast_rate));
998bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
999bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ccmp_stats = &tgt_stats->stats.tkip_ccmp_stats;
1000bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1001bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tkip_local_mic_fail +=
1002bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le32_to_cpu(ccmp_stats->tkip_local_mic_fail);
1003bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tkip_cnter_measures_invoked +=
1004bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le32_to_cpu(ccmp_stats->tkip_cnter_measures_invoked);
1005bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->tkip_fmt_err += le32_to_cpu(ccmp_stats->tkip_fmt_err);
1006bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1007bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->ccmp_fmt_err += le32_to_cpu(ccmp_stats->ccmp_fmt_err);
1008bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->ccmp_replays += le32_to_cpu(ccmp_stats->ccmp_replays);
1009bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1010bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->pwr_save_fail_cnt +=
1011bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le32_to_cpu(tgt_stats->pm_stats.pwr_save_failure_cnt);
1012bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->noise_floor_calib =
1013bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		a_sle32_to_cpu(tgt_stats->noise_floor_calib);
1014bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1015bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->cs_bmiss_cnt +=
1016bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le32_to_cpu(tgt_stats->cserv_stats.cs_bmiss_cnt);
1017bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->cs_low_rssi_cnt +=
1018bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le32_to_cpu(tgt_stats->cserv_stats.cs_low_rssi_cnt);
1019bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->cs_connect_cnt +=
1020bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le16_to_cpu(tgt_stats->cserv_stats.cs_connect_cnt);
1021bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->cs_discon_cnt +=
1022bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le16_to_cpu(tgt_stats->cserv_stats.cs_discon_cnt);
1023bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1024bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->cs_ave_beacon_rssi =
1025bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		a_sle16_to_cpu(tgt_stats->cserv_stats.cs_ave_beacon_rssi);
1026bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1027bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->cs_last_roam_msec =
1028bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		tgt_stats->cserv_stats.cs_last_roam_msec;
1029bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->cs_snr = tgt_stats->cserv_stats.cs_snr;
1030bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->cs_rssi = a_sle16_to_cpu(tgt_stats->cserv_stats.cs_rssi);
1031bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1032bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->lq_val = le32_to_cpu(tgt_stats->lq_val);
1033bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1034bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->wow_pkt_dropped +=
1035bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le32_to_cpu(tgt_stats->wow_stats.wow_pkt_dropped);
1036bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->wow_host_pkt_wakeups +=
1037bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		tgt_stats->wow_stats.wow_host_pkt_wakeups;
1038bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->wow_host_evt_wakeups +=
1039bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		tgt_stats->wow_stats.wow_host_evt_wakeups;
1040bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	stats->wow_evt_discarded +=
1041bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		le16_to_cpu(tgt_stats->wow_stats.wow_evt_discarded);
1042bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1043bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (test_bit(STATS_UPDATE_PEND, &ar->flag)) {
1044bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		clear_bit(STATS_UPDATE_PEND, &ar->flag);
1045bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		wake_up(&ar->event_wq);
1046bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
1047bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1048bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1049bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic void ath6kl_add_le32(__le32 *var, __le32 val)
1050bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1051bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	*var = cpu_to_le32(le32_to_cpu(*var) + le32_to_cpu(val));
1052bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1053bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1054bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_tgt_stats_event(struct ath6kl *ar, u8 *ptr, u32 len)
1055bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1056bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct wmi_ap_mode_stat *p = (struct wmi_ap_mode_stat *) ptr;
1057bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct wmi_ap_mode_stat *ap = &ar->ap_stats;
1058bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct wmi_per_sta_stat *st_ap, *st_p;
1059bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	u8 ac;
1060bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1061bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (ar->nw_type == AP_NETWORK) {
1062bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (len < sizeof(*p))
1063bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			return;
1064bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1065bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		for (ac = 0; ac < AP_MAX_NUM_STA; ac++) {
1066bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			st_ap = &ap->sta[ac];
1067bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			st_p = &p->sta[ac];
1068bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1069bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_add_le32(&st_ap->tx_bytes, st_p->tx_bytes);
1070bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_add_le32(&st_ap->tx_pkts, st_p->tx_pkts);
1071bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_add_le32(&st_ap->tx_error, st_p->tx_error);
1072bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_add_le32(&st_ap->tx_discard, st_p->tx_discard);
1073bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_add_le32(&st_ap->rx_bytes, st_p->rx_bytes);
1074bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_add_le32(&st_ap->rx_pkts, st_p->rx_pkts);
1075bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_add_le32(&st_ap->rx_error, st_p->rx_error);
1076bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_add_le32(&st_ap->rx_discard, st_p->rx_discard);
1077bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
1078bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1079bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	} else {
1080bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_update_target_stats(ar, ptr, len);
1081bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
1082bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1083bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1084bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_wakeup_event(void *dev)
1085bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1086bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl *ar = (struct ath6kl *) dev;
1087bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1088bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	wake_up(&ar->event_wq);
1089bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1090bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1091bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_txpwr_rx_evt(void *devt, u8 tx_pwr)
1092bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1093bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl *ar = (struct ath6kl *) devt;
1094bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1095bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->tx_pwr = tx_pwr;
1096bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	wake_up(&ar->event_wq);
1097bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1098bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1099bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_pspoll_event(struct ath6kl *ar, u8 aid)
1100bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1101bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl_sta *conn;
1102bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct sk_buff *skb;
1103bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	bool psq_empty = false;
1104bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1105bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	conn = ath6kl_find_sta_by_aid(ar, aid);
1106bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1107bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (!conn)
1108bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
1109bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/*
1110bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * Send out a packet queued on ps queue. When the ps queue
1111bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * becomes empty update the PVB for this station.
1112bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 */
1113bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_lock_bh(&conn->psq_lock);
1114bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	psq_empty  = skb_queue_empty(&conn->psq);
1115bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_unlock_bh(&conn->psq_lock);
1116bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1117bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (psq_empty)
1118bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		/* TODO: Send out a NULL data frame */
1119bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
1120bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1121bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_lock_bh(&conn->psq_lock);
1122bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	skb = skb_dequeue(&conn->psq);
1123bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_unlock_bh(&conn->psq_lock);
1124bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1125bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	conn->sta_flags |= STA_PS_POLLED;
1126bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_data_tx(skb, ar->net_dev);
1127bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	conn->sta_flags &= ~STA_PS_POLLED;
1128bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1129bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_lock_bh(&conn->psq_lock);
1130bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	psq_empty  = skb_queue_empty(&conn->psq);
1131bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_unlock_bh(&conn->psq_lock);
1132bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1133bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (psq_empty)
1134bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_wmi_set_pvb_cmd(ar->wmi, conn->aid, 0);
1135bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1136bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1137bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_dtimexpiry_event(struct ath6kl *ar)
1138bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1139bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	bool mcastq_empty = false;
1140bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct sk_buff *skb;
1141bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1142bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/*
1143bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * If there are no associated STAs, ignore the DTIM expiry event.
1144bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * There can be potential race conditions where the last associated
1145bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * STA may disconnect & before the host could clear the 'Indicate
1146bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * DTIM' request to the firmware, the firmware would have just
1147bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * indicated a DTIM expiry event. The race is between 'clear DTIM
1148bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * expiry cmd' going from the host to the firmware & the DTIM
1149bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * expiry event happening from the firmware to the host.
1150bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 */
1151bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (!ar->sta_list_index)
1152bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
1153bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1154bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_lock_bh(&ar->mcastpsq_lock);
1155bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	mcastq_empty = skb_queue_empty(&ar->mcastpsq);
1156bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_unlock_bh(&ar->mcastpsq_lock);
1157bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1158bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (mcastq_empty)
1159bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
1160bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1161bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* set the STA flag to dtim_expired for the frame to go out */
1162bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	set_bit(DTIM_EXPIRED, &ar->flag);
1163bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1164bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_lock_bh(&ar->mcastpsq_lock);
1165bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	while ((skb = skb_dequeue(&ar->mcastpsq)) != NULL) {
1166bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		spin_unlock_bh(&ar->mcastpsq_lock);
1167bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1168bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_data_tx(skb, ar->net_dev);
1169bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1170bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		spin_lock_bh(&ar->mcastpsq_lock);
1171bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
1172bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_unlock_bh(&ar->mcastpsq_lock);
1173bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1174bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	clear_bit(DTIM_EXPIRED, &ar->flag);
1175bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1176bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* clear the LSB of the BitMapCtl field of the TIM IE */
1177bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_wmi_set_pvb_cmd(ar->wmi, MCAST_AID, 0);
1178bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1179bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1180bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid ath6kl_disconnect_event(struct ath6kl *ar, u8 reason, u8 *bssid,
1181bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			     u8 assoc_resp_len, u8 *assoc_info,
1182bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			     u16 prot_reason_status)
1183bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1184bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct bss *wmi_ssid_node = NULL;
1185bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	unsigned long flags;
1186bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1187bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (ar->nw_type == AP_NETWORK) {
1188bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (!ath6kl_remove_sta(ar, bssid, prot_reason_status))
1189bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			return;
1190bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1191bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		/* if no more associated STAs, empty the mcast PS q */
1192bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (ar->sta_list_index == 0) {
1193bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			spin_lock_bh(&ar->mcastpsq_lock);
1194bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			skb_queue_purge(&ar->mcastpsq);
1195bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			spin_unlock_bh(&ar->mcastpsq_lock);
1196bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1197bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			/* clear the LSB of the TIM IE's BitMapCtl field */
1198bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (test_bit(WMI_READY, &ar->flag))
1199bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6kl_wmi_set_pvb_cmd(ar->wmi, MCAST_AID, 0);
1200bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
1201bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1202bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (!is_broadcast_ether_addr(bssid)) {
1203bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			/* send event to application */
1204bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			cfg80211_del_sta(ar->net_dev, bssid, GFP_KERNEL);
1205bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
1206bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1207bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		clear_bit(CONNECTED, &ar->flag);
1208bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		return;
1209bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
1210bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1211bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_cfg80211_disconnect_event(ar, reason, bssid,
1212bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				       assoc_resp_len, assoc_info,
1213bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				       prot_reason_status);
1214bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1215bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	aggr_reset_state(ar->aggr_cntxt);
1216bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1217bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	del_timer(&ar->disconnect_timer);
1218bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1219bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_dbg(ATH6KL_DBG_WLAN_CONNECT,
1220bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		   "disconnect reason is %d\n", reason);
1221bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1222bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/*
1223bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * If the event is due to disconnect cmd from the host, only they
1224bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * the target would stop trying to connect. Under any other
1225bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 * condition, target would keep trying to connect.
1226bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	 */
1227bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (reason == DISCONNECT_CMD) {
1228bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (!ar->usr_bss_filter && test_bit(WMI_READY, &ar->flag))
1229bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			ath6kl_wmi_bssfilter_cmd(ar->wmi, NONE_BSS_FILTER, 0);
1230bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	} else {
1231bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		set_bit(CONNECT_PEND, &ar->flag);
1232bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (((reason == ASSOC_FAILED) &&
1233bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		    (prot_reason_status == 0x11)) ||
1234bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		    ((reason == ASSOC_FAILED) && (prot_reason_status == 0x0)
1235bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		     && (ar->reconnect_flag == 1))) {
1236bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			set_bit(CONNECTED, &ar->flag);
1237bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			return;
1238bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		}
1239bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
1240bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1241bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if ((reason == NO_NETWORK_AVAIL) && test_bit(WMI_READY, &ar->flag))  {
1242bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ath6kl_wmi_node_free(ar->wmi, bssid);
1243bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1244bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		/*
1245bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * In case any other same SSID nodes are present remove it,
1246bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 * since those nodes also not available now.
1247bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		 */
1248bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		do {
1249bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			/*
1250bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * Find the nodes based on SSID and remove it
1251bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 *
1252bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * Note: This case will not work out for
1253bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 * Hidden-SSID
1254bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			 */
1255bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			wmi_ssid_node = ath6kl_wmi_find_ssid_node(ar->wmi,
1256bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo								  ar->ssid,
1257bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo								  ar->ssid_len,
1258bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo								  false,
1259bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo								  true);
1260bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1261bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			if (wmi_ssid_node)
1262bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				ath6kl_wmi_node_free(ar->wmi,
1263bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo						     wmi_ssid_node->ni_macaddr);
1264bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1265bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		} while (wmi_ssid_node);
1266bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
1267bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1268bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	/* update connect & link status atomically */
1269bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_lock_irqsave(&ar->lock, flags);
1270bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	clear_bit(CONNECTED, &ar->flag);
1271bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	netif_carrier_off(ar->net_dev);
1272bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_unlock_irqrestore(&ar->lock, flags);
1273bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1274bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if ((reason != CSERV_DISCONNECT) || (ar->reconnect_flag != 1))
1275bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ar->reconnect_flag = 0;
1276bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1277bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (reason != CSERV_DISCONNECT)
1278bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		ar->user_key_ctrl = 0;
1279bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1280bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	netif_stop_queue(ar->net_dev);
1281bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	memset(ar->bssid, 0, sizeof(ar->bssid));
1282bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ar->bss_ch = 0;
1283bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1284bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_tx_data_cleanup(ar);
1285bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1286bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1287bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic int ath6kl_open(struct net_device *dev)
1288bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1289bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl *ar = ath6kl_priv(dev);
1290bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	unsigned long flags;
1291bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1292bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_lock_irqsave(&ar->lock, flags);
1293bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1294575b5f34aa089cdaf92dda905d3b1dff1947f257Raja Mani	set_bit(WLAN_ENABLED, &ar->flag);
1295bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1296bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (test_bit(CONNECTED, &ar->flag)) {
1297bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		netif_carrier_on(dev);
1298bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		netif_wake_queue(dev);
1299bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	} else
1300bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		netif_carrier_off(dev);
1301bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1302bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	spin_unlock_irqrestore(&ar->lock, flags);
1303bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1304bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return 0;
1305bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1306bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1307bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic int ath6kl_close(struct net_device *dev)
1308bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1309bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl *ar = ath6kl_priv(dev);
1310bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1311bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	netif_stop_queue(dev);
1312bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1313bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_disconnect(ar);
1314bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1315bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	if (test_bit(WMI_READY, &ar->flag)) {
1316bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo		if (ath6kl_wmi_scanparams_cmd(ar->wmi, 0xFFFF, 0, 0, 0, 0, 0, 0,
1317bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo					      0, 0, 0))
1318bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo			return -EIO;
1319bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1320575b5f34aa089cdaf92dda905d3b1dff1947f257Raja Mani		clear_bit(WLAN_ENABLED, &ar->flag);
1321bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	}
1322bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1323bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	ath6kl_cfg80211_scan_complete_event(ar, -ECANCELED);
1324bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1325bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return 0;
1326bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1327bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1328bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic struct net_device_stats *ath6kl_get_stats(struct net_device *dev)
1329bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1330bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	struct ath6kl *ar = ath6kl_priv(dev);
1331bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1332bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return &ar->net_stats;
1333bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1334bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1335bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valostatic struct net_device_ops ath6kl_netdev_ops = {
1336bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	.ndo_open               = ath6kl_open,
1337bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	.ndo_stop               = ath6kl_close,
1338bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	.ndo_start_xmit         = ath6kl_data_tx,
1339bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	.ndo_get_stats          = ath6kl_get_stats,
1340bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo};
1341bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1342bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valovoid init_netdev(struct net_device *dev)
1343bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo{
1344bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	dev->netdev_ops = &ath6kl_netdev_ops;
1345bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	dev->watchdog_timeo = ATH6KL_TX_TIMEOUT;
1346bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1347bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	dev->needed_headroom = ETH_HLEN;
1348bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	dev->needed_headroom += sizeof(struct ath6kl_llc_snap_hdr) +
1349bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				sizeof(struct wmi_data_hdr) + HTC_HDR_LENGTH
1350bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo				+ WMI_MAX_TX_META_SZ;
1351bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo
1352bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo	return;
1353bdcd81707973cf8aa9305337166f8ee842a050d4Kalle Valo}
1354