1 /******************************************************************************
5 * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
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.
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.
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,
21 * The full GNU General Public License is included in this distribution
22 * in the file called LICENSE.GPL.
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>
33 #include "iwl-eeprom.h"
38 #include "iwl-helpers.h"
41 /* For active scan, listen ACTIVE_DWELL_TIME (msec) on each channel after
42 * sending probe req. This should be set long enough to hear probe responses
43 * from more than one AP. */
44 #define IWL_ACTIVE_DWELL_TIME_24 (30) /* all times in msec */
45 #define IWL_ACTIVE_DWELL_TIME_52 (20)
47 #define IWL_ACTIVE_DWELL_FACTOR_24GHZ (3)
48 #define IWL_ACTIVE_DWELL_FACTOR_52GHZ (2)
50 /* For passive scan, listen PASSIVE_DWELL_TIME (msec) on each channel.
51 * Must be set longer than active dwell time.
52 * For the most reliable scan, set > AP beacon interval (typically 100msec). */
53 #define IWL_PASSIVE_DWELL_TIME_24 (20) /* all times in msec */
54 #define IWL_PASSIVE_DWELL_TIME_52 (10)
55 #define IWL_PASSIVE_DWELL_BASE (100)
56 #define IWL_CHANNEL_TUNE_TIME 5
58 static int iwl_send_scan_abort(struct iwl_priv *priv)
61 struct iwl_rx_packet *pkt;
62 struct iwl_host_cmd cmd = {
63 .id = REPLY_SCAN_ABORT_CMD,
64 .flags = CMD_SYNC | CMD_WANT_SKB,
67 /* Exit instantly with error when device is not ready
68 * to receive scan abort command or it does not perform
69 * hardware scan currently */
70 if (!test_bit(STATUS_READY, &priv->status) ||
71 !test_bit(STATUS_GEO_CONFIGURED, &priv->status) ||
72 !test_bit(STATUS_SCAN_HW, &priv->status) ||
73 test_bit(STATUS_FW_ERROR, &priv->status) ||
74 test_bit(STATUS_EXIT_PENDING, &priv->status))
77 ret = priv->trans.ops->send_cmd(priv, &cmd);
81 pkt = (struct iwl_rx_packet *)cmd.reply_page;
82 if (pkt->u.status != CAN_ABORT_STATUS) {
83 /* The scan abort will return 1 for success or
84 * 2 for "failure". A failure condition can be
85 * due to simply not being in an active scan which
86 * can occur if we send the scan abort before we
87 * the microcode has notified us that a scan is
89 IWL_DEBUG_SCAN(priv, "SCAN_ABORT ret %d.\n", pkt->u.status);
93 iwl_free_pages(priv, cmd.reply_page);
97 static void iwl_complete_scan(struct iwl_priv *priv, bool aborted)
99 /* check if scan was requested from mac80211 */
100 if (priv->scan_request) {
101 IWL_DEBUG_SCAN(priv, "Complete scan in mac80211\n");
102 ieee80211_scan_completed(priv->hw, aborted);
105 priv->scan_type = IWL_SCAN_NORMAL;
106 priv->scan_vif = NULL;
107 priv->scan_request = NULL;
110 void iwl_force_scan_end(struct iwl_priv *priv)
112 lockdep_assert_held(&priv->mutex);
114 if (!test_bit(STATUS_SCANNING, &priv->status)) {
115 IWL_DEBUG_SCAN(priv, "Forcing scan end while not scanning\n");
119 IWL_DEBUG_SCAN(priv, "Forcing scan end\n");
120 clear_bit(STATUS_SCANNING, &priv->status);
121 clear_bit(STATUS_SCAN_HW, &priv->status);
122 clear_bit(STATUS_SCAN_ABORTING, &priv->status);
123 iwl_complete_scan(priv, true);
126 static void iwl_do_scan_abort(struct iwl_priv *priv)
130 lockdep_assert_held(&priv->mutex);
132 if (!test_bit(STATUS_SCANNING, &priv->status)) {
133 IWL_DEBUG_SCAN(priv, "Not performing scan to abort\n");
137 if (test_and_set_bit(STATUS_SCAN_ABORTING, &priv->status)) {
138 IWL_DEBUG_SCAN(priv, "Scan abort in progress\n");
142 ret = iwl_send_scan_abort(priv);
144 IWL_DEBUG_SCAN(priv, "Send scan abort failed %d\n", ret);
145 iwl_force_scan_end(priv);
147 IWL_DEBUG_SCAN(priv, "Successfully send scan abort\n");
151 * iwl_scan_cancel - Cancel any currently executing HW scan
153 int iwl_scan_cancel(struct iwl_priv *priv)
155 IWL_DEBUG_SCAN(priv, "Queuing abort scan\n");
156 queue_work(priv->workqueue, &priv->abort_scan);
161 * iwl_scan_cancel_timeout - Cancel any currently executing HW scan
162 * @ms: amount of time to wait (in milliseconds) for scan to abort
165 int iwl_scan_cancel_timeout(struct iwl_priv *priv, unsigned long ms)
167 unsigned long timeout = jiffies + msecs_to_jiffies(ms);
169 lockdep_assert_held(&priv->mutex);
171 IWL_DEBUG_SCAN(priv, "Scan cancel timeout\n");
173 iwl_do_scan_abort(priv);
175 while (time_before_eq(jiffies, timeout)) {
176 if (!test_bit(STATUS_SCAN_HW, &priv->status))
181 return test_bit(STATUS_SCAN_HW, &priv->status);
184 /* Service response to REPLY_SCAN_CMD (0x80) */
185 static void iwl_rx_reply_scan(struct iwl_priv *priv,
186 struct iwl_rx_mem_buffer *rxb)
188 #ifdef CONFIG_IWLWIFI_DEBUG
189 struct iwl_rx_packet *pkt = rxb_addr(rxb);
190 struct iwl_scanreq_notification *notif =
191 (struct iwl_scanreq_notification *)pkt->u.raw;
193 IWL_DEBUG_SCAN(priv, "Scan request status = 0x%x\n", notif->status);
197 /* Service SCAN_START_NOTIFICATION (0x82) */
198 static void iwl_rx_scan_start_notif(struct iwl_priv *priv,
199 struct iwl_rx_mem_buffer *rxb)
201 struct iwl_rx_packet *pkt = rxb_addr(rxb);
202 struct iwl_scanstart_notification *notif =
203 (struct iwl_scanstart_notification *)pkt->u.raw;
204 priv->scan_start_tsf = le32_to_cpu(notif->tsf_low);
205 IWL_DEBUG_SCAN(priv, "Scan start: "
207 "(TSF: 0x%08X:%08X) - %d (beacon timer %u)\n",
209 notif->band ? "bg" : "a",
210 le32_to_cpu(notif->tsf_high),
211 le32_to_cpu(notif->tsf_low),
212 notif->status, notif->beacon_timer);
215 /* Service SCAN_RESULTS_NOTIFICATION (0x83) */
216 static void iwl_rx_scan_results_notif(struct iwl_priv *priv,
217 struct iwl_rx_mem_buffer *rxb)
219 #ifdef CONFIG_IWLWIFI_DEBUG
220 struct iwl_rx_packet *pkt = rxb_addr(rxb);
221 struct iwl_scanresults_notification *notif =
222 (struct iwl_scanresults_notification *)pkt->u.raw;
224 IWL_DEBUG_SCAN(priv, "Scan ch.res: "
226 "(TSF: 0x%08X:%08X) - %d "
227 "elapsed=%lu usec\n",
229 notif->band ? "bg" : "a",
230 le32_to_cpu(notif->tsf_high),
231 le32_to_cpu(notif->tsf_low),
232 le32_to_cpu(notif->statistics[0]),
233 le32_to_cpu(notif->tsf_low) - priv->scan_start_tsf);
237 /* Service SCAN_COMPLETE_NOTIFICATION (0x84) */
238 static void iwl_rx_scan_complete_notif(struct iwl_priv *priv,
239 struct iwl_rx_mem_buffer *rxb)
241 struct iwl_rx_packet *pkt = rxb_addr(rxb);
242 struct iwl_scancomplete_notification *scan_notif = (void *)pkt->u.raw;
244 IWL_DEBUG_SCAN(priv, "Scan complete: %d channels (TSF 0x%08X:%08X) - %d\n",
245 scan_notif->scanned_channels,
247 scan_notif->tsf_high, scan_notif->status);
249 /* The HW is no longer scanning */
250 clear_bit(STATUS_SCAN_HW, &priv->status);
252 IWL_DEBUG_SCAN(priv, "Scan on %sGHz took %dms\n",
253 (priv->scan_band == IEEE80211_BAND_2GHZ) ? "2.4" : "5.2",
254 jiffies_to_msecs(jiffies - priv->scan_start));
256 queue_work(priv->workqueue, &priv->scan_completed);
258 if (priv->iw_mode != NL80211_IFTYPE_ADHOC &&
259 iwl_advanced_bt_coexist(priv) &&
260 priv->bt_status != scan_notif->bt_status) {
261 if (scan_notif->bt_status) {
263 if (!priv->bt_ch_announce)
264 priv->bt_traffic_load =
265 IWL_BT_COEX_TRAFFIC_LOAD_HIGH;
267 * otherwise, no traffic load information provided
272 priv->bt_traffic_load =
273 IWL_BT_COEX_TRAFFIC_LOAD_NONE;
275 priv->bt_status = scan_notif->bt_status;
276 queue_work(priv->workqueue, &priv->bt_traffic_change_work);
280 void iwl_setup_rx_scan_handlers(struct iwl_priv *priv)
283 priv->rx_handlers[REPLY_SCAN_CMD] = iwl_rx_reply_scan;
284 priv->rx_handlers[SCAN_START_NOTIFICATION] = iwl_rx_scan_start_notif;
285 priv->rx_handlers[SCAN_RESULTS_NOTIFICATION] =
286 iwl_rx_scan_results_notif;
287 priv->rx_handlers[SCAN_COMPLETE_NOTIFICATION] =
288 iwl_rx_scan_complete_notif;
291 inline u16 iwl_get_active_dwell_time(struct iwl_priv *priv,
292 enum ieee80211_band band,
295 if (band == IEEE80211_BAND_5GHZ)
296 return IWL_ACTIVE_DWELL_TIME_52 +
297 IWL_ACTIVE_DWELL_FACTOR_52GHZ * (n_probes + 1);
299 return IWL_ACTIVE_DWELL_TIME_24 +
300 IWL_ACTIVE_DWELL_FACTOR_24GHZ * (n_probes + 1);
303 u16 iwl_get_passive_dwell_time(struct iwl_priv *priv,
304 enum ieee80211_band band,
305 struct ieee80211_vif *vif)
307 struct iwl_rxon_context *ctx;
308 u16 passive = (band == IEEE80211_BAND_2GHZ) ?
309 IWL_PASSIVE_DWELL_BASE + IWL_PASSIVE_DWELL_TIME_24 :
310 IWL_PASSIVE_DWELL_BASE + IWL_PASSIVE_DWELL_TIME_52;
312 if (iwl_is_any_associated(priv)) {
314 * If we're associated, we clamp the maximum passive
315 * dwell time to be 98% of the smallest beacon interval
316 * (minus 2 * channel tune time)
318 for_each_context(priv, ctx) {
321 if (!iwl_is_associated_ctx(ctx))
323 value = ctx->vif ? ctx->vif->bss_conf.beacon_int : 0;
324 if ((value > IWL_PASSIVE_DWELL_BASE) || !value)
325 value = IWL_PASSIVE_DWELL_BASE;
326 value = (value * 98) / 100 - IWL_CHANNEL_TUNE_TIME * 2;
327 passive = min(value, passive);
334 void iwl_init_scan_params(struct iwl_priv *priv)
336 u8 ant_idx = fls(priv->hw_params.valid_tx_ant) - 1;
337 if (!priv->scan_tx_ant[IEEE80211_BAND_5GHZ])
338 priv->scan_tx_ant[IEEE80211_BAND_5GHZ] = ant_idx;
339 if (!priv->scan_tx_ant[IEEE80211_BAND_2GHZ])
340 priv->scan_tx_ant[IEEE80211_BAND_2GHZ] = ant_idx;
343 int __must_check iwl_scan_initiate(struct iwl_priv *priv,
344 struct ieee80211_vif *vif,
345 enum iwl_scan_type scan_type,
346 enum ieee80211_band band)
350 lockdep_assert_held(&priv->mutex);
352 if (WARN_ON(!priv->cfg->ops->utils->request_scan))
355 cancel_delayed_work(&priv->scan_check);
357 if (!iwl_is_ready_rf(priv)) {
358 IWL_WARN(priv, "Request scan called when driver not ready.\n");
362 if (test_bit(STATUS_SCAN_HW, &priv->status)) {
364 "Multiple concurrent scan requests in parallel.\n");
368 if (test_bit(STATUS_SCAN_ABORTING, &priv->status)) {
369 IWL_DEBUG_SCAN(priv, "Scan request while abort pending.\n");
373 IWL_DEBUG_SCAN(priv, "Starting %sscan...\n",
374 scan_type == IWL_SCAN_NORMAL ? "" :
375 scan_type == IWL_SCAN_OFFCH_TX ? "offchan TX " :
378 set_bit(STATUS_SCANNING, &priv->status);
379 priv->scan_type = scan_type;
380 priv->scan_start = jiffies;
381 priv->scan_band = band;
383 ret = priv->cfg->ops->utils->request_scan(priv, vif);
385 clear_bit(STATUS_SCANNING, &priv->status);
386 priv->scan_type = IWL_SCAN_NORMAL;
390 queue_delayed_work(priv->workqueue, &priv->scan_check,
391 IWL_SCAN_CHECK_WATCHDOG);
396 int iwl_mac_hw_scan(struct ieee80211_hw *hw,
397 struct ieee80211_vif *vif,
398 struct cfg80211_scan_request *req)
400 struct iwl_priv *priv = hw->priv;
403 IWL_DEBUG_MAC80211(priv, "enter\n");
405 if (req->n_channels == 0)
408 mutex_lock(&priv->mutex);
410 if (test_bit(STATUS_SCANNING, &priv->status) &&
411 priv->scan_type != IWL_SCAN_NORMAL) {
412 IWL_DEBUG_SCAN(priv, "Scan already in progress.\n");
417 /* mac80211 will only ask for one band at a time */
418 priv->scan_request = req;
419 priv->scan_vif = vif;
422 * If an internal scan is in progress, just set
423 * up the scan_request as per above.
425 if (priv->scan_type != IWL_SCAN_NORMAL) {
426 IWL_DEBUG_SCAN(priv, "SCAN request during internal scan\n");
429 ret = iwl_scan_initiate(priv, vif, IWL_SCAN_NORMAL,
430 req->channels[0]->band);
432 IWL_DEBUG_MAC80211(priv, "leave\n");
435 mutex_unlock(&priv->mutex);
441 * internal short scan, this function should only been called while associated.
442 * It will reset and tune the radio to prevent possible RF related problem
444 void iwl_internal_short_hw_scan(struct iwl_priv *priv)
446 queue_work(priv->workqueue, &priv->start_internal_scan);
449 static void iwl_bg_start_internal_scan(struct work_struct *work)
451 struct iwl_priv *priv =
452 container_of(work, struct iwl_priv, start_internal_scan);
454 IWL_DEBUG_SCAN(priv, "Start internal scan\n");
456 mutex_lock(&priv->mutex);
458 if (priv->scan_type == IWL_SCAN_RADIO_RESET) {
459 IWL_DEBUG_SCAN(priv, "Internal scan already in progress\n");
463 if (test_bit(STATUS_SCANNING, &priv->status)) {
464 IWL_DEBUG_SCAN(priv, "Scan already in progress.\n");
468 if (iwl_scan_initiate(priv, NULL, IWL_SCAN_RADIO_RESET, priv->band))
469 IWL_DEBUG_SCAN(priv, "failed to start internal short scan\n");
471 mutex_unlock(&priv->mutex);
474 static void iwl_bg_scan_check(struct work_struct *data)
476 struct iwl_priv *priv =
477 container_of(data, struct iwl_priv, scan_check.work);
479 IWL_DEBUG_SCAN(priv, "Scan check work\n");
481 /* Since we are here firmware does not finish scan and
482 * most likely is in bad shape, so we don't bother to
483 * send abort command, just force scan complete to mac80211 */
484 mutex_lock(&priv->mutex);
485 iwl_force_scan_end(priv);
486 mutex_unlock(&priv->mutex);
490 * iwl_fill_probe_req - fill in all required fields and IE for probe request
493 u16 iwl_fill_probe_req(struct iwl_priv *priv, struct ieee80211_mgmt *frame,
494 const u8 *ta, const u8 *ies, int ie_len, int left)
499 /* Make sure there is enough space for the probe request,
500 * two mandatory IEs and the data */
505 frame->frame_control = cpu_to_le16(IEEE80211_STYPE_PROBE_REQ);
506 memcpy(frame->da, iwl_bcast_addr, ETH_ALEN);
507 memcpy(frame->sa, ta, ETH_ALEN);
508 memcpy(frame->bssid, iwl_bcast_addr, ETH_ALEN);
514 pos = &frame->u.probe_req.variable[0];
516 /* fill in our indirect SSID IE */
520 *pos++ = WLAN_EID_SSID;
525 if (WARN_ON(left < ie_len))
529 memcpy(pos, ies, ie_len);
536 static void iwl_bg_abort_scan(struct work_struct *work)
538 struct iwl_priv *priv = container_of(work, struct iwl_priv, abort_scan);
540 IWL_DEBUG_SCAN(priv, "Abort scan work\n");
542 /* We keep scan_check work queued in case when firmware will not
543 * report back scan completed notification */
544 mutex_lock(&priv->mutex);
545 iwl_scan_cancel_timeout(priv, 200);
546 mutex_unlock(&priv->mutex);
549 static void iwl_bg_scan_completed(struct work_struct *work)
551 struct iwl_priv *priv =
552 container_of(work, struct iwl_priv, scan_completed);
555 IWL_DEBUG_SCAN(priv, "Completed scan.\n");
557 cancel_delayed_work(&priv->scan_check);
559 mutex_lock(&priv->mutex);
561 aborted = test_and_clear_bit(STATUS_SCAN_ABORTING, &priv->status);
563 IWL_DEBUG_SCAN(priv, "Aborted scan completed.\n");
565 if (!test_and_clear_bit(STATUS_SCANNING, &priv->status)) {
566 IWL_DEBUG_SCAN(priv, "Scan already completed.\n");
570 if (priv->scan_type == IWL_SCAN_OFFCH_TX && priv->_agn.offchan_tx_skb) {
571 ieee80211_tx_status_irqsafe(priv->hw,
572 priv->_agn.offchan_tx_skb);
573 priv->_agn.offchan_tx_skb = NULL;
576 if (priv->scan_type != IWL_SCAN_NORMAL && !aborted) {
579 /* Check if mac80211 requested scan during our internal scan */
580 if (priv->scan_request == NULL)
583 /* If so request a new scan */
584 err = iwl_scan_initiate(priv, priv->scan_vif, IWL_SCAN_NORMAL,
585 priv->scan_request->channels[0]->band);
588 "failed to initiate pending scan: %d\n", err);
597 iwl_complete_scan(priv, aborted);
600 /* Can we still talk to firmware ? */
601 if (!iwl_is_ready_rf(priv))
604 iwlagn_post_scan(priv);
607 mutex_unlock(&priv->mutex);
610 void iwl_setup_scan_deferred_work(struct iwl_priv *priv)
612 INIT_WORK(&priv->scan_completed, iwl_bg_scan_completed);
613 INIT_WORK(&priv->abort_scan, iwl_bg_abort_scan);
614 INIT_WORK(&priv->start_internal_scan, iwl_bg_start_internal_scan);
615 INIT_DELAYED_WORK(&priv->scan_check, iwl_bg_scan_check);
618 void iwl_cancel_scan_deferred_work(struct iwl_priv *priv)
620 cancel_work_sync(&priv->start_internal_scan);
621 cancel_work_sync(&priv->abort_scan);
622 cancel_work_sync(&priv->scan_completed);
624 if (cancel_delayed_work_sync(&priv->scan_check)) {
625 mutex_lock(&priv->mutex);
626 iwl_force_scan_end(priv);
627 mutex_unlock(&priv->mutex);