2 * cfg80211 scan result handling
4 * Copyright 2008 Johannes Berg <johannes@sipsolutions.net>
6 #include <linux/kernel.h>
7 #include <linux/slab.h>
8 #include <linux/module.h>
9 #include <linux/netdevice.h>
10 #include <linux/wireless.h>
11 #include <linux/nl80211.h>
12 #include <linux/etherdevice.h>
14 #include <net/cfg80211.h>
15 #include <net/iw_handler.h>
18 #include "wext-compat.h"
20 #define IEEE80211_SCAN_RESULT_EXPIRE (15 * HZ)
22 void ___cfg80211_scan_done(struct cfg80211_registered_device
*rdev
, bool leak
)
24 struct cfg80211_scan_request
*request
;
25 struct net_device
*dev
;
26 #ifdef CONFIG_CFG80211_WEXT
27 union iwreq_data wrqu
;
30 ASSERT_RDEV_LOCK(rdev
);
32 request
= rdev
->scan_req
;
40 * This must be before sending the other events!
41 * Otherwise, wpa_supplicant gets completely confused with
44 cfg80211_sme_scan_done(dev
);
47 nl80211_send_scan_aborted(rdev
, dev
);
49 nl80211_send_scan_done(rdev
, dev
);
51 #ifdef CONFIG_CFG80211_WEXT
52 if (!request
->aborted
) {
53 memset(&wrqu
, 0, sizeof(wrqu
));
55 wireless_send_event(dev
, SIOCGIWSCAN
, &wrqu
, NULL
);
61 rdev
->scan_req
= NULL
;
64 * OK. If this is invoked with "leak" then we can't
65 * free this ... but we've cleaned it up anyway. The
66 * driver failed to call the scan_done callback, so
67 * all bets are off, it might still be trying to use
68 * the scan request or not ... if it accesses the dev
69 * in there (it shouldn't anyway) then it may crash.
75 void __cfg80211_scan_done(struct work_struct
*wk
)
77 struct cfg80211_registered_device
*rdev
;
79 rdev
= container_of(wk
, struct cfg80211_registered_device
,
82 cfg80211_lock_rdev(rdev
);
83 ___cfg80211_scan_done(rdev
, false);
84 cfg80211_unlock_rdev(rdev
);
87 void cfg80211_scan_done(struct cfg80211_scan_request
*request
, bool aborted
)
89 WARN_ON(request
!= wiphy_to_dev(request
->wiphy
)->scan_req
);
91 request
->aborted
= aborted
;
92 queue_work(cfg80211_wq
, &wiphy_to_dev(request
->wiphy
)->scan_done_wk
);
94 EXPORT_SYMBOL(cfg80211_scan_done
);
96 void __cfg80211_sched_scan_results(struct work_struct
*wk
)
98 struct cfg80211_registered_device
*rdev
;
100 rdev
= container_of(wk
, struct cfg80211_registered_device
,
101 sched_scan_results_wk
);
103 cfg80211_lock_rdev(rdev
);
105 /* we don't have sched_scan_req anymore if the scan is stopping */
106 if (rdev
->sched_scan_req
)
107 nl80211_send_sched_scan_results(rdev
,
108 rdev
->sched_scan_req
->dev
);
110 cfg80211_unlock_rdev(rdev
);
113 void cfg80211_sched_scan_results(struct wiphy
*wiphy
)
115 /* ignore if we're not scanning */
116 if (wiphy_to_dev(wiphy
)->sched_scan_req
)
117 queue_work(cfg80211_wq
,
118 &wiphy_to_dev(wiphy
)->sched_scan_results_wk
);
120 EXPORT_SYMBOL(cfg80211_sched_scan_results
);
122 void cfg80211_sched_scan_stopped(struct wiphy
*wiphy
)
124 struct cfg80211_registered_device
*rdev
= wiphy_to_dev(wiphy
);
126 cfg80211_lock_rdev(rdev
);
127 __cfg80211_stop_sched_scan(rdev
, true);
128 cfg80211_unlock_rdev(rdev
);
130 EXPORT_SYMBOL(cfg80211_sched_scan_stopped
);
132 int __cfg80211_stop_sched_scan(struct cfg80211_registered_device
*rdev
,
133 bool driver_initiated
)
136 struct net_device
*dev
;
138 ASSERT_RDEV_LOCK(rdev
);
140 if (!rdev
->sched_scan_req
)
143 dev
= rdev
->sched_scan_req
->dev
;
145 if (!driver_initiated
) {
146 err
= rdev
->ops
->sched_scan_stop(&rdev
->wiphy
, dev
);
151 nl80211_send_sched_scan(rdev
, dev
, NL80211_CMD_SCHED_SCAN_STOPPED
);
153 kfree(rdev
->sched_scan_req
);
154 rdev
->sched_scan_req
= NULL
;
159 static void bss_release(struct kref
*ref
)
161 struct cfg80211_internal_bss
*bss
;
163 bss
= container_of(ref
, struct cfg80211_internal_bss
, ref
);
164 if (bss
->pub
.free_priv
)
165 bss
->pub
.free_priv(&bss
->pub
);
167 if (bss
->beacon_ies_allocated
)
168 kfree(bss
->pub
.beacon_ies
);
169 if (bss
->proberesp_ies_allocated
)
170 kfree(bss
->pub
.proberesp_ies
);
172 BUG_ON(atomic_read(&bss
->hold
));
177 /* must hold dev->bss_lock! */
178 void cfg80211_bss_age(struct cfg80211_registered_device
*dev
,
179 unsigned long age_secs
)
181 struct cfg80211_internal_bss
*bss
;
182 unsigned long age_jiffies
= msecs_to_jiffies(age_secs
* MSEC_PER_SEC
);
184 list_for_each_entry(bss
, &dev
->bss_list
, list
) {
185 bss
->ts
-= age_jiffies
;
189 /* must hold dev->bss_lock! */
190 static void __cfg80211_unlink_bss(struct cfg80211_registered_device
*dev
,
191 struct cfg80211_internal_bss
*bss
)
193 list_del_init(&bss
->list
);
194 rb_erase(&bss
->rbn
, &dev
->bss_tree
);
195 kref_put(&bss
->ref
, bss_release
);
198 /* must hold dev->bss_lock! */
199 void cfg80211_bss_expire(struct cfg80211_registered_device
*dev
)
201 struct cfg80211_internal_bss
*bss
, *tmp
;
202 bool expired
= false;
204 list_for_each_entry_safe(bss
, tmp
, &dev
->bss_list
, list
) {
205 if (atomic_read(&bss
->hold
))
207 if (!time_after(jiffies
, bss
->ts
+ IEEE80211_SCAN_RESULT_EXPIRE
))
209 __cfg80211_unlink_bss(dev
, bss
);
214 dev
->bss_generation
++;
217 const u8
*cfg80211_find_ie(u8 eid
, const u8
*ies
, int len
)
219 while (len
> 2 && ies
[0] != eid
) {
225 if (len
< 2 + ies
[1])
229 EXPORT_SYMBOL(cfg80211_find_ie
);
231 static int cmp_ies(u8 num
, u8
*ies1
, size_t len1
, u8
*ies2
, size_t len2
)
233 const u8
*ie1
= cfg80211_find_ie(num
, ies1
, len1
);
234 const u8
*ie2
= cfg80211_find_ie(num
, ies2
, len2
);
242 r
= memcmp(ie1
+ 2, ie2
+ 2, min(ie1
[1], ie2
[1]));
243 if (r
== 0 && ie1
[1] != ie2
[1])
244 return ie2
[1] - ie1
[1];
248 static bool is_bss(struct cfg80211_bss
*a
,
250 const u8
*ssid
, size_t ssid_len
)
254 if (bssid
&& compare_ether_addr(a
->bssid
, bssid
))
260 ssidie
= cfg80211_find_ie(WLAN_EID_SSID
,
261 a
->information_elements
,
262 a
->len_information_elements
);
265 if (ssidie
[1] != ssid_len
)
267 return memcmp(ssidie
+ 2, ssid
, ssid_len
) == 0;
270 static bool is_mesh(struct cfg80211_bss
*a
,
271 const u8
*meshid
, size_t meshidlen
,
276 if (!WLAN_CAPABILITY_IS_MBSS(a
->capability
))
279 ie
= cfg80211_find_ie(WLAN_EID_MESH_ID
,
280 a
->information_elements
,
281 a
->len_information_elements
);
284 if (ie
[1] != meshidlen
)
286 if (memcmp(ie
+ 2, meshid
, meshidlen
))
289 ie
= cfg80211_find_ie(WLAN_EID_MESH_CONFIG
,
290 a
->information_elements
,
291 a
->len_information_elements
);
294 if (ie
[1] != sizeof(struct ieee80211_meshconf_ie
))
298 * Ignore mesh capability (last two bytes of the IE) when
299 * comparing since that may differ between stations taking
300 * part in the same mesh.
302 return memcmp(ie
+ 2, meshcfg
,
303 sizeof(struct ieee80211_meshconf_ie
) - 2) == 0;
306 static int cmp_bss(struct cfg80211_bss
*a
,
307 struct cfg80211_bss
*b
)
311 if (a
->channel
!= b
->channel
)
312 return b
->channel
->center_freq
- a
->channel
->center_freq
;
314 if (WLAN_CAPABILITY_IS_MBSS(a
->capability
| b
->capability
)) {
315 r
= cmp_ies(WLAN_EID_MESH_ID
,
316 a
->information_elements
,
317 a
->len_information_elements
,
318 b
->information_elements
,
319 b
->len_information_elements
);
322 return cmp_ies(WLAN_EID_MESH_CONFIG
,
323 a
->information_elements
,
324 a
->len_information_elements
,
325 b
->information_elements
,
326 b
->len_information_elements
);
329 r
= memcmp(a
->bssid
, b
->bssid
, ETH_ALEN
);
333 return cmp_ies(WLAN_EID_SSID
,
334 a
->information_elements
,
335 a
->len_information_elements
,
336 b
->information_elements
,
337 b
->len_information_elements
);
340 struct cfg80211_bss
*cfg80211_get_bss(struct wiphy
*wiphy
,
341 struct ieee80211_channel
*channel
,
343 const u8
*ssid
, size_t ssid_len
,
344 u16 capa_mask
, u16 capa_val
)
346 struct cfg80211_registered_device
*dev
= wiphy_to_dev(wiphy
);
347 struct cfg80211_internal_bss
*bss
, *res
= NULL
;
348 unsigned long now
= jiffies
;
350 spin_lock_bh(&dev
->bss_lock
);
352 list_for_each_entry(bss
, &dev
->bss_list
, list
) {
353 if ((bss
->pub
.capability
& capa_mask
) != capa_val
)
355 if (channel
&& bss
->pub
.channel
!= channel
)
357 /* Don't get expired BSS structs */
358 if (time_after(now
, bss
->ts
+ IEEE80211_SCAN_RESULT_EXPIRE
) &&
359 !atomic_read(&bss
->hold
))
361 if (is_bss(&bss
->pub
, bssid
, ssid
, ssid_len
)) {
368 spin_unlock_bh(&dev
->bss_lock
);
373 EXPORT_SYMBOL(cfg80211_get_bss
);
375 struct cfg80211_bss
*cfg80211_get_mesh(struct wiphy
*wiphy
,
376 struct ieee80211_channel
*channel
,
377 const u8
*meshid
, size_t meshidlen
,
380 struct cfg80211_registered_device
*dev
= wiphy_to_dev(wiphy
);
381 struct cfg80211_internal_bss
*bss
, *res
= NULL
;
383 spin_lock_bh(&dev
->bss_lock
);
385 list_for_each_entry(bss
, &dev
->bss_list
, list
) {
386 if (channel
&& bss
->pub
.channel
!= channel
)
388 if (is_mesh(&bss
->pub
, meshid
, meshidlen
, meshcfg
)) {
395 spin_unlock_bh(&dev
->bss_lock
);
400 EXPORT_SYMBOL(cfg80211_get_mesh
);
403 static void rb_insert_bss(struct cfg80211_registered_device
*dev
,
404 struct cfg80211_internal_bss
*bss
)
406 struct rb_node
**p
= &dev
->bss_tree
.rb_node
;
407 struct rb_node
*parent
= NULL
;
408 struct cfg80211_internal_bss
*tbss
;
413 tbss
= rb_entry(parent
, struct cfg80211_internal_bss
, rbn
);
415 cmp
= cmp_bss(&bss
->pub
, &tbss
->pub
);
418 /* will sort of leak this BSS */
428 rb_link_node(&bss
->rbn
, parent
, p
);
429 rb_insert_color(&bss
->rbn
, &dev
->bss_tree
);
432 static struct cfg80211_internal_bss
*
433 rb_find_bss(struct cfg80211_registered_device
*dev
,
434 struct cfg80211_internal_bss
*res
)
436 struct rb_node
*n
= dev
->bss_tree
.rb_node
;
437 struct cfg80211_internal_bss
*bss
;
441 bss
= rb_entry(n
, struct cfg80211_internal_bss
, rbn
);
442 r
= cmp_bss(&res
->pub
, &bss
->pub
);
455 static struct cfg80211_internal_bss
*
456 cfg80211_bss_update(struct cfg80211_registered_device
*dev
,
457 struct cfg80211_internal_bss
*res
)
459 struct cfg80211_internal_bss
*found
= NULL
;
460 const u8
*meshid
, *meshcfg
;
463 * The reference to "res" is donated to this function.
466 if (WARN_ON(!res
->pub
.channel
)) {
467 kref_put(&res
->ref
, bss_release
);
473 if (WLAN_CAPABILITY_IS_MBSS(res
->pub
.capability
)) {
474 /* must be mesh, verify */
475 meshid
= cfg80211_find_ie(WLAN_EID_MESH_ID
,
476 res
->pub
.information_elements
,
477 res
->pub
.len_information_elements
);
478 meshcfg
= cfg80211_find_ie(WLAN_EID_MESH_CONFIG
,
479 res
->pub
.information_elements
,
480 res
->pub
.len_information_elements
);
481 if (!meshid
|| !meshcfg
||
482 meshcfg
[1] != sizeof(struct ieee80211_meshconf_ie
)) {
484 kref_put(&res
->ref
, bss_release
);
489 spin_lock_bh(&dev
->bss_lock
);
491 found
= rb_find_bss(dev
, res
);
494 found
->pub
.beacon_interval
= res
->pub
.beacon_interval
;
495 found
->pub
.tsf
= res
->pub
.tsf
;
496 found
->pub
.signal
= res
->pub
.signal
;
497 found
->pub
.capability
= res
->pub
.capability
;
501 if (res
->pub
.proberesp_ies
) {
502 size_t used
= dev
->wiphy
.bss_priv_size
+ sizeof(*res
);
503 size_t ielen
= res
->pub
.len_proberesp_ies
;
505 if (found
->pub
.proberesp_ies
&&
506 !found
->proberesp_ies_allocated
&&
507 ksize(found
) >= used
+ ielen
) {
508 memcpy(found
->pub
.proberesp_ies
,
509 res
->pub
.proberesp_ies
, ielen
);
510 found
->pub
.len_proberesp_ies
= ielen
;
512 u8
*ies
= found
->pub
.proberesp_ies
;
514 if (found
->proberesp_ies_allocated
)
515 ies
= krealloc(ies
, ielen
, GFP_ATOMIC
);
517 ies
= kmalloc(ielen
, GFP_ATOMIC
);
520 memcpy(ies
, res
->pub
.proberesp_ies
,
522 found
->proberesp_ies_allocated
= true;
523 found
->pub
.proberesp_ies
= ies
;
524 found
->pub
.len_proberesp_ies
= ielen
;
528 /* Override possible earlier Beacon frame IEs */
529 found
->pub
.information_elements
=
530 found
->pub
.proberesp_ies
;
531 found
->pub
.len_information_elements
=
532 found
->pub
.len_proberesp_ies
;
534 if (res
->pub
.beacon_ies
) {
535 size_t used
= dev
->wiphy
.bss_priv_size
+ sizeof(*res
);
536 size_t ielen
= res
->pub
.len_beacon_ies
;
537 bool information_elements_is_beacon_ies
=
538 (found
->pub
.information_elements
==
539 found
->pub
.beacon_ies
);
541 if (found
->pub
.beacon_ies
&&
542 !found
->beacon_ies_allocated
&&
543 ksize(found
) >= used
+ ielen
) {
544 memcpy(found
->pub
.beacon_ies
,
545 res
->pub
.beacon_ies
, ielen
);
546 found
->pub
.len_beacon_ies
= ielen
;
548 u8
*ies
= found
->pub
.beacon_ies
;
550 if (found
->beacon_ies_allocated
)
551 ies
= krealloc(ies
, ielen
, GFP_ATOMIC
);
553 ies
= kmalloc(ielen
, GFP_ATOMIC
);
556 memcpy(ies
, res
->pub
.beacon_ies
,
558 found
->beacon_ies_allocated
= true;
559 found
->pub
.beacon_ies
= ies
;
560 found
->pub
.len_beacon_ies
= ielen
;
564 /* Override IEs if they were from a beacon before */
565 if (information_elements_is_beacon_ies
) {
566 found
->pub
.information_elements
=
567 found
->pub
.beacon_ies
;
568 found
->pub
.len_information_elements
=
569 found
->pub
.len_beacon_ies
;
573 kref_put(&res
->ref
, bss_release
);
575 /* this "consumes" the reference */
576 list_add_tail(&res
->list
, &dev
->bss_list
);
577 rb_insert_bss(dev
, res
);
581 dev
->bss_generation
++;
582 spin_unlock_bh(&dev
->bss_lock
);
584 kref_get(&found
->ref
);
589 cfg80211_inform_bss(struct wiphy
*wiphy
,
590 struct ieee80211_channel
*channel
,
592 u64 timestamp
, u16 capability
, u16 beacon_interval
,
593 const u8
*ie
, size_t ielen
,
594 s32 signal
, gfp_t gfp
)
596 struct cfg80211_internal_bss
*res
;
602 privsz
= wiphy
->bss_priv_size
;
604 if (WARN_ON(wiphy
->signal_type
== CFG80211_SIGNAL_TYPE_UNSPEC
&&
605 (signal
< 0 || signal
> 100)))
608 res
= kzalloc(sizeof(*res
) + privsz
+ ielen
, gfp
);
612 memcpy(res
->pub
.bssid
, bssid
, ETH_ALEN
);
613 res
->pub
.channel
= channel
;
614 res
->pub
.signal
= signal
;
615 res
->pub
.tsf
= timestamp
;
616 res
->pub
.beacon_interval
= beacon_interval
;
617 res
->pub
.capability
= capability
;
619 * Since we do not know here whether the IEs are from a Beacon or Probe
620 * Response frame, we need to pick one of the options and only use it
621 * with the driver that does not provide the full Beacon/Probe Response
622 * frame. Use Beacon frame pointer to avoid indicating that this should
623 * override the information_elements pointer should we have received an
624 * earlier indication of Probe Response data.
626 * The initial buffer for the IEs is allocated with the BSS entry and
627 * is located after the private area.
629 res
->pub
.beacon_ies
= (u8
*)res
+ sizeof(*res
) + privsz
;
630 memcpy(res
->pub
.beacon_ies
, ie
, ielen
);
631 res
->pub
.len_beacon_ies
= ielen
;
632 res
->pub
.information_elements
= res
->pub
.beacon_ies
;
633 res
->pub
.len_information_elements
= res
->pub
.len_beacon_ies
;
635 kref_init(&res
->ref
);
637 res
= cfg80211_bss_update(wiphy_to_dev(wiphy
), res
);
641 if (res
->pub
.capability
& WLAN_CAPABILITY_ESS
)
642 regulatory_hint_found_beacon(wiphy
, channel
, gfp
);
644 /* cfg80211_bss_update gives us a referenced result */
647 EXPORT_SYMBOL(cfg80211_inform_bss
);
649 struct cfg80211_bss
*
650 cfg80211_inform_bss_frame(struct wiphy
*wiphy
,
651 struct ieee80211_channel
*channel
,
652 struct ieee80211_mgmt
*mgmt
, size_t len
,
653 s32 signal
, gfp_t gfp
)
655 struct cfg80211_internal_bss
*res
;
656 size_t ielen
= len
- offsetof(struct ieee80211_mgmt
,
657 u
.probe_resp
.variable
);
666 if (WARN_ON(wiphy
->signal_type
== CFG80211_SIGNAL_TYPE_UNSPEC
&&
667 (signal
< 0 || signal
> 100)))
670 if (WARN_ON(len
< offsetof(struct ieee80211_mgmt
, u
.probe_resp
.variable
)))
673 privsz
= wiphy
->bss_priv_size
;
675 res
= kzalloc(sizeof(*res
) + privsz
+ ielen
, gfp
);
679 memcpy(res
->pub
.bssid
, mgmt
->bssid
, ETH_ALEN
);
680 res
->pub
.channel
= channel
;
681 res
->pub
.signal
= signal
;
682 res
->pub
.tsf
= le64_to_cpu(mgmt
->u
.probe_resp
.timestamp
);
683 res
->pub
.beacon_interval
= le16_to_cpu(mgmt
->u
.probe_resp
.beacon_int
);
684 res
->pub
.capability
= le16_to_cpu(mgmt
->u
.probe_resp
.capab_info
);
686 * The initial buffer for the IEs is allocated with the BSS entry and
687 * is located after the private area.
689 if (ieee80211_is_probe_resp(mgmt
->frame_control
)) {
690 res
->pub
.proberesp_ies
= (u8
*) res
+ sizeof(*res
) + privsz
;
691 memcpy(res
->pub
.proberesp_ies
, mgmt
->u
.probe_resp
.variable
,
693 res
->pub
.len_proberesp_ies
= ielen
;
694 res
->pub
.information_elements
= res
->pub
.proberesp_ies
;
695 res
->pub
.len_information_elements
= res
->pub
.len_proberesp_ies
;
697 res
->pub
.beacon_ies
= (u8
*) res
+ sizeof(*res
) + privsz
;
698 memcpy(res
->pub
.beacon_ies
, mgmt
->u
.beacon
.variable
, ielen
);
699 res
->pub
.len_beacon_ies
= ielen
;
700 res
->pub
.information_elements
= res
->pub
.beacon_ies
;
701 res
->pub
.len_information_elements
= res
->pub
.len_beacon_ies
;
704 kref_init(&res
->ref
);
706 res
= cfg80211_bss_update(wiphy_to_dev(wiphy
), res
);
710 if (res
->pub
.capability
& WLAN_CAPABILITY_ESS
)
711 regulatory_hint_found_beacon(wiphy
, channel
, gfp
);
713 /* cfg80211_bss_update gives us a referenced result */
716 EXPORT_SYMBOL(cfg80211_inform_bss_frame
);
718 void cfg80211_put_bss(struct cfg80211_bss
*pub
)
720 struct cfg80211_internal_bss
*bss
;
725 bss
= container_of(pub
, struct cfg80211_internal_bss
, pub
);
726 kref_put(&bss
->ref
, bss_release
);
728 EXPORT_SYMBOL(cfg80211_put_bss
);
730 void cfg80211_unlink_bss(struct wiphy
*wiphy
, struct cfg80211_bss
*pub
)
732 struct cfg80211_registered_device
*dev
= wiphy_to_dev(wiphy
);
733 struct cfg80211_internal_bss
*bss
;
738 bss
= container_of(pub
, struct cfg80211_internal_bss
, pub
);
740 spin_lock_bh(&dev
->bss_lock
);
741 if (!list_empty(&bss
->list
)) {
742 __cfg80211_unlink_bss(dev
, bss
);
743 dev
->bss_generation
++;
745 spin_unlock_bh(&dev
->bss_lock
);
747 EXPORT_SYMBOL(cfg80211_unlink_bss
);
749 #ifdef CONFIG_CFG80211_WEXT
750 int cfg80211_wext_siwscan(struct net_device
*dev
,
751 struct iw_request_info
*info
,
752 union iwreq_data
*wrqu
, char *extra
)
754 struct cfg80211_registered_device
*rdev
;
756 struct iw_scan_req
*wreq
= NULL
;
757 struct cfg80211_scan_request
*creq
= NULL
;
758 int i
, err
, n_channels
= 0;
759 enum ieee80211_band band
;
761 if (!netif_running(dev
))
764 if (wrqu
->data
.length
== sizeof(struct iw_scan_req
))
765 wreq
= (struct iw_scan_req
*)extra
;
767 rdev
= cfg80211_get_dev_from_ifindex(dev_net(dev
), dev
->ifindex
);
770 return PTR_ERR(rdev
);
772 if (rdev
->scan_req
) {
777 wiphy
= &rdev
->wiphy
;
779 /* Determine number of channels, needed to allocate creq */
780 if (wreq
&& wreq
->num_channels
)
781 n_channels
= wreq
->num_channels
;
783 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++)
784 if (wiphy
->bands
[band
])
785 n_channels
+= wiphy
->bands
[band
]->n_channels
;
788 creq
= kzalloc(sizeof(*creq
) + sizeof(struct cfg80211_ssid
) +
789 n_channels
* sizeof(void *),
798 /* SSIDs come after channels */
799 creq
->ssids
= (void *)&creq
->channels
[n_channels
];
800 creq
->n_channels
= n_channels
;
803 /* translate "Scan on frequencies" request */
805 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++) {
808 if (!wiphy
->bands
[band
])
811 for (j
= 0; j
< wiphy
->bands
[band
]->n_channels
; j
++) {
812 /* ignore disabled channels */
813 if (wiphy
->bands
[band
]->channels
[j
].flags
&
814 IEEE80211_CHAN_DISABLED
)
817 /* If we have a wireless request structure and the
818 * wireless request specifies frequencies, then search
819 * for the matching hardware channel.
821 if (wreq
&& wreq
->num_channels
) {
823 int wiphy_freq
= wiphy
->bands
[band
]->channels
[j
].center_freq
;
824 for (k
= 0; k
< wreq
->num_channels
; k
++) {
825 int wext_freq
= cfg80211_wext_freq(wiphy
, &wreq
->channel_list
[k
]);
826 if (wext_freq
== wiphy_freq
)
827 goto wext_freq_found
;
829 goto wext_freq_not_found
;
833 creq
->channels
[i
] = &wiphy
->bands
[band
]->channels
[j
];
835 wext_freq_not_found
: ;
838 /* No channels found? */
844 /* Set real number of channels specified in creq->channels[] */
845 creq
->n_channels
= i
;
847 /* translate "Scan for SSID" request */
849 if (wrqu
->data
.flags
& IW_SCAN_THIS_ESSID
) {
850 if (wreq
->essid_len
> IEEE80211_MAX_SSID_LEN
) {
854 memcpy(creq
->ssids
[0].ssid
, wreq
->essid
, wreq
->essid_len
);
855 creq
->ssids
[0].ssid_len
= wreq
->essid_len
;
857 if (wreq
->scan_type
== IW_SCAN_TYPE_PASSIVE
)
861 rdev
->scan_req
= creq
;
862 err
= rdev
->ops
->scan(wiphy
, dev
, creq
);
864 rdev
->scan_req
= NULL
;
865 /* creq will be freed below */
867 nl80211_send_scan_start(rdev
, dev
);
868 /* creq now owned by driver */
874 cfg80211_unlock_rdev(rdev
);
877 EXPORT_SYMBOL_GPL(cfg80211_wext_siwscan
);
879 static void ieee80211_scan_add_ies(struct iw_request_info
*info
,
880 struct cfg80211_bss
*bss
,
881 char **current_ev
, char *end_buf
)
883 u8
*pos
, *end
, *next
;
886 if (!bss
->information_elements
||
887 !bss
->len_information_elements
)
891 * If needed, fragment the IEs buffer (at IE boundaries) into short
892 * enough fragments to fit into IW_GENERIC_IE_MAX octet messages.
894 pos
= bss
->information_elements
;
895 end
= pos
+ bss
->len_information_elements
;
897 while (end
- pos
> IW_GENERIC_IE_MAX
) {
898 next
= pos
+ 2 + pos
[1];
899 while (next
+ 2 + next
[1] - pos
< IW_GENERIC_IE_MAX
)
900 next
= next
+ 2 + next
[1];
902 memset(&iwe
, 0, sizeof(iwe
));
904 iwe
.u
.data
.length
= next
- pos
;
905 *current_ev
= iwe_stream_add_point(info
, *current_ev
,
912 memset(&iwe
, 0, sizeof(iwe
));
914 iwe
.u
.data
.length
= end
- pos
;
915 *current_ev
= iwe_stream_add_point(info
, *current_ev
,
920 static inline unsigned int elapsed_jiffies_msecs(unsigned long start
)
922 unsigned long end
= jiffies
;
925 return jiffies_to_msecs(end
- start
);
927 return jiffies_to_msecs(end
+ (MAX_JIFFY_OFFSET
- start
) + 1);
931 ieee80211_bss(struct wiphy
*wiphy
, struct iw_request_info
*info
,
932 struct cfg80211_internal_bss
*bss
, char *current_ev
,
937 u8
*ie
= bss
->pub
.information_elements
;
938 int rem
= bss
->pub
.len_information_elements
, i
, sig
;
941 memset(&iwe
, 0, sizeof(iwe
));
943 iwe
.u
.ap_addr
.sa_family
= ARPHRD_ETHER
;
944 memcpy(iwe
.u
.ap_addr
.sa_data
, bss
->pub
.bssid
, ETH_ALEN
);
945 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
, &iwe
,
948 memset(&iwe
, 0, sizeof(iwe
));
949 iwe
.cmd
= SIOCGIWFREQ
;
950 iwe
.u
.freq
.m
= ieee80211_frequency_to_channel(bss
->pub
.channel
->center_freq
);
952 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
, &iwe
,
955 memset(&iwe
, 0, sizeof(iwe
));
956 iwe
.cmd
= SIOCGIWFREQ
;
957 iwe
.u
.freq
.m
= bss
->pub
.channel
->center_freq
;
959 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
, &iwe
,
962 if (wiphy
->signal_type
!= CFG80211_SIGNAL_TYPE_NONE
) {
963 memset(&iwe
, 0, sizeof(iwe
));
965 iwe
.u
.qual
.updated
= IW_QUAL_LEVEL_UPDATED
|
966 IW_QUAL_NOISE_INVALID
|
967 IW_QUAL_QUAL_UPDATED
;
968 switch (wiphy
->signal_type
) {
969 case CFG80211_SIGNAL_TYPE_MBM
:
970 sig
= bss
->pub
.signal
/ 100;
971 iwe
.u
.qual
.level
= sig
;
972 iwe
.u
.qual
.updated
|= IW_QUAL_DBM
;
973 if (sig
< -110) /* rather bad */
975 else if (sig
> -40) /* perfect */
977 /* will give a range of 0 .. 70 */
978 iwe
.u
.qual
.qual
= sig
+ 110;
980 case CFG80211_SIGNAL_TYPE_UNSPEC
:
981 iwe
.u
.qual
.level
= bss
->pub
.signal
;
982 /* will give range 0 .. 100 */
983 iwe
.u
.qual
.qual
= bss
->pub
.signal
;
989 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
,
990 &iwe
, IW_EV_QUAL_LEN
);
993 memset(&iwe
, 0, sizeof(iwe
));
994 iwe
.cmd
= SIOCGIWENCODE
;
995 if (bss
->pub
.capability
& WLAN_CAPABILITY_PRIVACY
)
996 iwe
.u
.data
.flags
= IW_ENCODE_ENABLED
| IW_ENCODE_NOKEY
;
998 iwe
.u
.data
.flags
= IW_ENCODE_DISABLED
;
999 iwe
.u
.data
.length
= 0;
1000 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1005 if (ie
[1] > rem
- 2)
1010 memset(&iwe
, 0, sizeof(iwe
));
1011 iwe
.cmd
= SIOCGIWESSID
;
1012 iwe
.u
.data
.length
= ie
[1];
1013 iwe
.u
.data
.flags
= 1;
1014 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1017 case WLAN_EID_MESH_ID
:
1018 memset(&iwe
, 0, sizeof(iwe
));
1019 iwe
.cmd
= SIOCGIWESSID
;
1020 iwe
.u
.data
.length
= ie
[1];
1021 iwe
.u
.data
.flags
= 1;
1022 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1025 case WLAN_EID_MESH_CONFIG
:
1027 if (ie
[1] != sizeof(struct ieee80211_meshconf_ie
))
1029 buf
= kmalloc(50, GFP_ATOMIC
);
1033 memset(&iwe
, 0, sizeof(iwe
));
1034 iwe
.cmd
= IWEVCUSTOM
;
1035 sprintf(buf
, "Mesh Network Path Selection Protocol ID: "
1037 iwe
.u
.data
.length
= strlen(buf
);
1038 current_ev
= iwe_stream_add_point(info
, current_ev
,
1041 sprintf(buf
, "Path Selection Metric ID: 0x%02X",
1043 iwe
.u
.data
.length
= strlen(buf
);
1044 current_ev
= iwe_stream_add_point(info
, current_ev
,
1047 sprintf(buf
, "Congestion Control Mode ID: 0x%02X",
1049 iwe
.u
.data
.length
= strlen(buf
);
1050 current_ev
= iwe_stream_add_point(info
, current_ev
,
1053 sprintf(buf
, "Synchronization ID: 0x%02X", cfg
[3]);
1054 iwe
.u
.data
.length
= strlen(buf
);
1055 current_ev
= iwe_stream_add_point(info
, current_ev
,
1058 sprintf(buf
, "Authentication ID: 0x%02X", cfg
[4]);
1059 iwe
.u
.data
.length
= strlen(buf
);
1060 current_ev
= iwe_stream_add_point(info
, current_ev
,
1063 sprintf(buf
, "Formation Info: 0x%02X", cfg
[5]);
1064 iwe
.u
.data
.length
= strlen(buf
);
1065 current_ev
= iwe_stream_add_point(info
, current_ev
,
1068 sprintf(buf
, "Capabilities: 0x%02X", cfg
[6]);
1069 iwe
.u
.data
.length
= strlen(buf
);
1070 current_ev
= iwe_stream_add_point(info
, current_ev
,
1075 case WLAN_EID_SUPP_RATES
:
1076 case WLAN_EID_EXT_SUPP_RATES
:
1077 /* display all supported rates in readable format */
1078 p
= current_ev
+ iwe_stream_lcp_len(info
);
1080 memset(&iwe
, 0, sizeof(iwe
));
1081 iwe
.cmd
= SIOCGIWRATE
;
1082 /* Those two flags are ignored... */
1083 iwe
.u
.bitrate
.fixed
= iwe
.u
.bitrate
.disabled
= 0;
1085 for (i
= 0; i
< ie
[1]; i
++) {
1086 iwe
.u
.bitrate
.value
=
1087 ((ie
[i
+ 2] & 0x7f) * 500000);
1088 p
= iwe_stream_add_value(info
, current_ev
, p
,
1089 end_buf
, &iwe
, IW_EV_PARAM_LEN
);
1098 if (bss
->pub
.capability
& (WLAN_CAPABILITY_ESS
| WLAN_CAPABILITY_IBSS
) ||
1100 memset(&iwe
, 0, sizeof(iwe
));
1101 iwe
.cmd
= SIOCGIWMODE
;
1103 iwe
.u
.mode
= IW_MODE_MESH
;
1104 else if (bss
->pub
.capability
& WLAN_CAPABILITY_ESS
)
1105 iwe
.u
.mode
= IW_MODE_MASTER
;
1107 iwe
.u
.mode
= IW_MODE_ADHOC
;
1108 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
,
1109 &iwe
, IW_EV_UINT_LEN
);
1112 buf
= kmalloc(30, GFP_ATOMIC
);
1114 memset(&iwe
, 0, sizeof(iwe
));
1115 iwe
.cmd
= IWEVCUSTOM
;
1116 sprintf(buf
, "tsf=%016llx", (unsigned long long)(bss
->pub
.tsf
));
1117 iwe
.u
.data
.length
= strlen(buf
);
1118 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1120 memset(&iwe
, 0, sizeof(iwe
));
1121 iwe
.cmd
= IWEVCUSTOM
;
1122 sprintf(buf
, " Last beacon: %ums ago",
1123 elapsed_jiffies_msecs(bss
->ts
));
1124 iwe
.u
.data
.length
= strlen(buf
);
1125 current_ev
= iwe_stream_add_point(info
, current_ev
,
1126 end_buf
, &iwe
, buf
);
1130 ieee80211_scan_add_ies(info
, &bss
->pub
, ¤t_ev
, end_buf
);
1136 static int ieee80211_scan_results(struct cfg80211_registered_device
*dev
,
1137 struct iw_request_info
*info
,
1138 char *buf
, size_t len
)
1140 char *current_ev
= buf
;
1141 char *end_buf
= buf
+ len
;
1142 struct cfg80211_internal_bss
*bss
;
1144 spin_lock_bh(&dev
->bss_lock
);
1145 cfg80211_bss_expire(dev
);
1147 list_for_each_entry(bss
, &dev
->bss_list
, list
) {
1148 if (buf
+ len
- current_ev
<= IW_EV_ADDR_LEN
) {
1149 spin_unlock_bh(&dev
->bss_lock
);
1152 current_ev
= ieee80211_bss(&dev
->wiphy
, info
, bss
,
1153 current_ev
, end_buf
);
1155 spin_unlock_bh(&dev
->bss_lock
);
1156 return current_ev
- buf
;
1160 int cfg80211_wext_giwscan(struct net_device
*dev
,
1161 struct iw_request_info
*info
,
1162 struct iw_point
*data
, char *extra
)
1164 struct cfg80211_registered_device
*rdev
;
1167 if (!netif_running(dev
))
1170 rdev
= cfg80211_get_dev_from_ifindex(dev_net(dev
), dev
->ifindex
);
1173 return PTR_ERR(rdev
);
1175 if (rdev
->scan_req
) {
1180 res
= ieee80211_scan_results(rdev
, info
, extra
, data
->length
);
1188 cfg80211_unlock_rdev(rdev
);
1191 EXPORT_SYMBOL_GPL(cfg80211_wext_giwscan
);