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