249 lines
6.5 KiB
Diff
249 lines
6.5 KiB
Diff
From 6744d0a7ea037c7d65e13ca906da93009b241d00 Mon Sep 17 00:00:00 2001
|
|
From: Felix Fietkau <nbd@openwrt.org>
|
|
Date: Tue, 11 Feb 2014 11:16:24 +0100
|
|
Subject: [PATCH] ath9k: implement p2p client powersave support
|
|
|
|
Use generic TSF timers to trigger powersave state changes based
|
|
information from the P2P NoA attribute.
|
|
Opportunistic Powersave is not handled, because the driver does not
|
|
support powersave at the moment.
|
|
|
|
Signed-off-by: Felix Fietkau <nbd@openwrt.org>
|
|
---
|
|
drivers/net/wireless/ath/ath9k/ath9k.h | 12 ++++
|
|
drivers/net/wireless/ath/ath9k/init.c | 6 ++
|
|
drivers/net/wireless/ath/ath9k/main.c | 104 +++++++++++++++++++++++++++++++++
|
|
drivers/net/wireless/ath/ath9k/recv.c | 3 +
|
|
4 files changed, 125 insertions(+)
|
|
|
|
--- a/drivers/net/wireless/ath/ath9k/main.c
|
|
+++ b/drivers/net/wireless/ath/ath9k/main.c
|
|
@@ -261,6 +261,8 @@ static bool ath_complete_reset(struct at
|
|
sc->gtt_cnt = 0;
|
|
ieee80211_wake_queues(sc->hw);
|
|
|
|
+ ath9k_p2p_ps_timer(sc);
|
|
+
|
|
return true;
|
|
}
|
|
|
|
@@ -1128,6 +1130,8 @@ static int ath9k_add_interface(struct ie
|
|
if (ath9k_uses_beacons(vif->type))
|
|
ath9k_beacon_assign_slot(sc, vif);
|
|
|
|
+ avp->vif = vif;
|
|
+
|
|
an->sc = sc;
|
|
an->sta = NULL;
|
|
an->vif = vif;
|
|
@@ -1172,6 +1176,29 @@ static int ath9k_change_interface(struct
|
|
return 0;
|
|
}
|
|
|
|
+static void
|
|
+ath9k_update_p2p_ps_timer(struct ath_softc *sc, struct ath_vif *avp)
|
|
+{
|
|
+ struct ath_hw *ah = sc->sc_ah;
|
|
+ s32 tsf, target_tsf;
|
|
+
|
|
+ if (!avp || !avp->noa.has_next_tsf)
|
|
+ return;
|
|
+
|
|
+ ath9k_hw_gen_timer_stop(ah, sc->p2p_ps_timer);
|
|
+
|
|
+ tsf = ath9k_hw_gettsf32(sc->sc_ah);
|
|
+
|
|
+ target_tsf = avp->noa.next_tsf;
|
|
+ if (!avp->noa.absent)
|
|
+ target_tsf -= ATH_P2P_PS_STOP_TIME;
|
|
+
|
|
+ if (target_tsf - tsf < ATH_P2P_PS_STOP_TIME)
|
|
+ target_tsf = tsf + ATH_P2P_PS_STOP_TIME;
|
|
+
|
|
+ ath9k_hw_gen_timer_start(ah, sc->p2p_ps_timer, (u32) target_tsf, 1000000);
|
|
+}
|
|
+
|
|
static void ath9k_remove_interface(struct ieee80211_hw *hw,
|
|
struct ieee80211_vif *vif)
|
|
{
|
|
@@ -1183,6 +1210,13 @@ static void ath9k_remove_interface(struc
|
|
|
|
mutex_lock(&sc->mutex);
|
|
|
|
+ spin_lock_bh(&sc->sc_pcu_lock);
|
|
+ if (avp == sc->p2p_ps_vif) {
|
|
+ sc->p2p_ps_vif = NULL;
|
|
+ ath9k_update_p2p_ps_timer(sc, NULL);
|
|
+ }
|
|
+ spin_unlock_bh(&sc->sc_pcu_lock);
|
|
+
|
|
sc->nvifs--;
|
|
sc->tx99_vif = NULL;
|
|
|
|
@@ -1649,6 +1683,72 @@ static void ath9k_bss_assoc_iter(void *d
|
|
ath9k_set_assoc_state(sc, vif);
|
|
}
|
|
|
|
+void ath9k_p2p_ps_timer(void *priv)
|
|
+{
|
|
+ struct ath_softc *sc = priv;
|
|
+ struct ath_vif *avp = sc->p2p_ps_vif;
|
|
+ struct ieee80211_vif *vif;
|
|
+ struct ieee80211_sta *sta;
|
|
+ struct ath_node *an;
|
|
+ u32 tsf;
|
|
+
|
|
+ if (!avp)
|
|
+ return;
|
|
+
|
|
+ tsf = ath9k_hw_gettsf32(sc->sc_ah);
|
|
+ if (!avp->noa.absent)
|
|
+ tsf += ATH_P2P_PS_STOP_TIME;
|
|
+
|
|
+ if (!avp->noa.has_next_tsf ||
|
|
+ avp->noa.next_tsf - tsf > BIT(31))
|
|
+ ieee80211_update_p2p_noa(&avp->noa, tsf);
|
|
+
|
|
+ ath9k_update_p2p_ps_timer(sc, avp);
|
|
+
|
|
+ rcu_read_lock();
|
|
+
|
|
+ vif = avp->vif;
|
|
+ sta = ieee80211_find_sta(vif, vif->bss_conf.bssid);
|
|
+ if (!sta)
|
|
+ goto out;
|
|
+
|
|
+ an = (void *) sta->drv_priv;
|
|
+ if (an->sleeping == !!avp->noa.absent)
|
|
+ goto out;
|
|
+
|
|
+ an->sleeping = avp->noa.absent;
|
|
+ if (an->sleeping)
|
|
+ ath_tx_aggr_sleep(sta, sc, an);
|
|
+ else
|
|
+ ath_tx_aggr_wakeup(sc, an);
|
|
+
|
|
+out:
|
|
+ rcu_read_unlock();
|
|
+}
|
|
+
|
|
+void ath9k_update_p2p_ps(struct ath_softc *sc, struct ieee80211_vif *vif)
|
|
+{
|
|
+ struct ath_vif *avp = (void *)vif->drv_priv;
|
|
+ unsigned long flags;
|
|
+ u32 tsf;
|
|
+
|
|
+ if (!sc->p2p_ps_timer)
|
|
+ return;
|
|
+
|
|
+ if (vif->type != NL80211_IFTYPE_STATION || !vif->p2p)
|
|
+ return;
|
|
+
|
|
+ sc->p2p_ps_vif = avp;
|
|
+
|
|
+ spin_lock_irqsave(&sc->sc_pm_lock, flags);
|
|
+ if (!(sc->ps_flags & PS_BEACON_SYNC)) {
|
|
+ tsf = ath9k_hw_gettsf32(sc->sc_ah);
|
|
+ ieee80211_parse_p2p_noa(&vif->bss_conf.p2p_noa_attr, &avp->noa, tsf);
|
|
+ ath9k_update_p2p_ps_timer(sc, avp);
|
|
+ }
|
|
+ spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
|
|
+}
|
|
+
|
|
static void ath9k_bss_info_changed(struct ieee80211_hw *hw,
|
|
struct ieee80211_vif *vif,
|
|
struct ieee80211_bss_conf *bss_conf,
|
|
@@ -1723,6 +1823,12 @@ static void ath9k_bss_info_changed(struc
|
|
}
|
|
}
|
|
|
|
+ if (changed & BSS_CHANGED_P2P_PS) {
|
|
+ spin_lock_bh(&sc->sc_pcu_lock);
|
|
+ ath9k_update_p2p_ps(sc, vif);
|
|
+ spin_unlock_bh(&sc->sc_pcu_lock);
|
|
+ }
|
|
+
|
|
if (changed & CHECK_ANI)
|
|
ath_check_ani(sc);
|
|
|
|
--- a/drivers/net/wireless/ath/ath9k/ath9k.h
|
|
+++ b/drivers/net/wireless/ath/ath9k/ath9k.h
|
|
@@ -114,6 +114,9 @@ int ath_descdma_setup(struct ath_softc *
|
|
#define ATH_TXFIFO_DEPTH 8
|
|
#define ATH_TX_ERROR 0x01
|
|
|
|
+/* Stop tx traffic 1ms before the GO goes away */
|
|
+#define ATH_P2P_PS_STOP_TIME 1000
|
|
+
|
|
#define IEEE80211_SEQ_SEQ_SHIFT 4
|
|
#define IEEE80211_SEQ_MAX 4096
|
|
#define IEEE80211_WEP_IVLEN 3
|
|
@@ -366,11 +369,15 @@ void ath9k_release_buffered_frames(struc
|
|
/********/
|
|
|
|
struct ath_vif {
|
|
+ struct ieee80211_vif *vif;
|
|
struct ath_node mcast_node;
|
|
int av_bslot;
|
|
bool primary_sta_vif;
|
|
__le64 tsf_adjust; /* TSF adjustment for staggered beacons */
|
|
struct ath_buf *av_bcbuf;
|
|
+
|
|
+ /* P2P Client */
|
|
+ struct ieee80211_noa_data noa;
|
|
};
|
|
|
|
struct ath9k_vif_iter_data {
|
|
@@ -463,6 +470,8 @@ int ath_update_survey_stats(struct ath_s
|
|
void ath_update_survey_nf(struct ath_softc *sc, int channel);
|
|
void ath9k_queue_reset(struct ath_softc *sc, enum ath_reset_type type);
|
|
void ath_ps_full_sleep(unsigned long data);
|
|
+void ath9k_p2p_ps_timer(void *priv);
|
|
+void ath9k_update_p2p_ps(struct ath_softc *sc, struct ieee80211_vif *vif);
|
|
|
|
/**********/
|
|
/* BTCOEX */
|
|
@@ -723,6 +732,9 @@ struct ath_softc {
|
|
struct completion paprd_complete;
|
|
wait_queue_head_t tx_wait;
|
|
|
|
+ struct ath_gen_timer *p2p_ps_timer;
|
|
+ struct ath_vif *p2p_ps_vif;
|
|
+
|
|
unsigned long driver_data;
|
|
|
|
u8 gtt_cnt;
|
|
--- a/drivers/net/wireless/ath/ath9k/init.c
|
|
+++ b/drivers/net/wireless/ath/ath9k/init.c
|
|
@@ -593,6 +593,9 @@ static int ath9k_init_softc(u16 devid, s
|
|
if (ret)
|
|
goto err_btcoex;
|
|
|
|
+ sc->p2p_ps_timer = ath_gen_timer_alloc(sc->sc_ah, ath9k_p2p_ps_timer,
|
|
+ NULL, sc, AR_FIRST_NDP_TIMER);
|
|
+
|
|
ath9k_cmn_init_crypto(sc->sc_ah);
|
|
ath9k_init_misc(sc);
|
|
ath_fill_led_pin(sc);
|
|
@@ -875,6 +878,9 @@ static void ath9k_deinit_softc(struct at
|
|
{
|
|
int i = 0;
|
|
|
|
+ if (sc->p2p_ps_timer)
|
|
+ ath_gen_timer_free(sc->sc_ah, sc->p2p_ps_timer);
|
|
+
|
|
ath9k_deinit_btcoex(sc);
|
|
|
|
for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++)
|
|
--- a/drivers/net/wireless/ath/ath9k/recv.c
|
|
+++ b/drivers/net/wireless/ath/ath9k/recv.c
|
|
@@ -539,6 +539,9 @@ static void ath_rx_ps_beacon(struct ath_
|
|
ath_dbg(common, PS,
|
|
"Reconfigure beacon timers based on synchronized timestamp\n");
|
|
ath9k_set_beacon(sc);
|
|
+
|
|
+ if (sc->p2p_ps_vif)
|
|
+ ath9k_update_p2p_ps(sc, sc->p2p_ps_vif->vif);
|
|
}
|
|
|
|
if (ath_beacon_dtim_pending_cab(skb)) {
|