2 * Copyright (c) 2008-2011 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.
17 #include <linux/nl80211.h>
18 #include <linux/delay.h>
22 u8
ath9k_parse_mpdudensity(u8 mpdudensity
)
25 * 802.11n D2.0 defined values for "Minimum MPDU Start Spacing":
26 * 0 for no restriction
35 switch (mpdudensity
) {
41 /* Our lower layer calculations limit our precision to
57 static bool ath9k_has_pending_frames(struct ath_softc
*sc
, struct ath_txq
*txq
,
62 spin_lock_bh(&txq
->axq_lock
);
72 if (txq
->mac80211_qnum
>= 0) {
73 struct list_head
*list
;
75 list
= &sc
->cur_chan
->acq
[txq
->mac80211_qnum
];
76 if (!list_empty(list
))
80 spin_unlock_bh(&txq
->axq_lock
);
84 static bool ath9k_setpower(struct ath_softc
*sc
, enum ath9k_power_mode mode
)
89 spin_lock_irqsave(&sc
->sc_pm_lock
, flags
);
90 ret
= ath9k_hw_setpower(sc
->sc_ah
, mode
);
91 spin_unlock_irqrestore(&sc
->sc_pm_lock
, flags
);
96 void ath_ps_full_sleep(unsigned long data
)
98 struct ath_softc
*sc
= (struct ath_softc
*) data
;
99 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
102 spin_lock(&common
->cc_lock
);
103 ath_hw_cycle_counters_update(common
);
104 spin_unlock(&common
->cc_lock
);
106 ath9k_hw_setrxabort(sc
->sc_ah
, 1);
107 ath9k_hw_stopdmarecv(sc
->sc_ah
, &reset
);
109 ath9k_hw_setpower(sc
->sc_ah
, ATH9K_PM_FULL_SLEEP
);
112 void ath9k_ps_wakeup(struct ath_softc
*sc
)
114 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
116 enum ath9k_power_mode power_mode
;
118 spin_lock_irqsave(&sc
->sc_pm_lock
, flags
);
119 if (++sc
->ps_usecount
!= 1)
122 del_timer_sync(&sc
->sleep_timer
);
123 power_mode
= sc
->sc_ah
->power_mode
;
124 ath9k_hw_setpower(sc
->sc_ah
, ATH9K_PM_AWAKE
);
127 * While the hardware is asleep, the cycle counters contain no
128 * useful data. Better clear them now so that they don't mess up
129 * survey data results.
131 if (power_mode
!= ATH9K_PM_AWAKE
) {
132 spin_lock(&common
->cc_lock
);
133 ath_hw_cycle_counters_update(common
);
134 memset(&common
->cc_survey
, 0, sizeof(common
->cc_survey
));
135 memset(&common
->cc_ani
, 0, sizeof(common
->cc_ani
));
136 spin_unlock(&common
->cc_lock
);
140 spin_unlock_irqrestore(&sc
->sc_pm_lock
, flags
);
143 void ath9k_ps_restore(struct ath_softc
*sc
)
145 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
146 enum ath9k_power_mode mode
;
149 spin_lock_irqsave(&sc
->sc_pm_lock
, flags
);
150 if (--sc
->ps_usecount
!= 0)
154 mod_timer(&sc
->sleep_timer
, jiffies
+ HZ
/ 10);
158 if (sc
->ps_enabled
&&
159 !(sc
->ps_flags
& (PS_WAIT_FOR_BEACON
|
161 PS_WAIT_FOR_PSPOLL_DATA
|
164 mode
= ATH9K_PM_NETWORK_SLEEP
;
165 if (ath9k_hw_btcoex_is_enabled(sc
->sc_ah
))
166 ath9k_btcoex_stop_gen_timer(sc
);
171 spin_lock(&common
->cc_lock
);
172 ath_hw_cycle_counters_update(common
);
173 spin_unlock(&common
->cc_lock
);
175 ath9k_hw_setpower(sc
->sc_ah
, mode
);
178 spin_unlock_irqrestore(&sc
->sc_pm_lock
, flags
);
181 static void __ath_cancel_work(struct ath_softc
*sc
)
183 cancel_work_sync(&sc
->paprd_work
);
184 cancel_delayed_work_sync(&sc
->tx_complete_work
);
185 cancel_delayed_work_sync(&sc
->hw_pll_work
);
187 #ifdef CONFIG_ATH9K_BTCOEX_SUPPORT
188 if (ath9k_hw_mci_is_enabled(sc
->sc_ah
))
189 cancel_work_sync(&sc
->mci_work
);
193 void ath_cancel_work(struct ath_softc
*sc
)
195 __ath_cancel_work(sc
);
196 cancel_work_sync(&sc
->hw_reset_work
);
199 void ath_restart_work(struct ath_softc
*sc
)
201 ieee80211_queue_delayed_work(sc
->hw
, &sc
->tx_complete_work
, 0);
203 if (AR_SREV_9340(sc
->sc_ah
) || AR_SREV_9330(sc
->sc_ah
))
204 ieee80211_queue_delayed_work(sc
->hw
, &sc
->hw_pll_work
,
205 msecs_to_jiffies(ATH_PLL_WORK_INTERVAL
));
210 static bool ath_prepare_reset(struct ath_softc
*sc
)
212 struct ath_hw
*ah
= sc
->sc_ah
;
215 ieee80211_stop_queues(sc
->hw
);
217 ath9k_hw_disable_interrupts(ah
);
219 if (!ath_drain_all_txq(sc
))
222 if (!ath_stoprecv(sc
))
228 static bool ath_complete_reset(struct ath_softc
*sc
, bool start
)
230 struct ath_hw
*ah
= sc
->sc_ah
;
231 struct ath_common
*common
= ath9k_hw_common(ah
);
234 ath9k_calculate_summary_state(sc
, sc
->cur_chan
);
236 ath9k_cmn_update_txpow(ah
, sc
->cur_chan
->cur_txpower
,
237 sc
->cur_chan
->txpower
,
238 &sc
->cur_chan
->cur_txpower
);
239 clear_bit(ATH_OP_HW_RESET
, &common
->op_flags
);
241 if (!sc
->cur_chan
->offchannel
&& start
) {
242 /* restore per chanctx TSF timer */
243 if (sc
->cur_chan
->tsf_val
) {
246 offset
= ath9k_hw_get_tsf_offset(&sc
->cur_chan
->tsf_ts
,
248 ath9k_hw_settsf64(ah
, sc
->cur_chan
->tsf_val
+ offset
);
252 if (!test_bit(ATH_OP_BEACONS
, &common
->op_flags
))
255 if (ah
->opmode
== NL80211_IFTYPE_STATION
&&
256 test_bit(ATH_OP_PRIM_STA_VIF
, &common
->op_flags
)) {
257 spin_lock_irqsave(&sc
->sc_pm_lock
, flags
);
258 sc
->ps_flags
|= PS_BEACON_SYNC
| PS_WAIT_FOR_BEACON
;
259 spin_unlock_irqrestore(&sc
->sc_pm_lock
, flags
);
261 ath9k_set_beacon(sc
);
264 ath_restart_work(sc
);
265 ath_txq_schedule_all(sc
);
270 ath9k_hw_set_interrupts(ah
);
271 ath9k_hw_enable_interrupts(ah
);
272 ieee80211_wake_queues(sc
->hw
);
273 ath9k_p2p_ps_timer(sc
);
278 static int ath_reset_internal(struct ath_softc
*sc
, struct ath9k_channel
*hchan
)
280 struct ath_hw
*ah
= sc
->sc_ah
;
281 struct ath_common
*common
= ath9k_hw_common(ah
);
282 struct ath9k_hw_cal_data
*caldata
= NULL
;
286 __ath_cancel_work(sc
);
288 disable_irq(sc
->irq
);
289 tasklet_disable(&sc
->intr_tq
);
290 tasklet_disable(&sc
->bcon_tasklet
);
291 spin_lock_bh(&sc
->sc_pcu_lock
);
293 if (!sc
->cur_chan
->offchannel
) {
295 caldata
= &sc
->cur_chan
->caldata
;
303 if (!ath_prepare_reset(sc
))
306 if (ath9k_is_chanctx_enabled())
309 spin_lock_bh(&sc
->chan_lock
);
310 sc
->cur_chandef
= sc
->cur_chan
->chandef
;
311 spin_unlock_bh(&sc
->chan_lock
);
313 ath_dbg(common
, CONFIG
, "Reset to %u MHz, HT40: %d fastcc: %d\n",
314 hchan
->channel
, IS_CHAN_HT40(hchan
), fastcc
);
316 r
= ath9k_hw_reset(ah
, hchan
, caldata
, fastcc
);
319 "Unable to reset channel, reset status %d\n", r
);
321 ath9k_hw_enable_interrupts(ah
);
322 ath9k_queue_reset(sc
, RESET_TYPE_BB_HANG
);
327 if (ath9k_hw_mci_is_enabled(sc
->sc_ah
) &&
328 sc
->cur_chan
->offchannel
)
329 ath9k_mci_set_txpower(sc
, true, false);
331 if (!ath_complete_reset(sc
, true))
336 spin_unlock_bh(&sc
->sc_pcu_lock
);
337 tasklet_enable(&sc
->bcon_tasklet
);
338 tasklet_enable(&sc
->intr_tq
);
343 static void ath_node_attach(struct ath_softc
*sc
, struct ieee80211_sta
*sta
,
344 struct ieee80211_vif
*vif
)
347 an
= (struct ath_node
*)sta
->drv_priv
;
352 memset(&an
->key_idx
, 0, sizeof(an
->key_idx
));
354 ath_tx_node_init(sc
, an
);
356 ath_dynack_node_init(sc
->sc_ah
, an
);
359 static void ath_node_detach(struct ath_softc
*sc
, struct ieee80211_sta
*sta
)
361 struct ath_node
*an
= (struct ath_node
*)sta
->drv_priv
;
362 ath_tx_node_cleanup(sc
, an
);
364 ath_dynack_node_deinit(sc
->sc_ah
, an
);
367 void ath9k_tasklet(unsigned long data
)
369 struct ath_softc
*sc
= (struct ath_softc
*)data
;
370 struct ath_hw
*ah
= sc
->sc_ah
;
371 struct ath_common
*common
= ath9k_hw_common(ah
);
372 enum ath_reset_type type
;
374 u32 status
= sc
->intrstatus
;
378 spin_lock(&sc
->sc_pcu_lock
);
380 if (status
& ATH9K_INT_FATAL
) {
381 type
= RESET_TYPE_FATAL_INT
;
382 ath9k_queue_reset(sc
, type
);
385 * Increment the ref. counter here so that
386 * interrupts are enabled in the reset routine.
388 atomic_inc(&ah
->intr_ref_cnt
);
389 ath_dbg(common
, RESET
, "FATAL: Skipping interrupts\n");
393 if ((ah
->config
.hw_hang_checks
& HW_BB_WATCHDOG
) &&
394 (status
& ATH9K_INT_BB_WATCHDOG
)) {
395 spin_lock(&common
->cc_lock
);
396 ath_hw_cycle_counters_update(common
);
397 ar9003_hw_bb_watchdog_dbg_info(ah
);
398 spin_unlock(&common
->cc_lock
);
400 if (ar9003_hw_bb_watchdog_check(ah
)) {
401 type
= RESET_TYPE_BB_WATCHDOG
;
402 ath9k_queue_reset(sc
, type
);
405 * Increment the ref. counter here so that
406 * interrupts are enabled in the reset routine.
408 atomic_inc(&ah
->intr_ref_cnt
);
409 ath_dbg(common
, RESET
,
410 "BB_WATCHDOG: Skipping interrupts\n");
415 if (status
& ATH9K_INT_GTT
) {
418 if ((sc
->gtt_cnt
>= MAX_GTT_CNT
) && !ath9k_hw_check_alive(ah
)) {
419 type
= RESET_TYPE_TX_GTT
;
420 ath9k_queue_reset(sc
, type
);
421 atomic_inc(&ah
->intr_ref_cnt
);
422 ath_dbg(common
, RESET
,
423 "GTT: Skipping interrupts\n");
428 spin_lock_irqsave(&sc
->sc_pm_lock
, flags
);
429 if ((status
& ATH9K_INT_TSFOOR
) && sc
->ps_enabled
) {
431 * TSF sync does not look correct; remain awake to sync with
434 ath_dbg(common
, PS
, "TSFOOR - Sync with next Beacon\n");
435 sc
->ps_flags
|= PS_WAIT_FOR_BEACON
| PS_BEACON_SYNC
;
437 spin_unlock_irqrestore(&sc
->sc_pm_lock
, flags
);
439 if (ah
->caps
.hw_caps
& ATH9K_HW_CAP_EDMA
)
440 rxmask
= (ATH9K_INT_RXHP
| ATH9K_INT_RXLP
| ATH9K_INT_RXEOL
|
443 rxmask
= (ATH9K_INT_RX
| ATH9K_INT_RXEOL
| ATH9K_INT_RXORN
);
445 if (status
& rxmask
) {
446 /* Check for high priority Rx first */
447 if ((ah
->caps
.hw_caps
& ATH9K_HW_CAP_EDMA
) &&
448 (status
& ATH9K_INT_RXHP
))
449 ath_rx_tasklet(sc
, 0, true);
451 ath_rx_tasklet(sc
, 0, false);
454 if (status
& ATH9K_INT_TX
) {
455 if (ah
->caps
.hw_caps
& ATH9K_HW_CAP_EDMA
) {
457 * For EDMA chips, TX completion is enabled for the
458 * beacon queue, so if a beacon has been transmitted
459 * successfully after a GTT interrupt, the GTT counter
460 * gets reset to zero here.
464 ath_tx_edma_tasklet(sc
);
469 wake_up(&sc
->tx_wait
);
472 if (status
& ATH9K_INT_GENTIMER
)
473 ath_gen_timer_isr(sc
->sc_ah
);
475 ath9k_btcoex_handle_interrupt(sc
, status
);
477 /* re-enable hardware interrupt */
478 ath9k_hw_enable_interrupts(ah
);
480 spin_unlock(&sc
->sc_pcu_lock
);
481 ath9k_ps_restore(sc
);
484 irqreturn_t
ath_isr(int irq
, void *dev
)
486 #define SCHED_INTR ( \
488 ATH9K_INT_BB_WATCHDOG | \
499 ATH9K_INT_GENTIMER | \
502 struct ath_softc
*sc
= dev
;
503 struct ath_hw
*ah
= sc
->sc_ah
;
504 struct ath_common
*common
= ath9k_hw_common(ah
);
505 enum ath9k_int status
;
510 * The hardware is not ready/present, don't
511 * touch anything. Note this can happen early
512 * on if the IRQ is shared.
514 if (!ah
|| test_bit(ATH_OP_INVALID
, &common
->op_flags
))
517 /* shared irq, not for us */
518 if (!ath9k_hw_intrpend(ah
))
522 * Figure out the reason(s) for the interrupt. Note
523 * that the hal returns a pseudo-ISR that may include
524 * bits we haven't explicitly enabled so we mask the
525 * value to insure we only process bits we requested.
527 ath9k_hw_getisr(ah
, &status
, &sync_cause
); /* NB: clears ISR too */
528 ath9k_debug_sync_cause(sc
, sync_cause
);
529 status
&= ah
->imask
; /* discard unasked-for bits */
531 if (test_bit(ATH_OP_HW_RESET
, &common
->op_flags
))
535 * If there are no status bits set, then this interrupt was not
536 * for me (should have been caught above).
541 /* Cache the status */
542 sc
->intrstatus
= status
;
544 if (status
& SCHED_INTR
)
548 * If a FATAL interrupt is received, we have to reset the chip
551 if (status
& ATH9K_INT_FATAL
)
554 if ((ah
->config
.hw_hang_checks
& HW_BB_WATCHDOG
) &&
555 (status
& ATH9K_INT_BB_WATCHDOG
))
558 if (status
& ATH9K_INT_SWBA
)
559 tasklet_schedule(&sc
->bcon_tasklet
);
561 if (status
& ATH9K_INT_TXURN
)
562 ath9k_hw_updatetxtriglevel(ah
, true);
564 if (status
& ATH9K_INT_RXEOL
) {
565 ah
->imask
&= ~(ATH9K_INT_RXEOL
| ATH9K_INT_RXORN
);
566 ath9k_hw_set_interrupts(ah
);
569 if (!(ah
->caps
.hw_caps
& ATH9K_HW_CAP_AUTOSLEEP
))
570 if (status
& ATH9K_INT_TIM_TIMER
) {
571 if (ATH_DBG_WARN_ON_ONCE(sc
->ps_idle
))
573 /* Clear RxAbort bit so that we can
575 ath9k_setpower(sc
, ATH9K_PM_AWAKE
);
576 spin_lock(&sc
->sc_pm_lock
);
577 ath9k_hw_setrxabort(sc
->sc_ah
, 0);
578 sc
->ps_flags
|= PS_WAIT_FOR_BEACON
;
579 spin_unlock(&sc
->sc_pm_lock
);
584 ath_debug_stat_interrupt(sc
, status
);
587 /* turn off every interrupt */
588 ath9k_hw_disable_interrupts(ah
);
589 tasklet_schedule(&sc
->intr_tq
);
598 * This function is called when a HW reset cannot be deferred
599 * and has to be immediate.
601 int ath_reset(struct ath_softc
*sc
, struct ath9k_channel
*hchan
)
603 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
606 ath9k_hw_kill_interrupts(sc
->sc_ah
);
607 set_bit(ATH_OP_HW_RESET
, &common
->op_flags
);
610 r
= ath_reset_internal(sc
, hchan
);
611 ath9k_ps_restore(sc
);
617 * When a HW reset can be deferred, it is added to the
618 * hw_reset_work workqueue, but we set ATH_OP_HW_RESET before
621 void ath9k_queue_reset(struct ath_softc
*sc
, enum ath_reset_type type
)
623 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
624 #ifdef CONFIG_ATH9K_DEBUGFS
625 RESET_STAT_INC(sc
, type
);
627 ath9k_hw_kill_interrupts(sc
->sc_ah
);
628 set_bit(ATH_OP_HW_RESET
, &common
->op_flags
);
629 ieee80211_queue_work(sc
->hw
, &sc
->hw_reset_work
);
632 void ath_reset_work(struct work_struct
*work
)
634 struct ath_softc
*sc
= container_of(work
, struct ath_softc
, hw_reset_work
);
637 ath_reset_internal(sc
, NULL
);
638 ath9k_ps_restore(sc
);
641 /**********************/
642 /* mac80211 callbacks */
643 /**********************/
645 static int ath9k_start(struct ieee80211_hw
*hw
)
647 struct ath_softc
*sc
= hw
->priv
;
648 struct ath_hw
*ah
= sc
->sc_ah
;
649 struct ath_common
*common
= ath9k_hw_common(ah
);
650 struct ieee80211_channel
*curchan
= sc
->cur_chan
->chandef
.chan
;
651 struct ath_chanctx
*ctx
= sc
->cur_chan
;
652 struct ath9k_channel
*init_channel
;
655 ath_dbg(common
, CONFIG
,
656 "Starting driver with initial channel: %d MHz\n",
657 curchan
->center_freq
);
660 mutex_lock(&sc
->mutex
);
662 init_channel
= ath9k_cmn_get_channel(hw
, ah
, &ctx
->chandef
);
663 sc
->cur_chandef
= hw
->conf
.chandef
;
665 /* Reset SERDES registers */
666 ath9k_hw_configpcipowersave(ah
, false);
669 * The basic interface to setting the hardware in a good
670 * state is ``reset''. On return the hardware is known to
671 * be powered up and with interrupts disabled. This must
672 * be followed by initialization of the appropriate bits
673 * and then setup of the interrupt mask.
675 spin_lock_bh(&sc
->sc_pcu_lock
);
677 atomic_set(&ah
->intr_ref_cnt
, -1);
679 r
= ath9k_hw_reset(ah
, init_channel
, ah
->caldata
, false);
682 "Unable to reset hardware; reset status %d (freq %u MHz)\n",
683 r
, curchan
->center_freq
);
684 ah
->reset_power_on
= false;
687 /* Setup our intr mask. */
688 ah
->imask
= ATH9K_INT_TX
| ATH9K_INT_RXEOL
|
689 ATH9K_INT_RXORN
| ATH9K_INT_FATAL
|
692 if (ah
->caps
.hw_caps
& ATH9K_HW_CAP_EDMA
)
693 ah
->imask
|= ATH9K_INT_RXHP
|
696 ah
->imask
|= ATH9K_INT_RX
;
698 if (ah
->config
.hw_hang_checks
& HW_BB_WATCHDOG
)
699 ah
->imask
|= ATH9K_INT_BB_WATCHDOG
;
702 * Enable GTT interrupts only for AR9003/AR9004 chips
705 if (AR_SREV_9300_20_OR_LATER(ah
))
706 ah
->imask
|= ATH9K_INT_GTT
;
708 if (ah
->caps
.hw_caps
& ATH9K_HW_CAP_HT
)
709 ah
->imask
|= ATH9K_INT_CST
;
713 clear_bit(ATH_OP_INVALID
, &common
->op_flags
);
714 sc
->sc_ah
->is_monitoring
= false;
716 if (!ath_complete_reset(sc
, false))
717 ah
->reset_power_on
= false;
719 if (ah
->led_pin
>= 0) {
720 ath9k_hw_cfg_output(ah
, ah
->led_pin
,
721 AR_GPIO_OUTPUT_MUX_AS_OUTPUT
);
722 ath9k_hw_set_gpio(ah
, ah
->led_pin
,
723 (ah
->config
.led_active_high
) ? 1 : 0);
727 * Reset key cache to sane defaults (all entries cleared) instead of
728 * semi-random values after suspend/resume.
730 ath9k_cmn_init_crypto(sc
->sc_ah
);
732 ath9k_hw_reset_tsf(ah
);
734 spin_unlock_bh(&sc
->sc_pcu_lock
);
736 mutex_unlock(&sc
->mutex
);
738 ath9k_ps_restore(sc
);
743 static void ath9k_tx(struct ieee80211_hw
*hw
,
744 struct ieee80211_tx_control
*control
,
747 struct ath_softc
*sc
= hw
->priv
;
748 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
749 struct ath_tx_control txctl
;
750 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*) skb
->data
;
753 if (sc
->ps_enabled
) {
755 * mac80211 does not set PM field for normal data frames, so we
756 * need to update that based on the current PS mode.
758 if (ieee80211_is_data(hdr
->frame_control
) &&
759 !ieee80211_is_nullfunc(hdr
->frame_control
) &&
760 !ieee80211_has_pm(hdr
->frame_control
)) {
762 "Add PM=1 for a TX frame while in PS mode\n");
763 hdr
->frame_control
|= cpu_to_le16(IEEE80211_FCTL_PM
);
767 if (unlikely(sc
->sc_ah
->power_mode
== ATH9K_PM_NETWORK_SLEEP
)) {
769 * We are using PS-Poll and mac80211 can request TX while in
770 * power save mode. Need to wake up hardware for the TX to be
771 * completed and if needed, also for RX of buffered frames.
774 spin_lock_irqsave(&sc
->sc_pm_lock
, flags
);
775 if (!(sc
->sc_ah
->caps
.hw_caps
& ATH9K_HW_CAP_AUTOSLEEP
))
776 ath9k_hw_setrxabort(sc
->sc_ah
, 0);
777 if (ieee80211_is_pspoll(hdr
->frame_control
)) {
779 "Sending PS-Poll to pick a buffered frame\n");
780 sc
->ps_flags
|= PS_WAIT_FOR_PSPOLL_DATA
;
782 ath_dbg(common
, PS
, "Wake up to complete TX\n");
783 sc
->ps_flags
|= PS_WAIT_FOR_TX_ACK
;
786 * The actual restore operation will happen only after
787 * the ps_flags bit is cleared. We are just dropping
788 * the ps_usecount here.
790 spin_unlock_irqrestore(&sc
->sc_pm_lock
, flags
);
791 ath9k_ps_restore(sc
);
795 * Cannot tx while the hardware is in full sleep, it first needs a full
796 * chip reset to recover from that
798 if (unlikely(sc
->sc_ah
->power_mode
== ATH9K_PM_FULL_SLEEP
)) {
799 ath_err(common
, "TX while HW is in FULL_SLEEP mode\n");
803 memset(&txctl
, 0, sizeof(struct ath_tx_control
));
804 txctl
.txq
= sc
->tx
.txq_map
[skb_get_queue_mapping(skb
)];
805 txctl
.sta
= control
->sta
;
807 ath_dbg(common
, XMIT
, "transmitting packet, skb: %p\n", skb
);
809 if (ath_tx_start(hw
, skb
, &txctl
) != 0) {
810 ath_dbg(common
, XMIT
, "TX failed\n");
811 TX_STAT_INC(txctl
.txq
->axq_qnum
, txfailed
);
817 ieee80211_free_txskb(hw
, skb
);
820 static void ath9k_stop(struct ieee80211_hw
*hw
)
822 struct ath_softc
*sc
= hw
->priv
;
823 struct ath_hw
*ah
= sc
->sc_ah
;
824 struct ath_common
*common
= ath9k_hw_common(ah
);
827 ath9k_deinit_channel_context(sc
);
829 mutex_lock(&sc
->mutex
);
833 if (test_bit(ATH_OP_INVALID
, &common
->op_flags
)) {
834 ath_dbg(common
, ANY
, "Device not present\n");
835 mutex_unlock(&sc
->mutex
);
839 /* Ensure HW is awake when we try to shut it down. */
842 spin_lock_bh(&sc
->sc_pcu_lock
);
844 /* prevent tasklets to enable interrupts once we disable them */
845 ah
->imask
&= ~ATH9K_INT_GLOBAL
;
847 /* make sure h/w will not generate any interrupt
848 * before setting the invalid flag. */
849 ath9k_hw_disable_interrupts(ah
);
851 spin_unlock_bh(&sc
->sc_pcu_lock
);
853 /* we can now sync irq and kill any running tasklets, since we already
854 * disabled interrupts and not holding a spin lock */
855 synchronize_irq(sc
->irq
);
856 tasklet_kill(&sc
->intr_tq
);
857 tasklet_kill(&sc
->bcon_tasklet
);
859 prev_idle
= sc
->ps_idle
;
862 spin_lock_bh(&sc
->sc_pcu_lock
);
864 if (ah
->led_pin
>= 0) {
865 ath9k_hw_set_gpio(ah
, ah
->led_pin
,
866 (ah
->config
.led_active_high
) ? 0 : 1);
867 ath9k_hw_cfg_gpio_input(ah
, ah
->led_pin
);
870 ath_prepare_reset(sc
);
873 dev_kfree_skb_any(sc
->rx
.frag
);
878 ah
->curchan
= ath9k_cmn_get_channel(hw
, ah
,
879 &sc
->cur_chan
->chandef
);
881 ath9k_hw_reset(ah
, ah
->curchan
, ah
->caldata
, false);
883 set_bit(ATH_OP_INVALID
, &common
->op_flags
);
885 ath9k_hw_phy_disable(ah
);
887 ath9k_hw_configpcipowersave(ah
, true);
889 spin_unlock_bh(&sc
->sc_pcu_lock
);
891 ath9k_ps_restore(sc
);
893 sc
->ps_idle
= prev_idle
;
895 mutex_unlock(&sc
->mutex
);
897 ath_dbg(common
, CONFIG
, "Driver halt\n");
900 static bool ath9k_uses_beacons(int type
)
903 case NL80211_IFTYPE_AP
:
904 case NL80211_IFTYPE_ADHOC
:
905 case NL80211_IFTYPE_MESH_POINT
:
912 static void ath9k_vif_iter(struct ath9k_vif_iter_data
*iter_data
,
913 u8
*mac
, struct ieee80211_vif
*vif
)
915 struct ath_vif
*avp
= (struct ath_vif
*)vif
->drv_priv
;
918 if (iter_data
->has_hw_macaddr
) {
919 for (i
= 0; i
< ETH_ALEN
; i
++)
920 iter_data
->mask
[i
] &=
921 ~(iter_data
->hw_macaddr
[i
] ^ mac
[i
]);
923 memcpy(iter_data
->hw_macaddr
, mac
, ETH_ALEN
);
924 iter_data
->has_hw_macaddr
= true;
927 if (!vif
->bss_conf
.use_short_slot
)
928 iter_data
->slottime
= ATH9K_SLOT_TIME_20
;
931 case NL80211_IFTYPE_AP
:
934 case NL80211_IFTYPE_STATION
:
935 iter_data
->nstations
++;
936 if (avp
->assoc
&& !iter_data
->primary_sta
)
937 iter_data
->primary_sta
= vif
;
939 case NL80211_IFTYPE_ADHOC
:
940 iter_data
->nadhocs
++;
941 if (vif
->bss_conf
.enable_beacon
)
942 iter_data
->beacons
= true;
944 case NL80211_IFTYPE_MESH_POINT
:
945 iter_data
->nmeshes
++;
946 if (vif
->bss_conf
.enable_beacon
)
947 iter_data
->beacons
= true;
949 case NL80211_IFTYPE_WDS
:
957 static void ath9k_update_bssid_mask(struct ath_softc
*sc
,
958 struct ath_chanctx
*ctx
,
959 struct ath9k_vif_iter_data
*iter_data
)
961 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
965 if (!ath9k_is_chanctx_enabled())
968 list_for_each_entry(avp
, &ctx
->vifs
, list
) {
969 if (ctx
->nvifs_assigned
!= 1)
972 if (!avp
->vif
->p2p
|| !iter_data
->has_hw_macaddr
)
975 ether_addr_copy(common
->curbssid
, avp
->bssid
);
977 /* perm_addr will be used as the p2p device address. */
978 for (i
= 0; i
< ETH_ALEN
; i
++)
979 iter_data
->mask
[i
] &=
980 ~(iter_data
->hw_macaddr
[i
] ^
981 sc
->hw
->wiphy
->perm_addr
[i
]);
985 /* Called with sc->mutex held. */
986 void ath9k_calculate_iter_data(struct ath_softc
*sc
,
987 struct ath_chanctx
*ctx
,
988 struct ath9k_vif_iter_data
*iter_data
)
993 * The hardware will use primary station addr together with the
994 * BSSID mask when matching addresses.
996 memset(iter_data
, 0, sizeof(*iter_data
));
997 memset(&iter_data
->mask
, 0xff, ETH_ALEN
);
998 iter_data
->slottime
= ATH9K_SLOT_TIME_9
;
1000 list_for_each_entry(avp
, &ctx
->vifs
, list
)
1001 ath9k_vif_iter(iter_data
, avp
->vif
->addr
, avp
->vif
);
1003 ath9k_update_bssid_mask(sc
, ctx
, iter_data
);
1006 static void ath9k_set_assoc_state(struct ath_softc
*sc
,
1007 struct ieee80211_vif
*vif
, bool changed
)
1009 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1010 struct ath_vif
*avp
= (struct ath_vif
*)vif
->drv_priv
;
1011 unsigned long flags
;
1013 set_bit(ATH_OP_PRIM_STA_VIF
, &common
->op_flags
);
1015 ether_addr_copy(common
->curbssid
, avp
->bssid
);
1016 common
->curaid
= avp
->aid
;
1017 ath9k_hw_write_associd(sc
->sc_ah
);
1020 common
->last_rssi
= ATH_RSSI_DUMMY_MARKER
;
1021 sc
->sc_ah
->stats
.avgbrssi
= ATH_RSSI_DUMMY_MARKER
;
1023 spin_lock_irqsave(&sc
->sc_pm_lock
, flags
);
1024 sc
->ps_flags
|= PS_BEACON_SYNC
| PS_WAIT_FOR_BEACON
;
1025 spin_unlock_irqrestore(&sc
->sc_pm_lock
, flags
);
1028 if (ath9k_hw_mci_is_enabled(sc
->sc_ah
))
1029 ath9k_mci_update_wlan_channels(sc
, false);
1031 ath_dbg(common
, CONFIG
,
1032 "Primary Station interface: %pM, BSSID: %pM\n",
1033 vif
->addr
, common
->curbssid
);
1036 #ifdef CONFIG_ATH9K_CHANNEL_CONTEXT
1037 static void ath9k_set_offchannel_state(struct ath_softc
*sc
)
1039 struct ath_hw
*ah
= sc
->sc_ah
;
1040 struct ath_common
*common
= ath9k_hw_common(ah
);
1041 struct ieee80211_vif
*vif
= NULL
;
1043 ath9k_ps_wakeup(sc
);
1045 if (sc
->offchannel
.state
< ATH_OFFCHANNEL_ROC_START
)
1046 vif
= sc
->offchannel
.scan_vif
;
1048 vif
= sc
->offchannel
.roc_vif
;
1053 eth_zero_addr(common
->curbssid
);
1054 eth_broadcast_addr(common
->bssidmask
);
1055 memcpy(common
->macaddr
, vif
->addr
, ETH_ALEN
);
1057 ah
->opmode
= vif
->type
;
1058 ah
->imask
&= ~ATH9K_INT_SWBA
;
1059 ah
->imask
&= ~ATH9K_INT_TSFOOR
;
1060 ah
->slottime
= ATH9K_SLOT_TIME_9
;
1062 ath_hw_setbssidmask(common
);
1063 ath9k_hw_setopmode(ah
);
1064 ath9k_hw_write_associd(sc
->sc_ah
);
1065 ath9k_hw_set_interrupts(ah
);
1066 ath9k_hw_init_global_settings(ah
);
1069 ath9k_ps_restore(sc
);
1073 /* Called with sc->mutex held. */
1074 void ath9k_calculate_summary_state(struct ath_softc
*sc
,
1075 struct ath_chanctx
*ctx
)
1077 struct ath_hw
*ah
= sc
->sc_ah
;
1078 struct ath_common
*common
= ath9k_hw_common(ah
);
1079 struct ath9k_vif_iter_data iter_data
;
1080 struct ath_beacon_config
*cur_conf
;
1082 ath_chanctx_check_active(sc
, ctx
);
1084 if (ctx
!= sc
->cur_chan
)
1087 #ifdef CONFIG_ATH9K_CHANNEL_CONTEXT
1088 if (ctx
== &sc
->offchannel
.chan
)
1089 return ath9k_set_offchannel_state(sc
);
1092 ath9k_ps_wakeup(sc
);
1093 ath9k_calculate_iter_data(sc
, ctx
, &iter_data
);
1095 if (iter_data
.has_hw_macaddr
)
1096 memcpy(common
->macaddr
, iter_data
.hw_macaddr
, ETH_ALEN
);
1098 memcpy(common
->bssidmask
, iter_data
.mask
, ETH_ALEN
);
1099 ath_hw_setbssidmask(common
);
1101 if (iter_data
.naps
> 0) {
1102 cur_conf
= &ctx
->beacon
;
1103 ath9k_hw_set_tsfadjust(ah
, true);
1104 ah
->opmode
= NL80211_IFTYPE_AP
;
1105 if (cur_conf
->enable_beacon
)
1106 iter_data
.beacons
= true;
1108 ath9k_hw_set_tsfadjust(ah
, false);
1110 if (iter_data
.nmeshes
)
1111 ah
->opmode
= NL80211_IFTYPE_MESH_POINT
;
1112 else if (iter_data
.nwds
)
1113 ah
->opmode
= NL80211_IFTYPE_AP
;
1114 else if (iter_data
.nadhocs
)
1115 ah
->opmode
= NL80211_IFTYPE_ADHOC
;
1117 ah
->opmode
= NL80211_IFTYPE_STATION
;
1120 ath9k_hw_setopmode(ah
);
1122 ctx
->switch_after_beacon
= false;
1123 if ((iter_data
.nstations
+ iter_data
.nadhocs
+ iter_data
.nmeshes
) > 0)
1124 ah
->imask
|= ATH9K_INT_TSFOOR
;
1126 ah
->imask
&= ~ATH9K_INT_TSFOOR
;
1127 if (iter_data
.naps
== 1 && iter_data
.beacons
)
1128 ctx
->switch_after_beacon
= true;
1131 ah
->imask
&= ~ATH9K_INT_SWBA
;
1132 if (ah
->opmode
== NL80211_IFTYPE_STATION
) {
1133 bool changed
= (iter_data
.primary_sta
!= ctx
->primary_sta
);
1135 if (iter_data
.primary_sta
) {
1136 iter_data
.beacons
= true;
1137 ath9k_set_assoc_state(sc
, iter_data
.primary_sta
,
1139 ctx
->primary_sta
= iter_data
.primary_sta
;
1141 ctx
->primary_sta
= NULL
;
1142 memset(common
->curbssid
, 0, ETH_ALEN
);
1144 ath9k_hw_write_associd(sc
->sc_ah
);
1145 if (ath9k_hw_mci_is_enabled(sc
->sc_ah
))
1146 ath9k_mci_update_wlan_channels(sc
, true);
1148 } else if (iter_data
.beacons
) {
1149 ah
->imask
|= ATH9K_INT_SWBA
;
1151 ath9k_hw_set_interrupts(ah
);
1153 if (iter_data
.beacons
)
1154 set_bit(ATH_OP_BEACONS
, &common
->op_flags
);
1156 clear_bit(ATH_OP_BEACONS
, &common
->op_flags
);
1158 if (ah
->slottime
!= iter_data
.slottime
) {
1159 ah
->slottime
= iter_data
.slottime
;
1160 ath9k_hw_init_global_settings(ah
);
1163 if (iter_data
.primary_sta
)
1164 set_bit(ATH_OP_PRIM_STA_VIF
, &common
->op_flags
);
1166 clear_bit(ATH_OP_PRIM_STA_VIF
, &common
->op_flags
);
1168 ath_dbg(common
, CONFIG
,
1169 "macaddr: %pM, bssid: %pM, bssidmask: %pM\n",
1170 common
->macaddr
, common
->curbssid
, common
->bssidmask
);
1172 ath9k_ps_restore(sc
);
1175 static void ath9k_assign_hw_queues(struct ieee80211_hw
*hw
,
1176 struct ieee80211_vif
*vif
)
1180 if (!ath9k_is_chanctx_enabled())
1183 for (i
= 0; i
< IEEE80211_NUM_ACS
; i
++)
1184 vif
->hw_queue
[i
] = i
;
1186 if (vif
->type
== NL80211_IFTYPE_AP
||
1187 vif
->type
== NL80211_IFTYPE_MESH_POINT
)
1188 vif
->cab_queue
= hw
->queues
- 2;
1190 vif
->cab_queue
= IEEE80211_INVAL_HW_QUEUE
;
1193 static int ath9k_add_interface(struct ieee80211_hw
*hw
,
1194 struct ieee80211_vif
*vif
)
1196 struct ath_softc
*sc
= hw
->priv
;
1197 struct ath_hw
*ah
= sc
->sc_ah
;
1198 struct ath_common
*common
= ath9k_hw_common(ah
);
1199 struct ath_vif
*avp
= (void *)vif
->drv_priv
;
1200 struct ath_node
*an
= &avp
->mcast_node
;
1202 mutex_lock(&sc
->mutex
);
1204 if (config_enabled(CONFIG_ATH9K_TX99
)) {
1205 if (sc
->cur_chan
->nvifs
>= 1) {
1206 mutex_unlock(&sc
->mutex
);
1212 ath_dbg(common
, CONFIG
, "Attach a VIF of type: %d\n", vif
->type
);
1213 sc
->cur_chan
->nvifs
++;
1215 if (ath9k_uses_beacons(vif
->type
))
1216 ath9k_beacon_assign_slot(sc
, vif
);
1219 if (!ath9k_is_chanctx_enabled()) {
1220 avp
->chanctx
= sc
->cur_chan
;
1221 list_add_tail(&avp
->list
, &avp
->chanctx
->vifs
);
1224 ath9k_calculate_summary_state(sc
, avp
->chanctx
);
1226 ath9k_assign_hw_queues(hw
, vif
);
1231 an
->no_ps_filter
= true;
1232 ath_tx_node_init(sc
, an
);
1234 mutex_unlock(&sc
->mutex
);
1238 static int ath9k_change_interface(struct ieee80211_hw
*hw
,
1239 struct ieee80211_vif
*vif
,
1240 enum nl80211_iftype new_type
,
1243 struct ath_softc
*sc
= hw
->priv
;
1244 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1245 struct ath_vif
*avp
= (void *)vif
->drv_priv
;
1247 mutex_lock(&sc
->mutex
);
1249 if (config_enabled(CONFIG_ATH9K_TX99
)) {
1250 mutex_unlock(&sc
->mutex
);
1254 ath_dbg(common
, CONFIG
, "Change Interface\n");
1256 if (ath9k_uses_beacons(vif
->type
))
1257 ath9k_beacon_remove_slot(sc
, vif
);
1259 vif
->type
= new_type
;
1262 if (ath9k_uses_beacons(vif
->type
))
1263 ath9k_beacon_assign_slot(sc
, vif
);
1265 ath9k_assign_hw_queues(hw
, vif
);
1266 ath9k_calculate_summary_state(sc
, avp
->chanctx
);
1268 mutex_unlock(&sc
->mutex
);
1272 static void ath9k_remove_interface(struct ieee80211_hw
*hw
,
1273 struct ieee80211_vif
*vif
)
1275 struct ath_softc
*sc
= hw
->priv
;
1276 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1277 struct ath_vif
*avp
= (void *)vif
->drv_priv
;
1279 ath_dbg(common
, CONFIG
, "Detach Interface\n");
1281 mutex_lock(&sc
->mutex
);
1283 ath9k_p2p_remove_vif(sc
, vif
);
1285 sc
->cur_chan
->nvifs
--;
1286 sc
->tx99_vif
= NULL
;
1287 if (!ath9k_is_chanctx_enabled())
1288 list_del(&avp
->list
);
1290 if (ath9k_uses_beacons(vif
->type
))
1291 ath9k_beacon_remove_slot(sc
, vif
);
1293 ath_tx_node_cleanup(sc
, &avp
->mcast_node
);
1295 ath9k_calculate_summary_state(sc
, avp
->chanctx
);
1297 mutex_unlock(&sc
->mutex
);
1300 static void ath9k_enable_ps(struct ath_softc
*sc
)
1302 struct ath_hw
*ah
= sc
->sc_ah
;
1303 struct ath_common
*common
= ath9k_hw_common(ah
);
1305 if (config_enabled(CONFIG_ATH9K_TX99
))
1308 sc
->ps_enabled
= true;
1309 if (!(ah
->caps
.hw_caps
& ATH9K_HW_CAP_AUTOSLEEP
)) {
1310 if ((ah
->imask
& ATH9K_INT_TIM_TIMER
) == 0) {
1311 ah
->imask
|= ATH9K_INT_TIM_TIMER
;
1312 ath9k_hw_set_interrupts(ah
);
1314 ath9k_hw_setrxabort(ah
, 1);
1316 ath_dbg(common
, PS
, "PowerSave enabled\n");
1319 static void ath9k_disable_ps(struct ath_softc
*sc
)
1321 struct ath_hw
*ah
= sc
->sc_ah
;
1322 struct ath_common
*common
= ath9k_hw_common(ah
);
1324 if (config_enabled(CONFIG_ATH9K_TX99
))
1327 sc
->ps_enabled
= false;
1328 ath9k_hw_setpower(ah
, ATH9K_PM_AWAKE
);
1329 if (!(ah
->caps
.hw_caps
& ATH9K_HW_CAP_AUTOSLEEP
)) {
1330 ath9k_hw_setrxabort(ah
, 0);
1331 sc
->ps_flags
&= ~(PS_WAIT_FOR_BEACON
|
1333 PS_WAIT_FOR_PSPOLL_DATA
|
1334 PS_WAIT_FOR_TX_ACK
);
1335 if (ah
->imask
& ATH9K_INT_TIM_TIMER
) {
1336 ah
->imask
&= ~ATH9K_INT_TIM_TIMER
;
1337 ath9k_hw_set_interrupts(ah
);
1340 ath_dbg(common
, PS
, "PowerSave disabled\n");
1343 static int ath9k_config(struct ieee80211_hw
*hw
, u32 changed
)
1345 struct ath_softc
*sc
= hw
->priv
;
1346 struct ath_hw
*ah
= sc
->sc_ah
;
1347 struct ath_common
*common
= ath9k_hw_common(ah
);
1348 struct ieee80211_conf
*conf
= &hw
->conf
;
1349 struct ath_chanctx
*ctx
= sc
->cur_chan
;
1351 ath9k_ps_wakeup(sc
);
1352 mutex_lock(&sc
->mutex
);
1354 if (changed
& IEEE80211_CONF_CHANGE_IDLE
) {
1355 sc
->ps_idle
= !!(conf
->flags
& IEEE80211_CONF_IDLE
);
1357 ath_cancel_work(sc
);
1358 ath9k_stop_btcoex(sc
);
1360 ath9k_start_btcoex(sc
);
1362 * The chip needs a reset to properly wake up from
1365 ath_chanctx_set_channel(sc
, ctx
, &ctx
->chandef
);
1370 * We just prepare to enable PS. We have to wait until our AP has
1371 * ACK'd our null data frame to disable RX otherwise we'll ignore
1372 * those ACKs and end up retransmitting the same null data frames.
1373 * IEEE80211_CONF_CHANGE_PS is only passed by mac80211 for STA mode.
1375 if (changed
& IEEE80211_CONF_CHANGE_PS
) {
1376 unsigned long flags
;
1377 spin_lock_irqsave(&sc
->sc_pm_lock
, flags
);
1378 if (conf
->flags
& IEEE80211_CONF_PS
)
1379 ath9k_enable_ps(sc
);
1381 ath9k_disable_ps(sc
);
1382 spin_unlock_irqrestore(&sc
->sc_pm_lock
, flags
);
1385 if (changed
& IEEE80211_CONF_CHANGE_MONITOR
) {
1386 if (conf
->flags
& IEEE80211_CONF_MONITOR
) {
1387 ath_dbg(common
, CONFIG
, "Monitor mode is enabled\n");
1388 sc
->sc_ah
->is_monitoring
= true;
1390 ath_dbg(common
, CONFIG
, "Monitor mode is disabled\n");
1391 sc
->sc_ah
->is_monitoring
= false;
1395 if (!ath9k_is_chanctx_enabled() && (changed
& IEEE80211_CONF_CHANGE_CHANNEL
)) {
1396 ctx
->offchannel
= !!(conf
->flags
& IEEE80211_CONF_OFFCHANNEL
);
1397 ath_chanctx_set_channel(sc
, ctx
, &hw
->conf
.chandef
);
1400 if (changed
& IEEE80211_CONF_CHANGE_POWER
) {
1401 ath_dbg(common
, CONFIG
, "Set power: %d\n", conf
->power_level
);
1402 sc
->cur_chan
->txpower
= 2 * conf
->power_level
;
1403 ath9k_cmn_update_txpow(ah
, sc
->cur_chan
->cur_txpower
,
1404 sc
->cur_chan
->txpower
,
1405 &sc
->cur_chan
->cur_txpower
);
1408 mutex_unlock(&sc
->mutex
);
1409 ath9k_ps_restore(sc
);
1414 #define SUPPORTED_FILTERS \
1415 (FIF_PROMISC_IN_BSS | \
1420 FIF_BCN_PRBRESP_PROMISC | \
1424 /* FIXME: sc->sc_full_reset ? */
1425 static void ath9k_configure_filter(struct ieee80211_hw
*hw
,
1426 unsigned int changed_flags
,
1427 unsigned int *total_flags
,
1430 struct ath_softc
*sc
= hw
->priv
;
1433 changed_flags
&= SUPPORTED_FILTERS
;
1434 *total_flags
&= SUPPORTED_FILTERS
;
1436 spin_lock_bh(&sc
->chan_lock
);
1437 sc
->cur_chan
->rxfilter
= *total_flags
;
1438 spin_unlock_bh(&sc
->chan_lock
);
1440 ath9k_ps_wakeup(sc
);
1441 rfilt
= ath_calcrxfilter(sc
);
1442 ath9k_hw_setrxfilter(sc
->sc_ah
, rfilt
);
1443 ath9k_ps_restore(sc
);
1445 ath_dbg(ath9k_hw_common(sc
->sc_ah
), CONFIG
, "Set HW RX filter: 0x%x\n",
1449 static int ath9k_sta_add(struct ieee80211_hw
*hw
,
1450 struct ieee80211_vif
*vif
,
1451 struct ieee80211_sta
*sta
)
1453 struct ath_softc
*sc
= hw
->priv
;
1454 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1455 struct ath_node
*an
= (struct ath_node
*) sta
->drv_priv
;
1456 struct ieee80211_key_conf ps_key
= { };
1459 ath_node_attach(sc
, sta
, vif
);
1461 if (vif
->type
!= NL80211_IFTYPE_AP
&&
1462 vif
->type
!= NL80211_IFTYPE_AP_VLAN
)
1465 key
= ath_key_config(common
, vif
, sta
, &ps_key
);
1468 an
->key_idx
[0] = key
;
1474 static void ath9k_del_ps_key(struct ath_softc
*sc
,
1475 struct ieee80211_vif
*vif
,
1476 struct ieee80211_sta
*sta
)
1478 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1479 struct ath_node
*an
= (struct ath_node
*) sta
->drv_priv
;
1480 struct ieee80211_key_conf ps_key
= { .hw_key_idx
= an
->ps_key
};
1485 ath_key_delete(common
, &ps_key
);
1490 static int ath9k_sta_remove(struct ieee80211_hw
*hw
,
1491 struct ieee80211_vif
*vif
,
1492 struct ieee80211_sta
*sta
)
1494 struct ath_softc
*sc
= hw
->priv
;
1496 ath9k_del_ps_key(sc
, vif
, sta
);
1497 ath_node_detach(sc
, sta
);
1502 static int ath9k_sta_state(struct ieee80211_hw
*hw
,
1503 struct ieee80211_vif
*vif
,
1504 struct ieee80211_sta
*sta
,
1505 enum ieee80211_sta_state old_state
,
1506 enum ieee80211_sta_state new_state
)
1508 struct ath_softc
*sc
= hw
->priv
;
1509 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1512 if (old_state
== IEEE80211_STA_AUTH
&&
1513 new_state
== IEEE80211_STA_ASSOC
) {
1514 ret
= ath9k_sta_add(hw
, vif
, sta
);
1515 ath_dbg(common
, CONFIG
,
1516 "Add station: %pM\n", sta
->addr
);
1517 } else if (old_state
== IEEE80211_STA_ASSOC
&&
1518 new_state
== IEEE80211_STA_AUTH
) {
1519 ret
= ath9k_sta_remove(hw
, vif
, sta
);
1520 ath_dbg(common
, CONFIG
,
1521 "Remove station: %pM\n", sta
->addr
);
1524 if (ath9k_is_chanctx_enabled()) {
1525 if (vif
->type
== NL80211_IFTYPE_STATION
) {
1526 if (old_state
== IEEE80211_STA_ASSOC
&&
1527 new_state
== IEEE80211_STA_AUTHORIZED
)
1528 ath_chanctx_event(sc
, vif
,
1529 ATH_CHANCTX_EVENT_AUTHORIZED
);
1536 static void ath9k_sta_set_tx_filter(struct ath_hw
*ah
,
1537 struct ath_node
*an
,
1542 for (i
= 0; i
< ARRAY_SIZE(an
->key_idx
); i
++) {
1543 if (!an
->key_idx
[i
])
1545 ath9k_hw_set_tx_filter(ah
, an
->key_idx
[i
], set
);
1549 static void ath9k_sta_notify(struct ieee80211_hw
*hw
,
1550 struct ieee80211_vif
*vif
,
1551 enum sta_notify_cmd cmd
,
1552 struct ieee80211_sta
*sta
)
1554 struct ath_softc
*sc
= hw
->priv
;
1555 struct ath_node
*an
= (struct ath_node
*) sta
->drv_priv
;
1558 case STA_NOTIFY_SLEEP
:
1559 an
->sleeping
= true;
1560 ath_tx_aggr_sleep(sta
, sc
, an
);
1561 ath9k_sta_set_tx_filter(sc
->sc_ah
, an
, true);
1563 case STA_NOTIFY_AWAKE
:
1564 ath9k_sta_set_tx_filter(sc
->sc_ah
, an
, false);
1565 an
->sleeping
= false;
1566 ath_tx_aggr_wakeup(sc
, an
);
1571 static int ath9k_conf_tx(struct ieee80211_hw
*hw
,
1572 struct ieee80211_vif
*vif
, u16 queue
,
1573 const struct ieee80211_tx_queue_params
*params
)
1575 struct ath_softc
*sc
= hw
->priv
;
1576 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1577 struct ath_txq
*txq
;
1578 struct ath9k_tx_queue_info qi
;
1581 if (queue
>= IEEE80211_NUM_ACS
)
1584 txq
= sc
->tx
.txq_map
[queue
];
1586 ath9k_ps_wakeup(sc
);
1587 mutex_lock(&sc
->mutex
);
1589 memset(&qi
, 0, sizeof(struct ath9k_tx_queue_info
));
1591 qi
.tqi_aifs
= params
->aifs
;
1592 qi
.tqi_cwmin
= params
->cw_min
;
1593 qi
.tqi_cwmax
= params
->cw_max
;
1594 qi
.tqi_burstTime
= params
->txop
* 32;
1596 ath_dbg(common
, CONFIG
,
1597 "Configure tx [queue/halq] [%d/%d], aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
1598 queue
, txq
->axq_qnum
, params
->aifs
, params
->cw_min
,
1599 params
->cw_max
, params
->txop
);
1601 ath_update_max_aggr_framelen(sc
, queue
, qi
.tqi_burstTime
);
1602 ret
= ath_txq_update(sc
, txq
->axq_qnum
, &qi
);
1604 ath_err(common
, "TXQ Update failed\n");
1606 mutex_unlock(&sc
->mutex
);
1607 ath9k_ps_restore(sc
);
1612 static int ath9k_set_key(struct ieee80211_hw
*hw
,
1613 enum set_key_cmd cmd
,
1614 struct ieee80211_vif
*vif
,
1615 struct ieee80211_sta
*sta
,
1616 struct ieee80211_key_conf
*key
)
1618 struct ath_softc
*sc
= hw
->priv
;
1619 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1620 struct ath_node
*an
= NULL
;
1623 if (ath9k_modparam_nohwcrypt
)
1626 if ((vif
->type
== NL80211_IFTYPE_ADHOC
||
1627 vif
->type
== NL80211_IFTYPE_MESH_POINT
) &&
1628 (key
->cipher
== WLAN_CIPHER_SUITE_TKIP
||
1629 key
->cipher
== WLAN_CIPHER_SUITE_CCMP
) &&
1630 !(key
->flags
& IEEE80211_KEY_FLAG_PAIRWISE
)) {
1632 * For now, disable hw crypto for the RSN IBSS group keys. This
1633 * could be optimized in the future to use a modified key cache
1634 * design to support per-STA RX GTK, but until that gets
1635 * implemented, use of software crypto for group addressed
1636 * frames is a acceptable to allow RSN IBSS to be used.
1641 mutex_lock(&sc
->mutex
);
1642 ath9k_ps_wakeup(sc
);
1643 ath_dbg(common
, CONFIG
, "Set HW Key %d\n", cmd
);
1645 an
= (struct ath_node
*)sta
->drv_priv
;
1650 ath9k_del_ps_key(sc
, vif
, sta
);
1652 key
->hw_key_idx
= 0;
1653 ret
= ath_key_config(common
, vif
, sta
, key
);
1655 key
->hw_key_idx
= ret
;
1656 /* push IV and Michael MIC generation to stack */
1657 key
->flags
|= IEEE80211_KEY_FLAG_GENERATE_IV
;
1658 if (key
->cipher
== WLAN_CIPHER_SUITE_TKIP
)
1659 key
->flags
|= IEEE80211_KEY_FLAG_GENERATE_MMIC
;
1660 if (sc
->sc_ah
->sw_mgmt_crypto_tx
&&
1661 key
->cipher
== WLAN_CIPHER_SUITE_CCMP
)
1662 key
->flags
|= IEEE80211_KEY_FLAG_SW_MGMT_TX
;
1665 if (an
&& key
->hw_key_idx
) {
1666 for (i
= 0; i
< ARRAY_SIZE(an
->key_idx
); i
++) {
1669 an
->key_idx
[i
] = key
->hw_key_idx
;
1672 WARN_ON(i
== ARRAY_SIZE(an
->key_idx
));
1676 ath_key_delete(common
, key
);
1678 for (i
= 0; i
< ARRAY_SIZE(an
->key_idx
); i
++) {
1679 if (an
->key_idx
[i
] != key
->hw_key_idx
)
1685 key
->hw_key_idx
= 0;
1691 ath9k_ps_restore(sc
);
1692 mutex_unlock(&sc
->mutex
);
1697 static void ath9k_bss_info_changed(struct ieee80211_hw
*hw
,
1698 struct ieee80211_vif
*vif
,
1699 struct ieee80211_bss_conf
*bss_conf
,
1703 (BSS_CHANGED_ASSOC | \
1704 BSS_CHANGED_IBSS | \
1705 BSS_CHANGED_BEACON_ENABLED)
1707 struct ath_softc
*sc
= hw
->priv
;
1708 struct ath_hw
*ah
= sc
->sc_ah
;
1709 struct ath_common
*common
= ath9k_hw_common(ah
);
1710 struct ath_vif
*avp
= (void *)vif
->drv_priv
;
1713 ath9k_ps_wakeup(sc
);
1714 mutex_lock(&sc
->mutex
);
1716 if (changed
& BSS_CHANGED_ASSOC
) {
1717 ath_dbg(common
, CONFIG
, "BSSID %pM Changed ASSOC %d\n",
1718 bss_conf
->bssid
, bss_conf
->assoc
);
1720 memcpy(avp
->bssid
, bss_conf
->bssid
, ETH_ALEN
);
1721 avp
->aid
= bss_conf
->aid
;
1722 avp
->assoc
= bss_conf
->assoc
;
1724 ath9k_calculate_summary_state(sc
, avp
->chanctx
);
1727 if (changed
& BSS_CHANGED_IBSS
) {
1728 memcpy(common
->curbssid
, bss_conf
->bssid
, ETH_ALEN
);
1729 common
->curaid
= bss_conf
->aid
;
1730 ath9k_hw_write_associd(sc
->sc_ah
);
1733 if ((changed
& BSS_CHANGED_BEACON_ENABLED
) ||
1734 (changed
& BSS_CHANGED_BEACON_INT
) ||
1735 (changed
& BSS_CHANGED_BEACON_INFO
)) {
1736 ath9k_beacon_config(sc
, vif
, changed
);
1737 if (changed
& BSS_CHANGED_BEACON_ENABLED
)
1738 ath9k_calculate_summary_state(sc
, avp
->chanctx
);
1741 if ((avp
->chanctx
== sc
->cur_chan
) &&
1742 (changed
& BSS_CHANGED_ERP_SLOT
)) {
1743 if (bss_conf
->use_short_slot
)
1747 if (vif
->type
== NL80211_IFTYPE_AP
) {
1749 * Defer update, so that connected stations can adjust
1750 * their settings at the same time.
1751 * See beacon.c for more details
1753 sc
->beacon
.slottime
= slottime
;
1754 sc
->beacon
.updateslot
= UPDATE
;
1756 ah
->slottime
= slottime
;
1757 ath9k_hw_init_global_settings(ah
);
1761 if (changed
& BSS_CHANGED_P2P_PS
)
1762 ath9k_p2p_bss_info_changed(sc
, vif
);
1764 if (changed
& CHECK_ANI
)
1767 mutex_unlock(&sc
->mutex
);
1768 ath9k_ps_restore(sc
);
1773 static u64
ath9k_get_tsf(struct ieee80211_hw
*hw
, struct ieee80211_vif
*vif
)
1775 struct ath_softc
*sc
= hw
->priv
;
1778 mutex_lock(&sc
->mutex
);
1779 ath9k_ps_wakeup(sc
);
1780 tsf
= ath9k_hw_gettsf64(sc
->sc_ah
);
1781 ath9k_ps_restore(sc
);
1782 mutex_unlock(&sc
->mutex
);
1787 static void ath9k_set_tsf(struct ieee80211_hw
*hw
,
1788 struct ieee80211_vif
*vif
,
1791 struct ath_softc
*sc
= hw
->priv
;
1793 mutex_lock(&sc
->mutex
);
1794 ath9k_ps_wakeup(sc
);
1795 ath9k_hw_settsf64(sc
->sc_ah
, tsf
);
1796 ath9k_ps_restore(sc
);
1797 mutex_unlock(&sc
->mutex
);
1800 static void ath9k_reset_tsf(struct ieee80211_hw
*hw
, struct ieee80211_vif
*vif
)
1802 struct ath_softc
*sc
= hw
->priv
;
1804 mutex_lock(&sc
->mutex
);
1806 ath9k_ps_wakeup(sc
);
1807 ath9k_hw_reset_tsf(sc
->sc_ah
);
1808 ath9k_ps_restore(sc
);
1810 mutex_unlock(&sc
->mutex
);
1813 static int ath9k_ampdu_action(struct ieee80211_hw
*hw
,
1814 struct ieee80211_vif
*vif
,
1815 enum ieee80211_ampdu_mlme_action action
,
1816 struct ieee80211_sta
*sta
,
1817 u16 tid
, u16
*ssn
, u8 buf_size
)
1819 struct ath_softc
*sc
= hw
->priv
;
1820 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1824 mutex_lock(&sc
->mutex
);
1827 case IEEE80211_AMPDU_RX_START
:
1829 case IEEE80211_AMPDU_RX_STOP
:
1831 case IEEE80211_AMPDU_TX_START
:
1832 if (ath9k_is_chanctx_enabled()) {
1833 if (test_bit(ATH_OP_SCANNING
, &common
->op_flags
)) {
1838 ath9k_ps_wakeup(sc
);
1839 ret
= ath_tx_aggr_start(sc
, sta
, tid
, ssn
);
1841 ieee80211_start_tx_ba_cb_irqsafe(vif
, sta
->addr
, tid
);
1842 ath9k_ps_restore(sc
);
1844 case IEEE80211_AMPDU_TX_STOP_FLUSH
:
1845 case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT
:
1847 case IEEE80211_AMPDU_TX_STOP_CONT
:
1848 ath9k_ps_wakeup(sc
);
1849 ath_tx_aggr_stop(sc
, sta
, tid
);
1851 ieee80211_stop_tx_ba_cb_irqsafe(vif
, sta
->addr
, tid
);
1852 ath9k_ps_restore(sc
);
1854 case IEEE80211_AMPDU_TX_OPERATIONAL
:
1855 ath9k_ps_wakeup(sc
);
1856 ath_tx_aggr_resume(sc
, sta
, tid
);
1857 ath9k_ps_restore(sc
);
1860 ath_err(ath9k_hw_common(sc
->sc_ah
), "Unknown AMPDU action\n");
1863 mutex_unlock(&sc
->mutex
);
1868 static int ath9k_get_survey(struct ieee80211_hw
*hw
, int idx
,
1869 struct survey_info
*survey
)
1871 struct ath_softc
*sc
= hw
->priv
;
1872 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1873 struct ieee80211_supported_band
*sband
;
1874 struct ieee80211_channel
*chan
;
1877 if (config_enabled(CONFIG_ATH9K_TX99
))
1880 spin_lock_bh(&common
->cc_lock
);
1882 ath_update_survey_stats(sc
);
1884 sband
= hw
->wiphy
->bands
[IEEE80211_BAND_2GHZ
];
1885 if (sband
&& idx
>= sband
->n_channels
) {
1886 idx
-= sband
->n_channels
;
1891 sband
= hw
->wiphy
->bands
[IEEE80211_BAND_5GHZ
];
1893 if (!sband
|| idx
>= sband
->n_channels
) {
1894 spin_unlock_bh(&common
->cc_lock
);
1898 chan
= &sband
->channels
[idx
];
1899 pos
= chan
->hw_value
;
1900 memcpy(survey
, &sc
->survey
[pos
], sizeof(*survey
));
1901 survey
->channel
= chan
;
1902 spin_unlock_bh(&common
->cc_lock
);
1907 static void ath9k_enable_dynack(struct ath_softc
*sc
)
1909 #ifdef CONFIG_ATH9K_DYNACK
1911 struct ath_hw
*ah
= sc
->sc_ah
;
1913 ath_dynack_reset(ah
);
1915 ah
->dynack
.enabled
= true;
1916 rfilt
= ath_calcrxfilter(sc
);
1917 ath9k_hw_setrxfilter(ah
, rfilt
);
1921 static void ath9k_set_coverage_class(struct ieee80211_hw
*hw
,
1924 struct ath_softc
*sc
= hw
->priv
;
1925 struct ath_hw
*ah
= sc
->sc_ah
;
1927 if (config_enabled(CONFIG_ATH9K_TX99
))
1930 mutex_lock(&sc
->mutex
);
1932 if (coverage_class
>= 0) {
1933 ah
->coverage_class
= coverage_class
;
1934 if (ah
->dynack
.enabled
) {
1937 ah
->dynack
.enabled
= false;
1938 rfilt
= ath_calcrxfilter(sc
);
1939 ath9k_hw_setrxfilter(ah
, rfilt
);
1941 ath9k_ps_wakeup(sc
);
1942 ath9k_hw_init_global_settings(ah
);
1943 ath9k_ps_restore(sc
);
1944 } else if (!ah
->dynack
.enabled
) {
1945 ath9k_enable_dynack(sc
);
1948 mutex_unlock(&sc
->mutex
);
1951 static bool ath9k_has_tx_pending(struct ath_softc
*sc
,
1956 for (i
= 0; i
< ATH9K_NUM_TX_QUEUES
; i
++) {
1957 if (!ATH_TXQ_SETUP(sc
, i
))
1960 npend
= ath9k_has_pending_frames(sc
, &sc
->tx
.txq
[i
],
1969 static void ath9k_flush(struct ieee80211_hw
*hw
, struct ieee80211_vif
*vif
,
1970 u32 queues
, bool drop
)
1972 struct ath_softc
*sc
= hw
->priv
;
1973 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
1975 if (ath9k_is_chanctx_enabled()) {
1976 if (!test_bit(ATH_OP_MULTI_CHANNEL
, &common
->op_flags
))
1980 * If MCC is active, extend the flush timeout
1981 * and wait for the HW/SW queues to become
1982 * empty. This needs to be done outside the
1983 * sc->mutex lock to allow the channel scheduler
1984 * to switch channel contexts.
1986 * The vif queues have been stopped in mac80211,
1987 * so there won't be any incoming frames.
1989 __ath9k_flush(hw
, queues
, drop
, true, true);
1993 mutex_lock(&sc
->mutex
);
1994 __ath9k_flush(hw
, queues
, drop
, true, false);
1995 mutex_unlock(&sc
->mutex
);
1998 void __ath9k_flush(struct ieee80211_hw
*hw
, u32 queues
, bool drop
,
1999 bool sw_pending
, bool timeout_override
)
2001 struct ath_softc
*sc
= hw
->priv
;
2002 struct ath_hw
*ah
= sc
->sc_ah
;
2003 struct ath_common
*common
= ath9k_hw_common(ah
);
2007 cancel_delayed_work_sync(&sc
->tx_complete_work
);
2009 if (ah
->ah_flags
& AH_UNPLUGGED
) {
2010 ath_dbg(common
, ANY
, "Device has been unplugged!\n");
2014 if (test_bit(ATH_OP_INVALID
, &common
->op_flags
)) {
2015 ath_dbg(common
, ANY
, "Device not present\n");
2019 spin_lock_bh(&sc
->chan_lock
);
2020 if (timeout_override
)
2023 timeout
= sc
->cur_chan
->flush_timeout
;
2024 spin_unlock_bh(&sc
->chan_lock
);
2026 ath_dbg(common
, CHAN_CTX
,
2027 "Flush timeout: %d\n", jiffies_to_msecs(timeout
));
2029 if (wait_event_timeout(sc
->tx_wait
, !ath9k_has_tx_pending(sc
, sw_pending
),
2034 ath9k_ps_wakeup(sc
);
2035 spin_lock_bh(&sc
->sc_pcu_lock
);
2036 drain_txq
= ath_drain_all_txq(sc
);
2037 spin_unlock_bh(&sc
->sc_pcu_lock
);
2040 ath_reset(sc
, NULL
);
2042 ath9k_ps_restore(sc
);
2045 ieee80211_queue_delayed_work(hw
, &sc
->tx_complete_work
, 0);
2048 static bool ath9k_tx_frames_pending(struct ieee80211_hw
*hw
)
2050 struct ath_softc
*sc
= hw
->priv
;
2052 return ath9k_has_tx_pending(sc
, true);
2055 static int ath9k_tx_last_beacon(struct ieee80211_hw
*hw
)
2057 struct ath_softc
*sc
= hw
->priv
;
2058 struct ath_hw
*ah
= sc
->sc_ah
;
2059 struct ieee80211_vif
*vif
;
2060 struct ath_vif
*avp
;
2062 struct ath_tx_status ts
;
2063 bool edma
= !!(ah
->caps
.hw_caps
& ATH9K_HW_CAP_EDMA
);
2066 vif
= sc
->beacon
.bslot
[0];
2070 if (!vif
->bss_conf
.enable_beacon
)
2073 avp
= (void *)vif
->drv_priv
;
2075 if (!sc
->beacon
.tx_processed
&& !edma
) {
2076 tasklet_disable(&sc
->bcon_tasklet
);
2079 if (!bf
|| !bf
->bf_mpdu
)
2082 status
= ath9k_hw_txprocdesc(ah
, bf
->bf_desc
, &ts
);
2083 if (status
== -EINPROGRESS
)
2086 sc
->beacon
.tx_processed
= true;
2087 sc
->beacon
.tx_last
= !(ts
.ts_status
& ATH9K_TXERR_MASK
);
2090 tasklet_enable(&sc
->bcon_tasklet
);
2093 return sc
->beacon
.tx_last
;
2096 static int ath9k_get_stats(struct ieee80211_hw
*hw
,
2097 struct ieee80211_low_level_stats
*stats
)
2099 struct ath_softc
*sc
= hw
->priv
;
2100 struct ath_hw
*ah
= sc
->sc_ah
;
2101 struct ath9k_mib_stats
*mib_stats
= &ah
->ah_mibStats
;
2103 stats
->dot11ACKFailureCount
= mib_stats
->ackrcv_bad
;
2104 stats
->dot11RTSFailureCount
= mib_stats
->rts_bad
;
2105 stats
->dot11FCSErrorCount
= mib_stats
->fcs_bad
;
2106 stats
->dot11RTSSuccessCount
= mib_stats
->rts_good
;
2110 static u32
fill_chainmask(u32 cap
, u32
new)
2115 for (i
= 0; cap
&& new; i
++, cap
>>= 1) {
2116 if (!(cap
& BIT(0)))
2128 static bool validate_antenna_mask(struct ath_hw
*ah
, u32 val
)
2130 if (AR_SREV_9300_20_OR_LATER(ah
))
2133 switch (val
& 0x7) {
2139 return (ah
->caps
.rx_chainmask
== 1);
2145 static int ath9k_set_antenna(struct ieee80211_hw
*hw
, u32 tx_ant
, u32 rx_ant
)
2147 struct ath_softc
*sc
= hw
->priv
;
2148 struct ath_hw
*ah
= sc
->sc_ah
;
2150 if (ah
->caps
.rx_chainmask
!= 1)
2153 if (!validate_antenna_mask(ah
, rx_ant
) || !tx_ant
)
2156 sc
->ant_rx
= rx_ant
;
2157 sc
->ant_tx
= tx_ant
;
2159 if (ah
->caps
.rx_chainmask
== 1)
2162 /* AR9100 runs into calibration issues if not all rx chains are enabled */
2163 if (AR_SREV_9100(ah
))
2164 ah
->rxchainmask
= 0x7;
2166 ah
->rxchainmask
= fill_chainmask(ah
->caps
.rx_chainmask
, rx_ant
);
2168 ah
->txchainmask
= fill_chainmask(ah
->caps
.tx_chainmask
, tx_ant
);
2169 ath9k_cmn_reload_chainmask(ah
);
2174 static int ath9k_get_antenna(struct ieee80211_hw
*hw
, u32
*tx_ant
, u32
*rx_ant
)
2176 struct ath_softc
*sc
= hw
->priv
;
2178 *tx_ant
= sc
->ant_tx
;
2179 *rx_ant
= sc
->ant_rx
;
2183 static void ath9k_sw_scan_start(struct ieee80211_hw
*hw
,
2184 struct ieee80211_vif
*vif
,
2187 struct ath_softc
*sc
= hw
->priv
;
2188 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2189 set_bit(ATH_OP_SCANNING
, &common
->op_flags
);
2192 static void ath9k_sw_scan_complete(struct ieee80211_hw
*hw
,
2193 struct ieee80211_vif
*vif
)
2195 struct ath_softc
*sc
= hw
->priv
;
2196 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2197 clear_bit(ATH_OP_SCANNING
, &common
->op_flags
);
2200 #ifdef CONFIG_ATH9K_CHANNEL_CONTEXT
2202 static void ath9k_cancel_pending_offchannel(struct ath_softc
*sc
)
2204 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2206 if (sc
->offchannel
.roc_vif
) {
2207 ath_dbg(common
, CHAN_CTX
,
2208 "%s: Aborting RoC\n", __func__
);
2210 del_timer_sync(&sc
->offchannel
.timer
);
2211 if (sc
->offchannel
.state
>= ATH_OFFCHANNEL_ROC_START
)
2212 ath_roc_complete(sc
, true);
2215 if (test_bit(ATH_OP_SCANNING
, &common
->op_flags
)) {
2216 ath_dbg(common
, CHAN_CTX
,
2217 "%s: Aborting HW scan\n", __func__
);
2219 del_timer_sync(&sc
->offchannel
.timer
);
2220 ath_scan_complete(sc
, true);
2224 static int ath9k_hw_scan(struct ieee80211_hw
*hw
, struct ieee80211_vif
*vif
,
2225 struct ieee80211_scan_request
*hw_req
)
2227 struct cfg80211_scan_request
*req
= &hw_req
->req
;
2228 struct ath_softc
*sc
= hw
->priv
;
2229 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2232 mutex_lock(&sc
->mutex
);
2234 if (WARN_ON(sc
->offchannel
.scan_req
)) {
2239 ath9k_ps_wakeup(sc
);
2240 set_bit(ATH_OP_SCANNING
, &common
->op_flags
);
2241 sc
->offchannel
.scan_vif
= vif
;
2242 sc
->offchannel
.scan_req
= req
;
2243 sc
->offchannel
.scan_idx
= 0;
2245 ath_dbg(common
, CHAN_CTX
, "HW scan request received on vif: %pM\n",
2248 if (sc
->offchannel
.state
== ATH_OFFCHANNEL_IDLE
) {
2249 ath_dbg(common
, CHAN_CTX
, "Starting HW scan\n");
2250 ath_offchannel_next(sc
);
2254 mutex_unlock(&sc
->mutex
);
2259 static void ath9k_cancel_hw_scan(struct ieee80211_hw
*hw
,
2260 struct ieee80211_vif
*vif
)
2262 struct ath_softc
*sc
= hw
->priv
;
2263 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2265 ath_dbg(common
, CHAN_CTX
, "Cancel HW scan on vif: %pM\n", vif
->addr
);
2267 mutex_lock(&sc
->mutex
);
2268 del_timer_sync(&sc
->offchannel
.timer
);
2269 ath_scan_complete(sc
, true);
2270 mutex_unlock(&sc
->mutex
);
2273 static int ath9k_remain_on_channel(struct ieee80211_hw
*hw
,
2274 struct ieee80211_vif
*vif
,
2275 struct ieee80211_channel
*chan
, int duration
,
2276 enum ieee80211_roc_type type
)
2278 struct ath_softc
*sc
= hw
->priv
;
2279 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2282 mutex_lock(&sc
->mutex
);
2284 if (WARN_ON(sc
->offchannel
.roc_vif
)) {
2289 ath9k_ps_wakeup(sc
);
2290 sc
->offchannel
.roc_vif
= vif
;
2291 sc
->offchannel
.roc_chan
= chan
;
2292 sc
->offchannel
.roc_duration
= duration
;
2294 ath_dbg(common
, CHAN_CTX
,
2295 "RoC request on vif: %pM, type: %d duration: %d\n",
2296 vif
->addr
, type
, duration
);
2298 if (sc
->offchannel
.state
== ATH_OFFCHANNEL_IDLE
) {
2299 ath_dbg(common
, CHAN_CTX
, "Starting RoC period\n");
2300 ath_offchannel_next(sc
);
2304 mutex_unlock(&sc
->mutex
);
2309 static int ath9k_cancel_remain_on_channel(struct ieee80211_hw
*hw
)
2311 struct ath_softc
*sc
= hw
->priv
;
2312 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2314 mutex_lock(&sc
->mutex
);
2316 ath_dbg(common
, CHAN_CTX
, "Cancel RoC\n");
2317 del_timer_sync(&sc
->offchannel
.timer
);
2319 if (sc
->offchannel
.roc_vif
) {
2320 if (sc
->offchannel
.state
>= ATH_OFFCHANNEL_ROC_START
)
2321 ath_roc_complete(sc
, true);
2324 mutex_unlock(&sc
->mutex
);
2329 static int ath9k_add_chanctx(struct ieee80211_hw
*hw
,
2330 struct ieee80211_chanctx_conf
*conf
)
2332 struct ath_softc
*sc
= hw
->priv
;
2333 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2334 struct ath_chanctx
*ctx
, **ptr
;
2337 mutex_lock(&sc
->mutex
);
2339 ath_for_each_chanctx(sc
, ctx
) {
2343 ptr
= (void *) conf
->drv_priv
;
2345 ctx
->assigned
= true;
2346 pos
= ctx
- &sc
->chanctx
[0];
2347 ctx
->hw_queue_base
= pos
* IEEE80211_NUM_ACS
;
2349 ath_dbg(common
, CHAN_CTX
,
2350 "Add channel context: %d MHz\n",
2351 conf
->def
.chan
->center_freq
);
2353 ath_chanctx_set_channel(sc
, ctx
, &conf
->def
);
2355 mutex_unlock(&sc
->mutex
);
2359 mutex_unlock(&sc
->mutex
);
2364 static void ath9k_remove_chanctx(struct ieee80211_hw
*hw
,
2365 struct ieee80211_chanctx_conf
*conf
)
2367 struct ath_softc
*sc
= hw
->priv
;
2368 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2369 struct ath_chanctx
*ctx
= ath_chanctx_get(conf
);
2371 mutex_lock(&sc
->mutex
);
2373 ath_dbg(common
, CHAN_CTX
,
2374 "Remove channel context: %d MHz\n",
2375 conf
->def
.chan
->center_freq
);
2377 ctx
->assigned
= false;
2378 ctx
->hw_queue_base
= 0;
2379 ath_chanctx_event(sc
, NULL
, ATH_CHANCTX_EVENT_UNASSIGN
);
2381 mutex_unlock(&sc
->mutex
);
2384 static void ath9k_change_chanctx(struct ieee80211_hw
*hw
,
2385 struct ieee80211_chanctx_conf
*conf
,
2388 struct ath_softc
*sc
= hw
->priv
;
2389 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2390 struct ath_chanctx
*ctx
= ath_chanctx_get(conf
);
2392 mutex_lock(&sc
->mutex
);
2393 ath_dbg(common
, CHAN_CTX
,
2394 "Change channel context: %d MHz\n",
2395 conf
->def
.chan
->center_freq
);
2396 ath_chanctx_set_channel(sc
, ctx
, &conf
->def
);
2397 mutex_unlock(&sc
->mutex
);
2400 static int ath9k_assign_vif_chanctx(struct ieee80211_hw
*hw
,
2401 struct ieee80211_vif
*vif
,
2402 struct ieee80211_chanctx_conf
*conf
)
2404 struct ath_softc
*sc
= hw
->priv
;
2405 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2406 struct ath_vif
*avp
= (void *)vif
->drv_priv
;
2407 struct ath_chanctx
*ctx
= ath_chanctx_get(conf
);
2410 ath9k_cancel_pending_offchannel(sc
);
2412 mutex_lock(&sc
->mutex
);
2414 ath_dbg(common
, CHAN_CTX
,
2415 "Assign VIF (addr: %pM, type: %d, p2p: %d) to channel context: %d MHz\n",
2416 vif
->addr
, vif
->type
, vif
->p2p
,
2417 conf
->def
.chan
->center_freq
);
2420 ctx
->nvifs_assigned
++;
2421 list_add_tail(&avp
->list
, &ctx
->vifs
);
2422 ath9k_calculate_summary_state(sc
, ctx
);
2423 for (i
= 0; i
< IEEE80211_NUM_ACS
; i
++)
2424 vif
->hw_queue
[i
] = ctx
->hw_queue_base
+ i
;
2426 mutex_unlock(&sc
->mutex
);
2431 static void ath9k_unassign_vif_chanctx(struct ieee80211_hw
*hw
,
2432 struct ieee80211_vif
*vif
,
2433 struct ieee80211_chanctx_conf
*conf
)
2435 struct ath_softc
*sc
= hw
->priv
;
2436 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2437 struct ath_vif
*avp
= (void *)vif
->drv_priv
;
2438 struct ath_chanctx
*ctx
= ath_chanctx_get(conf
);
2441 ath9k_cancel_pending_offchannel(sc
);
2443 mutex_lock(&sc
->mutex
);
2445 ath_dbg(common
, CHAN_CTX
,
2446 "Remove VIF (addr: %pM, type: %d, p2p: %d) from channel context: %d MHz\n",
2447 vif
->addr
, vif
->type
, vif
->p2p
,
2448 conf
->def
.chan
->center_freq
);
2450 avp
->chanctx
= NULL
;
2451 ctx
->nvifs_assigned
--;
2452 list_del(&avp
->list
);
2453 ath9k_calculate_summary_state(sc
, ctx
);
2454 for (ac
= 0; ac
< IEEE80211_NUM_ACS
; ac
++)
2455 vif
->hw_queue
[ac
] = IEEE80211_INVAL_HW_QUEUE
;
2457 mutex_unlock(&sc
->mutex
);
2460 static void ath9k_mgd_prepare_tx(struct ieee80211_hw
*hw
,
2461 struct ieee80211_vif
*vif
)
2463 struct ath_softc
*sc
= hw
->priv
;
2464 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
2465 struct ath_vif
*avp
= (struct ath_vif
*) vif
->drv_priv
;
2466 struct ath_beacon_config
*cur_conf
;
2467 struct ath_chanctx
*go_ctx
;
2468 unsigned long timeout
;
2469 bool changed
= false;
2472 if (!test_bit(ATH_OP_MULTI_CHANNEL
, &common
->op_flags
))
2478 mutex_lock(&sc
->mutex
);
2480 spin_lock_bh(&sc
->chan_lock
);
2481 if (sc
->next_chan
|| (sc
->cur_chan
!= avp
->chanctx
))
2483 spin_unlock_bh(&sc
->chan_lock
);
2488 ath9k_cancel_pending_offchannel(sc
);
2490 go_ctx
= ath_is_go_chanctx_present(sc
);
2494 * Wait till the GO interface gets a chance
2495 * to send out an NoA.
2497 spin_lock_bh(&sc
->chan_lock
);
2498 sc
->sched
.mgd_prepare_tx
= true;
2499 cur_conf
= &go_ctx
->beacon
;
2500 beacon_int
= TU_TO_USEC(cur_conf
->beacon_interval
);
2501 spin_unlock_bh(&sc
->chan_lock
);
2503 timeout
= usecs_to_jiffies(beacon_int
* 2);
2504 init_completion(&sc
->go_beacon
);
2506 mutex_unlock(&sc
->mutex
);
2508 if (wait_for_completion_timeout(&sc
->go_beacon
,
2510 ath_dbg(common
, CHAN_CTX
,
2511 "Failed to send new NoA\n");
2513 spin_lock_bh(&sc
->chan_lock
);
2514 sc
->sched
.mgd_prepare_tx
= false;
2515 spin_unlock_bh(&sc
->chan_lock
);
2518 mutex_lock(&sc
->mutex
);
2521 ath_dbg(common
, CHAN_CTX
,
2522 "%s: Set chanctx state to FORCE_ACTIVE for vif: %pM\n",
2523 __func__
, vif
->addr
);
2525 spin_lock_bh(&sc
->chan_lock
);
2526 sc
->next_chan
= avp
->chanctx
;
2527 sc
->sched
.state
= ATH_CHANCTX_STATE_FORCE_ACTIVE
;
2528 spin_unlock_bh(&sc
->chan_lock
);
2530 ath_chanctx_set_next(sc
, true);
2532 mutex_unlock(&sc
->mutex
);
2535 void ath9k_fill_chanctx_ops(void)
2537 if (!ath9k_is_chanctx_enabled())
2540 ath9k_ops
.hw_scan
= ath9k_hw_scan
;
2541 ath9k_ops
.cancel_hw_scan
= ath9k_cancel_hw_scan
;
2542 ath9k_ops
.remain_on_channel
= ath9k_remain_on_channel
;
2543 ath9k_ops
.cancel_remain_on_channel
= ath9k_cancel_remain_on_channel
;
2544 ath9k_ops
.add_chanctx
= ath9k_add_chanctx
;
2545 ath9k_ops
.remove_chanctx
= ath9k_remove_chanctx
;
2546 ath9k_ops
.change_chanctx
= ath9k_change_chanctx
;
2547 ath9k_ops
.assign_vif_chanctx
= ath9k_assign_vif_chanctx
;
2548 ath9k_ops
.unassign_vif_chanctx
= ath9k_unassign_vif_chanctx
;
2549 ath9k_ops
.mgd_prepare_tx
= ath9k_mgd_prepare_tx
;
2554 static int ath9k_get_txpower(struct ieee80211_hw
*hw
, struct ieee80211_vif
*vif
,
2557 struct ath_softc
*sc
= hw
->priv
;
2558 struct ath_vif
*avp
= (void *)vif
->drv_priv
;
2560 mutex_lock(&sc
->mutex
);
2562 *dbm
= avp
->chanctx
->cur_txpower
;
2564 *dbm
= sc
->cur_chan
->cur_txpower
;
2565 mutex_unlock(&sc
->mutex
);
2572 struct ieee80211_ops ath9k_ops
= {
2574 .start
= ath9k_start
,
2576 .add_interface
= ath9k_add_interface
,
2577 .change_interface
= ath9k_change_interface
,
2578 .remove_interface
= ath9k_remove_interface
,
2579 .config
= ath9k_config
,
2580 .configure_filter
= ath9k_configure_filter
,
2581 .sta_state
= ath9k_sta_state
,
2582 .sta_notify
= ath9k_sta_notify
,
2583 .conf_tx
= ath9k_conf_tx
,
2584 .bss_info_changed
= ath9k_bss_info_changed
,
2585 .set_key
= ath9k_set_key
,
2586 .get_tsf
= ath9k_get_tsf
,
2587 .set_tsf
= ath9k_set_tsf
,
2588 .reset_tsf
= ath9k_reset_tsf
,
2589 .ampdu_action
= ath9k_ampdu_action
,
2590 .get_survey
= ath9k_get_survey
,
2591 .rfkill_poll
= ath9k_rfkill_poll_state
,
2592 .set_coverage_class
= ath9k_set_coverage_class
,
2593 .flush
= ath9k_flush
,
2594 .tx_frames_pending
= ath9k_tx_frames_pending
,
2595 .tx_last_beacon
= ath9k_tx_last_beacon
,
2596 .release_buffered_frames
= ath9k_release_buffered_frames
,
2597 .get_stats
= ath9k_get_stats
,
2598 .set_antenna
= ath9k_set_antenna
,
2599 .get_antenna
= ath9k_get_antenna
,
2601 #ifdef CONFIG_ATH9K_WOW
2602 .suspend
= ath9k_suspend
,
2603 .resume
= ath9k_resume
,
2604 .set_wakeup
= ath9k_set_wakeup
,
2607 #ifdef CONFIG_ATH9K_DEBUGFS
2608 .get_et_sset_count
= ath9k_get_et_sset_count
,
2609 .get_et_stats
= ath9k_get_et_stats
,
2610 .get_et_strings
= ath9k_get_et_strings
,
2613 #if defined(CONFIG_MAC80211_DEBUGFS) && defined(CONFIG_ATH9K_STATION_STATISTICS)
2614 .sta_add_debugfs
= ath9k_sta_add_debugfs
,
2616 .sw_scan_start
= ath9k_sw_scan_start
,
2617 .sw_scan_complete
= ath9k_sw_scan_complete
,
2618 .get_txpower
= ath9k_get_txpower
,