]>
Commit | Line | Data |
---|---|---|
2b27bdcc | 1 | // SPDX-License-Identifier: GPL-2.0-only |
f5fc0f86 LC |
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> | |
f5fc0f86 LC |
8 | */ |
9 | ||
00d20100 SL |
10 | #include "ps.h" |
11 | #include "io.h" | |
b622d992 | 12 | #include "tx.h" |
0f4e3122 | 13 | #include "debug.h" |
f5fc0f86 | 14 | |
0603d891 | 15 | int wl1271_ps_set_mode(struct wl1271 *wl, struct wl12xx_vif *wlvif, |
248a0018 | 16 | enum wl1271_cmd_ps_mode mode) |
f5fc0f86 LC |
17 | { |
18 | int ret; | |
f1d63a59 | 19 | u16 timeout = wl->conf.conn.dynamic_ps_timeout; |
f5fc0f86 LC |
20 | |
21 | switch (mode) { | |
f1d63a59 | 22 | case STATION_AUTO_PS_MODE: |
5c0dc2fc | 23 | case STATION_POWER_SAVE_MODE: |
f1d63a59 ES |
24 | wl1271_debug(DEBUG_PSM, "entering psm (mode=%d,timeout=%u)", |
25 | mode, timeout); | |
1922167b | 26 | |
dae728fe ES |
27 | ret = wl1271_acx_wake_up_conditions(wl, wlvif, |
28 | wl->conf.conn.wake_up_event, | |
29 | wl->conf.conn.listen_interval); | |
03f06b7e JO |
30 | if (ret < 0) { |
31 | wl1271_error("couldn't set wake up conditions"); | |
32 | return ret; | |
33 | } | |
34 | ||
f1d63a59 | 35 | ret = wl1271_cmd_ps_mode(wl, wlvif, mode, timeout); |
f5fc0f86 LC |
36 | if (ret < 0) |
37 | return ret; | |
38 | ||
5c0dc2fc | 39 | set_bit(WLVIF_FLAG_IN_PS, &wlvif->flags); |
ed471d34 | 40 | |
e832837b VG |
41 | /* |
42 | * enable beacon early termination. | |
43 | * Not relevant for 5GHz and for high rates. | |
44 | */ | |
57fbcce3 | 45 | if ((wlvif->band == NL80211_BAND_2GHZ) && |
e832837b | 46 | (wlvif->basic_rate < CONF_HW_BIT_RATE_9MBPS)) { |
ed471d34 ES |
47 | ret = wl1271_acx_bet_enable(wl, wlvif, true); |
48 | if (ret < 0) | |
49 | return ret; | |
50 | } | |
f5fc0f86 LC |
51 | break; |
52 | case STATION_ACTIVE_MODE: | |
f5fc0f86 | 53 | wl1271_debug(DEBUG_PSM, "leaving psm"); |
f5fc0f86 | 54 | |
11f70f97 | 55 | /* disable beacon early termination */ |
57fbcce3 | 56 | if ((wlvif->band == NL80211_BAND_2GHZ) && |
e832837b | 57 | (wlvif->basic_rate < CONF_HW_BIT_RATE_9MBPS)) { |
0603d891 | 58 | ret = wl1271_acx_bet_enable(wl, wlvif, false); |
0e44eb20 SL |
59 | if (ret < 0) |
60 | return ret; | |
61 | } | |
11f70f97 | 62 | |
f1d63a59 | 63 | ret = wl1271_cmd_ps_mode(wl, wlvif, mode, 0); |
f5fc0f86 LC |
64 | if (ret < 0) |
65 | return ret; | |
66 | ||
5c0dc2fc | 67 | clear_bit(WLVIF_FLAG_IN_PS, &wlvif->flags); |
f5fc0f86 | 68 | break; |
f1d63a59 ES |
69 | default: |
70 | wl1271_warning("trying to set ps to unsupported mode %d", mode); | |
71 | ret = -EINVAL; | |
f5fc0f86 LC |
72 | } |
73 | ||
74 | return ret; | |
75 | } | |
b622d992 AN |
76 | |
77 | static void wl1271_ps_filter_frames(struct wl1271 *wl, u8 hlid) | |
78 | { | |
f1a46384 | 79 | int i; |
b622d992 AN |
80 | struct sk_buff *skb; |
81 | struct ieee80211_tx_info *info; | |
82 | unsigned long flags; | |
f1a46384 | 83 | int filtered[NUM_TX_QUEUES]; |
8591d424 | 84 | struct wl1271_link *lnk = &wl->links[hlid]; |
b622d992 | 85 | |
f8e0af6b | 86 | /* filter all frames currently in the low level queues for this hlid */ |
b622d992 | 87 | for (i = 0; i < NUM_TX_QUEUES; i++) { |
f1a46384 | 88 | filtered[i] = 0; |
8591d424 | 89 | while ((skb = skb_dequeue(&lnk->tx_queue[i]))) { |
f8e0af6b AN |
90 | filtered[i]++; |
91 | ||
92 | if (WARN_ON(wl12xx_is_dummy_packet(wl, skb))) | |
93 | continue; | |
94 | ||
b622d992 AN |
95 | info = IEEE80211_SKB_CB(skb); |
96 | info->flags |= IEEE80211_TX_STAT_TX_FILTERED; | |
97 | info->status.rates[0].idx = -1; | |
c27d3acc | 98 | ieee80211_tx_status_ni(wl->hw, skb); |
b622d992 AN |
99 | } |
100 | } | |
101 | ||
102 | spin_lock_irqsave(&wl->wl_lock, flags); | |
8591d424 | 103 | for (i = 0; i < NUM_TX_QUEUES; i++) { |
f1a46384 | 104 | wl->tx_queue_count[i] -= filtered[i]; |
8591d424 AN |
105 | if (lnk->wlvif) |
106 | lnk->wlvif->tx_queue_count[i] -= filtered[i]; | |
107 | } | |
b622d992 AN |
108 | spin_unlock_irqrestore(&wl->wl_lock, flags); |
109 | ||
110 | wl1271_handle_tx_low_watermark(wl); | |
111 | } | |
112 | ||
6e8cd331 EP |
113 | void wl12xx_ps_link_start(struct wl1271 *wl, struct wl12xx_vif *wlvif, |
114 | u8 hlid, bool clean_queues) | |
b622d992 AN |
115 | { |
116 | struct ieee80211_sta *sta; | |
6e8cd331 | 117 | struct ieee80211_vif *vif = wl12xx_wlvif_to_vif(wlvif); |
b622d992 | 118 | |
7a536265 AN |
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)) | |
b622d992 AN |
124 | return; |
125 | ||
9b17f1b3 AN |
126 | wl1271_debug(DEBUG_PSM, "start mac80211 PSM on hlid %d pkts %d " |
127 | "clean_queues %d", hlid, wl->links[hlid].allocated_pkts, | |
b622d992 AN |
128 | clean_queues); |
129 | ||
130 | rcu_read_lock(); | |
6e8cd331 | 131 | sta = ieee80211_find_sta(vif, wl->links[hlid].addr); |
b622d992 AN |
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, 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 | ||
6e8cd331 | 149 | void wl12xx_ps_link_end(struct wl1271 *wl, struct wl12xx_vif *wlvif, u8 hlid) |
b622d992 AN |
150 | { |
151 | struct ieee80211_sta *sta; | |
6e8cd331 | 152 | struct ieee80211_vif *vif = wl12xx_wlvif_to_vif(wlvif); |
b622d992 AN |
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(); | |
6e8cd331 | 162 | sta = ieee80211_find_sta(vif, wl->links[hlid].addr); |
b622d992 AN |
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, false); | |
170 | end: | |
171 | rcu_read_unlock(); | |
172 | } |