Commit | Line | Data |
---|---|---|
b203ffc3 JM |
1 | /* |
2 | * Off-channel operation helpers | |
3 | * | |
4 | * Copyright 2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
5 | * Copyright 2004, Instant802 Networks, Inc. | |
6 | * Copyright 2005, Devicescape Software, Inc. | |
7 | * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz> | |
8 | * Copyright 2007, Michael Wu <flamingice@sourmilk.net> | |
9 | * Copyright 2009 Johannes Berg <johannes@sipsolutions.net> | |
10 | * | |
11 | * This program is free software; you can redistribute it and/or modify | |
12 | * it under the terms of the GNU General Public License version 2 as | |
13 | * published by the Free Software Foundation. | |
14 | */ | |
bc3b2d7f | 15 | #include <linux/export.h> |
b203ffc3 JM |
16 | #include <net/mac80211.h> |
17 | #include "ieee80211_i.h" | |
21f83589 | 18 | #include "driver-trace.h" |
b203ffc3 JM |
19 | |
20 | /* | |
b23b025f BG |
21 | * Tell our hardware to disable PS. |
22 | * Optionally inform AP that we will go to sleep so that it will buffer | |
23 | * the frames while we are doing off-channel work. This is optional | |
24 | * because we *may* be doing work on-operating channel, and want our | |
25 | * hardware unconditionally awake, but still let the AP send us normal frames. | |
b203ffc3 | 26 | */ |
b23b025f BG |
27 | static void ieee80211_offchannel_ps_enable(struct ieee80211_sub_if_data *sdata, |
28 | bool tell_ap) | |
b203ffc3 JM |
29 | { |
30 | struct ieee80211_local *local = sdata->local; | |
4730d597 | 31 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
b203ffc3 JM |
32 | |
33 | local->offchannel_ps_enabled = false; | |
34 | ||
35 | /* FIXME: what to do when local->pspolling is true? */ | |
36 | ||
37 | del_timer_sync(&local->dynamic_ps_timer); | |
3bc3c0d7 | 38 | del_timer_sync(&ifmgd->bcn_mon_timer); |
4730d597 LR |
39 | del_timer_sync(&ifmgd->conn_mon_timer); |
40 | ||
b203ffc3 JM |
41 | cancel_work_sync(&local->dynamic_ps_enable_work); |
42 | ||
43 | if (local->hw.conf.flags & IEEE80211_CONF_PS) { | |
44 | local->offchannel_ps_enabled = true; | |
45 | local->hw.conf.flags &= ~IEEE80211_CONF_PS; | |
46 | ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS); | |
47 | } | |
48 | ||
b23b025f BG |
49 | if (tell_ap && (!local->offchannel_ps_enabled || |
50 | !(local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK))) | |
b203ffc3 JM |
51 | /* |
52 | * If power save was enabled, no need to send a nullfunc | |
53 | * frame because AP knows that we are sleeping. But if the | |
54 | * hardware is creating the nullfunc frame for power save | |
55 | * status (ie. IEEE80211_HW_PS_NULLFUNC_STACK is not | |
56 | * enabled) and power save was enabled, the firmware just | |
57 | * sent a null frame with power save disabled. So we need | |
58 | * to send a new nullfunc frame to inform the AP that we | |
59 | * are again sleeping. | |
60 | */ | |
61 | ieee80211_send_nullfunc(local, sdata, 1); | |
62 | } | |
63 | ||
64 | /* inform AP that we are awake again, unless power save is enabled */ | |
65 | static void ieee80211_offchannel_ps_disable(struct ieee80211_sub_if_data *sdata) | |
66 | { | |
67 | struct ieee80211_local *local = sdata->local; | |
68 | ||
69 | if (!local->ps_sdata) | |
70 | ieee80211_send_nullfunc(local, sdata, 0); | |
71 | else if (local->offchannel_ps_enabled) { | |
72 | /* | |
73 | * In !IEEE80211_HW_PS_NULLFUNC_STACK case the hardware | |
74 | * will send a nullfunc frame with the powersave bit set | |
75 | * even though the AP already knows that we are sleeping. | |
76 | * This could be avoided by sending a null frame with power | |
77 | * save bit disabled before enabling the power save, but | |
78 | * this doesn't gain anything. | |
79 | * | |
80 | * When IEEE80211_HW_PS_NULLFUNC_STACK is enabled, no need | |
81 | * to send a nullfunc frame because AP already knows that | |
82 | * we are sleeping, let's just enable power save mode in | |
83 | * hardware. | |
84 | */ | |
b23b025f BG |
85 | /* TODO: Only set hardware if CONF_PS changed? |
86 | * TODO: Should we set offchannel_ps_enabled to false? | |
87 | */ | |
b203ffc3 JM |
88 | local->hw.conf.flags |= IEEE80211_CONF_PS; |
89 | ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS); | |
90 | } else if (local->hw.conf.dynamic_ps_timeout > 0) { | |
91 | /* | |
92 | * If IEEE80211_CONF_PS was not set and the dynamic_ps_timer | |
93 | * had been running before leaving the operating channel, | |
94 | * restart the timer now and send a nullfunc frame to inform | |
95 | * the AP that we are awake. | |
96 | */ | |
97 | ieee80211_send_nullfunc(local, sdata, 0); | |
98 | mod_timer(&local->dynamic_ps_timer, jiffies + | |
99 | msecs_to_jiffies(local->hw.conf.dynamic_ps_timeout)); | |
100 | } | |
4730d597 | 101 | |
3bc3c0d7 | 102 | ieee80211_sta_reset_beacon_monitor(sdata); |
4730d597 | 103 | ieee80211_sta_reset_conn_monitor(sdata); |
b203ffc3 JM |
104 | } |
105 | ||
b23b025f BG |
106 | void ieee80211_offchannel_stop_vifs(struct ieee80211_local *local, |
107 | bool offchannel_ps_enable) | |
b203ffc3 JM |
108 | { |
109 | struct ieee80211_sub_if_data *sdata; | |
110 | ||
b23b025f BG |
111 | /* |
112 | * notify the AP about us leaving the channel and stop all | |
113 | * STA interfaces. | |
114 | */ | |
b203ffc3 JM |
115 | mutex_lock(&local->iflist_mtx); |
116 | list_for_each_entry(sdata, &local->interfaces, list) { | |
117 | if (!ieee80211_sdata_running(sdata)) | |
118 | continue; | |
119 | ||
b23b025f BG |
120 | if (sdata->vif.type != NL80211_IFTYPE_MONITOR) |
121 | set_bit(SDATA_STATE_OFFCHANNEL, &sdata->state); | |
122 | ||
123 | /* Check to see if we should disable beaconing. */ | |
b203ffc3 JM |
124 | if (sdata->vif.type == NL80211_IFTYPE_AP || |
125 | sdata->vif.type == NL80211_IFTYPE_ADHOC || | |
126 | sdata->vif.type == NL80211_IFTYPE_MESH_POINT) | |
127 | ieee80211_bss_info_change_notify( | |
128 | sdata, BSS_CHANGED_BEACON_ENABLED); | |
129 | ||
b23b025f | 130 | if (sdata->vif.type != NL80211_IFTYPE_MONITOR) { |
cfa6cb20 | 131 | netif_tx_stop_all_queues(sdata->dev); |
b23b025f BG |
132 | if (offchannel_ps_enable && |
133 | (sdata->vif.type == NL80211_IFTYPE_STATION) && | |
134 | sdata->u.mgd.associated) | |
135 | ieee80211_offchannel_ps_enable(sdata, true); | |
5b714c6a | 136 | } |
b203ffc3 JM |
137 | } |
138 | mutex_unlock(&local->iflist_mtx); | |
139 | } | |
140 | ||
b23b025f BG |
141 | void ieee80211_offchannel_enable_all_ps(struct ieee80211_local *local, |
142 | bool tell_ap) | |
b203ffc3 JM |
143 | { |
144 | struct ieee80211_sub_if_data *sdata; | |
145 | ||
b203ffc3 JM |
146 | mutex_lock(&local->iflist_mtx); |
147 | list_for_each_entry(sdata, &local->interfaces, list) { | |
148 | if (!ieee80211_sdata_running(sdata)) | |
149 | continue; | |
150 | ||
b23b025f BG |
151 | if (sdata->vif.type == NL80211_IFTYPE_STATION && |
152 | sdata->u.mgd.associated) | |
153 | ieee80211_offchannel_ps_enable(sdata, tell_ap); | |
b203ffc3 JM |
154 | } |
155 | mutex_unlock(&local->iflist_mtx); | |
156 | } | |
157 | ||
158 | void ieee80211_offchannel_return(struct ieee80211_local *local, | |
b23b025f BG |
159 | bool enable_beaconing, |
160 | bool offchannel_ps_disable) | |
b203ffc3 JM |
161 | { |
162 | struct ieee80211_sub_if_data *sdata; | |
163 | ||
164 | mutex_lock(&local->iflist_mtx); | |
165 | list_for_each_entry(sdata, &local->interfaces, list) { | |
166 | if (!ieee80211_sdata_running(sdata)) | |
167 | continue; | |
168 | ||
169 | /* Tell AP we're back */ | |
b23b025f BG |
170 | if (offchannel_ps_disable && |
171 | sdata->vif.type == NL80211_IFTYPE_STATION) { | |
b203ffc3 JM |
172 | if (sdata->u.mgd.associated) |
173 | ieee80211_offchannel_ps_disable(sdata); | |
b203ffc3 JM |
174 | } |
175 | ||
5b714c6a JB |
176 | if (sdata->vif.type != NL80211_IFTYPE_MONITOR) { |
177 | clear_bit(SDATA_STATE_OFFCHANNEL, &sdata->state); | |
178 | /* | |
179 | * This may wake up queues even though the driver | |
180 | * currently has them stopped. This is not very | |
181 | * likely, since the driver won't have gotten any | |
182 | * (or hardly any) new packets while we weren't | |
183 | * on the right channel, and even if it happens | |
184 | * it will at most lead to queueing up one more | |
185 | * packet per queue in mac80211 rather than on | |
186 | * the interface qdisc. | |
187 | */ | |
93895757 | 188 | netif_tx_wake_all_queues(sdata->dev); |
5b714c6a | 189 | } |
93895757 | 190 | |
b23b025f | 191 | /* Check to see if we should re-enable beaconing */ |
b203ffc3 JM |
192 | if (enable_beaconing && |
193 | (sdata->vif.type == NL80211_IFTYPE_AP || | |
194 | sdata->vif.type == NL80211_IFTYPE_ADHOC || | |
195 | sdata->vif.type == NL80211_IFTYPE_MESH_POINT)) | |
196 | ieee80211_bss_info_change_notify( | |
197 | sdata, BSS_CHANGED_BEACON_ENABLED); | |
198 | } | |
199 | mutex_unlock(&local->iflist_mtx); | |
200 | } | |
21f83589 JB |
201 | |
202 | static void ieee80211_hw_roc_start(struct work_struct *work) | |
203 | { | |
204 | struct ieee80211_local *local = | |
205 | container_of(work, struct ieee80211_local, hw_roc_start); | |
90fc4b3a | 206 | struct ieee80211_sub_if_data *sdata; |
21f83589 JB |
207 | |
208 | mutex_lock(&local->mtx); | |
209 | ||
210 | if (!local->hw_roc_channel) { | |
211 | mutex_unlock(&local->mtx); | |
212 | return; | |
213 | } | |
214 | ||
215 | ieee80211_recalc_idle(local); | |
216 | ||
90fc4b3a JB |
217 | if (local->hw_roc_skb) { |
218 | sdata = IEEE80211_DEV_TO_SUB_IF(local->hw_roc_dev); | |
219 | ieee80211_tx_skb(sdata, local->hw_roc_skb); | |
220 | local->hw_roc_skb = NULL; | |
221 | } else { | |
222 | cfg80211_ready_on_channel(local->hw_roc_dev, | |
223 | local->hw_roc_cookie, | |
224 | local->hw_roc_channel, | |
225 | local->hw_roc_channel_type, | |
226 | local->hw_roc_duration, | |
227 | GFP_KERNEL); | |
228 | } | |
229 | ||
21f83589 JB |
230 | mutex_unlock(&local->mtx); |
231 | } | |
232 | ||
233 | void ieee80211_ready_on_channel(struct ieee80211_hw *hw) | |
234 | { | |
235 | struct ieee80211_local *local = hw_to_local(hw); | |
236 | ||
237 | trace_api_ready_on_channel(local); | |
238 | ||
239 | ieee80211_queue_work(hw, &local->hw_roc_start); | |
240 | } | |
241 | EXPORT_SYMBOL_GPL(ieee80211_ready_on_channel); | |
242 | ||
243 | static void ieee80211_hw_roc_done(struct work_struct *work) | |
244 | { | |
245 | struct ieee80211_local *local = | |
246 | container_of(work, struct ieee80211_local, hw_roc_done); | |
247 | ||
248 | mutex_lock(&local->mtx); | |
249 | ||
250 | if (!local->hw_roc_channel) { | |
251 | mutex_unlock(&local->mtx); | |
252 | return; | |
253 | } | |
254 | ||
90fc4b3a JB |
255 | if (!local->hw_roc_for_tx) |
256 | cfg80211_remain_on_channel_expired(local->hw_roc_dev, | |
257 | local->hw_roc_cookie, | |
258 | local->hw_roc_channel, | |
259 | local->hw_roc_channel_type, | |
260 | GFP_KERNEL); | |
21f83589 JB |
261 | |
262 | local->hw_roc_channel = NULL; | |
263 | local->hw_roc_cookie = 0; | |
264 | ||
265 | ieee80211_recalc_idle(local); | |
266 | ||
267 | mutex_unlock(&local->mtx); | |
268 | } | |
269 | ||
270 | void ieee80211_remain_on_channel_expired(struct ieee80211_hw *hw) | |
271 | { | |
272 | struct ieee80211_local *local = hw_to_local(hw); | |
273 | ||
274 | trace_api_remain_on_channel_expired(local); | |
275 | ||
276 | ieee80211_queue_work(hw, &local->hw_roc_done); | |
277 | } | |
278 | EXPORT_SYMBOL_GPL(ieee80211_remain_on_channel_expired); | |
279 | ||
280 | void ieee80211_hw_roc_setup(struct ieee80211_local *local) | |
281 | { | |
282 | INIT_WORK(&local->hw_roc_start, ieee80211_hw_roc_start); | |
283 | INIT_WORK(&local->hw_roc_done, ieee80211_hw_roc_done); | |
284 | } |