Commit | Line | Data |
---|---|---|
2a421b91 TW |
1 | /****************************************************************************** |
2 | * | |
3 | * GPL LICENSE SUMMARY | |
4 | * | |
901069c7 | 5 | * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved. |
2a421b91 TW |
6 | * |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of version 2 of the GNU General Public License as | |
9 | * published by the Free Software Foundation. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, but | |
12 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
14 | * General Public License for more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License | |
17 | * along with this program; if not, write to the Free Software | |
18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, | |
19 | * USA | |
20 | * | |
21 | * The full GNU General Public License is included in this distribution | |
22 | * in the file called LICENSE.GPL. | |
23 | * | |
24 | * Contact Information: | |
759ef89f | 25 | * Intel Linux Wireless <ilw@linux.intel.com> |
2a421b91 TW |
26 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 |
27 | *****************************************************************************/ | |
5a0e3ad6 | 28 | #include <linux/slab.h> |
7e272fcf | 29 | #include <linux/types.h> |
2a421b91 | 30 | #include <linux/etherdevice.h> |
7e272fcf | 31 | #include <net/mac80211.h> |
2a421b91 TW |
32 | |
33 | #include "iwl-eeprom.h" | |
34 | #include "iwl-dev.h" | |
35 | #include "iwl-core.h" | |
36 | #include "iwl-sta.h" | |
37 | #include "iwl-io.h" | |
38 | #include "iwl-helpers.h" | |
e80d70e9 | 39 | #include "iwl-agn.h" |
bdfbf092 | 40 | #include "iwl-trans.h" |
2a421b91 TW |
41 | |
42 | /* For active scan, listen ACTIVE_DWELL_TIME (msec) on each channel after | |
43 | * sending probe req. This should be set long enough to hear probe responses | |
44 | * from more than one AP. */ | |
fe905f1d TW |
45 | #define IWL_ACTIVE_DWELL_TIME_24 (30) /* all times in msec */ |
46 | #define IWL_ACTIVE_DWELL_TIME_52 (20) | |
47 | ||
48 | #define IWL_ACTIVE_DWELL_FACTOR_24GHZ (3) | |
49 | #define IWL_ACTIVE_DWELL_FACTOR_52GHZ (2) | |
2a421b91 | 50 | |
2a421b91 TW |
51 | /* For passive scan, listen PASSIVE_DWELL_TIME (msec) on each channel. |
52 | * Must be set longer than active dwell time. | |
53 | * For the most reliable scan, set > AP beacon interval (typically 100msec). */ | |
54 | #define IWL_PASSIVE_DWELL_TIME_24 (20) /* all times in msec */ | |
55 | #define IWL_PASSIVE_DWELL_TIME_52 (10) | |
56 | #define IWL_PASSIVE_DWELL_BASE (100) | |
57 | #define IWL_CHANNEL_TUNE_TIME 5 | |
58 | ||
cd44600f SG |
59 | static int iwl_send_scan_abort(struct iwl_priv *priv) |
60 | { | |
61 | int ret; | |
62 | struct iwl_rx_packet *pkt; | |
63 | struct iwl_host_cmd cmd = { | |
64 | .id = REPLY_SCAN_ABORT_CMD, | |
e419d62d | 65 | .flags = CMD_SYNC | CMD_WANT_SKB, |
cd44600f | 66 | }; |
fe905f1d | 67 | |
cd44600f SG |
68 | /* Exit instantly with error when device is not ready |
69 | * to receive scan abort command or it does not perform | |
70 | * hardware scan currently */ | |
63013ae3 EG |
71 | if (!test_bit(STATUS_READY, &priv->shrd->status) || |
72 | !test_bit(STATUS_GEO_CONFIGURED, &priv->shrd->status) || | |
73 | !test_bit(STATUS_SCAN_HW, &priv->shrd->status) || | |
74 | test_bit(STATUS_FW_ERROR, &priv->shrd->status) || | |
75 | test_bit(STATUS_EXIT_PENDING, &priv->shrd->status)) | |
cd44600f | 76 | return -EIO; |
fe905f1d | 77 | |
41c50542 | 78 | ret = trans_send_cmd(&priv->trans, &cmd); |
cd44600f SG |
79 | if (ret) |
80 | return ret; | |
81 | ||
82 | pkt = (struct iwl_rx_packet *)cmd.reply_page; | |
83 | if (pkt->u.status != CAN_ABORT_STATUS) { | |
84 | /* The scan abort will return 1 for success or | |
85 | * 2 for "failure". A failure condition can be | |
86 | * due to simply not being in an active scan which | |
87 | * can occur if we send the scan abort before we | |
88 | * the microcode has notified us that a scan is | |
89 | * completed. */ | |
7cf24421 | 90 | IWL_DEBUG_SCAN(priv, "SCAN_ABORT ret %d.\n", pkt->u.status); |
cd44600f | 91 | ret = -EIO; |
2a421b91 TW |
92 | } |
93 | ||
cd44600f SG |
94 | iwl_free_pages(priv, cmd.reply_page); |
95 | return ret; | |
96 | } | |
2a421b91 | 97 | |
02d8c14b SG |
98 | static void iwl_complete_scan(struct iwl_priv *priv, bool aborted) |
99 | { | |
100 | /* check if scan was requested from mac80211 */ | |
101 | if (priv->scan_request) { | |
102 | IWL_DEBUG_SCAN(priv, "Complete scan in mac80211\n"); | |
103 | ieee80211_scan_completed(priv->hw, aborted); | |
104 | } | |
105 | ||
c6baf7fb JB |
106 | if (priv->scan_type == IWL_SCAN_ROC) { |
107 | ieee80211_remain_on_channel_expired(priv->hw); | |
108 | priv->hw_roc_channel = NULL; | |
109 | schedule_delayed_work(&priv->hw_roc_disable_work, 10 * HZ); | |
110 | } | |
111 | ||
266af4c7 | 112 | priv->scan_type = IWL_SCAN_NORMAL; |
02d8c14b SG |
113 | priv->scan_vif = NULL; |
114 | priv->scan_request = NULL; | |
115 | } | |
116 | ||
e7e16b90 | 117 | void iwl_force_scan_end(struct iwl_priv *priv) |
f5354c17 | 118 | { |
e7e16b90 SG |
119 | lockdep_assert_held(&priv->mutex); |
120 | ||
63013ae3 | 121 | if (!test_bit(STATUS_SCANNING, &priv->shrd->status)) { |
e7e16b90 SG |
122 | IWL_DEBUG_SCAN(priv, "Forcing scan end while not scanning\n"); |
123 | return; | |
124 | } | |
125 | ||
f5354c17 | 126 | IWL_DEBUG_SCAN(priv, "Forcing scan end\n"); |
63013ae3 EG |
127 | clear_bit(STATUS_SCANNING, &priv->shrd->status); |
128 | clear_bit(STATUS_SCAN_HW, &priv->shrd->status); | |
129 | clear_bit(STATUS_SCAN_ABORTING, &priv->shrd->status); | |
f5354c17 SG |
130 | iwl_complete_scan(priv, true); |
131 | } | |
132 | ||
cd44600f SG |
133 | static void iwl_do_scan_abort(struct iwl_priv *priv) |
134 | { | |
135 | int ret; | |
2a421b91 | 136 | |
cd44600f SG |
137 | lockdep_assert_held(&priv->mutex); |
138 | ||
63013ae3 | 139 | if (!test_bit(STATUS_SCANNING, &priv->shrd->status)) { |
cd44600f SG |
140 | IWL_DEBUG_SCAN(priv, "Not performing scan to abort\n"); |
141 | return; | |
2a421b91 TW |
142 | } |
143 | ||
63013ae3 | 144 | if (test_and_set_bit(STATUS_SCAN_ABORTING, &priv->shrd->status)) { |
cd44600f SG |
145 | IWL_DEBUG_SCAN(priv, "Scan abort in progress\n"); |
146 | return; | |
147 | } | |
148 | ||
149 | ret = iwl_send_scan_abort(priv); | |
150 | if (ret) { | |
151 | IWL_DEBUG_SCAN(priv, "Send scan abort failed %d\n", ret); | |
f5354c17 | 152 | iwl_force_scan_end(priv); |
cd44600f | 153 | } else |
25985edc | 154 | IWL_DEBUG_SCAN(priv, "Successfully send scan abort\n"); |
cd44600f SG |
155 | } |
156 | ||
157 | /** | |
158 | * iwl_scan_cancel - Cancel any currently executing HW scan | |
159 | */ | |
160 | int iwl_scan_cancel(struct iwl_priv *priv) | |
161 | { | |
162 | IWL_DEBUG_SCAN(priv, "Queuing abort scan\n"); | |
74e28e44 | 163 | queue_work(priv->shrd->workqueue, &priv->abort_scan); |
2a421b91 TW |
164 | return 0; |
165 | } | |
cd44600f | 166 | |
2a421b91 TW |
167 | /** |
168 | * iwl_scan_cancel_timeout - Cancel any currently executing HW scan | |
169 | * @ms: amount of time to wait (in milliseconds) for scan to abort | |
170 | * | |
2a421b91 TW |
171 | */ |
172 | int iwl_scan_cancel_timeout(struct iwl_priv *priv, unsigned long ms) | |
173 | { | |
e693a802 SG |
174 | unsigned long timeout = jiffies + msecs_to_jiffies(ms); |
175 | ||
176 | lockdep_assert_held(&priv->mutex); | |
2a421b91 | 177 | |
e693a802 | 178 | IWL_DEBUG_SCAN(priv, "Scan cancel timeout\n"); |
2a421b91 | 179 | |
e693a802 SG |
180 | iwl_do_scan_abort(priv); |
181 | ||
182 | while (time_before_eq(jiffies, timeout)) { | |
63013ae3 | 183 | if (!test_bit(STATUS_SCAN_HW, &priv->shrd->status)) |
e693a802 SG |
184 | break; |
185 | msleep(20); | |
2a421b91 TW |
186 | } |
187 | ||
63013ae3 | 188 | return test_bit(STATUS_SCAN_HW, &priv->shrd->status); |
2a421b91 | 189 | } |
2a421b91 | 190 | |
2a421b91 TW |
191 | /* Service response to REPLY_SCAN_CMD (0x80) */ |
192 | static void iwl_rx_reply_scan(struct iwl_priv *priv, | |
193 | struct iwl_rx_mem_buffer *rxb) | |
194 | { | |
195 | #ifdef CONFIG_IWLWIFI_DEBUG | |
2f301227 | 196 | struct iwl_rx_packet *pkt = rxb_addr(rxb); |
2a421b91 TW |
197 | struct iwl_scanreq_notification *notif = |
198 | (struct iwl_scanreq_notification *)pkt->u.raw; | |
199 | ||
7cf24421 | 200 | IWL_DEBUG_SCAN(priv, "Scan request status = 0x%x\n", notif->status); |
2a421b91 TW |
201 | #endif |
202 | } | |
203 | ||
204 | /* Service SCAN_START_NOTIFICATION (0x82) */ | |
205 | static void iwl_rx_scan_start_notif(struct iwl_priv *priv, | |
206 | struct iwl_rx_mem_buffer *rxb) | |
207 | { | |
2f301227 | 208 | struct iwl_rx_packet *pkt = rxb_addr(rxb); |
2a421b91 TW |
209 | struct iwl_scanstart_notification *notif = |
210 | (struct iwl_scanstart_notification *)pkt->u.raw; | |
211 | priv->scan_start_tsf = le32_to_cpu(notif->tsf_low); | |
e1623446 | 212 | IWL_DEBUG_SCAN(priv, "Scan start: " |
2a421b91 TW |
213 | "%d [802.11%s] " |
214 | "(TSF: 0x%08X:%08X) - %d (beacon timer %u)\n", | |
215 | notif->channel, | |
216 | notif->band ? "bg" : "a", | |
fe905f1d TW |
217 | le32_to_cpu(notif->tsf_high), |
218 | le32_to_cpu(notif->tsf_low), | |
219 | notif->status, notif->beacon_timer); | |
c6baf7fb JB |
220 | |
221 | if (priv->scan_type == IWL_SCAN_ROC) | |
222 | ieee80211_ready_on_channel(priv->hw); | |
2a421b91 TW |
223 | } |
224 | ||
225 | /* Service SCAN_RESULTS_NOTIFICATION (0x83) */ | |
226 | static void iwl_rx_scan_results_notif(struct iwl_priv *priv, | |
227 | struct iwl_rx_mem_buffer *rxb) | |
228 | { | |
229 | #ifdef CONFIG_IWLWIFI_DEBUG | |
2f301227 | 230 | struct iwl_rx_packet *pkt = rxb_addr(rxb); |
2a421b91 TW |
231 | struct iwl_scanresults_notification *notif = |
232 | (struct iwl_scanresults_notification *)pkt->u.raw; | |
233 | ||
e1623446 | 234 | IWL_DEBUG_SCAN(priv, "Scan ch.res: " |
2a421b91 TW |
235 | "%d [802.11%s] " |
236 | "(TSF: 0x%08X:%08X) - %d " | |
220575f7 | 237 | "elapsed=%lu usec\n", |
2a421b91 TW |
238 | notif->channel, |
239 | notif->band ? "bg" : "a", | |
240 | le32_to_cpu(notif->tsf_high), | |
241 | le32_to_cpu(notif->tsf_low), | |
242 | le32_to_cpu(notif->statistics[0]), | |
220575f7 | 243 | le32_to_cpu(notif->tsf_low) - priv->scan_start_tsf); |
2a421b91 | 244 | #endif |
2a421b91 TW |
245 | } |
246 | ||
247 | /* Service SCAN_COMPLETE_NOTIFICATION (0x84) */ | |
248 | static void iwl_rx_scan_complete_notif(struct iwl_priv *priv, | |
249 | struct iwl_rx_mem_buffer *rxb) | |
250 | { | |
2f301227 | 251 | struct iwl_rx_packet *pkt = rxb_addr(rxb); |
2a421b91 TW |
252 | struct iwl_scancomplete_notification *scan_notif = (void *)pkt->u.raw; |
253 | ||
e1623446 | 254 | IWL_DEBUG_SCAN(priv, "Scan complete: %d channels (TSF 0x%08X:%08X) - %d\n", |
2a421b91 TW |
255 | scan_notif->scanned_channels, |
256 | scan_notif->tsf_low, | |
257 | scan_notif->tsf_high, scan_notif->status); | |
258 | ||
259 | /* The HW is no longer scanning */ | |
63013ae3 | 260 | clear_bit(STATUS_SCAN_HW, &priv->shrd->status); |
2a421b91 | 261 | |
7cf24421 | 262 | IWL_DEBUG_SCAN(priv, "Scan on %sGHz took %dms\n", |
00700ee0 | 263 | (priv->scan_band == IEEE80211_BAND_2GHZ) ? "2.4" : "5.2", |
ef1b21f7 | 264 | jiffies_to_msecs(jiffies - priv->scan_start)); |
2a421b91 | 265 | |
74e28e44 | 266 | queue_work(priv->shrd->workqueue, &priv->scan_completed); |
2a421b91 | 267 | |
f78e5454 | 268 | if (priv->iw_mode != NL80211_IFTYPE_ADHOC && |
88e58fc5 | 269 | iwl_advanced_bt_coexist(priv) && |
d5926d9d | 270 | priv->bt_status != scan_notif->bt_status) { |
f78e5454 WYG |
271 | if (scan_notif->bt_status) { |
272 | /* BT on */ | |
273 | if (!priv->bt_ch_announce) | |
274 | priv->bt_traffic_load = | |
275 | IWL_BT_COEX_TRAFFIC_LOAD_HIGH; | |
276 | /* | |
277 | * otherwise, no traffic load information provided | |
278 | * no changes made | |
279 | */ | |
280 | } else { | |
281 | /* BT off */ | |
282 | priv->bt_traffic_load = | |
283 | IWL_BT_COEX_TRAFFIC_LOAD_NONE; | |
284 | } | |
285 | priv->bt_status = scan_notif->bt_status; | |
74e28e44 EG |
286 | queue_work(priv->shrd->workqueue, |
287 | &priv->bt_traffic_change_work); | |
f78e5454 | 288 | } |
2a421b91 TW |
289 | } |
290 | ||
291 | void iwl_setup_rx_scan_handlers(struct iwl_priv *priv) | |
292 | { | |
293 | /* scan handlers */ | |
294 | priv->rx_handlers[REPLY_SCAN_CMD] = iwl_rx_reply_scan; | |
295 | priv->rx_handlers[SCAN_START_NOTIFICATION] = iwl_rx_scan_start_notif; | |
296 | priv->rx_handlers[SCAN_RESULTS_NOTIFICATION] = | |
297 | iwl_rx_scan_results_notif; | |
298 | priv->rx_handlers[SCAN_COMPLETE_NOTIFICATION] = | |
299 | iwl_rx_scan_complete_notif; | |
300 | } | |
2a421b91 | 301 | |
77fecfb8 SO |
302 | inline u16 iwl_get_active_dwell_time(struct iwl_priv *priv, |
303 | enum ieee80211_band band, | |
304 | u8 n_probes) | |
2a421b91 TW |
305 | { |
306 | if (band == IEEE80211_BAND_5GHZ) | |
fe905f1d TW |
307 | return IWL_ACTIVE_DWELL_TIME_52 + |
308 | IWL_ACTIVE_DWELL_FACTOR_52GHZ * (n_probes + 1); | |
2a421b91 | 309 | else |
fe905f1d TW |
310 | return IWL_ACTIVE_DWELL_TIME_24 + |
311 | IWL_ACTIVE_DWELL_FACTOR_24GHZ * (n_probes + 1); | |
2a421b91 TW |
312 | } |
313 | ||
77fecfb8 | 314 | u16 iwl_get_passive_dwell_time(struct iwl_priv *priv, |
1dda6d28 JB |
315 | enum ieee80211_band band, |
316 | struct ieee80211_vif *vif) | |
2a421b91 | 317 | { |
95c38dd4 | 318 | struct iwl_rxon_context *ctx; |
fe905f1d | 319 | u16 passive = (band == IEEE80211_BAND_2GHZ) ? |
2a421b91 TW |
320 | IWL_PASSIVE_DWELL_BASE + IWL_PASSIVE_DWELL_TIME_24 : |
321 | IWL_PASSIVE_DWELL_BASE + IWL_PASSIVE_DWELL_TIME_52; | |
322 | ||
246ed355 | 323 | if (iwl_is_any_associated(priv)) { |
95c38dd4 JB |
324 | /* |
325 | * If we're associated, we clamp the maximum passive | |
326 | * dwell time to be 98% of the smallest beacon interval | |
327 | * (minus 2 * channel tune time) | |
328 | */ | |
329 | for_each_context(priv, ctx) { | |
330 | u16 value; | |
331 | ||
332 | if (!iwl_is_associated_ctx(ctx)) | |
333 | continue; | |
334 | value = ctx->vif ? ctx->vif->bss_conf.beacon_int : 0; | |
335 | if ((value > IWL_PASSIVE_DWELL_BASE) || !value) | |
336 | value = IWL_PASSIVE_DWELL_BASE; | |
337 | value = (value * 98) / 100 - IWL_CHANNEL_TUNE_TIME * 2; | |
338 | passive = min(value, passive); | |
339 | } | |
2a421b91 TW |
340 | } |
341 | ||
2a421b91 TW |
342 | return passive; |
343 | } | |
344 | ||
f53696de TW |
345 | void iwl_init_scan_params(struct iwl_priv *priv) |
346 | { | |
d6189124 | 347 | u8 ant_idx = fls(hw_params(priv).valid_tx_ant) - 1; |
f53696de | 348 | if (!priv->scan_tx_ant[IEEE80211_BAND_5GHZ]) |
76eff18b | 349 | priv->scan_tx_ant[IEEE80211_BAND_5GHZ] = ant_idx; |
f53696de | 350 | if (!priv->scan_tx_ant[IEEE80211_BAND_2GHZ]) |
76eff18b | 351 | priv->scan_tx_ant[IEEE80211_BAND_2GHZ] = ant_idx; |
f53696de TW |
352 | } |
353 | ||
266af4c7 JB |
354 | int __must_check iwl_scan_initiate(struct iwl_priv *priv, |
355 | struct ieee80211_vif *vif, | |
356 | enum iwl_scan_type scan_type, | |
357 | enum ieee80211_band band) | |
2a421b91 | 358 | { |
3eecce52 JB |
359 | int ret; |
360 | ||
a24d52f3 | 361 | lockdep_assert_held(&priv->mutex); |
88be0264 | 362 | |
3eecce52 JB |
363 | cancel_delayed_work(&priv->scan_check); |
364 | ||
74d81b25 | 365 | if (!iwl_is_ready_rf(priv)) { |
7cf24421 | 366 | IWL_WARN(priv, "Request scan called when driver not ready.\n"); |
3eecce52 JB |
367 | return -EIO; |
368 | } | |
369 | ||
63013ae3 | 370 | if (test_bit(STATUS_SCAN_HW, &priv->shrd->status)) { |
7cf24421 | 371 | IWL_DEBUG_SCAN(priv, |
3eecce52 JB |
372 | "Multiple concurrent scan requests in parallel.\n"); |
373 | return -EBUSY; | |
374 | } | |
375 | ||
63013ae3 | 376 | if (test_bit(STATUS_SCAN_ABORTING, &priv->shrd->status)) { |
7cf24421 | 377 | IWL_DEBUG_SCAN(priv, "Scan request while abort pending.\n"); |
3eecce52 JB |
378 | return -EBUSY; |
379 | } | |
380 | ||
7cf24421 | 381 | IWL_DEBUG_SCAN(priv, "Starting %sscan...\n", |
266af4c7 | 382 | scan_type == IWL_SCAN_NORMAL ? "" : |
c6baf7fb | 383 | scan_type == IWL_SCAN_ROC ? "remain-on-channel " : |
266af4c7 | 384 | "internal short "); |
3eecce52 | 385 | |
63013ae3 | 386 | set_bit(STATUS_SCANNING, &priv->shrd->status); |
266af4c7 | 387 | priv->scan_type = scan_type; |
2a421b91 | 388 | priv->scan_start = jiffies; |
3eecce52 | 389 | priv->scan_band = band; |
2a421b91 | 390 | |
5c3d29fc | 391 | ret = iwlagn_request_scan(priv, vif); |
3eecce52 | 392 | if (ret) { |
63013ae3 | 393 | clear_bit(STATUS_SCANNING, &priv->shrd->status); |
266af4c7 | 394 | priv->scan_type = IWL_SCAN_NORMAL; |
3eecce52 JB |
395 | return ret; |
396 | } | |
b6e4c55a | 397 | |
74e28e44 | 398 | queue_delayed_work(priv->shrd->workqueue, &priv->scan_check, |
3eecce52 | 399 | IWL_SCAN_CHECK_WATCHDOG); |
2a421b91 TW |
400 | |
401 | return 0; | |
402 | } | |
2a421b91 | 403 | |
e9dde6f6 | 404 | int iwl_mac_hw_scan(struct ieee80211_hw *hw, |
a060bbfe JB |
405 | struct ieee80211_vif *vif, |
406 | struct cfg80211_scan_request *req) | |
e9dde6f6 | 407 | { |
e9dde6f6 | 408 | struct iwl_priv *priv = hw->priv; |
00700ee0 | 409 | int ret; |
e9dde6f6 AK |
410 | |
411 | IWL_DEBUG_MAC80211(priv, "enter\n"); | |
412 | ||
00700ee0 JB |
413 | if (req->n_channels == 0) |
414 | return -EINVAL; | |
415 | ||
e9dde6f6 | 416 | mutex_lock(&priv->mutex); |
e9dde6f6 | 417 | |
63013ae3 | 418 | if (test_bit(STATUS_SCANNING, &priv->shrd->status) && |
266af4c7 | 419 | priv->scan_type != IWL_SCAN_NORMAL) { |
bbcbb9ef RC |
420 | IWL_DEBUG_SCAN(priv, "Scan already in progress.\n"); |
421 | ret = -EAGAIN; | |
422 | goto out_unlock; | |
423 | } | |
424 | ||
00700ee0 | 425 | /* mac80211 will only ask for one band at a time */ |
1ecf9fc1 | 426 | priv->scan_request = req; |
f84b29ec | 427 | priv->scan_vif = vif; |
e9dde6f6 | 428 | |
f84b29ec JB |
429 | /* |
430 | * If an internal scan is in progress, just set | |
431 | * up the scan_request as per above. | |
432 | */ | |
266af4c7 | 433 | if (priv->scan_type != IWL_SCAN_NORMAL) { |
7cf24421 | 434 | IWL_DEBUG_SCAN(priv, "SCAN request during internal scan\n"); |
f84b29ec | 435 | ret = 0; |
7cf24421 | 436 | } else |
266af4c7 | 437 | ret = iwl_scan_initiate(priv, vif, IWL_SCAN_NORMAL, |
3eecce52 | 438 | req->channels[0]->band); |
e9dde6f6 AK |
439 | |
440 | IWL_DEBUG_MAC80211(priv, "leave\n"); | |
441 | ||
442 | out_unlock: | |
e9dde6f6 AK |
443 | mutex_unlock(&priv->mutex); |
444 | ||
445 | return ret; | |
446 | } | |
e9dde6f6 | 447 | |
afbdd69a WYG |
448 | /* |
449 | * internal short scan, this function should only been called while associated. | |
450 | * It will reset and tune the radio to prevent possible RF related problem | |
451 | */ | |
88be0264 | 452 | void iwl_internal_short_hw_scan(struct iwl_priv *priv) |
afbdd69a | 453 | { |
74e28e44 | 454 | queue_work(priv->shrd->workqueue, &priv->start_internal_scan); |
88be0264 JB |
455 | } |
456 | ||
c240879f | 457 | static void iwl_bg_start_internal_scan(struct work_struct *work) |
88be0264 JB |
458 | { |
459 | struct iwl_priv *priv = | |
460 | container_of(work, struct iwl_priv, start_internal_scan); | |
461 | ||
7cf24421 SG |
462 | IWL_DEBUG_SCAN(priv, "Start internal scan\n"); |
463 | ||
88be0264 | 464 | mutex_lock(&priv->mutex); |
afbdd69a | 465 | |
266af4c7 | 466 | if (priv->scan_type == IWL_SCAN_RADIO_RESET) { |
073d5eab RC |
467 | IWL_DEBUG_SCAN(priv, "Internal scan already in progress\n"); |
468 | goto unlock; | |
469 | } | |
470 | ||
63013ae3 | 471 | if (test_bit(STATUS_SCANNING, &priv->shrd->status)) { |
afbdd69a | 472 | IWL_DEBUG_SCAN(priv, "Scan already in progress.\n"); |
88be0264 | 473 | goto unlock; |
afbdd69a | 474 | } |
88be0264 | 475 | |
266af4c7 | 476 | if (iwl_scan_initiate(priv, NULL, IWL_SCAN_RADIO_RESET, priv->band)) |
3eecce52 | 477 | IWL_DEBUG_SCAN(priv, "failed to start internal short scan\n"); |
88be0264 JB |
478 | unlock: |
479 | mutex_unlock(&priv->mutex); | |
afbdd69a | 480 | } |
afbdd69a | 481 | |
c240879f | 482 | static void iwl_bg_scan_check(struct work_struct *data) |
2a421b91 TW |
483 | { |
484 | struct iwl_priv *priv = | |
485 | container_of(data, struct iwl_priv, scan_check.work); | |
486 | ||
7cf24421 SG |
487 | IWL_DEBUG_SCAN(priv, "Scan check work\n"); |
488 | ||
e7e16b90 SG |
489 | /* Since we are here firmware does not finish scan and |
490 | * most likely is in bad shape, so we don't bother to | |
491 | * send abort command, just force scan complete to mac80211 */ | |
2a421b91 | 492 | mutex_lock(&priv->mutex); |
e7e16b90 | 493 | iwl_force_scan_end(priv); |
2a421b91 TW |
494 | mutex_unlock(&priv->mutex); |
495 | } | |
77fecfb8 | 496 | |
2a421b91 TW |
497 | /** |
498 | * iwl_fill_probe_req - fill in all required fields and IE for probe request | |
499 | */ | |
f53696de | 500 | |
1ecf9fc1 | 501 | u16 iwl_fill_probe_req(struct iwl_priv *priv, struct ieee80211_mgmt *frame, |
3a0b9aad | 502 | const u8 *ta, const u8 *ies, int ie_len, int left) |
2a421b91 TW |
503 | { |
504 | int len = 0; | |
505 | u8 *pos = NULL; | |
f53696de | 506 | |
2a421b91 TW |
507 | /* Make sure there is enough space for the probe request, |
508 | * two mandatory IEs and the data */ | |
509 | left -= 24; | |
510 | if (left < 0) | |
511 | return 0; | |
2a421b91 TW |
512 | |
513 | frame->frame_control = cpu_to_le16(IEEE80211_STYPE_PROBE_REQ); | |
514 | memcpy(frame->da, iwl_bcast_addr, ETH_ALEN); | |
3a0b9aad | 515 | memcpy(frame->sa, ta, ETH_ALEN); |
2a421b91 TW |
516 | memcpy(frame->bssid, iwl_bcast_addr, ETH_ALEN); |
517 | frame->seq_ctrl = 0; | |
518 | ||
f53696de TW |
519 | len += 24; |
520 | ||
2a421b91 | 521 | /* ...next IE... */ |
f53696de | 522 | pos = &frame->u.probe_req.variable[0]; |
2a421b91 | 523 | |
f53696de | 524 | /* fill in our indirect SSID IE */ |
2a421b91 TW |
525 | left -= 2; |
526 | if (left < 0) | |
527 | return 0; | |
2a421b91 | 528 | *pos++ = WLAN_EID_SSID; |
1382c71c RC |
529 | *pos++ = 0; |
530 | ||
531 | len += 2; | |
2a421b91 | 532 | |
1ecf9fc1 JB |
533 | if (WARN_ON(left < ie_len)) |
534 | return len; | |
2a421b91 | 535 | |
eb2ec0fb | 536 | if (ies && ie_len) { |
afbdd69a | 537 | memcpy(pos, ies, ie_len); |
eb2ec0fb SG |
538 | len += ie_len; |
539 | } | |
f53696de | 540 | |
2a421b91 TW |
541 | return (u16)len; |
542 | } | |
543 | ||
c240879f | 544 | static void iwl_bg_abort_scan(struct work_struct *work) |
2a421b91 TW |
545 | { |
546 | struct iwl_priv *priv = container_of(work, struct iwl_priv, abort_scan); | |
547 | ||
7cf24421 SG |
548 | IWL_DEBUG_SCAN(priv, "Abort scan work\n"); |
549 | ||
e7e16b90 SG |
550 | /* We keep scan_check work queued in case when firmware will not |
551 | * report back scan completed notification */ | |
d28232b4 | 552 | mutex_lock(&priv->mutex); |
6bd1758d | 553 | iwl_scan_cancel_timeout(priv, 200); |
2a421b91 TW |
554 | mutex_unlock(&priv->mutex); |
555 | } | |
556 | ||
c240879f | 557 | static void iwl_bg_scan_completed(struct work_struct *work) |
eedda367 TW |
558 | { |
559 | struct iwl_priv *priv = | |
560 | container_of(work, struct iwl_priv, scan_completed); | |
02d8c14b | 561 | bool aborted; |
eedda367 | 562 | |
266af4c7 | 563 | IWL_DEBUG_SCAN(priv, "Completed scan.\n"); |
eedda367 | 564 | |
fbc9f97b RC |
565 | cancel_delayed_work(&priv->scan_check); |
566 | ||
073d5eab | 567 | mutex_lock(&priv->mutex); |
d5926d9d | 568 | |
63013ae3 | 569 | aborted = test_and_clear_bit(STATUS_SCAN_ABORTING, &priv->shrd->status); |
d5926d9d | 570 | if (aborted) |
7cf24421 | 571 | IWL_DEBUG_SCAN(priv, "Aborted scan completed.\n"); |
d5926d9d | 572 | |
63013ae3 | 573 | if (!test_and_clear_bit(STATUS_SCANNING, &priv->shrd->status)) { |
7cf24421 | 574 | IWL_DEBUG_SCAN(priv, "Scan already completed.\n"); |
3a160a5b | 575 | goto out_settings; |
afbdd69a | 576 | } |
f84b29ec | 577 | |
c6baf7fb JB |
578 | if (priv->scan_type == IWL_SCAN_ROC) { |
579 | ieee80211_remain_on_channel_expired(priv->hw); | |
580 | priv->hw_roc_channel = NULL; | |
581 | schedule_delayed_work(&priv->hw_roc_disable_work, 10 * HZ); | |
266af4c7 JB |
582 | } |
583 | ||
584 | if (priv->scan_type != IWL_SCAN_NORMAL && !aborted) { | |
02d8c14b | 585 | int err; |
f84b29ec | 586 | |
02d8c14b SG |
587 | /* Check if mac80211 requested scan during our internal scan */ |
588 | if (priv->scan_request == NULL) | |
589 | goto out_complete; | |
3eecce52 | 590 | |
02d8c14b | 591 | /* If so request a new scan */ |
266af4c7 | 592 | err = iwl_scan_initiate(priv, priv->scan_vif, IWL_SCAN_NORMAL, |
02d8c14b | 593 | priv->scan_request->channels[0]->band); |
3eecce52 JB |
594 | if (err) { |
595 | IWL_DEBUG_SCAN(priv, | |
596 | "failed to initiate pending scan: %d\n", err); | |
02d8c14b SG |
597 | aborted = true; |
598 | goto out_complete; | |
599 | } | |
600 | ||
601 | goto out; | |
3eecce52 | 602 | } |
f84b29ec | 603 | |
02d8c14b SG |
604 | out_complete: |
605 | iwl_complete_scan(priv, aborted); | |
606 | ||
3a160a5b | 607 | out_settings: |
02d8c14b SG |
608 | /* Can we still talk to firmware ? */ |
609 | if (!iwl_is_ready_rf(priv)) | |
610 | goto out; | |
611 | ||
e80d70e9 | 612 | iwlagn_post_scan(priv); |
52a02d15 | 613 | |
a25a66ac | 614 | out: |
073d5eab | 615 | mutex_unlock(&priv->mutex); |
eedda367 | 616 | } |
eedda367 | 617 | |
2a421b91 TW |
618 | void iwl_setup_scan_deferred_work(struct iwl_priv *priv) |
619 | { | |
eedda367 | 620 | INIT_WORK(&priv->scan_completed, iwl_bg_scan_completed); |
2a421b91 | 621 | INIT_WORK(&priv->abort_scan, iwl_bg_abort_scan); |
88be0264 | 622 | INIT_WORK(&priv->start_internal_scan, iwl_bg_start_internal_scan); |
2a421b91 TW |
623 | INIT_DELAYED_WORK(&priv->scan_check, iwl_bg_scan_check); |
624 | } | |
2a421b91 | 625 | |
e7e16b90 SG |
626 | void iwl_cancel_scan_deferred_work(struct iwl_priv *priv) |
627 | { | |
628 | cancel_work_sync(&priv->start_internal_scan); | |
629 | cancel_work_sync(&priv->abort_scan); | |
630 | cancel_work_sync(&priv->scan_completed); | |
631 | ||
632 | if (cancel_delayed_work_sync(&priv->scan_check)) { | |
633 | mutex_lock(&priv->mutex); | |
634 | iwl_force_scan_end(priv); | |
635 | mutex_unlock(&priv->mutex); | |
636 | } | |
637 | } |