1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * This file is part of wl1271 |
4 | * |
5 | * Copyright (C) 2008-2009 Nokia Corporation |
6 | * |
7 | * Contact: Luciano Coelho <luciano.coelho@nokia.com> |
8 | */ |
9 | |
10 | #include "ps.h" |
11 | #include "io.h" |
12 | #include "tx.h" |
13 | #include "debug.h" |
14 | |
15 | int wl1271_ps_set_mode(struct wl1271 *wl, struct wl12xx_vif *wlvif, |
16 | enum wl1271_cmd_ps_mode mode) |
17 | { |
18 | int ret; |
19 | u16 timeout = wl->conf.conn.dynamic_ps_timeout; |
20 | |
21 | switch (mode) { |
22 | case STATION_AUTO_PS_MODE: |
23 | case STATION_POWER_SAVE_MODE: |
24 | wl1271_debug(DEBUG_PSM, "entering psm (mode=%d,timeout=%u)" , |
25 | mode, timeout); |
26 | |
27 | ret = wl1271_acx_wake_up_conditions(wl, wlvif, |
28 | wake_up_event: wl->conf.conn.wake_up_event, |
29 | listen_interval: wl->conf.conn.listen_interval); |
30 | if (ret < 0) { |
31 | wl1271_error("couldn't set wake up conditions" ); |
32 | return ret; |
33 | } |
34 | |
35 | ret = wl1271_cmd_ps_mode(wl, wlvif, ps_mode: mode, auto_ps_timeout: timeout); |
36 | if (ret < 0) |
37 | return ret; |
38 | |
39 | set_bit(nr: WLVIF_FLAG_IN_PS, addr: &wlvif->flags); |
40 | |
41 | /* |
42 | * enable beacon early termination. |
43 | * Not relevant for 5GHz and for high rates. |
44 | */ |
45 | if ((wlvif->band == NL80211_BAND_2GHZ) && |
46 | (wlvif->basic_rate < CONF_HW_BIT_RATE_9MBPS)) { |
47 | ret = wl1271_acx_bet_enable(wl, wlvif, enable: true); |
48 | if (ret < 0) |
49 | return ret; |
50 | } |
51 | break; |
52 | case STATION_ACTIVE_MODE: |
53 | wl1271_debug(DEBUG_PSM, "leaving psm" ); |
54 | |
55 | /* disable beacon early termination */ |
56 | if ((wlvif->band == NL80211_BAND_2GHZ) && |
57 | (wlvif->basic_rate < CONF_HW_BIT_RATE_9MBPS)) { |
58 | ret = wl1271_acx_bet_enable(wl, wlvif, enable: false); |
59 | if (ret < 0) |
60 | return ret; |
61 | } |
62 | |
63 | ret = wl1271_cmd_ps_mode(wl, wlvif, ps_mode: mode, auto_ps_timeout: 0); |
64 | if (ret < 0) |
65 | return ret; |
66 | |
67 | clear_bit(nr: WLVIF_FLAG_IN_PS, addr: &wlvif->flags); |
68 | break; |
69 | default: |
70 | wl1271_warning("trying to set ps to unsupported mode %d" , mode); |
71 | ret = -EINVAL; |
72 | } |
73 | |
74 | return ret; |
75 | } |
76 | |
77 | static void wl1271_ps_filter_frames(struct wl1271 *wl, u8 hlid) |
78 | { |
79 | int i; |
80 | struct sk_buff *skb; |
81 | struct ieee80211_tx_info *info; |
82 | unsigned long flags; |
83 | int filtered[NUM_TX_QUEUES]; |
84 | struct wl1271_link *lnk = &wl->links[hlid]; |
85 | |
86 | /* filter all frames currently in the low level queues for this hlid */ |
87 | for (i = 0; i < NUM_TX_QUEUES; i++) { |
88 | filtered[i] = 0; |
89 | while ((skb = skb_dequeue(list: &lnk->tx_queue[i]))) { |
90 | filtered[i]++; |
91 | |
92 | if (WARN_ON(wl12xx_is_dummy_packet(wl, skb))) |
93 | continue; |
94 | |
95 | info = IEEE80211_SKB_CB(skb); |
96 | info->flags |= IEEE80211_TX_STAT_TX_FILTERED; |
97 | info->status.rates[0].idx = -1; |
98 | ieee80211_tx_status_ni(hw: wl->hw, skb); |
99 | } |
100 | } |
101 | |
102 | spin_lock_irqsave(&wl->wl_lock, flags); |
103 | for (i = 0; i < NUM_TX_QUEUES; i++) { |
104 | wl->tx_queue_count[i] -= filtered[i]; |
105 | if (lnk->wlvif) |
106 | lnk->wlvif->tx_queue_count[i] -= filtered[i]; |
107 | } |
108 | spin_unlock_irqrestore(lock: &wl->wl_lock, flags); |
109 | |
110 | wl1271_handle_tx_low_watermark(wl); |
111 | } |
112 | |
113 | void wl12xx_ps_link_start(struct wl1271 *wl, struct wl12xx_vif *wlvif, |
114 | u8 hlid, bool clean_queues) |
115 | { |
116 | struct ieee80211_sta *sta; |
117 | struct ieee80211_vif *vif = wl12xx_wlvif_to_vif(wlvif); |
118 | |
119 | if (WARN_ON_ONCE(wlvif->bss_type != BSS_TYPE_AP_BSS)) |
120 | return; |
121 | |
122 | if (!test_bit(hlid, wlvif->ap.sta_hlid_map) || |
123 | test_bit(hlid, &wl->ap_ps_map)) |
124 | return; |
125 | |
126 | wl1271_debug(DEBUG_PSM, "start mac80211 PSM on hlid %d pkts %d " |
127 | "clean_queues %d" , hlid, wl->links[hlid].allocated_pkts, |
128 | clean_queues); |
129 | |
130 | rcu_read_lock(); |
131 | sta = ieee80211_find_sta(vif, addr: wl->links[hlid].addr); |
132 | if (!sta) { |
133 | wl1271_error("could not find sta %pM for starting ps" , |
134 | wl->links[hlid].addr); |
135 | rcu_read_unlock(); |
136 | return; |
137 | } |
138 | |
139 | ieee80211_sta_ps_transition_ni(sta, start: true); |
140 | rcu_read_unlock(); |
141 | |
142 | /* do we want to filter all frames from this link's queues? */ |
143 | if (clean_queues) |
144 | wl1271_ps_filter_frames(wl, hlid); |
145 | |
146 | __set_bit(hlid, &wl->ap_ps_map); |
147 | } |
148 | |
149 | void wl12xx_ps_link_end(struct wl1271 *wl, struct wl12xx_vif *wlvif, u8 hlid) |
150 | { |
151 | struct ieee80211_sta *sta; |
152 | struct ieee80211_vif *vif = wl12xx_wlvif_to_vif(wlvif); |
153 | |
154 | if (!test_bit(hlid, &wl->ap_ps_map)) |
155 | return; |
156 | |
157 | wl1271_debug(DEBUG_PSM, "end mac80211 PSM on hlid %d" , hlid); |
158 | |
159 | __clear_bit(hlid, &wl->ap_ps_map); |
160 | |
161 | rcu_read_lock(); |
162 | sta = ieee80211_find_sta(vif, addr: wl->links[hlid].addr); |
163 | if (!sta) { |
164 | wl1271_error("could not find sta %pM for ending ps" , |
165 | wl->links[hlid].addr); |
166 | goto end; |
167 | } |
168 | |
169 | ieee80211_sta_ps_transition_ni(sta, start: false); |
170 | end: |
171 | rcu_read_unlock(); |
172 | } |
173 | |