xref: /linux/drivers/net/wireless/ath/ath9k/htc_drv_init.c (revision 95298d63c67673c654c08952672d016212b26054)
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 static int ath9k_ps_enable;
38 module_param_named(ps_enable, ath9k_ps_enable, int, 0444);
39 MODULE_PARM_DESC(ps_enable, "Enable WLAN PowerSave");
40 
41 int htc_use_dev_fw = 0;
42 module_param_named(use_dev_fw, htc_use_dev_fw, int, 0444);
43 MODULE_PARM_DESC(use_dev_fw, "Use development FW version");
44 
45 #ifdef CONFIG_MAC80211_LEDS
46 int ath9k_htc_led_blink = 1;
47 module_param_named(blink, ath9k_htc_led_blink, int, 0444);
48 MODULE_PARM_DESC(blink, "Enable LED blink on activity");
49 
50 static const struct ieee80211_tpt_blink ath9k_htc_tpt_blink[] = {
51 	{ .throughput = 0 * 1024, .blink_time = 334 },
52 	{ .throughput = 1 * 1024, .blink_time = 260 },
53 	{ .throughput = 5 * 1024, .blink_time = 220 },
54 	{ .throughput = 10 * 1024, .blink_time = 190 },
55 	{ .throughput = 20 * 1024, .blink_time = 170 },
56 	{ .throughput = 50 * 1024, .blink_time = 150 },
57 	{ .throughput = 70 * 1024, .blink_time = 130 },
58 	{ .throughput = 100 * 1024, .blink_time = 110 },
59 	{ .throughput = 200 * 1024, .blink_time = 80 },
60 	{ .throughput = 300 * 1024, .blink_time = 50 },
61 };
62 #endif
63 
64 static void ath9k_htc_op_ps_wakeup(struct ath_common *common)
65 {
66 	ath9k_htc_ps_wakeup((struct ath9k_htc_priv *) common->priv);
67 }
68 
69 static void ath9k_htc_op_ps_restore(struct ath_common *common)
70 {
71 	ath9k_htc_ps_restore((struct ath9k_htc_priv *) common->priv);
72 }
73 
74 static const struct ath_ps_ops ath9k_htc_ps_ops = {
75 	.wakeup = ath9k_htc_op_ps_wakeup,
76 	.restore = ath9k_htc_op_ps_restore,
77 };
78 
79 static int ath9k_htc_wait_for_target(struct ath9k_htc_priv *priv)
80 {
81 	unsigned long time_left;
82 
83 	if (atomic_read(&priv->htc->tgt_ready) > 0) {
84 		atomic_dec(&priv->htc->tgt_ready);
85 		return 0;
86 	}
87 
88 	/* Firmware can take up to 50ms to get ready, to be safe use 1 second */
89 	time_left = wait_for_completion_timeout(&priv->htc->target_wait, HZ);
90 	if (!time_left) {
91 		dev_err(priv->dev, "ath9k_htc: Target is unresponsive\n");
92 		return -ETIMEDOUT;
93 	}
94 
95 	atomic_dec(&priv->htc->tgt_ready);
96 
97 	return 0;
98 }
99 
100 static void ath9k_deinit_priv(struct ath9k_htc_priv *priv)
101 {
102 	ath9k_hw_deinit(priv->ah);
103 	kfree(priv->ah);
104 	priv->ah = NULL;
105 }
106 
107 static void ath9k_deinit_device(struct ath9k_htc_priv *priv)
108 {
109 	struct ieee80211_hw *hw = priv->hw;
110 
111 	wiphy_rfkill_stop_polling(hw->wiphy);
112 	ath9k_deinit_leds(priv);
113 	ath9k_htc_deinit_debug(priv);
114 	ieee80211_unregister_hw(hw);
115 	ath9k_rx_cleanup(priv);
116 	ath9k_tx_cleanup(priv);
117 	ath9k_deinit_priv(priv);
118 }
119 
120 static inline int ath9k_htc_connect_svc(struct ath9k_htc_priv *priv,
121 					u16 service_id,
122 					void (*tx) (void *,
123 						    struct sk_buff *,
124 						    enum htc_endpoint_id,
125 						    bool txok),
126 					enum htc_endpoint_id *ep_id)
127 {
128 	struct htc_service_connreq req;
129 
130 	memset(&req, 0, sizeof(struct htc_service_connreq));
131 
132 	req.service_id = service_id;
133 	req.ep_callbacks.priv = priv;
134 	req.ep_callbacks.rx = ath9k_htc_rxep;
135 	req.ep_callbacks.tx = tx;
136 
137 	return htc_connect_service(priv->htc, &req, ep_id);
138 }
139 
140 static int ath9k_init_htc_services(struct ath9k_htc_priv *priv, u16 devid,
141 				   u32 drv_info)
142 {
143 	int ret;
144 
145 	/* WMI CMD*/
146 	ret = ath9k_wmi_connect(priv->htc, priv->wmi, &priv->wmi_cmd_ep);
147 	if (ret)
148 		goto err;
149 
150 	/* Beacon */
151 	ret = ath9k_htc_connect_svc(priv, WMI_BEACON_SVC, ath9k_htc_beaconep,
152 				    &priv->beacon_ep);
153 	if (ret)
154 		goto err;
155 
156 	/* CAB */
157 	ret = ath9k_htc_connect_svc(priv, WMI_CAB_SVC, ath9k_htc_txep,
158 				    &priv->cab_ep);
159 	if (ret)
160 		goto err;
161 
162 
163 	/* UAPSD */
164 	ret = ath9k_htc_connect_svc(priv, WMI_UAPSD_SVC, ath9k_htc_txep,
165 				    &priv->uapsd_ep);
166 	if (ret)
167 		goto err;
168 
169 	/* MGMT */
170 	ret = ath9k_htc_connect_svc(priv, WMI_MGMT_SVC, ath9k_htc_txep,
171 				    &priv->mgmt_ep);
172 	if (ret)
173 		goto err;
174 
175 	/* DATA BE */
176 	ret = ath9k_htc_connect_svc(priv, WMI_DATA_BE_SVC, ath9k_htc_txep,
177 				    &priv->data_be_ep);
178 	if (ret)
179 		goto err;
180 
181 	/* DATA BK */
182 	ret = ath9k_htc_connect_svc(priv, WMI_DATA_BK_SVC, ath9k_htc_txep,
183 				    &priv->data_bk_ep);
184 	if (ret)
185 		goto err;
186 
187 	/* DATA VI */
188 	ret = ath9k_htc_connect_svc(priv, WMI_DATA_VI_SVC, ath9k_htc_txep,
189 				    &priv->data_vi_ep);
190 	if (ret)
191 		goto err;
192 
193 	/* DATA VO */
194 	ret = ath9k_htc_connect_svc(priv, WMI_DATA_VO_SVC, ath9k_htc_txep,
195 				    &priv->data_vo_ep);
196 	if (ret)
197 		goto err;
198 
199 	/*
200 	 * Setup required credits before initializing HTC.
201 	 * This is a bit hacky, but, since queuing is done in
202 	 * the HIF layer, shouldn't matter much.
203 	 */
204 
205 	if (IS_AR7010_DEVICE(drv_info))
206 		priv->htc->credits = 45;
207 	else
208 		priv->htc->credits = 33;
209 
210 	ret = htc_init(priv->htc);
211 	if (ret)
212 		goto err;
213 
214 	dev_info(priv->dev, "ath9k_htc: HTC initialized with %d credits\n",
215 		 priv->htc->credits);
216 
217 	return 0;
218 
219 err:
220 	dev_err(priv->dev, "ath9k_htc: Unable to initialize HTC services\n");
221 	return ret;
222 }
223 
224 static void ath9k_reg_notifier(struct wiphy *wiphy,
225 			       struct regulatory_request *request)
226 {
227 	struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy);
228 	struct ath9k_htc_priv *priv = hw->priv;
229 
230 	ath_reg_notifier_apply(wiphy, request,
231 			       ath9k_hw_regulatory(priv->ah));
232 }
233 
234 static unsigned int ath9k_regread(void *hw_priv, u32 reg_offset)
235 {
236 	struct ath_hw *ah = hw_priv;
237 	struct ath_common *common = ath9k_hw_common(ah);
238 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
239 	__be32 val, reg = cpu_to_be32(reg_offset);
240 	int r;
241 
242 	r = ath9k_wmi_cmd(priv->wmi, WMI_REG_READ_CMDID,
243 			  (u8 *) &reg, sizeof(reg),
244 			  (u8 *) &val, sizeof(val),
245 			  100);
246 	if (unlikely(r)) {
247 		ath_dbg(common, WMI, "REGISTER READ FAILED: (0x%04x, %d)\n",
248 			reg_offset, r);
249 		return -EIO;
250 	}
251 
252 	return be32_to_cpu(val);
253 }
254 
255 static void ath9k_multi_regread(void *hw_priv, u32 *addr,
256 				u32 *val, u16 count)
257 {
258 	struct ath_hw *ah = hw_priv;
259 	struct ath_common *common = ath9k_hw_common(ah);
260 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
261 	__be32 tmpaddr[8];
262 	__be32 tmpval[8];
263 	int i, ret;
264 
265 	for (i = 0; i < count; i++) {
266 		tmpaddr[i] = cpu_to_be32(addr[i]);
267 	}
268 
269 	ret = ath9k_wmi_cmd(priv->wmi, WMI_REG_READ_CMDID,
270 			   (u8 *)tmpaddr , sizeof(u32) * count,
271 			   (u8 *)tmpval, sizeof(u32) * count,
272 			   100);
273 	if (unlikely(ret)) {
274 		ath_dbg(common, WMI,
275 			"Multiple REGISTER READ FAILED (count: %d)\n", count);
276 	}
277 
278 	for (i = 0; i < count; i++) {
279 		val[i] = be32_to_cpu(tmpval[i]);
280 	}
281 }
282 
283 static void ath9k_regwrite_multi(struct ath_common *common)
284 {
285 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
286 	u32 rsp_status;
287 	int r;
288 
289 	r = ath9k_wmi_cmd(priv->wmi, WMI_REG_WRITE_CMDID,
290 			  (u8 *) &priv->wmi->multi_write,
291 			  sizeof(struct register_write) * priv->wmi->multi_write_idx,
292 			  (u8 *) &rsp_status, sizeof(rsp_status),
293 			  100);
294 	if (unlikely(r)) {
295 		ath_dbg(common, WMI,
296 			"REGISTER WRITE FAILED, multi len: %d\n",
297 			priv->wmi->multi_write_idx);
298 	}
299 	priv->wmi->multi_write_idx = 0;
300 }
301 
302 static void ath9k_regwrite_single(void *hw_priv, u32 val, u32 reg_offset)
303 {
304 	struct ath_hw *ah = hw_priv;
305 	struct ath_common *common = ath9k_hw_common(ah);
306 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
307 	const __be32 buf[2] = {
308 		cpu_to_be32(reg_offset),
309 		cpu_to_be32(val),
310 	};
311 	int r;
312 
313 	r = ath9k_wmi_cmd(priv->wmi, WMI_REG_WRITE_CMDID,
314 			  (u8 *) &buf, sizeof(buf),
315 			  (u8 *) &val, sizeof(val),
316 			  100);
317 	if (unlikely(r)) {
318 		ath_dbg(common, WMI, "REGISTER WRITE FAILED:(0x%04x, %d)\n",
319 			reg_offset, r);
320 	}
321 }
322 
323 static void ath9k_regwrite_buffer(void *hw_priv, u32 val, u32 reg_offset)
324 {
325 	struct ath_hw *ah = hw_priv;
326 	struct ath_common *common = ath9k_hw_common(ah);
327 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
328 
329 	mutex_lock(&priv->wmi->multi_write_mutex);
330 
331 	/* Store the register/value */
332 	priv->wmi->multi_write[priv->wmi->multi_write_idx].reg =
333 		cpu_to_be32(reg_offset);
334 	priv->wmi->multi_write[priv->wmi->multi_write_idx].val =
335 		cpu_to_be32(val);
336 
337 	priv->wmi->multi_write_idx++;
338 
339 	/* If the buffer is full, send it out. */
340 	if (priv->wmi->multi_write_idx == MAX_CMD_NUMBER)
341 		ath9k_regwrite_multi(common);
342 
343 	mutex_unlock(&priv->wmi->multi_write_mutex);
344 }
345 
346 static void ath9k_regwrite(void *hw_priv, u32 val, u32 reg_offset)
347 {
348 	struct ath_hw *ah = hw_priv;
349 	struct ath_common *common = ath9k_hw_common(ah);
350 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
351 
352 	if (atomic_read(&priv->wmi->mwrite_cnt))
353 		ath9k_regwrite_buffer(hw_priv, val, reg_offset);
354 	else
355 		ath9k_regwrite_single(hw_priv, val, reg_offset);
356 }
357 
358 static void ath9k_enable_regwrite_buffer(void *hw_priv)
359 {
360 	struct ath_hw *ah = hw_priv;
361 	struct ath_common *common = ath9k_hw_common(ah);
362 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
363 
364 	atomic_inc(&priv->wmi->mwrite_cnt);
365 }
366 
367 static void ath9k_regwrite_flush(void *hw_priv)
368 {
369 	struct ath_hw *ah = hw_priv;
370 	struct ath_common *common = ath9k_hw_common(ah);
371 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
372 
373 	atomic_dec(&priv->wmi->mwrite_cnt);
374 
375 	mutex_lock(&priv->wmi->multi_write_mutex);
376 
377 	if (priv->wmi->multi_write_idx)
378 		ath9k_regwrite_multi(common);
379 
380 	mutex_unlock(&priv->wmi->multi_write_mutex);
381 }
382 
383 static void ath9k_reg_rmw_buffer(void *hw_priv,
384 				 u32 reg_offset, u32 set, u32 clr)
385 {
386 	struct ath_hw *ah = hw_priv;
387 	struct ath_common *common = ath9k_hw_common(ah);
388 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
389 	u32 rsp_status;
390 	int r;
391 
392 	mutex_lock(&priv->wmi->multi_rmw_mutex);
393 
394 	/* Store the register/value */
395 	priv->wmi->multi_rmw[priv->wmi->multi_rmw_idx].reg =
396 		cpu_to_be32(reg_offset);
397 	priv->wmi->multi_rmw[priv->wmi->multi_rmw_idx].set =
398 		cpu_to_be32(set);
399 	priv->wmi->multi_rmw[priv->wmi->multi_rmw_idx].clr =
400 		cpu_to_be32(clr);
401 
402 	priv->wmi->multi_rmw_idx++;
403 
404 	/* If the buffer is full, send it out. */
405 	if (priv->wmi->multi_rmw_idx == MAX_RMW_CMD_NUMBER) {
406 		r = ath9k_wmi_cmd(priv->wmi, WMI_REG_RMW_CMDID,
407 			  (u8 *) &priv->wmi->multi_rmw,
408 			  sizeof(struct register_write) * priv->wmi->multi_rmw_idx,
409 			  (u8 *) &rsp_status, sizeof(rsp_status),
410 			  100);
411 		if (unlikely(r)) {
412 			ath_dbg(common, WMI,
413 				"REGISTER RMW FAILED, multi len: %d\n",
414 				priv->wmi->multi_rmw_idx);
415 		}
416 		priv->wmi->multi_rmw_idx = 0;
417 	}
418 
419 	mutex_unlock(&priv->wmi->multi_rmw_mutex);
420 }
421 
422 static void ath9k_reg_rmw_flush(void *hw_priv)
423 {
424 	struct ath_hw *ah = hw_priv;
425 	struct ath_common *common = ath9k_hw_common(ah);
426 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
427 	u32 rsp_status;
428 	int r;
429 
430 	if (test_bit(HTC_FWFLAG_NO_RMW, &priv->fw_flags))
431 		return;
432 
433 	atomic_dec(&priv->wmi->m_rmw_cnt);
434 
435 	mutex_lock(&priv->wmi->multi_rmw_mutex);
436 
437 	if (priv->wmi->multi_rmw_idx) {
438 		r = ath9k_wmi_cmd(priv->wmi, WMI_REG_RMW_CMDID,
439 			  (u8 *) &priv->wmi->multi_rmw,
440 			  sizeof(struct register_rmw) * priv->wmi->multi_rmw_idx,
441 			  (u8 *) &rsp_status, sizeof(rsp_status),
442 			  100);
443 		if (unlikely(r)) {
444 			ath_dbg(common, WMI,
445 				"REGISTER RMW FAILED, multi len: %d\n",
446 				priv->wmi->multi_rmw_idx);
447 		}
448 		priv->wmi->multi_rmw_idx = 0;
449 	}
450 
451 	mutex_unlock(&priv->wmi->multi_rmw_mutex);
452 }
453 
454 static void ath9k_enable_rmw_buffer(void *hw_priv)
455 {
456 	struct ath_hw *ah = hw_priv;
457 	struct ath_common *common = ath9k_hw_common(ah);
458 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
459 
460 	if (test_bit(HTC_FWFLAG_NO_RMW, &priv->fw_flags))
461 		return;
462 
463 	atomic_inc(&priv->wmi->m_rmw_cnt);
464 }
465 
466 static void ath9k_reg_rmw_single(void *hw_priv,
467 				 u32 reg_offset, u32 set, u32 clr)
468 {
469 	struct ath_hw *ah = hw_priv;
470 	struct ath_common *common = ath9k_hw_common(ah);
471 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
472 	struct register_rmw buf, buf_ret;
473 	int ret;
474 
475 	buf.reg = cpu_to_be32(reg_offset);
476 	buf.set = cpu_to_be32(set);
477 	buf.clr = cpu_to_be32(clr);
478 
479 	ret = ath9k_wmi_cmd(priv->wmi, WMI_REG_RMW_CMDID,
480 			  (u8 *) &buf, sizeof(buf),
481 			  (u8 *) &buf_ret, sizeof(buf_ret),
482 			  100);
483 	if (unlikely(ret)) {
484 		ath_dbg(common, WMI, "REGISTER RMW FAILED:(0x%04x, %d)\n",
485 			reg_offset, ret);
486 	}
487 }
488 
489 static u32 ath9k_reg_rmw(void *hw_priv, u32 reg_offset, u32 set, u32 clr)
490 {
491 	struct ath_hw *ah = hw_priv;
492 	struct ath_common *common = ath9k_hw_common(ah);
493 	struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
494 
495 	if (test_bit(HTC_FWFLAG_NO_RMW, &priv->fw_flags)) {
496 		u32 val;
497 
498 		val = REG_READ(ah, reg_offset);
499 		val &= ~clr;
500 		val |= set;
501 		REG_WRITE(ah, reg_offset, val);
502 
503 		return 0;
504 	}
505 
506 	if (atomic_read(&priv->wmi->m_rmw_cnt))
507 		ath9k_reg_rmw_buffer(hw_priv, reg_offset, set, clr);
508 	else
509 		ath9k_reg_rmw_single(hw_priv, reg_offset, set, clr);
510 
511 	return 0;
512 }
513 
514 static void ath_usb_read_cachesize(struct ath_common *common, int *csz)
515 {
516 	*csz = L1_CACHE_BYTES >> 2;
517 }
518 
519 static bool ath_usb_eeprom_read(struct ath_common *common, u32 off, u16 *data)
520 {
521 	struct ath_hw *ah = (struct ath_hw *) common->ah;
522 
523 	(void)REG_READ(ah, AR5416_EEPROM_OFFSET + (off << AR5416_EEPROM_S));
524 
525 	if (!ath9k_hw_wait(ah,
526 			   AR_EEPROM_STATUS_DATA,
527 			   AR_EEPROM_STATUS_DATA_BUSY |
528 			   AR_EEPROM_STATUS_DATA_PROT_ACCESS, 0,
529 			   AH_WAIT_TIMEOUT))
530 		return false;
531 
532 	*data = MS(REG_READ(ah, AR_EEPROM_STATUS_DATA),
533 		   AR_EEPROM_STATUS_DATA_VAL);
534 
535 	return true;
536 }
537 
538 static const struct ath_bus_ops ath9k_usb_bus_ops = {
539 	.ath_bus_type = ATH_USB,
540 	.read_cachesize = ath_usb_read_cachesize,
541 	.eeprom_read = ath_usb_eeprom_read,
542 };
543 
544 static int ath9k_init_queues(struct ath9k_htc_priv *priv)
545 {
546 	struct ath_common *common = ath9k_hw_common(priv->ah);
547 	int i;
548 
549 	for (i = 0; i < ARRAY_SIZE(priv->hwq_map); i++)
550 		priv->hwq_map[i] = -1;
551 
552 	priv->beacon.beaconq = ath9k_hw_beaconq_setup(priv->ah);
553 	if (priv->beacon.beaconq == -1) {
554 		ath_err(common, "Unable to setup BEACON xmit queue\n");
555 		goto err;
556 	}
557 
558 	priv->cabq = ath9k_htc_cabq_setup(priv);
559 	if (priv->cabq == -1) {
560 		ath_err(common, "Unable to setup CAB xmit queue\n");
561 		goto err;
562 	}
563 
564 	if (!ath9k_htc_txq_setup(priv, IEEE80211_AC_BE)) {
565 		ath_err(common, "Unable to setup xmit queue for BE traffic\n");
566 		goto err;
567 	}
568 
569 	if (!ath9k_htc_txq_setup(priv, IEEE80211_AC_BK)) {
570 		ath_err(common, "Unable to setup xmit queue for BK traffic\n");
571 		goto err;
572 	}
573 	if (!ath9k_htc_txq_setup(priv, IEEE80211_AC_VI)) {
574 		ath_err(common, "Unable to setup xmit queue for VI traffic\n");
575 		goto err;
576 	}
577 	if (!ath9k_htc_txq_setup(priv, IEEE80211_AC_VO)) {
578 		ath_err(common, "Unable to setup xmit queue for VO traffic\n");
579 		goto err;
580 	}
581 
582 	return 0;
583 
584 err:
585 	return -EINVAL;
586 }
587 
588 static void ath9k_init_misc(struct ath9k_htc_priv *priv)
589 {
590 	struct ath_common *common = ath9k_hw_common(priv->ah);
591 
592 	eth_broadcast_addr(common->bssidmask);
593 
594 	common->last_rssi = ATH_RSSI_DUMMY_MARKER;
595 	priv->ah->opmode = NL80211_IFTYPE_STATION;
596 
597 	priv->spec_priv.ah = priv->ah;
598 	priv->spec_priv.spec_config.enabled = 0;
599 	priv->spec_priv.spec_config.short_repeat = true;
600 	priv->spec_priv.spec_config.count = 8;
601 	priv->spec_priv.spec_config.endless = false;
602 	priv->spec_priv.spec_config.period = 0x12;
603 	priv->spec_priv.spec_config.fft_period = 0x02;
604 }
605 
606 static int ath9k_init_priv(struct ath9k_htc_priv *priv,
607 			   u16 devid, char *product,
608 			   u32 drv_info)
609 {
610 	struct ath_hw *ah = NULL;
611 	struct ath_common *common;
612 	int i, ret = 0, csz = 0;
613 
614 	ah = kzalloc(sizeof(struct ath_hw), GFP_KERNEL);
615 	if (!ah)
616 		return -ENOMEM;
617 
618 	ah->dev = priv->dev;
619 	ah->hw = priv->hw;
620 	ah->hw_version.devid = devid;
621 	ah->hw_version.usbdev = drv_info;
622 	ah->ah_flags |= AH_USE_EEPROM;
623 	ah->reg_ops.read = ath9k_regread;
624 	ah->reg_ops.multi_read = ath9k_multi_regread;
625 	ah->reg_ops.write = ath9k_regwrite;
626 	ah->reg_ops.enable_write_buffer = ath9k_enable_regwrite_buffer;
627 	ah->reg_ops.write_flush = ath9k_regwrite_flush;
628 	ah->reg_ops.enable_rmw_buffer = ath9k_enable_rmw_buffer;
629 	ah->reg_ops.rmw_flush = ath9k_reg_rmw_flush;
630 	ah->reg_ops.rmw = ath9k_reg_rmw;
631 	priv->ah = ah;
632 
633 	common = ath9k_hw_common(ah);
634 	common->ops = &ah->reg_ops;
635 	common->ps_ops = &ath9k_htc_ps_ops;
636 	common->bus_ops = &ath9k_usb_bus_ops;
637 	common->ah = ah;
638 	common->hw = priv->hw;
639 	common->priv = priv;
640 	common->debug_mask = ath9k_debug;
641 	common->btcoex_enabled = ath9k_htc_btcoex_enable == 1;
642 	set_bit(ATH_OP_INVALID, &common->op_flags);
643 
644 	spin_lock_init(&priv->beacon_lock);
645 	spin_lock_init(&priv->tx.tx_lock);
646 	mutex_init(&priv->mutex);
647 	mutex_init(&priv->htc_pm_lock);
648 	tasklet_init(&priv->rx_tasklet, ath9k_rx_tasklet,
649 		     (unsigned long)priv);
650 	tasklet_init(&priv->tx_failed_tasklet, ath9k_tx_failed_tasklet,
651 		     (unsigned long)priv);
652 	INIT_DELAYED_WORK(&priv->ani_work, ath9k_htc_ani_work);
653 	INIT_WORK(&priv->ps_work, ath9k_ps_work);
654 	INIT_WORK(&priv->fatal_work, ath9k_fatal_work);
655 	timer_setup(&priv->tx.cleanup_timer, ath9k_htc_tx_cleanup_timer, 0);
656 
657 	/*
658 	 * Cache line size is used to size and align various
659 	 * structures used to communicate with the hardware.
660 	 */
661 	ath_read_cachesize(common, &csz);
662 	common->cachelsz = csz << 2; /* convert to bytes */
663 
664 	ret = ath9k_hw_init(ah);
665 	if (ret) {
666 		ath_err(common,
667 			"Unable to initialize hardware; initialization status: %d\n",
668 			ret);
669 		goto err_hw;
670 	}
671 
672 	ret = ath9k_init_queues(priv);
673 	if (ret)
674 		goto err_queues;
675 
676 	for (i = 0; i < ATH9K_HTC_MAX_BCN_VIF; i++)
677 		priv->beacon.bslot[i] = NULL;
678 	priv->beacon.slottime = 9;
679 
680 	ath9k_cmn_init_channels_rates(common);
681 	ath9k_cmn_init_crypto(ah);
682 	ath9k_init_misc(priv);
683 	ath9k_htc_init_btcoex(priv, product);
684 
685 	return 0;
686 
687 err_queues:
688 	ath9k_hw_deinit(ah);
689 err_hw:
690 
691 	kfree(ah);
692 	priv->ah = NULL;
693 
694 	return ret;
695 }
696 
697 static const struct ieee80211_iface_limit if_limits[] = {
698 	{ .max = 2,	.types = BIT(NL80211_IFTYPE_STATION) |
699 				 BIT(NL80211_IFTYPE_P2P_CLIENT) },
700 	{ .max = 2,	.types = BIT(NL80211_IFTYPE_AP) |
701 #ifdef CONFIG_MAC80211_MESH
702 				 BIT(NL80211_IFTYPE_MESH_POINT) |
703 #endif
704 				 BIT(NL80211_IFTYPE_P2P_GO) },
705 };
706 
707 static const struct ieee80211_iface_combination if_comb = {
708 	.limits = if_limits,
709 	.n_limits = ARRAY_SIZE(if_limits),
710 	.max_interfaces = 2,
711 	.num_different_channels = 1,
712 };
713 
714 static void ath9k_set_hw_capab(struct ath9k_htc_priv *priv,
715 			       struct ieee80211_hw *hw)
716 {
717 	struct ath_hw *ah = priv->ah;
718 	struct ath_common *common = ath9k_hw_common(priv->ah);
719 	struct base_eep_header *pBase;
720 
721 	ieee80211_hw_set(hw, HOST_BROADCAST_PS_BUFFERING);
722 	ieee80211_hw_set(hw, MFP_CAPABLE);
723 	ieee80211_hw_set(hw, REPORTS_TX_ACK_STATUS);
724 	ieee80211_hw_set(hw, PS_NULLFUNC_STACK);
725 	ieee80211_hw_set(hw, RX_INCLUDES_FCS);
726 	ieee80211_hw_set(hw, HAS_RATE_CONTROL);
727 	ieee80211_hw_set(hw, SPECTRUM_MGMT);
728 	ieee80211_hw_set(hw, SIGNAL_DBM);
729 	ieee80211_hw_set(hw, AMPDU_AGGREGATION);
730 	ieee80211_hw_set(hw, DOESNT_SUPPORT_QOS_NDP);
731 
732 	if (ath9k_ps_enable)
733 		ieee80211_hw_set(hw, SUPPORTS_PS);
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 		BIT(NL80211_IFTYPE_OCB);
743 
744 	hw->wiphy->iface_combinations = &if_comb;
745 	hw->wiphy->n_iface_combinations = 1;
746 
747 	hw->wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT;
748 
749 	hw->wiphy->flags |= WIPHY_FLAG_IBSS_RSN |
750 			    WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL |
751 			    WIPHY_FLAG_HAS_CHANNEL_SWITCH;
752 
753 	hw->wiphy->flags |= WIPHY_FLAG_SUPPORTS_TDLS;
754 
755 	hw->queues = 4;
756 	hw->max_listen_interval = 1;
757 
758 	hw->vif_data_size = sizeof(struct ath9k_htc_vif);
759 	hw->sta_data_size = sizeof(struct ath9k_htc_sta);
760 
761 	/* tx_frame_hdr is larger than tx_mgmt_hdr anyway */
762 	hw->extra_tx_headroom = sizeof(struct tx_frame_hdr) +
763 		sizeof(struct htc_frame_hdr) + 4;
764 
765 	if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_2GHZ)
766 		hw->wiphy->bands[NL80211_BAND_2GHZ] =
767 			&common->sbands[NL80211_BAND_2GHZ];
768 	if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_5GHZ)
769 		hw->wiphy->bands[NL80211_BAND_5GHZ] =
770 			&common->sbands[NL80211_BAND_5GHZ];
771 
772 	ath9k_cmn_reload_chainmask(ah);
773 
774 	pBase = ath9k_htc_get_eeprom_base(priv);
775 	if (pBase) {
776 		hw->wiphy->available_antennas_rx = pBase->rxMask;
777 		hw->wiphy->available_antennas_tx = pBase->txMask;
778 	}
779 
780 	SET_IEEE80211_PERM_ADDR(hw, common->macaddr);
781 
782 	wiphy_ext_feature_set(hw->wiphy, NL80211_EXT_FEATURE_CQM_RSSI_LIST);
783 	wiphy_ext_feature_set(hw->wiphy,
784 			      NL80211_EXT_FEATURE_MULTICAST_REGISTRATIONS);
785 }
786 
787 static int ath9k_init_firmware_version(struct ath9k_htc_priv *priv)
788 {
789 	struct ieee80211_hw *hw = priv->hw;
790 	struct wmi_fw_version cmd_rsp;
791 	int ret;
792 
793 	memset(&cmd_rsp, 0, sizeof(cmd_rsp));
794 
795 	WMI_CMD(WMI_GET_FW_VERSION);
796 	if (ret)
797 		return -EINVAL;
798 
799 	priv->fw_version_major = be16_to_cpu(cmd_rsp.major);
800 	priv->fw_version_minor = be16_to_cpu(cmd_rsp.minor);
801 
802 	snprintf(hw->wiphy->fw_version, sizeof(hw->wiphy->fw_version), "%d.%d",
803 		 priv->fw_version_major,
804 		 priv->fw_version_minor);
805 
806 	dev_info(priv->dev, "ath9k_htc: FW Version: %d.%d\n",
807 		 priv->fw_version_major,
808 		 priv->fw_version_minor);
809 
810 	/*
811 	 * Check if the available FW matches the driver's
812 	 * required version.
813 	 */
814 	if (priv->fw_version_major != MAJOR_VERSION_REQ ||
815 	    priv->fw_version_minor < MINOR_VERSION_REQ) {
816 		dev_err(priv->dev, "ath9k_htc: Please upgrade to FW version %d.%d\n",
817 			MAJOR_VERSION_REQ, MINOR_VERSION_REQ);
818 		return -EINVAL;
819 	}
820 
821 	if (priv->fw_version_major == 1 && priv->fw_version_minor < 4)
822 		set_bit(HTC_FWFLAG_NO_RMW, &priv->fw_flags);
823 
824 	dev_info(priv->dev, "FW RMW support: %s\n",
825 		test_bit(HTC_FWFLAG_NO_RMW, &priv->fw_flags) ? "Off" : "On");
826 
827 	return 0;
828 }
829 
830 static int ath9k_init_device(struct ath9k_htc_priv *priv,
831 			     u16 devid, char *product, u32 drv_info)
832 {
833 	struct ieee80211_hw *hw = priv->hw;
834 	struct ath_common *common;
835 	struct ath_hw *ah;
836 	int error = 0;
837 	struct ath_regulatory *reg;
838 	char hw_name[64];
839 
840 	/* Bring up device */
841 	error = ath9k_init_priv(priv, devid, product, drv_info);
842 	if (error != 0)
843 		goto err_init;
844 
845 	ah = priv->ah;
846 	common = ath9k_hw_common(ah);
847 	ath9k_set_hw_capab(priv, hw);
848 
849 	error = ath9k_init_firmware_version(priv);
850 	if (error != 0)
851 		goto err_fw;
852 
853 	/* Initialize regulatory */
854 	error = ath_regd_init(&common->regulatory, priv->hw->wiphy,
855 			      ath9k_reg_notifier);
856 	if (error)
857 		goto err_regd;
858 
859 	reg = &common->regulatory;
860 
861 	/* Setup TX */
862 	error = ath9k_tx_init(priv);
863 	if (error != 0)
864 		goto err_tx;
865 
866 	/* Setup RX */
867 	error = ath9k_rx_init(priv);
868 	if (error != 0)
869 		goto err_rx;
870 
871 	ath9k_hw_disable(priv->ah);
872 #ifdef CONFIG_MAC80211_LEDS
873 	/* must be initialized before ieee80211_register_hw */
874 	priv->led_cdev.default_trigger = ieee80211_create_tpt_led_trigger(priv->hw,
875 		IEEE80211_TPT_LEDTRIG_FL_RADIO, ath9k_htc_tpt_blink,
876 		ARRAY_SIZE(ath9k_htc_tpt_blink));
877 #endif
878 
879 	/* Register with mac80211 */
880 	error = ieee80211_register_hw(hw);
881 	if (error)
882 		goto err_register;
883 
884 	/* Handle world regulatory */
885 	if (!ath_is_world_regd(reg)) {
886 		error = regulatory_hint(hw->wiphy, reg->alpha2);
887 		if (error)
888 			goto err_world;
889 	}
890 
891 	error = ath9k_htc_init_debug(priv->ah);
892 	if (error) {
893 		ath_err(common, "Unable to create debugfs files\n");
894 		goto err_world;
895 	}
896 
897 	ath_dbg(common, CONFIG,
898 		"WMI:%d, BCN:%d, CAB:%d, UAPSD:%d, MGMT:%d, BE:%d, BK:%d, VI:%d, VO:%d\n",
899 		priv->wmi_cmd_ep,
900 		priv->beacon_ep,
901 		priv->cab_ep,
902 		priv->uapsd_ep,
903 		priv->mgmt_ep,
904 		priv->data_be_ep,
905 		priv->data_bk_ep,
906 		priv->data_vi_ep,
907 		priv->data_vo_ep);
908 
909 	ath9k_hw_name(priv->ah, hw_name, sizeof(hw_name));
910 	wiphy_info(hw->wiphy, "%s\n", hw_name);
911 
912 	ath9k_init_leds(priv);
913 	ath9k_start_rfkill_poll(priv);
914 
915 	return 0;
916 
917 err_world:
918 	ieee80211_unregister_hw(hw);
919 err_register:
920 	ath9k_rx_cleanup(priv);
921 err_rx:
922 	ath9k_tx_cleanup(priv);
923 err_tx:
924 	/* Nothing */
925 err_regd:
926 	/* Nothing */
927 err_fw:
928 	ath9k_deinit_priv(priv);
929 err_init:
930 	return error;
931 }
932 
933 int ath9k_htc_probe_device(struct htc_target *htc_handle, struct device *dev,
934 			   u16 devid, char *product, u32 drv_info)
935 {
936 	struct hif_device_usb *hif_dev;
937 	struct ath9k_htc_priv *priv;
938 	struct ieee80211_hw *hw;
939 	int ret;
940 
941 	hw = ieee80211_alloc_hw(sizeof(struct ath9k_htc_priv), &ath9k_htc_ops);
942 	if (!hw)
943 		return -ENOMEM;
944 
945 	priv = hw->priv;
946 	priv->hw = hw;
947 	priv->htc = htc_handle;
948 	priv->dev = dev;
949 	htc_handle->drv_priv = priv;
950 	SET_IEEE80211_DEV(hw, priv->dev);
951 
952 	ret = ath9k_htc_wait_for_target(priv);
953 	if (ret)
954 		goto err_free;
955 
956 	priv->wmi = ath9k_init_wmi(priv);
957 	if (!priv->wmi) {
958 		ret = -EINVAL;
959 		goto err_free;
960 	}
961 
962 	ret = ath9k_init_htc_services(priv, devid, drv_info);
963 	if (ret)
964 		goto err_init;
965 
966 	ret = ath9k_init_device(priv, devid, product, drv_info);
967 	if (ret)
968 		goto err_init;
969 
970 	return 0;
971 
972 err_init:
973 	ath9k_stop_wmi(priv);
974 	hif_dev = (struct hif_device_usb *)htc_handle->hif_dev;
975 	ath9k_hif_usb_dealloc_urbs(hif_dev);
976 	ath9k_destoy_wmi(priv);
977 err_free:
978 	ieee80211_free_hw(hw);
979 	return ret;
980 }
981 
982 void ath9k_htc_disconnect_device(struct htc_target *htc_handle, bool hotunplug)
983 {
984 	if (htc_handle->drv_priv) {
985 
986 		/* Check if the device has been yanked out. */
987 		if (hotunplug)
988 			htc_handle->drv_priv->ah->ah_flags |= AH_UNPLUGGED;
989 
990 		ath9k_deinit_device(htc_handle->drv_priv);
991 		ath9k_stop_wmi(htc_handle->drv_priv);
992 		ieee80211_free_hw(htc_handle->drv_priv->hw);
993 	}
994 }
995 
996 #ifdef CONFIG_PM
997 
998 void ath9k_htc_suspend(struct htc_target *htc_handle)
999 {
1000 	ath9k_htc_setpower(htc_handle->drv_priv, ATH9K_PM_FULL_SLEEP);
1001 }
1002 
1003 int ath9k_htc_resume(struct htc_target *htc_handle)
1004 {
1005 	struct ath9k_htc_priv *priv = htc_handle->drv_priv;
1006 	int ret;
1007 
1008 	ret = ath9k_htc_wait_for_target(priv);
1009 	if (ret)
1010 		return ret;
1011 
1012 	ret = ath9k_init_htc_services(priv, priv->ah->hw_version.devid,
1013 				      priv->ah->hw_version.usbdev);
1014 	ath9k_configure_leds(priv);
1015 
1016 	return ret;
1017 }
1018 #endif
1019 
1020 static int __init ath9k_htc_init(void)
1021 {
1022 	if (ath9k_hif_usb_init() < 0) {
1023 		pr_err("No USB devices found, driver not installed\n");
1024 		return -ENODEV;
1025 	}
1026 
1027 	return 0;
1028 }
1029 module_init(ath9k_htc_init);
1030 
1031 static void __exit ath9k_htc_exit(void)
1032 {
1033 	ath9k_hif_usb_exit();
1034 	pr_info("Driver unloaded\n");
1035 }
1036 module_exit(ath9k_htc_exit);
1037