Fix common misspellings
[linux-block.git] / drivers / net / wireless / iwlwifi / iwl-scan.c
CommitLineData
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
57static 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
96static 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 109void 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
125static 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 */
152int 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 */
164int 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) */
184static 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) */
197static 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) */
215static 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) */
237static 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
279void 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
290inline 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 302u16 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
333void 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
342int __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 395int 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
433out_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 443void 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 448static 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 473static 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 492u16 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 535static 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 548static 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
595out_complete:
596 iwl_complete_scan(priv, aborted);
597
3a160a5b 598out_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 612out:
073d5eab 613 mutex_unlock(&priv->mutex);
eedda367 614}
eedda367 615
2a421b91
TW
616void 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
624void 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}