OSDN Git Service

iwlagn: update bt status upon scan complete
[uclinux-h8/linux.git] / drivers / net / wireless / iwlwifi / iwl-scan.c
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
57
58
59 /**
60  * iwl_scan_cancel - Cancel any currently executing HW scan
61  *
62  * NOTE: priv->mutex is not required before calling this function
63  */
64 int iwl_scan_cancel(struct iwl_priv *priv)
65 {
66         if (!test_bit(STATUS_SCAN_HW, &priv->status)) {
67                 clear_bit(STATUS_SCANNING, &priv->status);
68                 return 0;
69         }
70
71         if (test_bit(STATUS_SCANNING, &priv->status)) {
72                 if (!test_and_set_bit(STATUS_SCAN_ABORTING, &priv->status)) {
73                         IWL_DEBUG_SCAN(priv, "Queuing scan abort.\n");
74                         queue_work(priv->workqueue, &priv->abort_scan);
75
76                 } else
77                         IWL_DEBUG_SCAN(priv, "Scan abort already in progress.\n");
78
79                 return test_bit(STATUS_SCANNING, &priv->status);
80         }
81
82         return 0;
83 }
84 EXPORT_SYMBOL(iwl_scan_cancel);
85 /**
86  * iwl_scan_cancel_timeout - Cancel any currently executing HW scan
87  * @ms: amount of time to wait (in milliseconds) for scan to abort
88  *
89  * NOTE: priv->mutex must be held before calling this function
90  */
91 int iwl_scan_cancel_timeout(struct iwl_priv *priv, unsigned long ms)
92 {
93         unsigned long now = jiffies;
94         int ret;
95
96         ret = iwl_scan_cancel(priv);
97         if (ret && ms) {
98                 mutex_unlock(&priv->mutex);
99                 while (!time_after(jiffies, now + msecs_to_jiffies(ms)) &&
100                                 test_bit(STATUS_SCANNING, &priv->status))
101                         msleep(1);
102                 mutex_lock(&priv->mutex);
103
104                 return test_bit(STATUS_SCANNING, &priv->status);
105         }
106
107         return ret;
108 }
109 EXPORT_SYMBOL(iwl_scan_cancel_timeout);
110
111 static int iwl_send_scan_abort(struct iwl_priv *priv)
112 {
113         int ret = 0;
114         struct iwl_rx_packet *pkt;
115         struct iwl_host_cmd cmd = {
116                 .id = REPLY_SCAN_ABORT_CMD,
117                 .flags = CMD_WANT_SKB,
118         };
119
120         /* If there isn't a scan actively going on in the hardware
121          * then we are in between scan bands and not actually
122          * actively scanning, so don't send the abort command */
123         if (!test_bit(STATUS_SCAN_HW, &priv->status)) {
124                 clear_bit(STATUS_SCAN_ABORTING, &priv->status);
125                 return 0;
126         }
127
128         ret = iwl_send_cmd_sync(priv, &cmd);
129         if (ret) {
130                 clear_bit(STATUS_SCAN_ABORTING, &priv->status);
131                 return ret;
132         }
133
134         pkt = (struct iwl_rx_packet *)cmd.reply_page;
135         if (pkt->u.status != CAN_ABORT_STATUS) {
136                 /* The scan abort will return 1 for success or
137                  * 2 for "failure".  A failure condition can be
138                  * due to simply not being in an active scan which
139                  * can occur if we send the scan abort before we
140                  * the microcode has notified us that a scan is
141                  * completed. */
142                 IWL_DEBUG_INFO(priv, "SCAN_ABORT returned %d.\n", pkt->u.status);
143                 clear_bit(STATUS_SCAN_ABORTING, &priv->status);
144                 clear_bit(STATUS_SCAN_HW, &priv->status);
145         }
146
147         iwl_free_pages(priv, cmd.reply_page);
148
149         return ret;
150 }
151
152 /* Service response to REPLY_SCAN_CMD (0x80) */
153 static void iwl_rx_reply_scan(struct iwl_priv *priv,
154                               struct iwl_rx_mem_buffer *rxb)
155 {
156 #ifdef CONFIG_IWLWIFI_DEBUG
157         struct iwl_rx_packet *pkt = rxb_addr(rxb);
158         struct iwl_scanreq_notification *notif =
159             (struct iwl_scanreq_notification *)pkt->u.raw;
160
161         IWL_DEBUG_RX(priv, "Scan request status = 0x%x\n", notif->status);
162 #endif
163 }
164
165 /* Service SCAN_START_NOTIFICATION (0x82) */
166 static void iwl_rx_scan_start_notif(struct iwl_priv *priv,
167                                     struct iwl_rx_mem_buffer *rxb)
168 {
169         struct iwl_rx_packet *pkt = rxb_addr(rxb);
170         struct iwl_scanstart_notification *notif =
171             (struct iwl_scanstart_notification *)pkt->u.raw;
172         priv->scan_start_tsf = le32_to_cpu(notif->tsf_low);
173         IWL_DEBUG_SCAN(priv, "Scan start: "
174                        "%d [802.11%s] "
175                        "(TSF: 0x%08X:%08X) - %d (beacon timer %u)\n",
176                        notif->channel,
177                        notif->band ? "bg" : "a",
178                        le32_to_cpu(notif->tsf_high),
179                        le32_to_cpu(notif->tsf_low),
180                        notif->status, notif->beacon_timer);
181 }
182
183 /* Service SCAN_RESULTS_NOTIFICATION (0x83) */
184 static void iwl_rx_scan_results_notif(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_scanresults_notification *notif =
190             (struct iwl_scanresults_notification *)pkt->u.raw;
191
192         IWL_DEBUG_SCAN(priv, "Scan ch.res: "
193                        "%d [802.11%s] "
194                        "(TSF: 0x%08X:%08X) - %d "
195                        "elapsed=%lu usec\n",
196                        notif->channel,
197                        notif->band ? "bg" : "a",
198                        le32_to_cpu(notif->tsf_high),
199                        le32_to_cpu(notif->tsf_low),
200                        le32_to_cpu(notif->statistics[0]),
201                        le32_to_cpu(notif->tsf_low) - priv->scan_start_tsf);
202 #endif
203 }
204
205 /* Service SCAN_COMPLETE_NOTIFICATION (0x84) */
206 static void iwl_rx_scan_complete_notif(struct iwl_priv *priv,
207                                        struct iwl_rx_mem_buffer *rxb)
208 {
209 #ifdef CONFIG_IWLWIFI_DEBUG
210         struct iwl_rx_packet *pkt = rxb_addr(rxb);
211         struct iwl_scancomplete_notification *scan_notif = (void *)pkt->u.raw;
212
213         IWL_DEBUG_SCAN(priv, "Scan complete: %d channels (TSF 0x%08X:%08X) - %d\n",
214                        scan_notif->scanned_channels,
215                        scan_notif->tsf_low,
216                        scan_notif->tsf_high, scan_notif->status);
217 #endif
218
219         /* The HW is no longer scanning */
220         clear_bit(STATUS_SCAN_HW, &priv->status);
221
222         IWL_DEBUG_INFO(priv, "Scan on %sGHz took %dms\n",
223                        (priv->scan_band == IEEE80211_BAND_2GHZ) ? "2.4" : "5.2",
224                        jiffies_to_msecs(elapsed_jiffies
225                                         (priv->scan_start, jiffies)));
226
227         /*
228          * If a request to abort was given, or the scan did not succeed
229          * then we reset the scan state machine and terminate,
230          * re-queuing another scan if one has been requested
231          */
232         if (test_and_clear_bit(STATUS_SCAN_ABORTING, &priv->status))
233                 IWL_DEBUG_INFO(priv, "Aborted scan completed.\n");
234
235         IWL_DEBUG_INFO(priv, "Setting scan to off\n");
236
237         clear_bit(STATUS_SCANNING, &priv->status);
238
239         if (priv->iw_mode != NL80211_IFTYPE_ADHOC &&
240             priv->cfg->advanced_bt_coexist && priv->bt_status !=
241             scan_notif->bt_status) {
242                 if (scan_notif->bt_status) {
243                         /* BT on */
244                         if (!priv->bt_ch_announce)
245                                 priv->bt_traffic_load =
246                                         IWL_BT_COEX_TRAFFIC_LOAD_HIGH;
247                         /*
248                          * otherwise, no traffic load information provided
249                          * no changes made
250                          */
251                 } else {
252                         /* BT off */
253                         priv->bt_traffic_load =
254                                 IWL_BT_COEX_TRAFFIC_LOAD_NONE;
255                 }
256                 priv->bt_status = scan_notif->bt_status;
257                 queue_work(priv->workqueue, &priv->bt_traffic_change_work);
258         }
259         queue_work(priv->workqueue, &priv->scan_completed);
260 }
261
262 void iwl_setup_rx_scan_handlers(struct iwl_priv *priv)
263 {
264         /* scan handlers */
265         priv->rx_handlers[REPLY_SCAN_CMD] = iwl_rx_reply_scan;
266         priv->rx_handlers[SCAN_START_NOTIFICATION] = iwl_rx_scan_start_notif;
267         priv->rx_handlers[SCAN_RESULTS_NOTIFICATION] =
268                                         iwl_rx_scan_results_notif;
269         priv->rx_handlers[SCAN_COMPLETE_NOTIFICATION] =
270                                         iwl_rx_scan_complete_notif;
271 }
272 EXPORT_SYMBOL(iwl_setup_rx_scan_handlers);
273
274 inline u16 iwl_get_active_dwell_time(struct iwl_priv *priv,
275                                      enum ieee80211_band band,
276                                      u8 n_probes)
277 {
278         if (band == IEEE80211_BAND_5GHZ)
279                 return IWL_ACTIVE_DWELL_TIME_52 +
280                         IWL_ACTIVE_DWELL_FACTOR_52GHZ * (n_probes + 1);
281         else
282                 return IWL_ACTIVE_DWELL_TIME_24 +
283                         IWL_ACTIVE_DWELL_FACTOR_24GHZ * (n_probes + 1);
284 }
285 EXPORT_SYMBOL(iwl_get_active_dwell_time);
286
287 u16 iwl_get_passive_dwell_time(struct iwl_priv *priv,
288                                enum ieee80211_band band,
289                                struct ieee80211_vif *vif)
290 {
291         u16 passive = (band == IEEE80211_BAND_2GHZ) ?
292             IWL_PASSIVE_DWELL_BASE + IWL_PASSIVE_DWELL_TIME_24 :
293             IWL_PASSIVE_DWELL_BASE + IWL_PASSIVE_DWELL_TIME_52;
294
295         if (iwl_is_associated(priv)) {
296                 /* If we're associated, we clamp the maximum passive
297                  * dwell time to be 98% of the beacon interval (minus
298                  * 2 * channel tune time) */
299                 passive = vif ? vif->bss_conf.beacon_int : 0;
300                 if ((passive > IWL_PASSIVE_DWELL_BASE) || !passive)
301                         passive = IWL_PASSIVE_DWELL_BASE;
302                 passive = (passive * 98) / 100 - IWL_CHANNEL_TUNE_TIME * 2;
303         }
304
305         return passive;
306 }
307 EXPORT_SYMBOL(iwl_get_passive_dwell_time);
308
309 void iwl_init_scan_params(struct iwl_priv *priv)
310 {
311         u8 ant_idx = fls(priv->hw_params.valid_tx_ant) - 1;
312         if (!priv->scan_tx_ant[IEEE80211_BAND_5GHZ])
313                 priv->scan_tx_ant[IEEE80211_BAND_5GHZ] = ant_idx;
314         if (!priv->scan_tx_ant[IEEE80211_BAND_2GHZ])
315                 priv->scan_tx_ant[IEEE80211_BAND_2GHZ] = ant_idx;
316 }
317 EXPORT_SYMBOL(iwl_init_scan_params);
318
319 static int iwl_scan_initiate(struct iwl_priv *priv, struct ieee80211_vif *vif)
320 {
321         lockdep_assert_held(&priv->mutex);
322
323         IWL_DEBUG_INFO(priv, "Starting scan...\n");
324         set_bit(STATUS_SCANNING, &priv->status);
325         priv->is_internal_short_scan = false;
326         priv->scan_start = jiffies;
327
328         if (WARN_ON(!priv->cfg->ops->utils->request_scan))
329                 return -EOPNOTSUPP;
330
331         priv->cfg->ops->utils->request_scan(priv, vif);
332
333         return 0;
334 }
335
336 int iwl_mac_hw_scan(struct ieee80211_hw *hw,
337                     struct ieee80211_vif *vif,
338                     struct cfg80211_scan_request *req)
339 {
340         struct iwl_priv *priv = hw->priv;
341         int ret;
342
343         IWL_DEBUG_MAC80211(priv, "enter\n");
344
345         if (req->n_channels == 0)
346                 return -EINVAL;
347
348         mutex_lock(&priv->mutex);
349
350         if (!iwl_is_ready_rf(priv)) {
351                 ret = -EIO;
352                 IWL_DEBUG_MAC80211(priv, "leave - not ready or exit pending\n");
353                 goto out_unlock;
354         }
355
356         if (test_bit(STATUS_SCANNING, &priv->status) &&
357             !priv->is_internal_short_scan) {
358                 IWL_DEBUG_SCAN(priv, "Scan already in progress.\n");
359                 ret = -EAGAIN;
360                 goto out_unlock;
361         }
362
363         if (test_bit(STATUS_SCAN_ABORTING, &priv->status)) {
364                 IWL_DEBUG_SCAN(priv, "Scan request while abort pending\n");
365                 ret = -EAGAIN;
366                 goto out_unlock;
367         }
368
369         /* mac80211 will only ask for one band at a time */
370         priv->scan_band = req->channels[0]->band;
371         priv->scan_request = req;
372         priv->scan_vif = vif;
373
374         /*
375          * If an internal scan is in progress, just set
376          * up the scan_request as per above.
377          */
378         if (priv->is_internal_short_scan)
379                 ret = 0;
380         else
381                 ret = iwl_scan_initiate(priv, vif);
382
383         IWL_DEBUG_MAC80211(priv, "leave\n");
384
385 out_unlock:
386         mutex_unlock(&priv->mutex);
387
388         return ret;
389 }
390 EXPORT_SYMBOL(iwl_mac_hw_scan);
391
392 /*
393  * internal short scan, this function should only been called while associated.
394  * It will reset and tune the radio to prevent possible RF related problem
395  */
396 void iwl_internal_short_hw_scan(struct iwl_priv *priv)
397 {
398         queue_work(priv->workqueue, &priv->start_internal_scan);
399 }
400
401 static void iwl_bg_start_internal_scan(struct work_struct *work)
402 {
403         struct iwl_priv *priv =
404                 container_of(work, struct iwl_priv, start_internal_scan);
405
406         mutex_lock(&priv->mutex);
407
408         if (priv->is_internal_short_scan == true) {
409                 IWL_DEBUG_SCAN(priv, "Internal scan already in progress\n");
410                 goto unlock;
411         }
412
413         if (!iwl_is_ready_rf(priv)) {
414                 IWL_DEBUG_SCAN(priv, "not ready or exit pending\n");
415                 goto unlock;
416         }
417
418         if (test_bit(STATUS_SCANNING, &priv->status)) {
419                 IWL_DEBUG_SCAN(priv, "Scan already in progress.\n");
420                 goto unlock;
421         }
422
423         if (test_bit(STATUS_SCAN_ABORTING, &priv->status)) {
424                 IWL_DEBUG_SCAN(priv, "Scan request while abort pending\n");
425                 goto unlock;
426         }
427
428         priv->scan_band = priv->band;
429
430         IWL_DEBUG_SCAN(priv, "Start internal short scan...\n");
431         set_bit(STATUS_SCANNING, &priv->status);
432         priv->is_internal_short_scan = true;
433
434         if (WARN_ON(!priv->cfg->ops->utils->request_scan))
435                 goto unlock;
436
437         priv->cfg->ops->utils->request_scan(priv, NULL);
438  unlock:
439         mutex_unlock(&priv->mutex);
440 }
441
442 static void iwl_bg_scan_check(struct work_struct *data)
443 {
444         struct iwl_priv *priv =
445             container_of(data, struct iwl_priv, scan_check.work);
446
447         if (test_bit(STATUS_EXIT_PENDING, &priv->status))
448                 return;
449
450         mutex_lock(&priv->mutex);
451         if (test_bit(STATUS_SCANNING, &priv->status) &&
452             !test_bit(STATUS_SCAN_ABORTING, &priv->status)) {
453                 IWL_DEBUG_SCAN(priv, "Scan completion watchdog (%dms)\n",
454                                jiffies_to_msecs(IWL_SCAN_CHECK_WATCHDOG));
455
456                 if (!test_bit(STATUS_EXIT_PENDING, &priv->status))
457                         iwl_send_scan_abort(priv);
458         }
459         mutex_unlock(&priv->mutex);
460 }
461
462 /**
463  * iwl_fill_probe_req - fill in all required fields and IE for probe request
464  */
465
466 u16 iwl_fill_probe_req(struct iwl_priv *priv, struct ieee80211_mgmt *frame,
467                        const u8 *ta, const u8 *ies, int ie_len, int left)
468 {
469         int len = 0;
470         u8 *pos = NULL;
471
472         /* Make sure there is enough space for the probe request,
473          * two mandatory IEs and the data */
474         left -= 24;
475         if (left < 0)
476                 return 0;
477
478         frame->frame_control = cpu_to_le16(IEEE80211_STYPE_PROBE_REQ);
479         memcpy(frame->da, iwl_bcast_addr, ETH_ALEN);
480         memcpy(frame->sa, ta, ETH_ALEN);
481         memcpy(frame->bssid, iwl_bcast_addr, ETH_ALEN);
482         frame->seq_ctrl = 0;
483
484         len += 24;
485
486         /* ...next IE... */
487         pos = &frame->u.probe_req.variable[0];
488
489         /* fill in our indirect SSID IE */
490         left -= 2;
491         if (left < 0)
492                 return 0;
493         *pos++ = WLAN_EID_SSID;
494         *pos++ = 0;
495
496         len += 2;
497
498         if (WARN_ON(left < ie_len))
499                 return len;
500
501         if (ies && ie_len) {
502                 memcpy(pos, ies, ie_len);
503                 len += ie_len;
504         }
505
506         return (u16)len;
507 }
508 EXPORT_SYMBOL(iwl_fill_probe_req);
509
510 static void iwl_bg_abort_scan(struct work_struct *work)
511 {
512         struct iwl_priv *priv = container_of(work, struct iwl_priv, abort_scan);
513
514         if (!test_bit(STATUS_READY, &priv->status) ||
515             !test_bit(STATUS_GEO_CONFIGURED, &priv->status))
516                 return;
517
518         cancel_delayed_work(&priv->scan_check);
519
520         mutex_lock(&priv->mutex);
521         if (test_bit(STATUS_SCAN_ABORTING, &priv->status))
522                 iwl_send_scan_abort(priv);
523         mutex_unlock(&priv->mutex);
524 }
525
526 static void iwl_bg_scan_completed(struct work_struct *work)
527 {
528         struct iwl_priv *priv =
529             container_of(work, struct iwl_priv, scan_completed);
530         bool internal = false;
531         bool scan_completed = false;
532
533         IWL_DEBUG_SCAN(priv, "SCAN complete scan\n");
534
535         cancel_delayed_work(&priv->scan_check);
536
537         mutex_lock(&priv->mutex);
538         if (priv->is_internal_short_scan) {
539                 priv->is_internal_short_scan = false;
540                 IWL_DEBUG_SCAN(priv, "internal short scan completed\n");
541                 internal = true;
542         } else if (priv->scan_request) {
543                 scan_completed = true;
544                 priv->scan_request = NULL;
545                 priv->scan_vif = NULL;
546         }
547
548         if (test_bit(STATUS_EXIT_PENDING, &priv->status))
549                 goto out;
550
551         if (internal && priv->scan_request)
552                 iwl_scan_initiate(priv, priv->scan_vif);
553
554         /* Since setting the TXPOWER may have been deferred while
555          * performing the scan, fire one off */
556         iwl_set_tx_power(priv, priv->tx_power_user_lmt, true);
557
558         /*
559          * Since setting the RXON may have been deferred while
560          * performing the scan, fire one off if needed
561          */
562         if (memcmp(&priv->active_rxon,
563                    &priv->staging_rxon, sizeof(priv->staging_rxon)))
564                 iwlcore_commit_rxon(priv);
565
566  out:
567         mutex_unlock(&priv->mutex);
568
569         /*
570          * Do not hold mutex here since this will cause mac80211 to call
571          * into driver again into functions that will attempt to take
572          * mutex.
573          */
574         if (scan_completed)
575                 ieee80211_scan_completed(priv->hw, false);
576 }
577
578 void iwl_setup_scan_deferred_work(struct iwl_priv *priv)
579 {
580         INIT_WORK(&priv->scan_completed, iwl_bg_scan_completed);
581         INIT_WORK(&priv->abort_scan, iwl_bg_abort_scan);
582         INIT_WORK(&priv->start_internal_scan, iwl_bg_start_internal_scan);
583         INIT_DELAYED_WORK(&priv->scan_check, iwl_bg_scan_check);
584 }
585 EXPORT_SYMBOL(iwl_setup_scan_deferred_work);
586