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