1 /*
2  * Copyright (c) 2010-2011 Atheros Communications Inc.
3  *
4  * Permission to use, copy, modify, and/or distribute this software for any
5  * purpose with or without fee is hereby granted, provided that the above
6  * copyright notice and this permission notice appear in all copies.
7  *
8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15  */
16 
17 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
18 
19 #include "htc.h"
20 
21 MODULE_AUTHOR("Atheros Communications");
22 MODULE_LICENSE("Dual BSD/GPL");
23 MODULE_DESCRIPTION("Atheros driver 802.11n HTC based wireless devices");
24 
25 static unsigned int ath9k_debug = ATH_DBG_DEFAULT;
26 module_param_named(debug, ath9k_debug, uint, 0);
27 MODULE_PARM_DESC(debug, "Debugging mask");
28 
29 int htc_modparam_nohwcrypt;
30 module_param_named(nohwcrypt, htc_modparam_nohwcrypt, int, 0444);
31 MODULE_PARM_DESC(nohwcrypt, "Disable hardware encryption");
32 
33 static int ath9k_htc_btcoex_enable;
34 module_param_named(btcoex_enable, ath9k_htc_btcoex_enable, int, 0444);
35 MODULE_PARM_DESC(btcoex_enable, "Enable wifi-BT coexistence");
36 
37 #define CHAN2G(_freq, _idx)  { \
38 	.center_freq = (_freq), \
39 	.hw_value = (_idx), \
40 	.max_power = 20, \
41 }
42 
43 #define CHAN5G(_freq, _idx) { \
44 	.band = IEEE80211_BAND_5GHZ, \
45 	.center_freq = (_freq), \
46 	.hw_value = (_idx), \
47 	.max_power = 20, \
48 }
49 
50 static struct ieee80211_channel ath9k_2ghz_channels[] = {
51 	CHAN2G(2412, 0), /* Channel 1 */
52 	CHAN2G(2417, 1), /* Channel 2 */
53 	CHAN2G(2422, 2), /* Channel 3 */
54 	CHAN2G(2427, 3), /* Channel 4 */
55 	CHAN2G(2432, 4), /* Channel 5 */
56 	CHAN2G(2437, 5), /* Channel 6 */
57 	CHAN2G(2442, 6), /* Channel 7 */
58 	CHAN2G(2447, 7), /* Channel 8 */
59 	CHAN2G(2452, 8), /* Channel 9 */
60 	CHAN2G(2457, 9), /* Channel 10 */
61 	CHAN2G(2462, 10), /* Channel 11 */
62 	CHAN2G(2467, 11), /* Channel 12 */
63 	CHAN2G(2472, 12), /* Channel 13 */
64 	CHAN2G(2484, 13), /* Channel 14 */
65 };
66 
67 static struct ieee80211_channel ath9k_5ghz_channels[] = {
68 	/* _We_ call this UNII 1 */
69 	CHAN5G(5180, 14), /* Channel 36 */
70 	CHAN5G(5200, 15), /* Channel 40 */
71 	CHAN5G(5220, 16), /* Channel 44 */
72 	CHAN5G(5240, 17), /* Channel 48 */
73 	/* _We_ call this UNII 2 */
74 	CHAN5G(5260, 18), /* Channel 52 */
75 	CHAN5G(5280, 19), /* Channel 56 */
76 	CHAN5G(5300, 20), /* Channel 60 */
77 	CHAN5G(5320, 21), /* Channel 64 */
78 	/* _We_ call this "Middle band" */
79 	CHAN5G(5500, 22), /* Channel 100 */
80 	CHAN5G(5520, 23), /* Channel 104 */
81 	CHAN5G(5540, 24), /* Channel 108 */
82 	CHAN5G(5560, 25), /* Channel 112 */
83 	CHAN5G(5580, 26), /* Channel 116 */
84 	CHAN5G(5600, 27), /* Channel 120 */
85 	CHAN5G(5620, 28), /* Channel 124 */
86 	CHAN5G(5640, 29), /* Channel 128 */
87 	CHAN5G(5660, 30), /* Channel 132 */
88 	CHAN5G(5680, 31), /* Channel 136 */
89 	CHAN5G(5700, 32), /* Channel 140 */
90 	/* _We_ call this UNII 3 */
91 	CHAN5G(5745, 33), /* Channel 149 */
92 	CHAN5G(5765, 34), /* Channel 153 */
93 	CHAN5G(5785, 35), /* Channel 157 */
94 	CHAN5G(5805, 36), /* Channel 161 */
95 	CHAN5G(5825, 37), /* Channel 165 */
96 };
97 
98 /* Atheros hardware rate code addition for short premble */
99 #define SHPCHECK(__hw_rate, __flags) \
100 	((__flags & IEEE80211_RATE_SHORT_PREAMBLE) ? (__hw_rate | 0x04) : 0)
101 
102 #define RATE(_bitrate, _hw_rate, _flags) {		\
103 	.bitrate	= (_bitrate),			\
104 	.flags		= (_flags),			\
105 	.hw_value	= (_hw_rate),			\
106 	.hw_value_short = (SHPCHECK(_hw_rate, _flags))	\
107 }
108 
109 static struct ieee80211_rate ath9k_legacy_rates[] = {
110 	RATE(10, 0x1b, 0),
111 	RATE(20, 0x1a, IEEE80211_RATE_SHORT_PREAMBLE), /* shortp : 0x1e */
112 	RATE(55, 0x19, IEEE80211_RATE_SHORT_PREAMBLE), /* shortp: 0x1d */
113 	RATE(110, 0x18, IEEE80211_RATE_SHORT_PREAMBLE), /* short: 0x1c */
114 	RATE(60, 0x0b, 0),
115 	RATE(90, 0x0f, 0),
116 	RATE(120, 0x0a, 0),
117 	RATE(180, 0x0e, 0),
118 	RATE(240, 0x09, 0),
119 	RATE(360, 0x0d, 0),
120 	RATE(480, 0x08, 0),
121 	RATE(540, 0x0c, 0),
122 };
123 
124 #ifdef CONFIG_MAC80211_LEDS
125 static const struct ieee80211_tpt_blink ath9k_htc_tpt_blink[] = {
126 	{ .throughput = 0 * 1024, .blink_time = 334 },
127 	{ .throughput = 1 * 1024, .blink_time = 260 },
128 	{ .throughput = 5 * 1024, .blink_time = 220 },
129 	{ .throughput = 10 * 1024, .blink_time = 190 },
130 	{ .throughput = 20 * 1024, .blink_time = 170 },
131 	{ .throughput = 50 * 1024, .blink_time = 150 },
132 	{ .throughput = 70 * 1024, .blink_time = 130 },
133 	{ .throughput = 100 * 1024, .blink_time = 110 },
134 	{ .throughput = 200 * 1024, .blink_time = 80 },
135 	{ .throughput = 300 * 1024, .blink_time = 50 },
136 };
137 #endif
138 
139 static int ath9k_htc_wait_for_target(struct ath9k_htc_priv *priv)
140 {
141 	int time_left;
142 
143 	if (atomic_read(&priv->htc->tgt_ready) > 0) {
144 		atomic_dec(&priv->htc->tgt_ready);
145 		return 0;
146 	}
147 
148 	/* Firmware can take up to 50ms to get ready, to be safe use 1 second */
149 	time_left = wait_for_completion_timeout(&priv->htc->target_wait, HZ);
150 	if (!time_left) {
151 		dev_err(priv->dev, "ath9k_htc: Target is unresponsive\n");
152 		return -ETIMEDOUT;
153 	}
154 
155 	atomic_dec(&priv->htc->tgt_ready);
156 
157 	return 0;
158 }
159 
160 static void ath9k_deinit_priv(struct ath9k_htc_priv *priv)
161 {
162 	ath9k_hw_deinit(priv->ah);
163 	kfree(priv->ah);
164 	priv->ah = NULL;
165 }
166 
167 static void ath9k_deinit_device(struct ath9k_htc_priv *priv)
168 {
169 	struct ieee80211_hw *hw = priv->hw;
170 
171 	wiphy_rfkill_stop_polling(hw->wiphy);
172 	ath9k_deinit_leds(priv);
173 	ieee80211_unregister_hw(hw);
174 	ath9k_rx_cleanup(priv);
175 	ath9k_tx_cleanup(priv);
176 	ath9k_deinit_priv(priv);
177 }
178 
179 static inline int ath9k_htc_connect_svc(struct ath9k_htc_priv *priv,
180 					u16 service_id,
181 					void (*tx) (void *,
182 						    struct sk_buff *,
183 						    enum htc_endpoint_id,
184 						    bool txok),
185 					enum htc_endpoint_id *ep_id)
186 {
187 	struct htc_service_connreq req;
188 
189 	memset(&req, 0, sizeof(struct htc_service_connreq));
190 
191 	req.service_id = service_id;
192 	req.ep_callbacks.priv = priv;
193 	req.ep_callbacks.rx = ath9k_htc_rxep;
194 	req.ep_callbacks.tx = tx;
195 
196 	return htc_connect_service(priv->htc, &req, ep_id);
197 }
198 
199 static int ath9k_init_htc_services(struct ath9k_htc_priv *priv, u16 devid,
200 				   u32 drv_info)
201 {
202 	int ret;
203 
204 	/* WMI CMD*/
205 	ret = ath9k_wmi_connect(priv->htc, priv->wmi, &priv->wmi_cmd_ep);
206 	if (ret)
207 		goto err;
208 
209 	/* Beacon */
210 	ret = ath9k_htc_connect_svc(priv, WMI_BEACON_SVC, ath9k_htc_beaconep,
211 				    &priv->beacon_ep);
212 	if (ret)
213 		goto err;
214 
215 	/* CAB */
216 	ret = ath9k_htc_connect_svc(priv, WMI_CAB_SVC, ath9k_htc_txep,
217 				    &priv->cab_ep);
218 	if (ret)
219 		goto err;
220 
221 
222 	/* UAPSD */
223 	ret = ath9k_htc_connect_svc(priv, WMI_UAPSD_SVC, ath9k_htc_txep,
224 				    &priv->uapsd_ep);
225 	if (ret)
226 		goto err;
227 
228 	/* MGMT */
229 	ret = ath9k_htc_connect_svc(priv, WMI_MGMT_SVC, ath9k_htc_txep,
230 				    &priv->mgmt_ep);
231 	if (ret)
232 		goto err;
233 
234 	/* DATA BE */
235 	ret = ath9k_htc_connect_svc(priv, WMI_DATA_BE_SVC, ath9k_htc_txep,
236 				    &priv->data_be_ep);
237 	if (ret)
238 		goto err;
239 
240 	/* DATA BK */
241 	ret = ath9k_htc_connect_svc(priv, WMI_DATA_BK_SVC, ath9k_htc_txep,
242 				    &priv->data_bk_ep);
243 	if (ret)
244 		goto err;
245 
246 	/* DATA VI */
247 	ret = ath9k_htc_connect_svc(priv, WMI_DATA_VI_SVC, ath9k_htc_txep,
248 				    &priv->data_vi_ep);
249 	if (ret)
250 		goto err;
251 
252 	/* DATA VO */
253 	ret = ath9k_htc_connect_svc(priv, WMI_DATA_VO_SVC, ath9k_htc_txep,
254 				    &priv->data_vo_ep);
255 	if (ret)
256 		goto err;
257 
258 	/*
259 	 * Setup required credits before initializing HTC.
260 	 * This is a bit hacky, but, since queuing is done in
261 	 * the HIF layer, shouldn't matter much.
262 	 */
263 
264 	if (IS_AR7010_DEVICE(drv_info))
265 		priv->htc->credits = 45;
266 	else
267 		priv->htc->credits = 33;
268 
269 	ret = htc_init(priv->htc);
270 	if (ret)
271 		goto err;
272 
273 	dev_info(priv->dev, "ath9k_htc: HTC initialized with %d credits\n",
274 		 priv->htc->credits);
275 
276 	return 0;
277 
278 err:
279 	dev_err(priv->dev, "ath9k_htc: Unable to initialize HTC services\n");
280 	return ret;
281 }
282 
283 static void ath9k_reg_notifier(struct wiphy *wiphy,
284 			       struct regulatory_request *request)
285 {
286 	struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy);
287 	struct ath9k_htc_priv *priv = hw->priv;
288 
289 	ath_reg_notifier_apply(wiphy, request,
290 			       ath9k_hw_regulatory(priv->ah));
291 }
292 
293 static unsigned int ath9k_regread(void *hw_priv, u32 reg_offset)
294 {
295 	struct ath_hw *ah = (struct ath_hw *) hw_priv;
296 	struct ath_common *common = ath9k_hw_common(ah);
297 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
298 	__be32 val, reg = cpu_to_be32(reg_offset);
299 	int r;
300 
301 	r = ath9k_wmi_cmd(priv->wmi, WMI_REG_READ_CMDID,
302 			  (u8 *) &reg, sizeof(reg),
303 			  (u8 *) &val, sizeof(val),
304 			  100);
305 	if (unlikely(r)) {
306 		ath_dbg(common, WMI, "REGISTER READ FAILED: (0x%04x, %d)\n",
307 			reg_offset, r);
308 		return -EIO;
309 	}
310 
311 	return be32_to_cpu(val);
312 }
313 
314 static void ath9k_multi_regread(void *hw_priv, u32 *addr,
315 				u32 *val, u16 count)
316 {
317 	struct ath_hw *ah = (struct ath_hw *) hw_priv;
318 	struct ath_common *common = ath9k_hw_common(ah);
319 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
320 	__be32 tmpaddr[8];
321 	__be32 tmpval[8];
322 	int i, ret;
323 
324        for (i = 0; i < count; i++) {
325 	       tmpaddr[i] = cpu_to_be32(addr[i]);
326        }
327 
328        ret = ath9k_wmi_cmd(priv->wmi, WMI_REG_READ_CMDID,
329 			   (u8 *)tmpaddr , sizeof(u32) * count,
330 			   (u8 *)tmpval, sizeof(u32) * count,
331 			   100);
332 	if (unlikely(ret)) {
333 		ath_dbg(common, WMI,
334 			"Multiple REGISTER READ FAILED (count: %d)\n", count);
335 	}
336 
337        for (i = 0; i < count; i++) {
338 	       val[i] = be32_to_cpu(tmpval[i]);
339        }
340 }
341 
342 static void ath9k_regwrite_single(void *hw_priv, u32 val, u32 reg_offset)
343 {
344 	struct ath_hw *ah = (struct ath_hw *) hw_priv;
345 	struct ath_common *common = ath9k_hw_common(ah);
346 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
347 	const __be32 buf[2] = {
348 		cpu_to_be32(reg_offset),
349 		cpu_to_be32(val),
350 	};
351 	int r;
352 
353 	r = ath9k_wmi_cmd(priv->wmi, WMI_REG_WRITE_CMDID,
354 			  (u8 *) &buf, sizeof(buf),
355 			  (u8 *) &val, sizeof(val),
356 			  100);
357 	if (unlikely(r)) {
358 		ath_dbg(common, WMI, "REGISTER WRITE FAILED:(0x%04x, %d)\n",
359 			reg_offset, r);
360 	}
361 }
362 
363 static void ath9k_regwrite_buffer(void *hw_priv, u32 val, u32 reg_offset)
364 {
365 	struct ath_hw *ah = (struct ath_hw *) hw_priv;
366 	struct ath_common *common = ath9k_hw_common(ah);
367 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
368 	u32 rsp_status;
369 	int r;
370 
371 	mutex_lock(&priv->wmi->multi_write_mutex);
372 
373 	/* Store the register/value */
374 	priv->wmi->multi_write[priv->wmi->multi_write_idx].reg =
375 		cpu_to_be32(reg_offset);
376 	priv->wmi->multi_write[priv->wmi->multi_write_idx].val =
377 		cpu_to_be32(val);
378 
379 	priv->wmi->multi_write_idx++;
380 
381 	/* If the buffer is full, send it out. */
382 	if (priv->wmi->multi_write_idx == MAX_CMD_NUMBER) {
383 		r = ath9k_wmi_cmd(priv->wmi, WMI_REG_WRITE_CMDID,
384 			  (u8 *) &priv->wmi->multi_write,
385 			  sizeof(struct register_write) * priv->wmi->multi_write_idx,
386 			  (u8 *) &rsp_status, sizeof(rsp_status),
387 			  100);
388 		if (unlikely(r)) {
389 			ath_dbg(common, WMI,
390 				"REGISTER WRITE FAILED, multi len: %d\n",
391 				priv->wmi->multi_write_idx);
392 		}
393 		priv->wmi->multi_write_idx = 0;
394 	}
395 
396 	mutex_unlock(&priv->wmi->multi_write_mutex);
397 }
398 
399 static void ath9k_regwrite(void *hw_priv, u32 val, u32 reg_offset)
400 {
401 	struct ath_hw *ah = (struct ath_hw *) hw_priv;
402 	struct ath_common *common = ath9k_hw_common(ah);
403 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
404 
405 	if (atomic_read(&priv->wmi->mwrite_cnt))
406 		ath9k_regwrite_buffer(hw_priv, val, reg_offset);
407 	else
408 		ath9k_regwrite_single(hw_priv, val, reg_offset);
409 }
410 
411 static void ath9k_enable_regwrite_buffer(void *hw_priv)
412 {
413 	struct ath_hw *ah = (struct ath_hw *) hw_priv;
414 	struct ath_common *common = ath9k_hw_common(ah);
415 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
416 
417 	atomic_inc(&priv->wmi->mwrite_cnt);
418 }
419 
420 static void ath9k_regwrite_flush(void *hw_priv)
421 {
422 	struct ath_hw *ah = (struct ath_hw *) hw_priv;
423 	struct ath_common *common = ath9k_hw_common(ah);
424 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
425 	u32 rsp_status;
426 	int r;
427 
428 	atomic_dec(&priv->wmi->mwrite_cnt);
429 
430 	mutex_lock(&priv->wmi->multi_write_mutex);
431 
432 	if (priv->wmi->multi_write_idx) {
433 		r = ath9k_wmi_cmd(priv->wmi, WMI_REG_WRITE_CMDID,
434 			  (u8 *) &priv->wmi->multi_write,
435 			  sizeof(struct register_write) * priv->wmi->multi_write_idx,
436 			  (u8 *) &rsp_status, sizeof(rsp_status),
437 			  100);
438 		if (unlikely(r)) {
439 			ath_dbg(common, WMI,
440 				"REGISTER WRITE FAILED, multi len: %d\n",
441 				priv->wmi->multi_write_idx);
442 		}
443 		priv->wmi->multi_write_idx = 0;
444 	}
445 
446 	mutex_unlock(&priv->wmi->multi_write_mutex);
447 }
448 
449 static u32 ath9k_reg_rmw(void *hw_priv, u32 reg_offset, u32 set, u32 clr)
450 {
451 	u32 val;
452 
453 	val = ath9k_regread(hw_priv, reg_offset);
454 	val &= ~clr;
455 	val |= set;
456 	ath9k_regwrite(hw_priv, val, reg_offset);
457 	return val;
458 }
459 
460 static void ath_usb_read_cachesize(struct ath_common *common, int *csz)
461 {
462 	*csz = L1_CACHE_BYTES >> 2;
463 }
464 
465 static bool ath_usb_eeprom_read(struct ath_common *common, u32 off, u16 *data)
466 {
467 	struct ath_hw *ah = (struct ath_hw *) common->ah;
468 
469 	(void)REG_READ(ah, AR5416_EEPROM_OFFSET + (off << AR5416_EEPROM_S));
470 
471 	if (!ath9k_hw_wait(ah,
472 			   AR_EEPROM_STATUS_DATA,
473 			   AR_EEPROM_STATUS_DATA_BUSY |
474 			   AR_EEPROM_STATUS_DATA_PROT_ACCESS, 0,
475 			   AH_WAIT_TIMEOUT))
476 		return false;
477 
478 	*data = MS(REG_READ(ah, AR_EEPROM_STATUS_DATA),
479 		   AR_EEPROM_STATUS_DATA_VAL);
480 
481 	return true;
482 }
483 
484 static const struct ath_bus_ops ath9k_usb_bus_ops = {
485 	.ath_bus_type = ATH_USB,
486 	.read_cachesize = ath_usb_read_cachesize,
487 	.eeprom_read = ath_usb_eeprom_read,
488 };
489 
490 static void setup_ht_cap(struct ath9k_htc_priv *priv,
491 			 struct ieee80211_sta_ht_cap *ht_info)
492 {
493 	struct ath_common *common = ath9k_hw_common(priv->ah);
494 	u8 tx_streams, rx_streams;
495 	int i;
496 
497 	ht_info->ht_supported = true;
498 	ht_info->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 |
499 		       IEEE80211_HT_CAP_SM_PS |
500 		       IEEE80211_HT_CAP_SGI_40 |
501 		       IEEE80211_HT_CAP_DSSSCCK40;
502 
503 	if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_SGI_20)
504 		ht_info->cap |= IEEE80211_HT_CAP_SGI_20;
505 
506 	ht_info->cap |= (1 << IEEE80211_HT_CAP_RX_STBC_SHIFT);
507 
508 	ht_info->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K;
509 	ht_info->ampdu_density = IEEE80211_HT_MPDU_DENSITY_8;
510 
511 	memset(&ht_info->mcs, 0, sizeof(ht_info->mcs));
512 
513 	/* ath9k_htc supports only 1 or 2 stream devices */
514 	tx_streams = ath9k_cmn_count_streams(priv->ah->txchainmask, 2);
515 	rx_streams = ath9k_cmn_count_streams(priv->ah->rxchainmask, 2);
516 
517 	ath_dbg(common, CONFIG, "TX streams %d, RX streams: %d\n",
518 		tx_streams, rx_streams);
519 
520 	if (tx_streams >= 2)
521 		ht_info->cap |= IEEE80211_HT_CAP_TX_STBC;
522 
523 	if (tx_streams != rx_streams) {
524 		ht_info->mcs.tx_params |= IEEE80211_HT_MCS_TX_RX_DIFF;
525 		ht_info->mcs.tx_params |= ((tx_streams - 1) <<
526 					   IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT);
527 	}
528 
529 	for (i = 0; i < rx_streams; i++)
530 		ht_info->mcs.rx_mask[i] = 0xff;
531 
532 	ht_info->mcs.tx_params |= IEEE80211_HT_MCS_TX_DEFINED;
533 }
534 
535 static int ath9k_init_queues(struct ath9k_htc_priv *priv)
536 {
537 	struct ath_common *common = ath9k_hw_common(priv->ah);
538 	int i;
539 
540 	for (i = 0; i < ARRAY_SIZE(priv->hwq_map); i++)
541 		priv->hwq_map[i] = -1;
542 
543 	priv->beaconq = ath9k_hw_beaconq_setup(priv->ah);
544 	if (priv->beaconq == -1) {
545 		ath_err(common, "Unable to setup BEACON xmit queue\n");
546 		goto err;
547 	}
548 
549 	priv->cabq = ath9k_htc_cabq_setup(priv);
550 	if (priv->cabq == -1) {
551 		ath_err(common, "Unable to setup CAB xmit queue\n");
552 		goto err;
553 	}
554 
555 	if (!ath9k_htc_txq_setup(priv, IEEE80211_AC_BE)) {
556 		ath_err(common, "Unable to setup xmit queue for BE traffic\n");
557 		goto err;
558 	}
559 
560 	if (!ath9k_htc_txq_setup(priv, IEEE80211_AC_BK)) {
561 		ath_err(common, "Unable to setup xmit queue for BK traffic\n");
562 		goto err;
563 	}
564 	if (!ath9k_htc_txq_setup(priv, IEEE80211_AC_VI)) {
565 		ath_err(common, "Unable to setup xmit queue for VI traffic\n");
566 		goto err;
567 	}
568 	if (!ath9k_htc_txq_setup(priv, IEEE80211_AC_VO)) {
569 		ath_err(common, "Unable to setup xmit queue for VO traffic\n");
570 		goto err;
571 	}
572 
573 	return 0;
574 
575 err:
576 	return -EINVAL;
577 }
578 
579 static void ath9k_init_channels_rates(struct ath9k_htc_priv *priv)
580 {
581 	if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_2GHZ) {
582 		priv->sbands[IEEE80211_BAND_2GHZ].channels =
583 			ath9k_2ghz_channels;
584 		priv->sbands[IEEE80211_BAND_2GHZ].band = IEEE80211_BAND_2GHZ;
585 		priv->sbands[IEEE80211_BAND_2GHZ].n_channels =
586 			ARRAY_SIZE(ath9k_2ghz_channels);
587 		priv->sbands[IEEE80211_BAND_2GHZ].bitrates = ath9k_legacy_rates;
588 		priv->sbands[IEEE80211_BAND_2GHZ].n_bitrates =
589 			ARRAY_SIZE(ath9k_legacy_rates);
590 	}
591 
592 	if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_5GHZ) {
593 		priv->sbands[IEEE80211_BAND_5GHZ].channels = ath9k_5ghz_channels;
594 		priv->sbands[IEEE80211_BAND_5GHZ].band = IEEE80211_BAND_5GHZ;
595 		priv->sbands[IEEE80211_BAND_5GHZ].n_channels =
596 			ARRAY_SIZE(ath9k_5ghz_channels);
597 		priv->sbands[IEEE80211_BAND_5GHZ].bitrates =
598 			ath9k_legacy_rates + 4;
599 		priv->sbands[IEEE80211_BAND_5GHZ].n_bitrates =
600 			ARRAY_SIZE(ath9k_legacy_rates) - 4;
601 	}
602 }
603 
604 static void ath9k_init_misc(struct ath9k_htc_priv *priv)
605 {
606 	struct ath_common *common = ath9k_hw_common(priv->ah);
607 
608 	memcpy(common->bssidmask, ath_bcast_mac, ETH_ALEN);
609 
610 	common->last_rssi = ATH_RSSI_DUMMY_MARKER;
611 	priv->ah->opmode = NL80211_IFTYPE_STATION;
612 }
613 
614 static int ath9k_init_priv(struct ath9k_htc_priv *priv,
615 			   u16 devid, char *product,
616 			   u32 drv_info)
617 {
618 	struct ath_hw *ah = NULL;
619 	struct ath_common *common;
620 	int i, ret = 0, csz = 0;
621 
622 	set_bit(OP_INVALID, &priv->op_flags);
623 
624 	ah = kzalloc(sizeof(struct ath_hw), GFP_KERNEL);
625 	if (!ah)
626 		return -ENOMEM;
627 
628 	ah->hw_version.devid = devid;
629 	ah->hw_version.usbdev = drv_info;
630 	ah->ah_flags |= AH_USE_EEPROM;
631 	ah->reg_ops.read = ath9k_regread;
632 	ah->reg_ops.multi_read = ath9k_multi_regread;
633 	ah->reg_ops.write = ath9k_regwrite;
634 	ah->reg_ops.enable_write_buffer = ath9k_enable_regwrite_buffer;
635 	ah->reg_ops.write_flush = ath9k_regwrite_flush;
636 	ah->reg_ops.rmw = ath9k_reg_rmw;
637 	priv->ah = ah;
638 
639 	common = ath9k_hw_common(ah);
640 	common->ops = &ah->reg_ops;
641 	common->bus_ops = &ath9k_usb_bus_ops;
642 	common->ah = ah;
643 	common->hw = priv->hw;
644 	common->priv = priv;
645 	common->debug_mask = ath9k_debug;
646 	common->btcoex_enabled = ath9k_htc_btcoex_enable == 1;
647 
648 	spin_lock_init(&priv->beacon_lock);
649 	spin_lock_init(&priv->tx.tx_lock);
650 	mutex_init(&priv->mutex);
651 	mutex_init(&priv->htc_pm_lock);
652 	tasklet_init(&priv->rx_tasklet, ath9k_rx_tasklet,
653 		     (unsigned long)priv);
654 	tasklet_init(&priv->tx_failed_tasklet, ath9k_tx_failed_tasklet,
655 		     (unsigned long)priv);
656 	INIT_DELAYED_WORK(&priv->ani_work, ath9k_htc_ani_work);
657 	INIT_WORK(&priv->ps_work, ath9k_ps_work);
658 	INIT_WORK(&priv->fatal_work, ath9k_fatal_work);
659 	setup_timer(&priv->tx.cleanup_timer, ath9k_htc_tx_cleanup_timer,
660 		    (unsigned long)priv);
661 
662 	/*
663 	 * Cache line size is used to size and align various
664 	 * structures used to communicate with the hardware.
665 	 */
666 	ath_read_cachesize(common, &csz);
667 	common->cachelsz = csz << 2; /* convert to bytes */
668 
669 	ret = ath9k_hw_init(ah);
670 	if (ret) {
671 		ath_err(common,
672 			"Unable to initialize hardware; initialization status: %d\n",
673 			ret);
674 		goto err_hw;
675 	}
676 
677 	ret = ath9k_init_queues(priv);
678 	if (ret)
679 		goto err_queues;
680 
681 	for (i = 0; i < ATH9K_HTC_MAX_BCN_VIF; i++)
682 		priv->cur_beacon_conf.bslot[i] = NULL;
683 
684 	ath9k_cmn_init_crypto(ah);
685 	ath9k_init_channels_rates(priv);
686 	ath9k_init_misc(priv);
687 	ath9k_htc_init_btcoex(priv, product);
688 
689 	return 0;
690 
691 err_queues:
692 	ath9k_hw_deinit(ah);
693 err_hw:
694 
695 	kfree(ah);
696 	priv->ah = NULL;
697 
698 	return ret;
699 }
700 
701 static const struct ieee80211_iface_limit if_limits[] = {
702 	{ .max = 2,	.types = BIT(NL80211_IFTYPE_STATION) |
703 				 BIT(NL80211_IFTYPE_P2P_CLIENT) },
704 	{ .max = 2,	.types = BIT(NL80211_IFTYPE_AP) |
705 #ifdef CONFIG_MAC80211_MESH
706 				 BIT(NL80211_IFTYPE_MESH_POINT) |
707 #endif
708 				 BIT(NL80211_IFTYPE_P2P_GO) },
709 };
710 
711 static const struct ieee80211_iface_combination if_comb = {
712 	.limits = if_limits,
713 	.n_limits = ARRAY_SIZE(if_limits),
714 	.max_interfaces = 2,
715 	.num_different_channels = 1,
716 };
717 
718 static void ath9k_set_hw_capab(struct ath9k_htc_priv *priv,
719 			       struct ieee80211_hw *hw)
720 {
721 	struct ath_common *common = ath9k_hw_common(priv->ah);
722 	struct base_eep_header *pBase;
723 
724 	hw->flags = IEEE80211_HW_SIGNAL_DBM |
725 		IEEE80211_HW_AMPDU_AGGREGATION |
726 		IEEE80211_HW_SPECTRUM_MGMT |
727 		IEEE80211_HW_HAS_RATE_CONTROL |
728 		IEEE80211_HW_RX_INCLUDES_FCS |
729 		IEEE80211_HW_SUPPORTS_PS |
730 		IEEE80211_HW_PS_NULLFUNC_STACK |
731 		IEEE80211_HW_REPORTS_TX_ACK_STATUS |
732 		IEEE80211_HW_MFP_CAPABLE |
733 		IEEE80211_HW_HOST_BROADCAST_PS_BUFFERING;
734 
735 	hw->wiphy->interface_modes =
736 		BIT(NL80211_IFTYPE_STATION) |
737 		BIT(NL80211_IFTYPE_ADHOC) |
738 		BIT(NL80211_IFTYPE_AP) |
739 		BIT(NL80211_IFTYPE_P2P_GO) |
740 		BIT(NL80211_IFTYPE_P2P_CLIENT) |
741 		BIT(NL80211_IFTYPE_MESH_POINT);
742 
743 	hw->wiphy->iface_combinations = &if_comb;
744 	hw->wiphy->n_iface_combinations = 1;
745 
746 	hw->wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT;
747 
748 	hw->wiphy->flags |= WIPHY_FLAG_IBSS_RSN |
749 			    WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL;
750 
751 	hw->queues = 4;
752 	hw->max_listen_interval = 1;
753 
754 	hw->vif_data_size = sizeof(struct ath9k_htc_vif);
755 	hw->sta_data_size = sizeof(struct ath9k_htc_sta);
756 
757 	/* tx_frame_hdr is larger than tx_mgmt_hdr anyway */
758 	hw->extra_tx_headroom = sizeof(struct tx_frame_hdr) +
759 		sizeof(struct htc_frame_hdr) + 4;
760 
761 	if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_2GHZ)
762 		hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
763 			&priv->sbands[IEEE80211_BAND_2GHZ];
764 	if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_5GHZ)
765 		hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
766 			&priv->sbands[IEEE80211_BAND_5GHZ];
767 
768 	if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_HT) {
769 		if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_2GHZ)
770 			setup_ht_cap(priv,
771 				     &priv->sbands[IEEE80211_BAND_2GHZ].ht_cap);
772 		if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_5GHZ)
773 			setup_ht_cap(priv,
774 				     &priv->sbands[IEEE80211_BAND_5GHZ].ht_cap);
775 	}
776 
777 	pBase = ath9k_htc_get_eeprom_base(priv);
778 	if (pBase) {
779 		hw->wiphy->available_antennas_rx = pBase->rxMask;
780 		hw->wiphy->available_antennas_tx = pBase->txMask;
781 	}
782 
783 	SET_IEEE80211_PERM_ADDR(hw, common->macaddr);
784 }
785 
786 static int ath9k_init_firmware_version(struct ath9k_htc_priv *priv)
787 {
788 	struct ieee80211_hw *hw = priv->hw;
789 	struct wmi_fw_version cmd_rsp;
790 	int ret;
791 
792 	memset(&cmd_rsp, 0, sizeof(cmd_rsp));
793 
794 	WMI_CMD(WMI_GET_FW_VERSION);
795 	if (ret)
796 		return -EINVAL;
797 
798 	priv->fw_version_major = be16_to_cpu(cmd_rsp.major);
799 	priv->fw_version_minor = be16_to_cpu(cmd_rsp.minor);
800 
801 	snprintf(hw->wiphy->fw_version, sizeof(hw->wiphy->fw_version), "%d.%d",
802 		 priv->fw_version_major,
803 		 priv->fw_version_minor);
804 
805 	dev_info(priv->dev, "ath9k_htc: FW Version: %d.%d\n",
806 		 priv->fw_version_major,
807 		 priv->fw_version_minor);
808 
809 	/*
810 	 * Check if the available FW matches the driver's
811 	 * required version.
812 	 */
813 	if (priv->fw_version_major != MAJOR_VERSION_REQ ||
814 	    priv->fw_version_minor < MINOR_VERSION_REQ) {
815 		dev_err(priv->dev, "ath9k_htc: Please upgrade to FW version %d.%d\n",
816 			MAJOR_VERSION_REQ, MINOR_VERSION_REQ);
817 		return -EINVAL;
818 	}
819 
820 	return 0;
821 }
822 
823 static int ath9k_init_device(struct ath9k_htc_priv *priv,
824 			     u16 devid, char *product, u32 drv_info)
825 {
826 	struct ieee80211_hw *hw = priv->hw;
827 	struct ath_common *common;
828 	struct ath_hw *ah;
829 	int error = 0;
830 	struct ath_regulatory *reg;
831 	char hw_name[64];
832 
833 	/* Bring up device */
834 	error = ath9k_init_priv(priv, devid, product, drv_info);
835 	if (error != 0)
836 		goto err_init;
837 
838 	ah = priv->ah;
839 	common = ath9k_hw_common(ah);
840 	ath9k_set_hw_capab(priv, hw);
841 
842 	error = ath9k_init_firmware_version(priv);
843 	if (error != 0)
844 		goto err_fw;
845 
846 	/* Initialize regulatory */
847 	error = ath_regd_init(&common->regulatory, priv->hw->wiphy,
848 			      ath9k_reg_notifier);
849 	if (error)
850 		goto err_regd;
851 
852 	reg = &common->regulatory;
853 
854 	/* Setup TX */
855 	error = ath9k_tx_init(priv);
856 	if (error != 0)
857 		goto err_tx;
858 
859 	/* Setup RX */
860 	error = ath9k_rx_init(priv);
861 	if (error != 0)
862 		goto err_rx;
863 
864 	ath9k_hw_disable(priv->ah);
865 #ifdef CONFIG_MAC80211_LEDS
866 	/* must be initialized before ieee80211_register_hw */
867 	priv->led_cdev.default_trigger = ieee80211_create_tpt_led_trigger(priv->hw,
868 		IEEE80211_TPT_LEDTRIG_FL_RADIO, ath9k_htc_tpt_blink,
869 		ARRAY_SIZE(ath9k_htc_tpt_blink));
870 #endif
871 
872 	/* Register with mac80211 */
873 	error = ieee80211_register_hw(hw);
874 	if (error)
875 		goto err_register;
876 
877 	/* Handle world regulatory */
878 	if (!ath_is_world_regd(reg)) {
879 		error = regulatory_hint(hw->wiphy, reg->alpha2);
880 		if (error)
881 			goto err_world;
882 	}
883 
884 	error = ath9k_htc_init_debug(priv->ah);
885 	if (error) {
886 		ath_err(common, "Unable to create debugfs files\n");
887 		goto err_world;
888 	}
889 
890 	ath_dbg(common, CONFIG,
891 		"WMI:%d, BCN:%d, CAB:%d, UAPSD:%d, MGMT:%d, BE:%d, BK:%d, VI:%d, VO:%d\n",
892 		priv->wmi_cmd_ep,
893 		priv->beacon_ep,
894 		priv->cab_ep,
895 		priv->uapsd_ep,
896 		priv->mgmt_ep,
897 		priv->data_be_ep,
898 		priv->data_bk_ep,
899 		priv->data_vi_ep,
900 		priv->data_vo_ep);
901 
902 	ath9k_hw_name(priv->ah, hw_name, sizeof(hw_name));
903 	wiphy_info(hw->wiphy, "%s\n", hw_name);
904 
905 	ath9k_init_leds(priv);
906 	ath9k_start_rfkill_poll(priv);
907 
908 	return 0;
909 
910 err_world:
911 	ieee80211_unregister_hw(hw);
912 err_register:
913 	ath9k_rx_cleanup(priv);
914 err_rx:
915 	ath9k_tx_cleanup(priv);
916 err_tx:
917 	/* Nothing */
918 err_regd:
919 	/* Nothing */
920 err_fw:
921 	ath9k_deinit_priv(priv);
922 err_init:
923 	return error;
924 }
925 
926 int ath9k_htc_probe_device(struct htc_target *htc_handle, struct device *dev,
927 			   u16 devid, char *product, u32 drv_info)
928 {
929 	struct ieee80211_hw *hw;
930 	struct ath9k_htc_priv *priv;
931 	int ret;
932 
933 	hw = ieee80211_alloc_hw(sizeof(struct ath9k_htc_priv), &ath9k_htc_ops);
934 	if (!hw)
935 		return -ENOMEM;
936 
937 	priv = hw->priv;
938 	priv->hw = hw;
939 	priv->htc = htc_handle;
940 	priv->dev = dev;
941 	htc_handle->drv_priv = priv;
942 	SET_IEEE80211_DEV(hw, priv->dev);
943 
944 	ret = ath9k_htc_wait_for_target(priv);
945 	if (ret)
946 		goto err_free;
947 
948 	priv->wmi = ath9k_init_wmi(priv);
949 	if (!priv->wmi) {
950 		ret = -EINVAL;
951 		goto err_free;
952 	}
953 
954 	ret = ath9k_init_htc_services(priv, devid, drv_info);
955 	if (ret)
956 		goto err_init;
957 
958 	ret = ath9k_init_device(priv, devid, product, drv_info);
959 	if (ret)
960 		goto err_init;
961 
962 	return 0;
963 
964 err_init:
965 	ath9k_deinit_wmi(priv);
966 err_free:
967 	ieee80211_free_hw(hw);
968 	return ret;
969 }
970 
971 void ath9k_htc_disconnect_device(struct htc_target *htc_handle, bool hotunplug)
972 {
973 	if (htc_handle->drv_priv) {
974 
975 		/* Check if the device has been yanked out. */
976 		if (hotunplug)
977 			htc_handle->drv_priv->ah->ah_flags |= AH_UNPLUGGED;
978 
979 		ath9k_deinit_device(htc_handle->drv_priv);
980 		ath9k_deinit_wmi(htc_handle->drv_priv);
981 		ieee80211_free_hw(htc_handle->drv_priv->hw);
982 	}
983 }
984 
985 #ifdef CONFIG_PM
986 
987 void ath9k_htc_suspend(struct htc_target *htc_handle)
988 {
989 	ath9k_htc_setpower(htc_handle->drv_priv, ATH9K_PM_FULL_SLEEP);
990 }
991 
992 int ath9k_htc_resume(struct htc_target *htc_handle)
993 {
994 	struct ath9k_htc_priv *priv = htc_handle->drv_priv;
995 	int ret;
996 
997 	ret = ath9k_htc_wait_for_target(priv);
998 	if (ret)
999 		return ret;
1000 
1001 	ret = ath9k_init_htc_services(priv, priv->ah->hw_version.devid,
1002 				      priv->ah->hw_version.usbdev);
1003 	ath9k_configure_leds(priv);
1004 
1005 	return ret;
1006 }
1007 #endif
1008 
1009 static int __init ath9k_htc_init(void)
1010 {
1011 	if (ath9k_hif_usb_init() < 0) {
1012 		pr_err("No USB devices found, driver not installed\n");
1013 		return -ENODEV;
1014 	}
1015 
1016 	return 0;
1017 }
1018 module_init(ath9k_htc_init);
1019 
1020 static void __exit ath9k_htc_exit(void)
1021 {
1022 	ath9k_hif_usb_exit();
1023 	pr_info("Driver unloaded\n");
1024 }
1025 module_exit(ath9k_htc_exit);
1026