2 * Copyright (c) 2010 Atheros Communications Inc.
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.
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.
19 #ifdef CONFIG_ATH9K_HTC_DEBUGFS
20 static struct dentry
*ath9k_debugfs_root
;
27 static void ath_update_txpow(struct ath9k_htc_priv
*priv
)
29 struct ath_hw
*ah
= priv
->ah
;
31 if (priv
->curtxpow
!= priv
->txpowlimit
) {
32 ath9k_hw_set_txpowerlimit(ah
, priv
->txpowlimit
);
33 /* read back in case value is clamped */
34 priv
->curtxpow
= ath9k_hw_regulatory(ah
)->power_limit
;
38 /* HACK Alert: Use 11NG for 2.4, use 11NA for 5 */
39 static enum htc_phymode
ath9k_htc_get_curmode(struct ath9k_htc_priv
*priv
,
40 struct ath9k_channel
*ichan
)
42 enum htc_phymode mode
;
46 switch (ichan
->chanmode
) {
49 case CHANNEL_G_HT40PLUS
:
50 case CHANNEL_G_HT40MINUS
:
55 case CHANNEL_A_HT40PLUS
:
56 case CHANNEL_A_HT40MINUS
:
66 static bool ath9k_htc_setpower(struct ath9k_htc_priv
*priv
,
67 enum ath9k_power_mode mode
)
71 mutex_lock(&priv
->htc_pm_lock
);
72 ret
= ath9k_hw_setpower(priv
->ah
, mode
);
73 mutex_unlock(&priv
->htc_pm_lock
);
78 void ath9k_htc_ps_wakeup(struct ath9k_htc_priv
*priv
)
80 mutex_lock(&priv
->htc_pm_lock
);
81 if (++priv
->ps_usecount
!= 1)
83 ath9k_hw_setpower(priv
->ah
, ATH9K_PM_AWAKE
);
86 mutex_unlock(&priv
->htc_pm_lock
);
89 void ath9k_htc_ps_restore(struct ath9k_htc_priv
*priv
)
91 mutex_lock(&priv
->htc_pm_lock
);
92 if (--priv
->ps_usecount
!= 0)
96 ath9k_hw_setpower(priv
->ah
, ATH9K_PM_FULL_SLEEP
);
97 else if (priv
->ps_enabled
)
98 ath9k_hw_setpower(priv
->ah
, ATH9K_PM_NETWORK_SLEEP
);
101 mutex_unlock(&priv
->htc_pm_lock
);
104 void ath9k_ps_work(struct work_struct
*work
)
106 struct ath9k_htc_priv
*priv
=
107 container_of(work
, struct ath9k_htc_priv
,
109 ath9k_htc_setpower(priv
, ATH9K_PM_AWAKE
);
111 /* The chip wakes up after receiving the first beacon
112 while network sleep is enabled. For the driver to
113 be in sync with the hw, set the chip to awake and
114 only then set it to sleep.
116 ath9k_htc_setpower(priv
, ATH9K_PM_NETWORK_SLEEP
);
119 static int ath9k_htc_set_channel(struct ath9k_htc_priv
*priv
,
120 struct ieee80211_hw
*hw
,
121 struct ath9k_channel
*hchan
)
123 struct ath_hw
*ah
= priv
->ah
;
124 struct ath_common
*common
= ath9k_hw_common(ah
);
125 struct ieee80211_conf
*conf
= &common
->hw
->conf
;
127 struct ieee80211_channel
*channel
= hw
->conf
.channel
;
128 struct ath9k_hw_cal_data
*caldata
;
129 enum htc_phymode mode
;
134 if (priv
->op_flags
& OP_INVALID
)
137 if (priv
->op_flags
& OP_FULL_RESET
)
140 /* Fiddle around with fastcc later on, for now just use full reset */
142 ath9k_htc_ps_wakeup(priv
);
144 WMI_CMD(WMI_DISABLE_INTR_CMDID
);
145 WMI_CMD(WMI_DRAIN_TXQ_ALL_CMDID
);
146 WMI_CMD(WMI_STOP_RECV_CMDID
);
148 ath_print(common
, ATH_DBG_CONFIG
,
149 "(%u MHz) -> (%u MHz), HT: %d, HT40: %d\n",
150 priv
->ah
->curchan
->channel
,
151 channel
->center_freq
, conf_is_ht(conf
), conf_is_ht40(conf
));
153 caldata
= &priv
->caldata
[channel
->hw_value
];
154 ret
= ath9k_hw_reset(ah
, hchan
, caldata
, fastcc
);
156 ath_print(common
, ATH_DBG_FATAL
,
157 "Unable to reset channel (%u Mhz) "
158 "reset status %d\n", channel
->center_freq
, ret
);
162 ath_update_txpow(priv
);
164 WMI_CMD(WMI_START_RECV_CMDID
);
168 ath9k_host_rx_init(priv
);
170 mode
= ath9k_htc_get_curmode(priv
, hchan
);
171 htc_mode
= cpu_to_be16(mode
);
172 WMI_CMD_BUF(WMI_SET_MODE_CMDID
, &htc_mode
);
176 WMI_CMD(WMI_ENABLE_INTR_CMDID
);
180 htc_start(priv
->htc
);
182 priv
->op_flags
&= ~OP_FULL_RESET
;
184 ath9k_htc_ps_restore(priv
);
188 static int ath9k_htc_add_monitor_interface(struct ath9k_htc_priv
*priv
)
190 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
191 struct ath9k_htc_target_vif hvif
;
198 memset(&hvif
, 0, sizeof(struct ath9k_htc_target_vif
));
199 memcpy(&hvif
.myaddr
, common
->macaddr
, ETH_ALEN
);
201 hvif
.opmode
= cpu_to_be32(HTC_M_MONITOR
);
202 priv
->ah
->opmode
= NL80211_IFTYPE_MONITOR
;
203 hvif
.index
= priv
->nvifs
;
205 WMI_CMD_BUF(WMI_VAP_CREATE_CMDID
, &hvif
);
213 static int ath9k_htc_remove_monitor_interface(struct ath9k_htc_priv
*priv
)
215 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
216 struct ath9k_htc_target_vif hvif
;
220 memset(&hvif
, 0, sizeof(struct ath9k_htc_target_vif
));
221 memcpy(&hvif
.myaddr
, common
->macaddr
, ETH_ALEN
);
222 hvif
.index
= 0; /* Should do for now */
223 WMI_CMD_BUF(WMI_VAP_REMOVE_CMDID
, &hvif
);
229 static int ath9k_htc_add_station(struct ath9k_htc_priv
*priv
,
230 struct ieee80211_vif
*vif
,
231 struct ieee80211_sta
*sta
)
233 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
234 struct ath9k_htc_target_sta tsta
;
235 struct ath9k_htc_vif
*avp
= (struct ath9k_htc_vif
*) vif
->drv_priv
;
236 struct ath9k_htc_sta
*ista
;
240 if (priv
->nstations
>= ATH9K_HTC_MAX_STA
)
243 memset(&tsta
, 0, sizeof(struct ath9k_htc_target_sta
));
246 ista
= (struct ath9k_htc_sta
*) sta
->drv_priv
;
247 memcpy(&tsta
.macaddr
, sta
->addr
, ETH_ALEN
);
248 memcpy(&tsta
.bssid
, common
->curbssid
, ETH_ALEN
);
249 tsta
.associd
= common
->curaid
;
252 ista
->index
= priv
->nstations
;
254 memcpy(&tsta
.macaddr
, vif
->addr
, ETH_ALEN
);
258 tsta
.sta_index
= priv
->nstations
;
259 tsta
.vif_index
= avp
->index
;
260 tsta
.maxampdu
= 0xffff;
261 if (sta
&& sta
->ht_cap
.ht_supported
)
262 tsta
.flags
= cpu_to_be16(ATH_HTC_STA_HT
);
264 WMI_CMD_BUF(WMI_NODE_CREATE_CMDID
, &tsta
);
267 ath_print(common
, ATH_DBG_FATAL
,
268 "Unable to add station entry for: %pM\n", sta
->addr
);
273 ath_print(common
, ATH_DBG_CONFIG
,
274 "Added a station entry for: %pM (idx: %d)\n",
275 sta
->addr
, tsta
.sta_index
);
281 static int ath9k_htc_remove_station(struct ath9k_htc_priv
*priv
,
282 struct ieee80211_vif
*vif
,
283 struct ieee80211_sta
*sta
)
285 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
286 struct ath9k_htc_sta
*ista
;
291 ista
= (struct ath9k_htc_sta
*) sta
->drv_priv
;
292 sta_idx
= ista
->index
;
297 WMI_CMD_BUF(WMI_NODE_REMOVE_CMDID
, &sta_idx
);
300 ath_print(common
, ATH_DBG_FATAL
,
301 "Unable to remove station entry for: %pM\n",
307 ath_print(common
, ATH_DBG_CONFIG
,
308 "Removed a station entry for: %pM (idx: %d)\n",
315 static int ath9k_htc_update_cap_target(struct ath9k_htc_priv
*priv
)
317 struct ath9k_htc_cap_target tcap
;
321 memset(&tcap
, 0, sizeof(struct ath9k_htc_cap_target
));
323 /* FIXME: Values are hardcoded */
324 tcap
.flags
= 0x240c40;
325 tcap
.flags_ext
= 0x80601000;
326 tcap
.ampdu_limit
= 0xffff0000;
327 tcap
.ampdu_subframes
= 20;
328 tcap
.tx_chainmask_legacy
= priv
->ah
->caps
.tx_chainmask
;
330 tcap
.tx_chainmask
= priv
->ah
->caps
.tx_chainmask
;
332 WMI_CMD_BUF(WMI_TARGET_IC_UPDATE_CMDID
, &tcap
);
337 static void ath9k_htc_setup_rate(struct ath9k_htc_priv
*priv
,
338 struct ieee80211_sta
*sta
,
339 struct ath9k_htc_target_rate
*trate
)
341 struct ath9k_htc_sta
*ista
= (struct ath9k_htc_sta
*) sta
->drv_priv
;
342 struct ieee80211_supported_band
*sband
;
346 sband
= priv
->hw
->wiphy
->bands
[priv
->hw
->conf
.channel
->band
];
348 for (i
= 0, j
= 0; i
< sband
->n_bitrates
; i
++) {
349 if (sta
->supp_rates
[sband
->band
] & BIT(i
)) {
350 trate
->rates
.legacy_rates
.rs_rates
[j
]
351 = (sband
->bitrates
[i
].bitrate
* 2) / 10;
355 trate
->rates
.legacy_rates
.rs_nrates
= j
;
357 if (sta
->ht_cap
.ht_supported
) {
358 for (i
= 0, j
= 0; i
< 77; i
++) {
359 if (sta
->ht_cap
.mcs
.rx_mask
[i
/8] & (1<<(i
%8)))
360 trate
->rates
.ht_rates
.rs_rates
[j
++] = i
;
361 if (j
== ATH_HTC_RATE_MAX
)
364 trate
->rates
.ht_rates
.rs_nrates
= j
;
366 caps
= WLAN_RC_HT_FLAG
;
367 if (sta
->ht_cap
.mcs
.rx_mask
[1])
368 caps
|= WLAN_RC_DS_FLAG
;
369 if (sta
->ht_cap
.cap
& IEEE80211_HT_CAP_SUP_WIDTH_20_40
)
370 caps
|= WLAN_RC_40_FLAG
;
371 if (conf_is_ht40(&priv
->hw
->conf
) &&
372 (sta
->ht_cap
.cap
& IEEE80211_HT_CAP_SGI_40
))
373 caps
|= WLAN_RC_SGI_FLAG
;
374 else if (conf_is_ht20(&priv
->hw
->conf
) &&
375 (sta
->ht_cap
.cap
& IEEE80211_HT_CAP_SGI_20
))
376 caps
|= WLAN_RC_SGI_FLAG
;
379 trate
->sta_index
= ista
->index
;
381 trate
->capflags
= cpu_to_be32(caps
);
384 static int ath9k_htc_send_rate_cmd(struct ath9k_htc_priv
*priv
,
385 struct ath9k_htc_target_rate
*trate
)
387 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
391 WMI_CMD_BUF(WMI_RC_RATE_UPDATE_CMDID
, trate
);
393 ath_print(common
, ATH_DBG_FATAL
,
394 "Unable to initialize Rate information on target\n");
400 static void ath9k_htc_init_rate(struct ath9k_htc_priv
*priv
,
401 struct ieee80211_sta
*sta
)
403 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
404 struct ath9k_htc_target_rate trate
;
407 memset(&trate
, 0, sizeof(struct ath9k_htc_target_rate
));
408 ath9k_htc_setup_rate(priv
, sta
, &trate
);
409 ret
= ath9k_htc_send_rate_cmd(priv
, &trate
);
411 ath_print(common
, ATH_DBG_CONFIG
,
412 "Updated target sta: %pM, rate caps: 0x%X\n",
413 sta
->addr
, be32_to_cpu(trate
.capflags
));
416 static void ath9k_htc_update_rate(struct ath9k_htc_priv
*priv
,
417 struct ieee80211_vif
*vif
,
418 struct ieee80211_bss_conf
*bss_conf
)
420 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
421 struct ath9k_htc_target_rate trate
;
422 struct ieee80211_sta
*sta
;
425 memset(&trate
, 0, sizeof(struct ath9k_htc_target_rate
));
428 sta
= ieee80211_find_sta(vif
, bss_conf
->bssid
);
433 ath9k_htc_setup_rate(priv
, sta
, &trate
);
436 ret
= ath9k_htc_send_rate_cmd(priv
, &trate
);
438 ath_print(common
, ATH_DBG_CONFIG
,
439 "Updated target sta: %pM, rate caps: 0x%X\n",
440 bss_conf
->bssid
, be32_to_cpu(trate
.capflags
));
443 static int ath9k_htc_tx_aggr_oper(struct ath9k_htc_priv
*priv
,
444 struct ieee80211_vif
*vif
,
445 struct ieee80211_sta
*sta
,
446 enum ieee80211_ampdu_mlme_action action
,
449 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
450 struct ath9k_htc_target_aggr aggr
;
451 struct ath9k_htc_sta
*ista
;
455 if (tid
>= ATH9K_HTC_MAX_TID
)
458 memset(&aggr
, 0, sizeof(struct ath9k_htc_target_aggr
));
459 ista
= (struct ath9k_htc_sta
*) sta
->drv_priv
;
461 aggr
.sta_index
= ista
->index
;
462 aggr
.tidno
= tid
& 0xf;
463 aggr
.aggr_enable
= (action
== IEEE80211_AMPDU_TX_START
) ? true : false;
465 WMI_CMD_BUF(WMI_TX_AGGR_ENABLE_CMDID
, &aggr
);
467 ath_print(common
, ATH_DBG_CONFIG
,
468 "Unable to %s TX aggregation for (%pM, %d)\n",
469 (aggr
.aggr_enable
) ? "start" : "stop", sta
->addr
, tid
);
471 ath_print(common
, ATH_DBG_CONFIG
,
472 "%s TX aggregation for (%pM, %d)\n",
473 (aggr
.aggr_enable
) ? "Starting" : "Stopping",
476 spin_lock_bh(&priv
->tx_lock
);
477 ista
->tid_state
[tid
] = (aggr
.aggr_enable
&& !ret
) ? AGGR_START
: AGGR_STOP
;
478 spin_unlock_bh(&priv
->tx_lock
);
487 #ifdef CONFIG_ATH9K_HTC_DEBUGFS
489 static int ath9k_debugfs_open(struct inode
*inode
, struct file
*file
)
491 file
->private_data
= inode
->i_private
;
495 static ssize_t
read_file_tgt_stats(struct file
*file
, char __user
*user_buf
,
496 size_t count
, loff_t
*ppos
)
498 struct ath9k_htc_priv
*priv
= file
->private_data
;
499 struct ath9k_htc_target_stats cmd_rsp
;
501 unsigned int len
= 0;
504 memset(&cmd_rsp
, 0, sizeof(cmd_rsp
));
506 WMI_CMD(WMI_TGT_STATS_CMDID
);
511 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
512 "%19s : %10u\n", "TX Short Retries",
513 be32_to_cpu(cmd_rsp
.tx_shortretry
));
514 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
515 "%19s : %10u\n", "TX Long Retries",
516 be32_to_cpu(cmd_rsp
.tx_longretry
));
517 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
518 "%19s : %10u\n", "TX Xretries",
519 be32_to_cpu(cmd_rsp
.tx_xretries
));
520 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
521 "%19s : %10u\n", "TX Unaggr. Xretries",
522 be32_to_cpu(cmd_rsp
.ht_txunaggr_xretry
));
523 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
524 "%19s : %10u\n", "TX Xretries (HT)",
525 be32_to_cpu(cmd_rsp
.ht_tx_xretries
));
526 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
527 "%19s : %10u\n", "TX Rate", priv
->debug
.txrate
);
529 if (len
> sizeof(buf
))
532 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
535 static const struct file_operations fops_tgt_stats
= {
536 .read
= read_file_tgt_stats
,
537 .open
= ath9k_debugfs_open
,
541 static ssize_t
read_file_xmit(struct file
*file
, char __user
*user_buf
,
542 size_t count
, loff_t
*ppos
)
544 struct ath9k_htc_priv
*priv
= file
->private_data
;
546 unsigned int len
= 0;
548 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
549 "%20s : %10u\n", "Buffers queued",
550 priv
->debug
.tx_stats
.buf_queued
);
551 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
552 "%20s : %10u\n", "Buffers completed",
553 priv
->debug
.tx_stats
.buf_completed
);
554 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
555 "%20s : %10u\n", "SKBs queued",
556 priv
->debug
.tx_stats
.skb_queued
);
557 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
558 "%20s : %10u\n", "SKBs completed",
559 priv
->debug
.tx_stats
.skb_completed
);
560 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
561 "%20s : %10u\n", "SKBs dropped",
562 priv
->debug
.tx_stats
.skb_dropped
);
564 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
565 "%20s : %10u\n", "BE queued",
566 priv
->debug
.tx_stats
.queue_stats
[WME_AC_BE
]);
567 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
568 "%20s : %10u\n", "BK queued",
569 priv
->debug
.tx_stats
.queue_stats
[WME_AC_BK
]);
570 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
571 "%20s : %10u\n", "VI queued",
572 priv
->debug
.tx_stats
.queue_stats
[WME_AC_VI
]);
573 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
574 "%20s : %10u\n", "VO queued",
575 priv
->debug
.tx_stats
.queue_stats
[WME_AC_VO
]);
577 if (len
> sizeof(buf
))
580 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
583 static const struct file_operations fops_xmit
= {
584 .read
= read_file_xmit
,
585 .open
= ath9k_debugfs_open
,
589 static ssize_t
read_file_recv(struct file
*file
, char __user
*user_buf
,
590 size_t count
, loff_t
*ppos
)
592 struct ath9k_htc_priv
*priv
= file
->private_data
;
594 unsigned int len
= 0;
596 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
597 "%20s : %10u\n", "SKBs allocated",
598 priv
->debug
.rx_stats
.skb_allocated
);
599 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
600 "%20s : %10u\n", "SKBs completed",
601 priv
->debug
.rx_stats
.skb_completed
);
602 len
+= snprintf(buf
+ len
, sizeof(buf
) - len
,
603 "%20s : %10u\n", "SKBs Dropped",
604 priv
->debug
.rx_stats
.skb_dropped
);
606 if (len
> sizeof(buf
))
609 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
612 static const struct file_operations fops_recv
= {
613 .read
= read_file_recv
,
614 .open
= ath9k_debugfs_open
,
618 int ath9k_htc_init_debug(struct ath_hw
*ah
)
620 struct ath_common
*common
= ath9k_hw_common(ah
);
621 struct ath9k_htc_priv
*priv
= (struct ath9k_htc_priv
*) common
->priv
;
623 if (!ath9k_debugfs_root
)
626 priv
->debug
.debugfs_phy
= debugfs_create_dir(wiphy_name(priv
->hw
->wiphy
),
628 if (!priv
->debug
.debugfs_phy
)
631 priv
->debug
.debugfs_tgt_stats
= debugfs_create_file("tgt_stats", S_IRUSR
,
632 priv
->debug
.debugfs_phy
,
633 priv
, &fops_tgt_stats
);
634 if (!priv
->debug
.debugfs_tgt_stats
)
638 priv
->debug
.debugfs_xmit
= debugfs_create_file("xmit", S_IRUSR
,
639 priv
->debug
.debugfs_phy
,
641 if (!priv
->debug
.debugfs_xmit
)
644 priv
->debug
.debugfs_recv
= debugfs_create_file("recv", S_IRUSR
,
645 priv
->debug
.debugfs_phy
,
647 if (!priv
->debug
.debugfs_recv
)
653 ath9k_htc_exit_debug(ah
);
657 void ath9k_htc_exit_debug(struct ath_hw
*ah
)
659 struct ath_common
*common
= ath9k_hw_common(ah
);
660 struct ath9k_htc_priv
*priv
= (struct ath9k_htc_priv
*) common
->priv
;
662 debugfs_remove(priv
->debug
.debugfs_recv
);
663 debugfs_remove(priv
->debug
.debugfs_xmit
);
664 debugfs_remove(priv
->debug
.debugfs_tgt_stats
);
665 debugfs_remove(priv
->debug
.debugfs_phy
);
668 int ath9k_htc_debug_create_root(void)
670 ath9k_debugfs_root
= debugfs_create_dir(KBUILD_MODNAME
, NULL
);
671 if (!ath9k_debugfs_root
)
677 void ath9k_htc_debug_remove_root(void)
679 debugfs_remove(ath9k_debugfs_root
);
680 ath9k_debugfs_root
= NULL
;
683 #endif /* CONFIG_ATH9K_HTC_DEBUGFS */
689 static void ath_start_ani(struct ath9k_htc_priv
*priv
)
691 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
692 unsigned long timestamp
= jiffies_to_msecs(jiffies
);
694 common
->ani
.longcal_timer
= timestamp
;
695 common
->ani
.shortcal_timer
= timestamp
;
696 common
->ani
.checkani_timer
= timestamp
;
698 ieee80211_queue_delayed_work(common
->hw
, &priv
->ath9k_ani_work
,
699 msecs_to_jiffies(ATH_ANI_POLLINTERVAL
));
702 void ath9k_ani_work(struct work_struct
*work
)
704 struct ath9k_htc_priv
*priv
=
705 container_of(work
, struct ath9k_htc_priv
,
706 ath9k_ani_work
.work
);
707 struct ath_hw
*ah
= priv
->ah
;
708 struct ath_common
*common
= ath9k_hw_common(ah
);
709 bool longcal
= false;
710 bool shortcal
= false;
711 bool aniflag
= false;
712 unsigned int timestamp
= jiffies_to_msecs(jiffies
);
713 u32 cal_interval
, short_cal_interval
;
715 short_cal_interval
= ATH_STA_SHORT_CALINTERVAL
;
717 /* Only calibrate if awake */
718 if (ah
->power_mode
!= ATH9K_PM_AWAKE
)
721 /* Long calibration runs independently of short calibration. */
722 if ((timestamp
- common
->ani
.longcal_timer
) >= ATH_LONG_CALINTERVAL
) {
724 ath_print(common
, ATH_DBG_ANI
, "longcal @%lu\n", jiffies
);
725 common
->ani
.longcal_timer
= timestamp
;
728 /* Short calibration applies only while caldone is false */
729 if (!common
->ani
.caldone
) {
730 if ((timestamp
- common
->ani
.shortcal_timer
) >=
731 short_cal_interval
) {
733 ath_print(common
, ATH_DBG_ANI
,
734 "shortcal @%lu\n", jiffies
);
735 common
->ani
.shortcal_timer
= timestamp
;
736 common
->ani
.resetcal_timer
= timestamp
;
739 if ((timestamp
- common
->ani
.resetcal_timer
) >=
740 ATH_RESTART_CALINTERVAL
) {
741 common
->ani
.caldone
= ath9k_hw_reset_calvalid(ah
);
742 if (common
->ani
.caldone
)
743 common
->ani
.resetcal_timer
= timestamp
;
747 /* Verify whether we must check ANI */
748 if ((timestamp
- common
->ani
.checkani_timer
) >= ATH_ANI_POLLINTERVAL
) {
750 common
->ani
.checkani_timer
= timestamp
;
753 /* Skip all processing if there's nothing to do. */
754 if (longcal
|| shortcal
|| aniflag
) {
756 ath9k_htc_ps_wakeup(priv
);
758 /* Call ANI routine if necessary */
760 ath9k_hw_ani_monitor(ah
, ah
->curchan
);
762 /* Perform calibration if necessary */
763 if (longcal
|| shortcal
) {
764 common
->ani
.caldone
=
765 ath9k_hw_calibrate(ah
, ah
->curchan
,
766 common
->rx_chainmask
,
770 common
->ani
.noise_floor
=
771 ath9k_hw_getchan_noise(ah
, ah
->curchan
);
773 ath_print(common
, ATH_DBG_ANI
,
774 " calibrate chan %u/%x nf: %d\n",
775 ah
->curchan
->channel
,
776 ah
->curchan
->channelFlags
,
777 common
->ani
.noise_floor
);
780 ath9k_htc_ps_restore(priv
);
785 * Set timer interval based on previous results.
786 * The interval must be the shortest necessary to satisfy ANI,
787 * short calibration and long calibration.
789 cal_interval
= ATH_LONG_CALINTERVAL
;
790 if (priv
->ah
->config
.enable_ani
)
791 cal_interval
= min(cal_interval
, (u32
)ATH_ANI_POLLINTERVAL
);
792 if (!common
->ani
.caldone
)
793 cal_interval
= min(cal_interval
, (u32
)short_cal_interval
);
795 ieee80211_queue_delayed_work(common
->hw
, &priv
->ath9k_ani_work
,
796 msecs_to_jiffies(cal_interval
));
803 static void ath9k_led_blink_work(struct work_struct
*work
)
805 struct ath9k_htc_priv
*priv
= container_of(work
, struct ath9k_htc_priv
,
806 ath9k_led_blink_work
.work
);
808 if (!(priv
->op_flags
& OP_LED_ASSOCIATED
))
811 if ((priv
->led_on_duration
== ATH_LED_ON_DURATION_IDLE
) ||
812 (priv
->led_off_duration
== ATH_LED_OFF_DURATION_IDLE
))
813 ath9k_hw_set_gpio(priv
->ah
, priv
->ah
->led_pin
, 0);
815 ath9k_hw_set_gpio(priv
->ah
, priv
->ah
->led_pin
,
816 (priv
->op_flags
& OP_LED_ON
) ? 1 : 0);
818 ieee80211_queue_delayed_work(priv
->hw
,
819 &priv
->ath9k_led_blink_work
,
820 (priv
->op_flags
& OP_LED_ON
) ?
821 msecs_to_jiffies(priv
->led_off_duration
) :
822 msecs_to_jiffies(priv
->led_on_duration
));
824 priv
->led_on_duration
= priv
->led_on_cnt
?
825 max((ATH_LED_ON_DURATION_IDLE
- priv
->led_on_cnt
), 25) :
826 ATH_LED_ON_DURATION_IDLE
;
827 priv
->led_off_duration
= priv
->led_off_cnt
?
828 max((ATH_LED_OFF_DURATION_IDLE
- priv
->led_off_cnt
), 10) :
829 ATH_LED_OFF_DURATION_IDLE
;
830 priv
->led_on_cnt
= priv
->led_off_cnt
= 0;
832 if (priv
->op_flags
& OP_LED_ON
)
833 priv
->op_flags
&= ~OP_LED_ON
;
835 priv
->op_flags
|= OP_LED_ON
;
838 static void ath9k_led_brightness_work(struct work_struct
*work
)
840 struct ath_led
*led
= container_of(work
, struct ath_led
,
841 brightness_work
.work
);
842 struct ath9k_htc_priv
*priv
= led
->priv
;
844 switch (led
->brightness
) {
846 if (led
->led_type
== ATH_LED_ASSOC
||
847 led
->led_type
== ATH_LED_RADIO
) {
848 ath9k_hw_set_gpio(priv
->ah
, priv
->ah
->led_pin
,
849 (led
->led_type
== ATH_LED_RADIO
));
850 priv
->op_flags
&= ~OP_LED_ASSOCIATED
;
851 if (led
->led_type
== ATH_LED_RADIO
)
852 priv
->op_flags
&= ~OP_LED_ON
;
858 if (led
->led_type
== ATH_LED_ASSOC
) {
859 priv
->op_flags
|= OP_LED_ASSOCIATED
;
860 ieee80211_queue_delayed_work(priv
->hw
,
861 &priv
->ath9k_led_blink_work
, 0);
862 } else if (led
->led_type
== ATH_LED_RADIO
) {
863 ath9k_hw_set_gpio(priv
->ah
, priv
->ah
->led_pin
, 0);
864 priv
->op_flags
|= OP_LED_ON
;
874 static void ath9k_led_brightness(struct led_classdev
*led_cdev
,
875 enum led_brightness brightness
)
877 struct ath_led
*led
= container_of(led_cdev
, struct ath_led
, led_cdev
);
878 struct ath9k_htc_priv
*priv
= led
->priv
;
880 led
->brightness
= brightness
;
881 if (!(priv
->op_flags
& OP_LED_DEINIT
))
882 ieee80211_queue_delayed_work(priv
->hw
,
883 &led
->brightness_work
, 0);
886 static void ath9k_led_stop_brightness(struct ath9k_htc_priv
*priv
)
888 cancel_delayed_work_sync(&priv
->radio_led
.brightness_work
);
889 cancel_delayed_work_sync(&priv
->assoc_led
.brightness_work
);
890 cancel_delayed_work_sync(&priv
->tx_led
.brightness_work
);
891 cancel_delayed_work_sync(&priv
->rx_led
.brightness_work
);
894 static int ath9k_register_led(struct ath9k_htc_priv
*priv
, struct ath_led
*led
,
900 led
->led_cdev
.name
= led
->name
;
901 led
->led_cdev
.default_trigger
= trigger
;
902 led
->led_cdev
.brightness_set
= ath9k_led_brightness
;
904 ret
= led_classdev_register(wiphy_dev(priv
->hw
->wiphy
), &led
->led_cdev
);
906 ath_print(ath9k_hw_common(priv
->ah
), ATH_DBG_FATAL
,
907 "Failed to register led:%s", led
->name
);
911 INIT_DELAYED_WORK(&led
->brightness_work
, ath9k_led_brightness_work
);
916 static void ath9k_unregister_led(struct ath_led
*led
)
918 if (led
->registered
) {
919 led_classdev_unregister(&led
->led_cdev
);
924 void ath9k_deinit_leds(struct ath9k_htc_priv
*priv
)
926 priv
->op_flags
|= OP_LED_DEINIT
;
927 ath9k_unregister_led(&priv
->assoc_led
);
928 priv
->op_flags
&= ~OP_LED_ASSOCIATED
;
929 ath9k_unregister_led(&priv
->tx_led
);
930 ath9k_unregister_led(&priv
->rx_led
);
931 ath9k_unregister_led(&priv
->radio_led
);
934 void ath9k_init_leds(struct ath9k_htc_priv
*priv
)
939 if (AR_SREV_9287(priv
->ah
))
940 priv
->ah
->led_pin
= ATH_LED_PIN_9287
;
941 else if (AR_SREV_9271(priv
->ah
))
942 priv
->ah
->led_pin
= ATH_LED_PIN_9271
;
943 else if (AR_DEVID_7010(priv
->ah
))
944 priv
->ah
->led_pin
= ATH_LED_PIN_7010
;
946 priv
->ah
->led_pin
= ATH_LED_PIN_DEF
;
948 /* Configure gpio 1 for output */
949 ath9k_hw_cfg_output(priv
->ah
, priv
->ah
->led_pin
,
950 AR_GPIO_OUTPUT_MUX_AS_OUTPUT
);
951 /* LED off, active low */
952 ath9k_hw_set_gpio(priv
->ah
, priv
->ah
->led_pin
, 1);
954 INIT_DELAYED_WORK(&priv
->ath9k_led_blink_work
, ath9k_led_blink_work
);
956 trigger
= ieee80211_get_radio_led_name(priv
->hw
);
957 snprintf(priv
->radio_led
.name
, sizeof(priv
->radio_led
.name
),
958 "ath9k-%s::radio", wiphy_name(priv
->hw
->wiphy
));
959 ret
= ath9k_register_led(priv
, &priv
->radio_led
, trigger
);
960 priv
->radio_led
.led_type
= ATH_LED_RADIO
;
964 trigger
= ieee80211_get_assoc_led_name(priv
->hw
);
965 snprintf(priv
->assoc_led
.name
, sizeof(priv
->assoc_led
.name
),
966 "ath9k-%s::assoc", wiphy_name(priv
->hw
->wiphy
));
967 ret
= ath9k_register_led(priv
, &priv
->assoc_led
, trigger
);
968 priv
->assoc_led
.led_type
= ATH_LED_ASSOC
;
972 trigger
= ieee80211_get_tx_led_name(priv
->hw
);
973 snprintf(priv
->tx_led
.name
, sizeof(priv
->tx_led
.name
),
974 "ath9k-%s::tx", wiphy_name(priv
->hw
->wiphy
));
975 ret
= ath9k_register_led(priv
, &priv
->tx_led
, trigger
);
976 priv
->tx_led
.led_type
= ATH_LED_TX
;
980 trigger
= ieee80211_get_rx_led_name(priv
->hw
);
981 snprintf(priv
->rx_led
.name
, sizeof(priv
->rx_led
.name
),
982 "ath9k-%s::rx", wiphy_name(priv
->hw
->wiphy
));
983 ret
= ath9k_register_led(priv
, &priv
->rx_led
, trigger
);
984 priv
->rx_led
.led_type
= ATH_LED_RX
;
988 priv
->op_flags
&= ~OP_LED_DEINIT
;
993 cancel_delayed_work_sync(&priv
->ath9k_led_blink_work
);
994 ath9k_deinit_leds(priv
);
997 /*******************/
999 /*******************/
1001 static bool ath_is_rfkill_set(struct ath9k_htc_priv
*priv
)
1003 return ath9k_hw_gpio_get(priv
->ah
, priv
->ah
->rfkill_gpio
) ==
1004 priv
->ah
->rfkill_polarity
;
1007 static void ath9k_htc_rfkill_poll_state(struct ieee80211_hw
*hw
)
1009 struct ath9k_htc_priv
*priv
= hw
->priv
;
1010 bool blocked
= !!ath_is_rfkill_set(priv
);
1012 wiphy_rfkill_set_hw_state(hw
->wiphy
, blocked
);
1015 void ath9k_start_rfkill_poll(struct ath9k_htc_priv
*priv
)
1017 if (priv
->ah
->caps
.hw_caps
& ATH9K_HW_CAP_RFSILENT
)
1018 wiphy_rfkill_start_polling(priv
->hw
->wiphy
);
1021 static void ath9k_htc_radio_enable(struct ieee80211_hw
*hw
)
1023 struct ath9k_htc_priv
*priv
= hw
->priv
;
1024 struct ath_hw
*ah
= priv
->ah
;
1025 struct ath_common
*common
= ath9k_hw_common(ah
);
1030 ah
->curchan
= ath9k_cmn_get_curchannel(hw
, ah
);
1033 ret
= ath9k_hw_reset(ah
, ah
->curchan
, ah
->caldata
, false);
1035 ath_print(common
, ATH_DBG_FATAL
,
1036 "Unable to reset hardware; reset status %d "
1037 "(freq %u MHz)\n", ret
, ah
->curchan
->channel
);
1040 ath_update_txpow(priv
);
1043 WMI_CMD(WMI_START_RECV_CMDID
);
1044 ath9k_host_rx_init(priv
);
1047 htc_start(priv
->htc
);
1048 spin_lock_bh(&priv
->tx_lock
);
1049 priv
->tx_queues_stop
= false;
1050 spin_unlock_bh(&priv
->tx_lock
);
1051 ieee80211_wake_queues(hw
);
1053 WMI_CMD(WMI_ENABLE_INTR_CMDID
);
1056 ath9k_hw_cfg_output(ah
, ah
->led_pin
,
1057 AR_GPIO_OUTPUT_MUX_AS_OUTPUT
);
1058 ath9k_hw_set_gpio(ah
, ah
->led_pin
, 0);
1061 static void ath9k_htc_radio_disable(struct ieee80211_hw
*hw
)
1063 struct ath9k_htc_priv
*priv
= hw
->priv
;
1064 struct ath_hw
*ah
= priv
->ah
;
1065 struct ath_common
*common
= ath9k_hw_common(ah
);
1069 ath9k_htc_ps_wakeup(priv
);
1072 ath9k_hw_set_gpio(ah
, ah
->led_pin
, 1);
1073 ath9k_hw_cfg_gpio_input(ah
, ah
->led_pin
);
1075 WMI_CMD(WMI_DISABLE_INTR_CMDID
);
1078 ieee80211_stop_queues(hw
);
1079 htc_stop(priv
->htc
);
1080 WMI_CMD(WMI_DRAIN_TXQ_ALL_CMDID
);
1081 skb_queue_purge(&priv
->tx_queue
);
1084 WMI_CMD(WMI_STOP_RECV_CMDID
);
1087 * The MIB counters have to be disabled here,
1088 * since the target doesn't do it.
1090 ath9k_hw_disable_mib_counters(ah
);
1093 ah
->curchan
= ath9k_cmn_get_curchannel(hw
, ah
);
1096 ret
= ath9k_hw_reset(ah
, ah
->curchan
, ah
->caldata
, false);
1098 ath_print(common
, ATH_DBG_FATAL
,
1099 "Unable to reset hardware; reset status %d "
1100 "(freq %u MHz)\n", ret
, ah
->curchan
->channel
);
1103 /* Disable the PHY */
1104 ath9k_hw_phy_disable(ah
);
1106 ath9k_htc_ps_restore(priv
);
1107 ath9k_htc_setpower(priv
, ATH9K_PM_FULL_SLEEP
);
1110 /**********************/
1111 /* mac80211 Callbacks */
1112 /**********************/
1114 static int ath9k_htc_tx(struct ieee80211_hw
*hw
, struct sk_buff
*skb
)
1116 struct ieee80211_hdr
*hdr
;
1117 struct ath9k_htc_priv
*priv
= hw
->priv
;
1118 int padpos
, padsize
, ret
;
1120 hdr
= (struct ieee80211_hdr
*) skb
->data
;
1122 /* Add the padding after the header if this is not already done */
1123 padpos
= ath9k_cmn_padpos(hdr
->frame_control
);
1124 padsize
= padpos
& 3;
1125 if (padsize
&& skb
->len
> padpos
) {
1126 if (skb_headroom(skb
) < padsize
)
1128 skb_push(skb
, padsize
);
1129 memmove(skb
->data
, skb
->data
+ padsize
, padpos
);
1132 ret
= ath9k_htc_tx_start(priv
, skb
);
1134 if (ret
== -ENOMEM
) {
1135 ath_print(ath9k_hw_common(priv
->ah
), ATH_DBG_XMIT
,
1136 "Stopping TX queues\n");
1137 ieee80211_stop_queues(hw
);
1138 spin_lock_bh(&priv
->tx_lock
);
1139 priv
->tx_queues_stop
= true;
1140 spin_unlock_bh(&priv
->tx_lock
);
1142 ath_print(ath9k_hw_common(priv
->ah
), ATH_DBG_XMIT
,
1151 dev_kfree_skb_any(skb
);
1155 static int ath9k_htc_start(struct ieee80211_hw
*hw
)
1157 struct ath9k_htc_priv
*priv
= hw
->priv
;
1158 struct ath_hw
*ah
= priv
->ah
;
1159 struct ath_common
*common
= ath9k_hw_common(ah
);
1160 struct ieee80211_channel
*curchan
= hw
->conf
.channel
;
1161 struct ath9k_channel
*init_channel
;
1163 enum htc_phymode mode
;
1167 mutex_lock(&priv
->mutex
);
1169 ath_print(common
, ATH_DBG_CONFIG
,
1170 "Starting driver with initial channel: %d MHz\n",
1171 curchan
->center_freq
);
1173 /* Ensure that HW is awake before flushing RX */
1174 ath9k_htc_setpower(priv
, ATH9K_PM_AWAKE
);
1175 WMI_CMD(WMI_FLUSH_RECV_CMDID
);
1177 /* setup initial channel */
1178 init_channel
= ath9k_cmn_get_curchannel(hw
, ah
);
1180 /* Reset SERDES registers */
1181 ath9k_hw_configpcipowersave(ah
, 0, 0);
1183 ath9k_hw_htc_resetinit(ah
);
1184 ret
= ath9k_hw_reset(ah
, init_channel
, ah
->caldata
, false);
1186 ath_print(common
, ATH_DBG_FATAL
,
1187 "Unable to reset hardware; reset status %d "
1188 "(freq %u MHz)\n", ret
, curchan
->center_freq
);
1189 mutex_unlock(&priv
->mutex
);
1193 ath_update_txpow(priv
);
1195 mode
= ath9k_htc_get_curmode(priv
, init_channel
);
1196 htc_mode
= cpu_to_be16(mode
);
1197 WMI_CMD_BUF(WMI_SET_MODE_CMDID
, &htc_mode
);
1198 WMI_CMD(WMI_ATH_INIT_CMDID
);
1199 WMI_CMD(WMI_START_RECV_CMDID
);
1201 ath9k_host_rx_init(priv
);
1203 priv
->op_flags
&= ~OP_INVALID
;
1204 htc_start(priv
->htc
);
1206 spin_lock_bh(&priv
->tx_lock
);
1207 priv
->tx_queues_stop
= false;
1208 spin_unlock_bh(&priv
->tx_lock
);
1210 ieee80211_wake_queues(hw
);
1212 mutex_unlock(&priv
->mutex
);
1217 static void ath9k_htc_stop(struct ieee80211_hw
*hw
)
1219 struct ath9k_htc_priv
*priv
= hw
->priv
;
1220 struct ath_hw
*ah
= priv
->ah
;
1221 struct ath_common
*common
= ath9k_hw_common(ah
);
1225 mutex_lock(&priv
->mutex
);
1227 if (priv
->op_flags
& OP_INVALID
) {
1228 ath_print(common
, ATH_DBG_ANY
, "Device not present\n");
1229 mutex_unlock(&priv
->mutex
);
1233 /* Cancel all the running timers/work .. */
1234 cancel_work_sync(&priv
->ps_work
);
1235 cancel_delayed_work_sync(&priv
->ath9k_ani_work
);
1236 cancel_delayed_work_sync(&priv
->ath9k_led_blink_work
);
1237 ath9k_led_stop_brightness(priv
);
1239 ath9k_htc_ps_wakeup(priv
);
1240 htc_stop(priv
->htc
);
1241 WMI_CMD(WMI_DISABLE_INTR_CMDID
);
1242 WMI_CMD(WMI_DRAIN_TXQ_ALL_CMDID
);
1243 WMI_CMD(WMI_STOP_RECV_CMDID
);
1244 skb_queue_purge(&priv
->tx_queue
);
1246 /* Remove monitor interface here */
1247 if (ah
->opmode
== NL80211_IFTYPE_MONITOR
) {
1248 if (ath9k_htc_remove_monitor_interface(priv
))
1249 ath_print(common
, ATH_DBG_FATAL
,
1250 "Unable to remove monitor interface\n");
1252 ath_print(common
, ATH_DBG_CONFIG
,
1253 "Monitor interface removed\n");
1256 ath9k_hw_phy_disable(ah
);
1257 ath9k_hw_disable(ah
);
1258 ath9k_hw_configpcipowersave(ah
, 1, 1);
1259 ath9k_htc_ps_restore(priv
);
1260 ath9k_htc_setpower(priv
, ATH9K_PM_FULL_SLEEP
);
1262 priv
->op_flags
|= OP_INVALID
;
1264 ath_print(common
, ATH_DBG_CONFIG
, "Driver halt\n");
1265 mutex_unlock(&priv
->mutex
);
1268 static int ath9k_htc_add_interface(struct ieee80211_hw
*hw
,
1269 struct ieee80211_vif
*vif
)
1271 struct ath9k_htc_priv
*priv
= hw
->priv
;
1272 struct ath9k_htc_vif
*avp
= (void *)vif
->drv_priv
;
1273 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
1274 struct ath9k_htc_target_vif hvif
;
1278 mutex_lock(&priv
->mutex
);
1280 /* Only one interface for now */
1281 if (priv
->nvifs
> 0) {
1286 ath9k_htc_ps_wakeup(priv
);
1287 memset(&hvif
, 0, sizeof(struct ath9k_htc_target_vif
));
1288 memcpy(&hvif
.myaddr
, vif
->addr
, ETH_ALEN
);
1290 switch (vif
->type
) {
1291 case NL80211_IFTYPE_STATION
:
1292 hvif
.opmode
= cpu_to_be32(HTC_M_STA
);
1294 case NL80211_IFTYPE_ADHOC
:
1295 hvif
.opmode
= cpu_to_be32(HTC_M_IBSS
);
1298 ath_print(common
, ATH_DBG_FATAL
,
1299 "Interface type %d not yet supported\n", vif
->type
);
1304 ath_print(common
, ATH_DBG_CONFIG
,
1305 "Attach a VIF of type: %d\n", vif
->type
);
1307 priv
->ah
->opmode
= vif
->type
;
1309 /* Index starts from zero on the target */
1310 avp
->index
= hvif
.index
= priv
->nvifs
;
1311 hvif
.rtsthreshold
= cpu_to_be16(2304);
1312 WMI_CMD_BUF(WMI_VAP_CREATE_CMDID
, &hvif
);
1319 * We need a node in target to tx mgmt frames
1320 * before association.
1322 ret
= ath9k_htc_add_station(priv
, vif
, NULL
);
1326 ret
= ath9k_htc_update_cap_target(priv
);
1328 ath_print(common
, ATH_DBG_CONFIG
, "Failed to update"
1329 " capability in target \n");
1333 ath9k_htc_ps_restore(priv
);
1334 mutex_unlock(&priv
->mutex
);
1339 static void ath9k_htc_remove_interface(struct ieee80211_hw
*hw
,
1340 struct ieee80211_vif
*vif
)
1342 struct ath9k_htc_priv
*priv
= hw
->priv
;
1343 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
1344 struct ath9k_htc_vif
*avp
= (void *)vif
->drv_priv
;
1345 struct ath9k_htc_target_vif hvif
;
1349 ath_print(common
, ATH_DBG_CONFIG
, "Detach Interface\n");
1351 mutex_lock(&priv
->mutex
);
1352 ath9k_htc_ps_wakeup(priv
);
1354 memset(&hvif
, 0, sizeof(struct ath9k_htc_target_vif
));
1355 memcpy(&hvif
.myaddr
, vif
->addr
, ETH_ALEN
);
1356 hvif
.index
= avp
->index
;
1357 WMI_CMD_BUF(WMI_VAP_REMOVE_CMDID
, &hvif
);
1360 ath9k_htc_remove_station(priv
, vif
, NULL
);
1363 ath9k_htc_ps_restore(priv
);
1364 mutex_unlock(&priv
->mutex
);
1367 static int ath9k_htc_config(struct ieee80211_hw
*hw
, u32 changed
)
1369 struct ath9k_htc_priv
*priv
= hw
->priv
;
1370 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
1371 struct ieee80211_conf
*conf
= &hw
->conf
;
1373 mutex_lock(&priv
->mutex
);
1375 if (changed
& IEEE80211_CONF_CHANGE_IDLE
) {
1376 bool enable_radio
= false;
1377 bool idle
= !!(conf
->flags
& IEEE80211_CONF_IDLE
);
1379 mutex_lock(&priv
->htc_pm_lock
);
1380 if (!idle
&& priv
->ps_idle
)
1381 enable_radio
= true;
1382 priv
->ps_idle
= idle
;
1383 mutex_unlock(&priv
->htc_pm_lock
);
1386 ath_print(common
, ATH_DBG_CONFIG
,
1387 "not-idle: enabling radio\n");
1388 ath9k_htc_setpower(priv
, ATH9K_PM_AWAKE
);
1389 ath9k_htc_radio_enable(hw
);
1393 if (changed
& IEEE80211_CONF_CHANGE_CHANNEL
) {
1394 struct ieee80211_channel
*curchan
= hw
->conf
.channel
;
1395 int pos
= curchan
->hw_value
;
1397 ath_print(common
, ATH_DBG_CONFIG
, "Set channel: %d MHz\n",
1398 curchan
->center_freq
);
1400 ath9k_cmn_update_ichannel(hw
, &priv
->ah
->channels
[pos
]);
1402 if (ath9k_htc_set_channel(priv
, hw
, &priv
->ah
->channels
[pos
]) < 0) {
1403 ath_print(common
, ATH_DBG_FATAL
,
1404 "Unable to set channel\n");
1405 mutex_unlock(&priv
->mutex
);
1410 if (changed
& IEEE80211_CONF_CHANGE_PS
) {
1411 if (conf
->flags
& IEEE80211_CONF_PS
) {
1412 ath9k_htc_setpower(priv
, ATH9K_PM_NETWORK_SLEEP
);
1413 priv
->ps_enabled
= true;
1415 priv
->ps_enabled
= false;
1416 cancel_work_sync(&priv
->ps_work
);
1417 ath9k_htc_setpower(priv
, ATH9K_PM_AWAKE
);
1421 if (changed
& IEEE80211_CONF_CHANGE_MONITOR
) {
1422 if (conf
->flags
& IEEE80211_CONF_MONITOR
) {
1423 if (ath9k_htc_add_monitor_interface(priv
))
1424 ath_print(common
, ATH_DBG_FATAL
,
1425 "Failed to set monitor mode\n");
1427 ath_print(common
, ATH_DBG_CONFIG
,
1428 "HW opmode set to Monitor mode\n");
1432 if (changed
& IEEE80211_CONF_CHANGE_IDLE
) {
1433 mutex_lock(&priv
->htc_pm_lock
);
1434 if (!priv
->ps_idle
) {
1435 mutex_unlock(&priv
->htc_pm_lock
);
1438 mutex_unlock(&priv
->htc_pm_lock
);
1440 ath_print(common
, ATH_DBG_CONFIG
,
1441 "idle: disabling radio\n");
1442 ath9k_htc_radio_disable(hw
);
1446 mutex_unlock(&priv
->mutex
);
1450 #define SUPPORTED_FILTERS \
1451 (FIF_PROMISC_IN_BSS | \
1456 FIF_BCN_PRBRESP_PROMISC | \
1459 static void ath9k_htc_configure_filter(struct ieee80211_hw
*hw
,
1460 unsigned int changed_flags
,
1461 unsigned int *total_flags
,
1464 struct ath9k_htc_priv
*priv
= hw
->priv
;
1467 mutex_lock(&priv
->mutex
);
1468 ath9k_htc_ps_wakeup(priv
);
1470 changed_flags
&= SUPPORTED_FILTERS
;
1471 *total_flags
&= SUPPORTED_FILTERS
;
1473 priv
->rxfilter
= *total_flags
;
1474 rfilt
= ath9k_htc_calcrxfilter(priv
);
1475 ath9k_hw_setrxfilter(priv
->ah
, rfilt
);
1477 ath_print(ath9k_hw_common(priv
->ah
), ATH_DBG_CONFIG
,
1478 "Set HW RX filter: 0x%x\n", rfilt
);
1480 ath9k_htc_ps_restore(priv
);
1481 mutex_unlock(&priv
->mutex
);
1484 static int ath9k_htc_sta_add(struct ieee80211_hw
*hw
,
1485 struct ieee80211_vif
*vif
,
1486 struct ieee80211_sta
*sta
)
1488 struct ath9k_htc_priv
*priv
= hw
->priv
;
1491 mutex_lock(&priv
->mutex
);
1492 ath9k_htc_ps_wakeup(priv
);
1493 ret
= ath9k_htc_add_station(priv
, vif
, sta
);
1495 ath9k_htc_init_rate(priv
, sta
);
1496 ath9k_htc_ps_restore(priv
);
1497 mutex_unlock(&priv
->mutex
);
1502 static int ath9k_htc_sta_remove(struct ieee80211_hw
*hw
,
1503 struct ieee80211_vif
*vif
,
1504 struct ieee80211_sta
*sta
)
1506 struct ath9k_htc_priv
*priv
= hw
->priv
;
1509 mutex_lock(&priv
->mutex
);
1510 ath9k_htc_ps_wakeup(priv
);
1511 ret
= ath9k_htc_remove_station(priv
, vif
, sta
);
1512 ath9k_htc_ps_restore(priv
);
1513 mutex_unlock(&priv
->mutex
);
1518 static int ath9k_htc_conf_tx(struct ieee80211_hw
*hw
, u16 queue
,
1519 const struct ieee80211_tx_queue_params
*params
)
1521 struct ath9k_htc_priv
*priv
= hw
->priv
;
1522 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
1523 struct ath9k_tx_queue_info qi
;
1526 if (queue
>= WME_NUM_AC
)
1529 mutex_lock(&priv
->mutex
);
1530 ath9k_htc_ps_wakeup(priv
);
1532 memset(&qi
, 0, sizeof(struct ath9k_tx_queue_info
));
1534 qi
.tqi_aifs
= params
->aifs
;
1535 qi
.tqi_cwmin
= params
->cw_min
;
1536 qi
.tqi_cwmax
= params
->cw_max
;
1537 qi
.tqi_burstTime
= params
->txop
;
1539 qnum
= get_hw_qnum(queue
, priv
->hwq_map
);
1541 ath_print(common
, ATH_DBG_CONFIG
,
1542 "Configure tx [queue/hwq] [%d/%d], "
1543 "aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
1544 queue
, qnum
, params
->aifs
, params
->cw_min
,
1545 params
->cw_max
, params
->txop
);
1547 ret
= ath_htc_txq_update(priv
, qnum
, &qi
);
1549 ath_print(common
, ATH_DBG_FATAL
, "TXQ Update failed\n");
1553 if ((priv
->ah
->opmode
== NL80211_IFTYPE_ADHOC
) &&
1554 (qnum
== priv
->hwq_map
[WME_AC_BE
]))
1555 ath9k_htc_beaconq_config(priv
);
1557 ath9k_htc_ps_restore(priv
);
1558 mutex_unlock(&priv
->mutex
);
1563 static int ath9k_htc_set_key(struct ieee80211_hw
*hw
,
1564 enum set_key_cmd cmd
,
1565 struct ieee80211_vif
*vif
,
1566 struct ieee80211_sta
*sta
,
1567 struct ieee80211_key_conf
*key
)
1569 struct ath9k_htc_priv
*priv
= hw
->priv
;
1570 struct ath_common
*common
= ath9k_hw_common(priv
->ah
);
1573 if (htc_modparam_nohwcrypt
)
1576 mutex_lock(&priv
->mutex
);
1577 ath_print(common
, ATH_DBG_CONFIG
, "Set HW Key\n");
1578 ath9k_htc_ps_wakeup(priv
);
1582 ret
= ath9k_cmn_key_config(common
, vif
, sta
, key
);
1584 key
->hw_key_idx
= ret
;
1585 /* push IV and Michael MIC generation to stack */
1586 key
->flags
|= IEEE80211_KEY_FLAG_GENERATE_IV
;
1587 if (key
->alg
== ALG_TKIP
)
1588 key
->flags
|= IEEE80211_KEY_FLAG_GENERATE_MMIC
;
1589 if (priv
->ah
->sw_mgmt_crypto
&& key
->alg
== ALG_CCMP
)
1590 key
->flags
|= IEEE80211_KEY_FLAG_SW_MGMT
;
1595 ath9k_cmn_key_delete(common
, key
);
1601 ath9k_htc_ps_restore(priv
);
1602 mutex_unlock(&priv
->mutex
);
1607 static void ath9k_htc_bss_info_changed(struct ieee80211_hw
*hw
,
1608 struct ieee80211_vif
*vif
,
1609 struct ieee80211_bss_conf
*bss_conf
,
1612 struct ath9k_htc_priv
*priv
= hw
->priv
;
1613 struct ath_hw
*ah
= priv
->ah
;
1614 struct ath_common
*common
= ath9k_hw_common(ah
);
1616 mutex_lock(&priv
->mutex
);
1617 ath9k_htc_ps_wakeup(priv
);
1619 if (changed
& BSS_CHANGED_ASSOC
) {
1620 common
->curaid
= bss_conf
->assoc
?
1622 ath_print(common
, ATH_DBG_CONFIG
, "BSS Changed ASSOC %d\n",
1625 if (bss_conf
->assoc
) {
1626 priv
->op_flags
|= OP_ASSOCIATED
;
1627 ath_start_ani(priv
);
1629 priv
->op_flags
&= ~OP_ASSOCIATED
;
1630 cancel_delayed_work_sync(&priv
->ath9k_ani_work
);
1634 if (changed
& BSS_CHANGED_BSSID
) {
1636 memcpy(common
->curbssid
, bss_conf
->bssid
, ETH_ALEN
);
1637 ath9k_hw_write_associd(ah
);
1639 ath_print(common
, ATH_DBG_CONFIG
,
1640 "BSSID: %pM aid: 0x%x\n",
1641 common
->curbssid
, common
->curaid
);
1644 if ((changed
& BSS_CHANGED_BEACON_INT
) ||
1645 (changed
& BSS_CHANGED_BEACON
) ||
1646 ((changed
& BSS_CHANGED_BEACON_ENABLED
) &&
1647 bss_conf
->enable_beacon
)) {
1648 priv
->op_flags
|= OP_ENABLE_BEACON
;
1649 ath9k_htc_beacon_config(priv
, vif
);
1652 if ((changed
& BSS_CHANGED_BEACON_ENABLED
) &&
1653 !bss_conf
->enable_beacon
) {
1654 priv
->op_flags
&= ~OP_ENABLE_BEACON
;
1655 ath9k_htc_beacon_config(priv
, vif
);
1658 if (changed
& BSS_CHANGED_ERP_PREAMBLE
) {
1659 ath_print(common
, ATH_DBG_CONFIG
, "BSS Changed PREAMBLE %d\n",
1660 bss_conf
->use_short_preamble
);
1661 if (bss_conf
->use_short_preamble
)
1662 priv
->op_flags
|= OP_PREAMBLE_SHORT
;
1664 priv
->op_flags
&= ~OP_PREAMBLE_SHORT
;
1667 if (changed
& BSS_CHANGED_ERP_CTS_PROT
) {
1668 ath_print(common
, ATH_DBG_CONFIG
, "BSS Changed CTS PROT %d\n",
1669 bss_conf
->use_cts_prot
);
1670 if (bss_conf
->use_cts_prot
&&
1671 hw
->conf
.channel
->band
!= IEEE80211_BAND_5GHZ
)
1672 priv
->op_flags
|= OP_PROTECT_ENABLE
;
1674 priv
->op_flags
&= ~OP_PROTECT_ENABLE
;
1677 if (changed
& BSS_CHANGED_ERP_SLOT
) {
1678 if (bss_conf
->use_short_slot
)
1683 ath9k_hw_init_global_settings(ah
);
1686 if (changed
& BSS_CHANGED_HT
)
1687 ath9k_htc_update_rate(priv
, vif
, bss_conf
);
1689 ath9k_htc_ps_restore(priv
);
1690 mutex_unlock(&priv
->mutex
);
1693 static u64
ath9k_htc_get_tsf(struct ieee80211_hw
*hw
)
1695 struct ath9k_htc_priv
*priv
= hw
->priv
;
1698 mutex_lock(&priv
->mutex
);
1699 ath9k_htc_ps_wakeup(priv
);
1700 tsf
= ath9k_hw_gettsf64(priv
->ah
);
1701 ath9k_htc_ps_restore(priv
);
1702 mutex_unlock(&priv
->mutex
);
1707 static void ath9k_htc_set_tsf(struct ieee80211_hw
*hw
, u64 tsf
)
1709 struct ath9k_htc_priv
*priv
= hw
->priv
;
1711 mutex_lock(&priv
->mutex
);
1712 ath9k_htc_ps_wakeup(priv
);
1713 ath9k_hw_settsf64(priv
->ah
, tsf
);
1714 ath9k_htc_ps_restore(priv
);
1715 mutex_unlock(&priv
->mutex
);
1718 static void ath9k_htc_reset_tsf(struct ieee80211_hw
*hw
)
1720 struct ath9k_htc_priv
*priv
= hw
->priv
;
1722 mutex_lock(&priv
->mutex
);
1723 ath9k_htc_ps_wakeup(priv
);
1724 ath9k_hw_reset_tsf(priv
->ah
);
1725 ath9k_htc_ps_restore(priv
);
1726 mutex_unlock(&priv
->mutex
);
1729 static int ath9k_htc_ampdu_action(struct ieee80211_hw
*hw
,
1730 struct ieee80211_vif
*vif
,
1731 enum ieee80211_ampdu_mlme_action action
,
1732 struct ieee80211_sta
*sta
,
1735 struct ath9k_htc_priv
*priv
= hw
->priv
;
1736 struct ath9k_htc_sta
*ista
;
1740 case IEEE80211_AMPDU_RX_START
:
1742 case IEEE80211_AMPDU_RX_STOP
:
1744 case IEEE80211_AMPDU_TX_START
:
1745 ret
= ath9k_htc_tx_aggr_oper(priv
, vif
, sta
, action
, tid
);
1747 ieee80211_start_tx_ba_cb_irqsafe(vif
, sta
->addr
, tid
);
1749 case IEEE80211_AMPDU_TX_STOP
:
1750 ath9k_htc_tx_aggr_oper(priv
, vif
, sta
, action
, tid
);
1751 ieee80211_stop_tx_ba_cb_irqsafe(vif
, sta
->addr
, tid
);
1753 case IEEE80211_AMPDU_TX_OPERATIONAL
:
1754 ista
= (struct ath9k_htc_sta
*) sta
->drv_priv
;
1755 spin_lock_bh(&priv
->tx_lock
);
1756 ista
->tid_state
[tid
] = AGGR_OPERATIONAL
;
1757 spin_unlock_bh(&priv
->tx_lock
);
1760 ath_print(ath9k_hw_common(priv
->ah
), ATH_DBG_FATAL
,
1761 "Unknown AMPDU action\n");
1767 static void ath9k_htc_sw_scan_start(struct ieee80211_hw
*hw
)
1769 struct ath9k_htc_priv
*priv
= hw
->priv
;
1771 mutex_lock(&priv
->mutex
);
1772 spin_lock_bh(&priv
->beacon_lock
);
1773 priv
->op_flags
|= OP_SCANNING
;
1774 spin_unlock_bh(&priv
->beacon_lock
);
1775 cancel_work_sync(&priv
->ps_work
);
1776 cancel_delayed_work_sync(&priv
->ath9k_ani_work
);
1777 mutex_unlock(&priv
->mutex
);
1780 static void ath9k_htc_sw_scan_complete(struct ieee80211_hw
*hw
)
1782 struct ath9k_htc_priv
*priv
= hw
->priv
;
1784 mutex_lock(&priv
->mutex
);
1785 ath9k_htc_ps_wakeup(priv
);
1786 spin_lock_bh(&priv
->beacon_lock
);
1787 priv
->op_flags
&= ~OP_SCANNING
;
1788 spin_unlock_bh(&priv
->beacon_lock
);
1789 priv
->op_flags
|= OP_FULL_RESET
;
1790 if (priv
->op_flags
& OP_ASSOCIATED
)
1791 ath9k_htc_beacon_config(priv
, priv
->vif
);
1792 ath_start_ani(priv
);
1793 ath9k_htc_ps_restore(priv
);
1794 mutex_unlock(&priv
->mutex
);
1797 static int ath9k_htc_set_rts_threshold(struct ieee80211_hw
*hw
, u32 value
)
1802 static void ath9k_htc_set_coverage_class(struct ieee80211_hw
*hw
,
1805 struct ath9k_htc_priv
*priv
= hw
->priv
;
1807 mutex_lock(&priv
->mutex
);
1808 ath9k_htc_ps_wakeup(priv
);
1809 priv
->ah
->coverage_class
= coverage_class
;
1810 ath9k_hw_init_global_settings(priv
->ah
);
1811 ath9k_htc_ps_restore(priv
);
1812 mutex_unlock(&priv
->mutex
);
1815 struct ieee80211_ops ath9k_htc_ops
= {
1817 .start
= ath9k_htc_start
,
1818 .stop
= ath9k_htc_stop
,
1819 .add_interface
= ath9k_htc_add_interface
,
1820 .remove_interface
= ath9k_htc_remove_interface
,
1821 .config
= ath9k_htc_config
,
1822 .configure_filter
= ath9k_htc_configure_filter
,
1823 .sta_add
= ath9k_htc_sta_add
,
1824 .sta_remove
= ath9k_htc_sta_remove
,
1825 .conf_tx
= ath9k_htc_conf_tx
,
1826 .bss_info_changed
= ath9k_htc_bss_info_changed
,
1827 .set_key
= ath9k_htc_set_key
,
1828 .get_tsf
= ath9k_htc_get_tsf
,
1829 .set_tsf
= ath9k_htc_set_tsf
,
1830 .reset_tsf
= ath9k_htc_reset_tsf
,
1831 .ampdu_action
= ath9k_htc_ampdu_action
,
1832 .sw_scan_start
= ath9k_htc_sw_scan_start
,
1833 .sw_scan_complete
= ath9k_htc_sw_scan_complete
,
1834 .set_rts_threshold
= ath9k_htc_set_rts_threshold
,
1835 .rfkill_poll
= ath9k_htc_rfkill_poll_state
,
1836 .set_coverage_class
= ath9k_htc_set_coverage_class
,