1 /******************************************************************************
2  *
3  * GPL LICENSE SUMMARY
4  *
5  * Copyright(c) 2008 - 2010 Intel Corporation. All rights reserved.
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:
25  *  Intel Linux Wireless <ilw@linux.intel.com>
26  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
27  *****************************************************************************/
28 #include <linux/slab.h>
29 #include <linux/types.h>
30 #include <linux/etherdevice.h>
31 #include <net/mac80211.h>
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.  */
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)
48 
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 
iwl_send_scan_abort(struct iwl_priv * priv)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 	};
65 
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;
75 
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. */
88 		IWL_DEBUG_SCAN(priv, "SCAN_ABORT ret %d.\n", pkt->u.status);
89 		ret = -EIO;
90 	}
91 
92 	iwl_free_pages(priv, cmd.reply_page);
93 	return ret;
94 }
95 
iwl_complete_scan(struct iwl_priv * priv,bool aborted)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 
104 	priv->scan_type = IWL_SCAN_NORMAL;
105 	priv->scan_vif = NULL;
106 	priv->scan_request = NULL;
107 }
108 
iwl_force_scan_end(struct iwl_priv * priv)109 void iwl_force_scan_end(struct iwl_priv *priv)
110 {
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 
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 
iwl_do_scan_abort(struct iwl_priv * priv)125 static void iwl_do_scan_abort(struct iwl_priv *priv)
126 {
127 	int ret;
128 
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;
134 	}
135 
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);
144 		iwl_force_scan_end(priv);
145 	} else
146 		IWL_DEBUG_SCAN(priv, "Successfully send scan abort\n");
147 }
148 
149 /**
150  * iwl_scan_cancel - Cancel any currently executing HW scan
151  */
iwl_scan_cancel(struct iwl_priv * priv)152 int iwl_scan_cancel(struct iwl_priv *priv)
153 {
154 	IWL_DEBUG_SCAN(priv, "Queuing abort scan\n");
155 	queue_work(priv->workqueue, &priv->abort_scan);
156 	return 0;
157 }
158 
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  *
163  */
iwl_scan_cancel_timeout(struct iwl_priv * priv,unsigned long ms)164 int iwl_scan_cancel_timeout(struct iwl_priv *priv, unsigned long ms)
165 {
166 	unsigned long timeout = jiffies + msecs_to_jiffies(ms);
167 
168 	lockdep_assert_held(&priv->mutex);
169 
170 	IWL_DEBUG_SCAN(priv, "Scan cancel timeout\n");
171 
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);
178 	}
179 
180 	return test_bit(STATUS_SCAN_HW, &priv->status);
181 }
182 
183 /* Service response to REPLY_SCAN_CMD (0x80) */
iwl_rx_reply_scan(struct iwl_priv * priv,struct iwl_rx_mem_buffer * rxb)184 static void iwl_rx_reply_scan(struct iwl_priv *priv,
185 			      struct iwl_rx_mem_buffer *rxb)
186 {
187 #ifdef CONFIG_IWLWIFI_DEBUG
188 	struct iwl_rx_packet *pkt = rxb_addr(rxb);
189 	struct iwl_scanreq_notification *notif =
190 	    (struct iwl_scanreq_notification *)pkt->u.raw;
191 
192 	IWL_DEBUG_SCAN(priv, "Scan request status = 0x%x\n", notif->status);
193 #endif
194 }
195 
196 /* Service SCAN_START_NOTIFICATION (0x82) */
iwl_rx_scan_start_notif(struct iwl_priv * priv,struct iwl_rx_mem_buffer * rxb)197 static void iwl_rx_scan_start_notif(struct iwl_priv *priv,
198 				    struct iwl_rx_mem_buffer *rxb)
199 {
200 	struct iwl_rx_packet *pkt = rxb_addr(rxb);
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);
204 	IWL_DEBUG_SCAN(priv, "Scan start: "
205 		       "%d [802.11%s] "
206 		       "(TSF: 0x%08X:%08X) - %d (beacon timer %u)\n",
207 		       notif->channel,
208 		       notif->band ? "bg" : "a",
209 		       le32_to_cpu(notif->tsf_high),
210 		       le32_to_cpu(notif->tsf_low),
211 		       notif->status, notif->beacon_timer);
212 }
213 
214 /* Service SCAN_RESULTS_NOTIFICATION (0x83) */
iwl_rx_scan_results_notif(struct iwl_priv * priv,struct iwl_rx_mem_buffer * rxb)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
219 	struct iwl_rx_packet *pkt = rxb_addr(rxb);
220 	struct iwl_scanresults_notification *notif =
221 	    (struct iwl_scanresults_notification *)pkt->u.raw;
222 
223 	IWL_DEBUG_SCAN(priv, "Scan ch.res: "
224 		       "%d [802.11%s] "
225 		       "(TSF: 0x%08X:%08X) - %d "
226 		       "elapsed=%lu usec\n",
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]),
232 		       le32_to_cpu(notif->tsf_low) - priv->scan_start_tsf);
233 #endif
234 }
235 
236 /* Service SCAN_COMPLETE_NOTIFICATION (0x84) */
iwl_rx_scan_complete_notif(struct iwl_priv * priv,struct iwl_rx_mem_buffer * rxb)237 static void iwl_rx_scan_complete_notif(struct iwl_priv *priv,
238 				       struct iwl_rx_mem_buffer *rxb)
239 {
240 	struct iwl_rx_packet *pkt = rxb_addr(rxb);
241 	struct iwl_scancomplete_notification *scan_notif = (void *)pkt->u.raw;
242 
243 	IWL_DEBUG_SCAN(priv, "Scan complete: %d channels (TSF 0x%08X:%08X) - %d\n",
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 
251 	IWL_DEBUG_SCAN(priv, "Scan on %sGHz took %dms\n",
252 		       (priv->scan_band == IEEE80211_BAND_2GHZ) ? "2.4" : "5.2",
253 		       jiffies_to_msecs(jiffies - priv->scan_start));
254 
255 	queue_work(priv->workqueue, &priv->scan_completed);
256 
257 	if (priv->iw_mode != NL80211_IFTYPE_ADHOC &&
258 	    iwl_advanced_bt_coexist(priv) &&
259 	    priv->bt_status != scan_notif->bt_status) {
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 	}
277 }
278 
iwl_setup_rx_scan_handlers(struct iwl_priv * priv)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 }
289 
iwl_get_active_dwell_time(struct iwl_priv * priv,enum ieee80211_band band,u8 n_probes)290 inline u16 iwl_get_active_dwell_time(struct iwl_priv *priv,
291 				     enum ieee80211_band band,
292 				     u8 n_probes)
293 {
294 	if (band == IEEE80211_BAND_5GHZ)
295 		return IWL_ACTIVE_DWELL_TIME_52 +
296 			IWL_ACTIVE_DWELL_FACTOR_52GHZ * (n_probes + 1);
297 	else
298 		return IWL_ACTIVE_DWELL_TIME_24 +
299 			IWL_ACTIVE_DWELL_FACTOR_24GHZ * (n_probes + 1);
300 }
301 
iwl_get_passive_dwell_time(struct iwl_priv * priv,enum ieee80211_band band,struct ieee80211_vif * vif)302 u16 iwl_get_passive_dwell_time(struct iwl_priv *priv,
303 			       enum ieee80211_band band,
304 			       struct ieee80211_vif *vif)
305 {
306 	struct iwl_rxon_context *ctx;
307 	u16 passive = (band == IEEE80211_BAND_2GHZ) ?
308 	    IWL_PASSIVE_DWELL_BASE + IWL_PASSIVE_DWELL_TIME_24 :
309 	    IWL_PASSIVE_DWELL_BASE + IWL_PASSIVE_DWELL_TIME_52;
310 
311 	if (iwl_is_any_associated(priv)) {
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 		}
328 	}
329 
330 	return passive;
331 }
332 
iwl_init_scan_params(struct iwl_priv * priv)333 void iwl_init_scan_params(struct iwl_priv *priv)
334 {
335 	u8 ant_idx = fls(priv->hw_params.valid_tx_ant) - 1;
336 	if (!priv->scan_tx_ant[IEEE80211_BAND_5GHZ])
337 		priv->scan_tx_ant[IEEE80211_BAND_5GHZ] = ant_idx;
338 	if (!priv->scan_tx_ant[IEEE80211_BAND_2GHZ])
339 		priv->scan_tx_ant[IEEE80211_BAND_2GHZ] = ant_idx;
340 }
341 
iwl_scan_initiate(struct iwl_priv * priv,struct ieee80211_vif * vif,enum iwl_scan_type scan_type,enum ieee80211_band band)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)
346 {
347 	int ret;
348 
349 	lockdep_assert_held(&priv->mutex);
350 
351 	if (WARN_ON(!priv->cfg->ops->utils->request_scan))
352 		return -EOPNOTSUPP;
353 
354 	cancel_delayed_work(&priv->scan_check);
355 
356 	if (!iwl_is_ready_rf(priv)) {
357 		IWL_WARN(priv, "Request scan called when driver not ready.\n");
358 		return -EIO;
359 	}
360 
361 	if (test_bit(STATUS_SCAN_HW, &priv->status)) {
362 		IWL_DEBUG_SCAN(priv,
363 			"Multiple concurrent scan requests in parallel.\n");
364 		return -EBUSY;
365 	}
366 
367 	if (test_bit(STATUS_SCAN_ABORTING, &priv->status)) {
368 		IWL_DEBUG_SCAN(priv, "Scan request while abort pending.\n");
369 		return -EBUSY;
370 	}
371 
372 	IWL_DEBUG_SCAN(priv, "Starting %sscan...\n",
373 			scan_type == IWL_SCAN_NORMAL ? "" :
374 			scan_type == IWL_SCAN_OFFCH_TX ? "offchan TX " :
375 			"internal short ");
376 
377 	set_bit(STATUS_SCANNING, &priv->status);
378 	priv->scan_type = scan_type;
379 	priv->scan_start = jiffies;
380 	priv->scan_band = band;
381 
382 	ret = priv->cfg->ops->utils->request_scan(priv, vif);
383 	if (ret) {
384 		clear_bit(STATUS_SCANNING, &priv->status);
385 		priv->scan_type = IWL_SCAN_NORMAL;
386 		return ret;
387 	}
388 
389 	queue_delayed_work(priv->workqueue, &priv->scan_check,
390 			   IWL_SCAN_CHECK_WATCHDOG);
391 
392 	return 0;
393 }
394 
iwl_mac_hw_scan(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct cfg80211_scan_request * req)395 int iwl_mac_hw_scan(struct ieee80211_hw *hw,
396 		    struct ieee80211_vif *vif,
397 		    struct cfg80211_scan_request *req)
398 {
399 	struct iwl_priv *priv = hw->priv;
400 	int ret;
401 
402 	IWL_DEBUG_MAC80211(priv, "enter\n");
403 
404 	if (req->n_channels == 0)
405 		return -EINVAL;
406 
407 	mutex_lock(&priv->mutex);
408 
409 	if (test_bit(STATUS_SCANNING, &priv->status) &&
410 	    priv->scan_type != IWL_SCAN_NORMAL) {
411 		IWL_DEBUG_SCAN(priv, "Scan already in progress.\n");
412 		ret = -EAGAIN;
413 		goto out_unlock;
414 	}
415 
416 	/* mac80211 will only ask for one band at a time */
417 	priv->scan_request = req;
418 	priv->scan_vif = vif;
419 
420 	/*
421 	 * If an internal scan is in progress, just set
422 	 * up the scan_request as per above.
423 	 */
424 	if (priv->scan_type != IWL_SCAN_NORMAL) {
425 		IWL_DEBUG_SCAN(priv, "SCAN request during internal scan\n");
426 		ret = 0;
427 	} else
428 		ret = iwl_scan_initiate(priv, vif, IWL_SCAN_NORMAL,
429 					req->channels[0]->band);
430 
431 	IWL_DEBUG_MAC80211(priv, "leave\n");
432 
433 out_unlock:
434 	mutex_unlock(&priv->mutex);
435 
436 	return ret;
437 }
438 
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  */
iwl_internal_short_hw_scan(struct iwl_priv * priv)443 void iwl_internal_short_hw_scan(struct iwl_priv *priv)
444 {
445 	queue_work(priv->workqueue, &priv->start_internal_scan);
446 }
447 
iwl_bg_start_internal_scan(struct work_struct * work)448 static void iwl_bg_start_internal_scan(struct work_struct *work)
449 {
450 	struct iwl_priv *priv =
451 		container_of(work, struct iwl_priv, start_internal_scan);
452 
453 	IWL_DEBUG_SCAN(priv, "Start internal scan\n");
454 
455 	mutex_lock(&priv->mutex);
456 
457 	if (priv->scan_type == IWL_SCAN_RADIO_RESET) {
458 		IWL_DEBUG_SCAN(priv, "Internal scan already in progress\n");
459 		goto unlock;
460 	}
461 
462 	if (test_bit(STATUS_SCANNING, &priv->status)) {
463 		IWL_DEBUG_SCAN(priv, "Scan already in progress.\n");
464 		goto unlock;
465 	}
466 
467 	if (iwl_scan_initiate(priv, NULL, IWL_SCAN_RADIO_RESET, priv->band))
468 		IWL_DEBUG_SCAN(priv, "failed to start internal short scan\n");
469  unlock:
470 	mutex_unlock(&priv->mutex);
471 }
472 
iwl_bg_scan_check(struct work_struct * data)473 static void iwl_bg_scan_check(struct work_struct *data)
474 {
475 	struct iwl_priv *priv =
476 	    container_of(data, struct iwl_priv, scan_check.work);
477 
478 	IWL_DEBUG_SCAN(priv, "Scan check work\n");
479 
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 */
483 	mutex_lock(&priv->mutex);
484 	iwl_force_scan_end(priv);
485 	mutex_unlock(&priv->mutex);
486 }
487 
488 /**
489  * iwl_fill_probe_req - fill in all required fields and IE for probe request
490  */
491 
iwl_fill_probe_req(struct iwl_priv * priv,struct ieee80211_mgmt * frame,const u8 * ta,const u8 * ies,int ie_len,int left)492 u16 iwl_fill_probe_req(struct iwl_priv *priv, struct ieee80211_mgmt *frame,
493 		       const u8 *ta, const u8 *ies, int ie_len, int left)
494 {
495 	int len = 0;
496 	u8 *pos = NULL;
497 
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;
503 
504 	frame->frame_control = cpu_to_le16(IEEE80211_STYPE_PROBE_REQ);
505 	memcpy(frame->da, iwl_bcast_addr, ETH_ALEN);
506 	memcpy(frame->sa, ta, ETH_ALEN);
507 	memcpy(frame->bssid, iwl_bcast_addr, ETH_ALEN);
508 	frame->seq_ctrl = 0;
509 
510 	len += 24;
511 
512 	/* ...next IE... */
513 	pos = &frame->u.probe_req.variable[0];
514 
515 	/* fill in our indirect SSID IE */
516 	left -= 2;
517 	if (left < 0)
518 		return 0;
519 	*pos++ = WLAN_EID_SSID;
520 	*pos++ = 0;
521 
522 	len += 2;
523 
524 	if (WARN_ON(left < ie_len))
525 		return len;
526 
527 	if (ies && ie_len) {
528 		memcpy(pos, ies, ie_len);
529 		len += ie_len;
530 	}
531 
532 	return (u16)len;
533 }
534 
iwl_bg_abort_scan(struct work_struct * work)535 static void iwl_bg_abort_scan(struct work_struct *work)
536 {
537 	struct iwl_priv *priv = container_of(work, struct iwl_priv, abort_scan);
538 
539 	IWL_DEBUG_SCAN(priv, "Abort scan work\n");
540 
541 	/* We keep scan_check work queued in case when firmware will not
542 	 * report back scan completed notification */
543 	mutex_lock(&priv->mutex);
544 	iwl_scan_cancel_timeout(priv, 200);
545 	mutex_unlock(&priv->mutex);
546 }
547 
iwl_bg_scan_completed(struct work_struct * work)548 static void iwl_bg_scan_completed(struct work_struct *work)
549 {
550 	struct iwl_priv *priv =
551 	    container_of(work, struct iwl_priv, scan_completed);
552 	bool aborted;
553 
554 	IWL_DEBUG_SCAN(priv, "Completed scan.\n");
555 
556 	cancel_delayed_work(&priv->scan_check);
557 
558 	mutex_lock(&priv->mutex);
559 
560 	aborted = test_and_clear_bit(STATUS_SCAN_ABORTING, &priv->status);
561 	if (aborted)
562 		IWL_DEBUG_SCAN(priv, "Aborted scan completed.\n");
563 
564 	if (!test_and_clear_bit(STATUS_SCANNING, &priv->status)) {
565 		IWL_DEBUG_SCAN(priv, "Scan already completed.\n");
566 		goto out_settings;
567 	}
568 
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) {
576 		int err;
577 
578 		/* Check if mac80211 requested scan during our internal scan */
579 		if (priv->scan_request == NULL)
580 			goto out_complete;
581 
582 		/* If so request a new scan */
583 		err = iwl_scan_initiate(priv, priv->scan_vif, IWL_SCAN_NORMAL,
584 					priv->scan_request->channels[0]->band);
585 		if (err) {
586 			IWL_DEBUG_SCAN(priv,
587 				"failed to initiate pending scan: %d\n", err);
588 			aborted = true;
589 			goto out_complete;
590 		}
591 
592 		goto out;
593 	}
594 
595 out_complete:
596 	iwl_complete_scan(priv, aborted);
597 
598 out_settings:
599 	/* Can we still talk to firmware ? */
600 	if (!iwl_is_ready_rf(priv))
601 		goto out;
602 
603 	/*
604 	 * We do not commit power settings while scan is pending,
605 	 * do it now if the settings changed.
606 	 */
607 	iwl_power_set_mode(priv, &priv->power_data.sleep_cmd_next, false);
608 	iwl_set_tx_power(priv, priv->tx_power_next, false);
609 
610 	priv->cfg->ops->utils->post_scan(priv);
611 
612 out:
613 	mutex_unlock(&priv->mutex);
614 }
615 
iwl_setup_scan_deferred_work(struct iwl_priv * priv)616 void iwl_setup_scan_deferred_work(struct iwl_priv *priv)
617 {
618 	INIT_WORK(&priv->scan_completed, iwl_bg_scan_completed);
619 	INIT_WORK(&priv->abort_scan, iwl_bg_abort_scan);
620 	INIT_WORK(&priv->start_internal_scan, iwl_bg_start_internal_scan);
621 	INIT_DELAYED_WORK(&priv->scan_check, iwl_bg_scan_check);
622 }
623 
iwl_cancel_scan_deferred_work(struct iwl_priv * priv)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 }
636