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/cfg80211-wext.h>
16 #include <net/iw_handler.h>
19 #include "wext-compat.h"
21 #define IEEE80211_SCAN_RESULT_EXPIRE (15 * HZ)
23 void ___cfg80211_scan_done(struct cfg80211_registered_device
*rdev
, bool leak
)
25 struct cfg80211_scan_request
*request
;
26 struct net_device
*dev
;
27 #ifdef CONFIG_CFG80211_WEXT
28 union iwreq_data wrqu
;
31 ASSERT_RDEV_LOCK(rdev
);
33 request
= rdev
->scan_req
;
41 * This must be before sending the other events!
42 * Otherwise, wpa_supplicant gets completely confused with
45 cfg80211_sme_scan_done(dev
);
48 nl80211_send_scan_aborted(rdev
, dev
);
50 nl80211_send_scan_done(rdev
, dev
);
52 #ifdef CONFIG_CFG80211_WEXT
53 if (!request
->aborted
) {
54 memset(&wrqu
, 0, sizeof(wrqu
));
56 wireless_send_event(dev
, SIOCGIWSCAN
, &wrqu
, NULL
);
62 rdev
->scan_req
= NULL
;
65 * OK. If this is invoked with "leak" then we can't
66 * free this ... but we've cleaned it up anyway. The
67 * driver failed to call the scan_done callback, so
68 * all bets are off, it might still be trying to use
69 * the scan request or not ... if it accesses the dev
70 * in there (it shouldn't anyway) then it may crash.
76 void __cfg80211_scan_done(struct work_struct
*wk
)
78 struct cfg80211_registered_device
*rdev
;
80 rdev
= container_of(wk
, struct cfg80211_registered_device
,
83 cfg80211_lock_rdev(rdev
);
84 ___cfg80211_scan_done(rdev
, false);
85 cfg80211_unlock_rdev(rdev
);
88 void cfg80211_scan_done(struct cfg80211_scan_request
*request
, bool aborted
)
90 WARN_ON(request
!= wiphy_to_dev(request
->wiphy
)->scan_req
);
92 request
->aborted
= aborted
;
93 queue_work(cfg80211_wq
, &wiphy_to_dev(request
->wiphy
)->scan_done_wk
);
95 EXPORT_SYMBOL(cfg80211_scan_done
);
97 void __cfg80211_sched_scan_results(struct work_struct
*wk
)
99 struct cfg80211_registered_device
*rdev
;
101 rdev
= container_of(wk
, struct cfg80211_registered_device
,
102 sched_scan_results_wk
);
104 mutex_lock(&rdev
->sched_scan_mtx
);
106 /* we don't have sched_scan_req anymore if the scan is stopping */
107 if (rdev
->sched_scan_req
)
108 nl80211_send_sched_scan_results(rdev
,
109 rdev
->sched_scan_req
->dev
);
111 mutex_unlock(&rdev
->sched_scan_mtx
);
114 void cfg80211_sched_scan_results(struct wiphy
*wiphy
)
116 /* ignore if we're not scanning */
117 if (wiphy_to_dev(wiphy
)->sched_scan_req
)
118 queue_work(cfg80211_wq
,
119 &wiphy_to_dev(wiphy
)->sched_scan_results_wk
);
121 EXPORT_SYMBOL(cfg80211_sched_scan_results
);
123 void cfg80211_sched_scan_stopped(struct wiphy
*wiphy
)
125 struct cfg80211_registered_device
*rdev
= wiphy_to_dev(wiphy
);
127 mutex_lock(&rdev
->sched_scan_mtx
);
128 __cfg80211_stop_sched_scan(rdev
, true);
129 mutex_unlock(&rdev
->sched_scan_mtx
);
131 EXPORT_SYMBOL(cfg80211_sched_scan_stopped
);
133 int __cfg80211_stop_sched_scan(struct cfg80211_registered_device
*rdev
,
134 bool driver_initiated
)
136 struct net_device
*dev
;
138 lockdep_assert_held(&rdev
->sched_scan_mtx
);
140 if (!rdev
->sched_scan_req
)
143 dev
= rdev
->sched_scan_req
->dev
;
145 if (!driver_initiated
) {
146 int 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 const u8
*cfg80211_find_vendor_ie(unsigned int oui
, u8 oui_type
,
232 const u8
*ies
, int len
)
234 struct ieee80211_vendor_ie
*ie
;
235 const u8
*pos
= ies
, *end
= ies
+ len
;
239 pos
= cfg80211_find_ie(WLAN_EID_VENDOR_SPECIFIC
, pos
,
244 if (end
- pos
< sizeof(*ie
))
247 ie
= (struct ieee80211_vendor_ie
*)pos
;
248 ie_oui
= ie
->oui
[0] << 16 | ie
->oui
[1] << 8 | ie
->oui
[2];
249 if (ie_oui
== oui
&& ie
->oui_type
== oui_type
)
256 EXPORT_SYMBOL(cfg80211_find_vendor_ie
);
258 static int cmp_ies(u8 num
, u8
*ies1
, size_t len1
, u8
*ies2
, size_t len2
)
260 const u8
*ie1
= cfg80211_find_ie(num
, ies1
, len1
);
261 const u8
*ie2
= cfg80211_find_ie(num
, ies2
, len2
);
263 /* equal if both missing */
266 /* sort missing IE before (left of) present IE */
272 /* sort by length first, then by contents */
273 if (ie1
[1] != ie2
[1])
274 return ie2
[1] - ie1
[1];
275 return memcmp(ie1
+ 2, ie2
+ 2, ie1
[1]);
278 static bool is_bss(struct cfg80211_bss
*a
,
280 const u8
*ssid
, size_t ssid_len
)
284 if (bssid
&& compare_ether_addr(a
->bssid
, bssid
))
290 ssidie
= cfg80211_find_ie(WLAN_EID_SSID
,
291 a
->information_elements
,
292 a
->len_information_elements
);
295 if (ssidie
[1] != ssid_len
)
297 return memcmp(ssidie
+ 2, ssid
, ssid_len
) == 0;
300 static bool is_mesh_bss(struct cfg80211_bss
*a
)
304 if (!WLAN_CAPABILITY_IS_STA_BSS(a
->capability
))
307 ie
= cfg80211_find_ie(WLAN_EID_MESH_ID
,
308 a
->information_elements
,
309 a
->len_information_elements
);
313 ie
= cfg80211_find_ie(WLAN_EID_MESH_CONFIG
,
314 a
->information_elements
,
315 a
->len_information_elements
);
322 static bool is_mesh(struct cfg80211_bss
*a
,
323 const u8
*meshid
, size_t meshidlen
,
328 if (!WLAN_CAPABILITY_IS_STA_BSS(a
->capability
))
331 ie
= cfg80211_find_ie(WLAN_EID_MESH_ID
,
332 a
->information_elements
,
333 a
->len_information_elements
);
336 if (ie
[1] != meshidlen
)
338 if (memcmp(ie
+ 2, meshid
, meshidlen
))
341 ie
= cfg80211_find_ie(WLAN_EID_MESH_CONFIG
,
342 a
->information_elements
,
343 a
->len_information_elements
);
346 if (ie
[1] != sizeof(struct ieee80211_meshconf_ie
))
350 * Ignore mesh capability (last two bytes of the IE) when
351 * comparing since that may differ between stations taking
352 * part in the same mesh.
354 return memcmp(ie
+ 2, meshcfg
,
355 sizeof(struct ieee80211_meshconf_ie
) - 2) == 0;
358 static int cmp_bss_core(struct cfg80211_bss
*a
,
359 struct cfg80211_bss
*b
)
363 if (a
->channel
!= b
->channel
)
364 return b
->channel
->center_freq
- a
->channel
->center_freq
;
366 if (is_mesh_bss(a
) && is_mesh_bss(b
)) {
367 r
= cmp_ies(WLAN_EID_MESH_ID
,
368 a
->information_elements
,
369 a
->len_information_elements
,
370 b
->information_elements
,
371 b
->len_information_elements
);
374 return cmp_ies(WLAN_EID_MESH_CONFIG
,
375 a
->information_elements
,
376 a
->len_information_elements
,
377 b
->information_elements
,
378 b
->len_information_elements
);
381 return memcmp(a
->bssid
, b
->bssid
, ETH_ALEN
);
384 static int cmp_bss(struct cfg80211_bss
*a
,
385 struct cfg80211_bss
*b
)
389 r
= cmp_bss_core(a
, b
);
393 return cmp_ies(WLAN_EID_SSID
,
394 a
->information_elements
,
395 a
->len_information_elements
,
396 b
->information_elements
,
397 b
->len_information_elements
);
400 static int cmp_hidden_bss(struct cfg80211_bss
*a
,
401 struct cfg80211_bss
*b
)
408 r
= cmp_bss_core(a
, b
);
412 ie1
= cfg80211_find_ie(WLAN_EID_SSID
,
413 a
->information_elements
,
414 a
->len_information_elements
);
415 ie2
= cfg80211_find_ie(WLAN_EID_SSID
,
416 b
->information_elements
,
417 b
->len_information_elements
);
419 /* Key comparator must use same algorithm in any rb-tree
420 * search function (order is important), otherwise ordering
421 * of items in the tree is broken and search gives incorrect
422 * results. This code uses same order as cmp_ies() does. */
424 /* sort missing IE before (left of) present IE */
430 /* zero-size SSID is used as an indication of the hidden bss */
434 /* sort by length first, then by contents */
435 if (ie1
[1] != ie2
[1])
436 return ie2
[1] - ie1
[1];
438 /* zeroed SSID ie is another indication of a hidden bss */
439 for (i
= 0; i
< ie2
[1]; i
++)
446 struct cfg80211_bss
*cfg80211_get_bss(struct wiphy
*wiphy
,
447 struct ieee80211_channel
*channel
,
449 const u8
*ssid
, size_t ssid_len
,
450 u16 capa_mask
, u16 capa_val
)
452 struct cfg80211_registered_device
*dev
= wiphy_to_dev(wiphy
);
453 struct cfg80211_internal_bss
*bss
, *res
= NULL
;
454 unsigned long now
= jiffies
;
456 spin_lock_bh(&dev
->bss_lock
);
458 list_for_each_entry(bss
, &dev
->bss_list
, list
) {
459 if ((bss
->pub
.capability
& capa_mask
) != capa_val
)
461 if (channel
&& bss
->pub
.channel
!= channel
)
463 /* Don't get expired BSS structs */
464 if (time_after(now
, bss
->ts
+ IEEE80211_SCAN_RESULT_EXPIRE
) &&
465 !atomic_read(&bss
->hold
))
467 if (is_bss(&bss
->pub
, bssid
, ssid
, ssid_len
)) {
474 spin_unlock_bh(&dev
->bss_lock
);
479 EXPORT_SYMBOL(cfg80211_get_bss
);
481 struct cfg80211_bss
*cfg80211_get_mesh(struct wiphy
*wiphy
,
482 struct ieee80211_channel
*channel
,
483 const u8
*meshid
, size_t meshidlen
,
486 struct cfg80211_registered_device
*dev
= wiphy_to_dev(wiphy
);
487 struct cfg80211_internal_bss
*bss
, *res
= NULL
;
489 spin_lock_bh(&dev
->bss_lock
);
491 list_for_each_entry(bss
, &dev
->bss_list
, list
) {
492 if (channel
&& bss
->pub
.channel
!= channel
)
494 if (is_mesh(&bss
->pub
, meshid
, meshidlen
, meshcfg
)) {
501 spin_unlock_bh(&dev
->bss_lock
);
506 EXPORT_SYMBOL(cfg80211_get_mesh
);
509 static void rb_insert_bss(struct cfg80211_registered_device
*dev
,
510 struct cfg80211_internal_bss
*bss
)
512 struct rb_node
**p
= &dev
->bss_tree
.rb_node
;
513 struct rb_node
*parent
= NULL
;
514 struct cfg80211_internal_bss
*tbss
;
519 tbss
= rb_entry(parent
, struct cfg80211_internal_bss
, rbn
);
521 cmp
= cmp_bss(&bss
->pub
, &tbss
->pub
);
524 /* will sort of leak this BSS */
534 rb_link_node(&bss
->rbn
, parent
, p
);
535 rb_insert_color(&bss
->rbn
, &dev
->bss_tree
);
538 static struct cfg80211_internal_bss
*
539 rb_find_bss(struct cfg80211_registered_device
*dev
,
540 struct cfg80211_internal_bss
*res
)
542 struct rb_node
*n
= dev
->bss_tree
.rb_node
;
543 struct cfg80211_internal_bss
*bss
;
547 bss
= rb_entry(n
, struct cfg80211_internal_bss
, rbn
);
548 r
= cmp_bss(&res
->pub
, &bss
->pub
);
561 static struct cfg80211_internal_bss
*
562 rb_find_hidden_bss(struct cfg80211_registered_device
*dev
,
563 struct cfg80211_internal_bss
*res
)
565 struct rb_node
*n
= dev
->bss_tree
.rb_node
;
566 struct cfg80211_internal_bss
*bss
;
570 bss
= rb_entry(n
, struct cfg80211_internal_bss
, rbn
);
571 r
= cmp_hidden_bss(&res
->pub
, &bss
->pub
);
585 copy_hidden_ies(struct cfg80211_internal_bss
*res
,
586 struct cfg80211_internal_bss
*hidden
)
588 if (unlikely(res
->pub
.beacon_ies
))
590 if (WARN_ON(!hidden
->pub
.beacon_ies
))
593 res
->pub
.beacon_ies
= kmalloc(hidden
->pub
.len_beacon_ies
, GFP_ATOMIC
);
594 if (unlikely(!res
->pub
.beacon_ies
))
597 res
->beacon_ies_allocated
= true;
598 res
->pub
.len_beacon_ies
= hidden
->pub
.len_beacon_ies
;
599 memcpy(res
->pub
.beacon_ies
, hidden
->pub
.beacon_ies
,
600 res
->pub
.len_beacon_ies
);
603 static struct cfg80211_internal_bss
*
604 cfg80211_bss_update(struct cfg80211_registered_device
*dev
,
605 struct cfg80211_internal_bss
*res
)
607 struct cfg80211_internal_bss
*found
= NULL
;
610 * The reference to "res" is donated to this function.
613 if (WARN_ON(!res
->pub
.channel
)) {
614 kref_put(&res
->ref
, bss_release
);
620 spin_lock_bh(&dev
->bss_lock
);
622 found
= rb_find_bss(dev
, res
);
625 found
->pub
.beacon_interval
= res
->pub
.beacon_interval
;
626 found
->pub
.tsf
= res
->pub
.tsf
;
627 found
->pub
.signal
= res
->pub
.signal
;
628 found
->pub
.capability
= res
->pub
.capability
;
632 if (res
->pub
.proberesp_ies
) {
633 size_t used
= dev
->wiphy
.bss_priv_size
+ sizeof(*res
);
634 size_t ielen
= res
->pub
.len_proberesp_ies
;
636 if (found
->pub
.proberesp_ies
&&
637 !found
->proberesp_ies_allocated
&&
638 ksize(found
) >= used
+ ielen
) {
639 memcpy(found
->pub
.proberesp_ies
,
640 res
->pub
.proberesp_ies
, ielen
);
641 found
->pub
.len_proberesp_ies
= ielen
;
643 u8
*ies
= found
->pub
.proberesp_ies
;
645 if (found
->proberesp_ies_allocated
)
646 ies
= krealloc(ies
, ielen
, GFP_ATOMIC
);
648 ies
= kmalloc(ielen
, GFP_ATOMIC
);
651 memcpy(ies
, res
->pub
.proberesp_ies
,
653 found
->proberesp_ies_allocated
= true;
654 found
->pub
.proberesp_ies
= ies
;
655 found
->pub
.len_proberesp_ies
= ielen
;
659 /* Override possible earlier Beacon frame IEs */
660 found
->pub
.information_elements
=
661 found
->pub
.proberesp_ies
;
662 found
->pub
.len_information_elements
=
663 found
->pub
.len_proberesp_ies
;
665 if (res
->pub
.beacon_ies
) {
666 size_t used
= dev
->wiphy
.bss_priv_size
+ sizeof(*res
);
667 size_t ielen
= res
->pub
.len_beacon_ies
;
668 bool information_elements_is_beacon_ies
=
669 (found
->pub
.information_elements
==
670 found
->pub
.beacon_ies
);
672 if (found
->pub
.beacon_ies
&&
673 !found
->beacon_ies_allocated
&&
674 ksize(found
) >= used
+ ielen
) {
675 memcpy(found
->pub
.beacon_ies
,
676 res
->pub
.beacon_ies
, ielen
);
677 found
->pub
.len_beacon_ies
= ielen
;
679 u8
*ies
= found
->pub
.beacon_ies
;
681 if (found
->beacon_ies_allocated
)
682 ies
= krealloc(ies
, ielen
, GFP_ATOMIC
);
684 ies
= kmalloc(ielen
, GFP_ATOMIC
);
687 memcpy(ies
, res
->pub
.beacon_ies
,
689 found
->beacon_ies_allocated
= true;
690 found
->pub
.beacon_ies
= ies
;
691 found
->pub
.len_beacon_ies
= ielen
;
695 /* Override IEs if they were from a beacon before */
696 if (information_elements_is_beacon_ies
) {
697 found
->pub
.information_elements
=
698 found
->pub
.beacon_ies
;
699 found
->pub
.len_information_elements
=
700 found
->pub
.len_beacon_ies
;
704 kref_put(&res
->ref
, bss_release
);
706 struct cfg80211_internal_bss
*hidden
;
708 /* First check if the beacon is a probe response from
709 * a hidden bss. If so, copy beacon ies (with nullified
710 * ssid) into the probe response bss entry (with real ssid).
711 * It is required basically for PSM implementation
712 * (probe responses do not contain tim ie) */
714 /* TODO: The code is not trying to update existing probe
715 * response bss entries when beacon ies are
716 * getting changed. */
717 hidden
= rb_find_hidden_bss(dev
, res
);
719 copy_hidden_ies(res
, hidden
);
721 /* this "consumes" the reference */
722 list_add_tail(&res
->list
, &dev
->bss_list
);
723 rb_insert_bss(dev
, res
);
727 dev
->bss_generation
++;
728 spin_unlock_bh(&dev
->bss_lock
);
730 kref_get(&found
->ref
);
735 cfg80211_inform_bss(struct wiphy
*wiphy
,
736 struct ieee80211_channel
*channel
,
737 const u8
*bssid
, u64 tsf
, u16 capability
,
738 u16 beacon_interval
, const u8
*ie
, size_t ielen
,
739 s32 signal
, gfp_t gfp
)
741 struct cfg80211_internal_bss
*res
;
747 privsz
= wiphy
->bss_priv_size
;
749 if (WARN_ON(wiphy
->signal_type
== CFG80211_SIGNAL_TYPE_UNSPEC
&&
750 (signal
< 0 || signal
> 100)))
753 res
= kzalloc(sizeof(*res
) + privsz
+ ielen
, gfp
);
757 memcpy(res
->pub
.bssid
, bssid
, ETH_ALEN
);
758 res
->pub
.channel
= channel
;
759 res
->pub
.signal
= signal
;
761 res
->pub
.beacon_interval
= beacon_interval
;
762 res
->pub
.capability
= capability
;
764 * Since we do not know here whether the IEs are from a Beacon or Probe
765 * Response frame, we need to pick one of the options and only use it
766 * with the driver that does not provide the full Beacon/Probe Response
767 * frame. Use Beacon frame pointer to avoid indicating that this should
768 * override the information_elements pointer should we have received an
769 * earlier indication of Probe Response data.
771 * The initial buffer for the IEs is allocated with the BSS entry and
772 * is located after the private area.
774 res
->pub
.beacon_ies
= (u8
*)res
+ sizeof(*res
) + privsz
;
775 memcpy(res
->pub
.beacon_ies
, ie
, ielen
);
776 res
->pub
.len_beacon_ies
= ielen
;
777 res
->pub
.information_elements
= res
->pub
.beacon_ies
;
778 res
->pub
.len_information_elements
= res
->pub
.len_beacon_ies
;
780 kref_init(&res
->ref
);
782 res
= cfg80211_bss_update(wiphy_to_dev(wiphy
), res
);
786 if (res
->pub
.capability
& WLAN_CAPABILITY_ESS
)
787 regulatory_hint_found_beacon(wiphy
, channel
, gfp
);
789 /* cfg80211_bss_update gives us a referenced result */
792 EXPORT_SYMBOL(cfg80211_inform_bss
);
794 struct cfg80211_bss
*
795 cfg80211_inform_bss_frame(struct wiphy
*wiphy
,
796 struct ieee80211_channel
*channel
,
797 struct ieee80211_mgmt
*mgmt
, size_t len
,
798 s32 signal
, gfp_t gfp
)
800 struct cfg80211_internal_bss
*res
;
801 size_t ielen
= len
- offsetof(struct ieee80211_mgmt
,
802 u
.probe_resp
.variable
);
811 if (WARN_ON(wiphy
->signal_type
== CFG80211_SIGNAL_TYPE_UNSPEC
&&
812 (signal
< 0 || signal
> 100)))
815 if (WARN_ON(len
< offsetof(struct ieee80211_mgmt
, u
.probe_resp
.variable
)))
818 privsz
= wiphy
->bss_priv_size
;
820 res
= kzalloc(sizeof(*res
) + privsz
+ ielen
, gfp
);
824 memcpy(res
->pub
.bssid
, mgmt
->bssid
, ETH_ALEN
);
825 res
->pub
.channel
= channel
;
826 res
->pub
.signal
= signal
;
827 res
->pub
.tsf
= le64_to_cpu(mgmt
->u
.probe_resp
.timestamp
);
828 res
->pub
.beacon_interval
= le16_to_cpu(mgmt
->u
.probe_resp
.beacon_int
);
829 res
->pub
.capability
= le16_to_cpu(mgmt
->u
.probe_resp
.capab_info
);
831 * The initial buffer for the IEs is allocated with the BSS entry and
832 * is located after the private area.
834 if (ieee80211_is_probe_resp(mgmt
->frame_control
)) {
835 res
->pub
.proberesp_ies
= (u8
*) res
+ sizeof(*res
) + privsz
;
836 memcpy(res
->pub
.proberesp_ies
, mgmt
->u
.probe_resp
.variable
,
838 res
->pub
.len_proberesp_ies
= ielen
;
839 res
->pub
.information_elements
= res
->pub
.proberesp_ies
;
840 res
->pub
.len_information_elements
= res
->pub
.len_proberesp_ies
;
842 res
->pub
.beacon_ies
= (u8
*) res
+ sizeof(*res
) + privsz
;
843 memcpy(res
->pub
.beacon_ies
, mgmt
->u
.beacon
.variable
, ielen
);
844 res
->pub
.len_beacon_ies
= ielen
;
845 res
->pub
.information_elements
= res
->pub
.beacon_ies
;
846 res
->pub
.len_information_elements
= res
->pub
.len_beacon_ies
;
849 kref_init(&res
->ref
);
851 res
= cfg80211_bss_update(wiphy_to_dev(wiphy
), res
);
855 if (res
->pub
.capability
& WLAN_CAPABILITY_ESS
)
856 regulatory_hint_found_beacon(wiphy
, channel
, gfp
);
858 /* cfg80211_bss_update gives us a referenced result */
861 EXPORT_SYMBOL(cfg80211_inform_bss_frame
);
863 void cfg80211_ref_bss(struct cfg80211_bss
*pub
)
865 struct cfg80211_internal_bss
*bss
;
870 bss
= container_of(pub
, struct cfg80211_internal_bss
, pub
);
873 EXPORT_SYMBOL(cfg80211_ref_bss
);
875 void cfg80211_put_bss(struct cfg80211_bss
*pub
)
877 struct cfg80211_internal_bss
*bss
;
882 bss
= container_of(pub
, struct cfg80211_internal_bss
, pub
);
883 kref_put(&bss
->ref
, bss_release
);
885 EXPORT_SYMBOL(cfg80211_put_bss
);
887 void cfg80211_unlink_bss(struct wiphy
*wiphy
, struct cfg80211_bss
*pub
)
889 struct cfg80211_registered_device
*dev
= wiphy_to_dev(wiphy
);
890 struct cfg80211_internal_bss
*bss
;
895 bss
= container_of(pub
, struct cfg80211_internal_bss
, pub
);
897 spin_lock_bh(&dev
->bss_lock
);
898 if (!list_empty(&bss
->list
)) {
899 __cfg80211_unlink_bss(dev
, bss
);
900 dev
->bss_generation
++;
902 spin_unlock_bh(&dev
->bss_lock
);
904 EXPORT_SYMBOL(cfg80211_unlink_bss
);
906 #ifdef CONFIG_CFG80211_WEXT
907 int cfg80211_wext_siwscan(struct net_device
*dev
,
908 struct iw_request_info
*info
,
909 union iwreq_data
*wrqu
, char *extra
)
911 struct cfg80211_registered_device
*rdev
;
913 struct iw_scan_req
*wreq
= NULL
;
914 struct cfg80211_scan_request
*creq
= NULL
;
915 int i
, err
, n_channels
= 0;
916 enum ieee80211_band band
;
918 if (!netif_running(dev
))
921 if (wrqu
->data
.length
== sizeof(struct iw_scan_req
))
922 wreq
= (struct iw_scan_req
*)extra
;
924 rdev
= cfg80211_get_dev_from_ifindex(dev_net(dev
), dev
->ifindex
);
927 return PTR_ERR(rdev
);
929 if (rdev
->scan_req
) {
934 wiphy
= &rdev
->wiphy
;
936 /* Determine number of channels, needed to allocate creq */
937 if (wreq
&& wreq
->num_channels
)
938 n_channels
= wreq
->num_channels
;
940 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++)
941 if (wiphy
->bands
[band
])
942 n_channels
+= wiphy
->bands
[band
]->n_channels
;
945 creq
= kzalloc(sizeof(*creq
) + sizeof(struct cfg80211_ssid
) +
946 n_channels
* sizeof(void *),
955 /* SSIDs come after channels */
956 creq
->ssids
= (void *)&creq
->channels
[n_channels
];
957 creq
->n_channels
= n_channels
;
960 /* translate "Scan on frequencies" request */
962 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++) {
965 if (!wiphy
->bands
[band
])
968 for (j
= 0; j
< wiphy
->bands
[band
]->n_channels
; j
++) {
969 /* ignore disabled channels */
970 if (wiphy
->bands
[band
]->channels
[j
].flags
&
971 IEEE80211_CHAN_DISABLED
)
974 /* If we have a wireless request structure and the
975 * wireless request specifies frequencies, then search
976 * for the matching hardware channel.
978 if (wreq
&& wreq
->num_channels
) {
980 int wiphy_freq
= wiphy
->bands
[band
]->channels
[j
].center_freq
;
981 for (k
= 0; k
< wreq
->num_channels
; k
++) {
982 int wext_freq
= cfg80211_wext_freq(wiphy
, &wreq
->channel_list
[k
]);
983 if (wext_freq
== wiphy_freq
)
984 goto wext_freq_found
;
986 goto wext_freq_not_found
;
990 creq
->channels
[i
] = &wiphy
->bands
[band
]->channels
[j
];
992 wext_freq_not_found
: ;
995 /* No channels found? */
1001 /* Set real number of channels specified in creq->channels[] */
1002 creq
->n_channels
= i
;
1004 /* translate "Scan for SSID" request */
1006 if (wrqu
->data
.flags
& IW_SCAN_THIS_ESSID
) {
1007 if (wreq
->essid_len
> IEEE80211_MAX_SSID_LEN
) {
1011 memcpy(creq
->ssids
[0].ssid
, wreq
->essid
, wreq
->essid_len
);
1012 creq
->ssids
[0].ssid_len
= wreq
->essid_len
;
1014 if (wreq
->scan_type
== IW_SCAN_TYPE_PASSIVE
)
1018 for (i
= 0; i
< IEEE80211_NUM_BANDS
; i
++)
1019 if (wiphy
->bands
[i
])
1020 creq
->rates
[i
] = (1 << wiphy
->bands
[i
]->n_bitrates
) - 1;
1022 rdev
->scan_req
= creq
;
1023 err
= rdev
->ops
->scan(wiphy
, dev
, creq
);
1025 rdev
->scan_req
= NULL
;
1026 /* creq will be freed below */
1028 nl80211_send_scan_start(rdev
, dev
);
1029 /* creq now owned by driver */
1035 cfg80211_unlock_rdev(rdev
);
1038 EXPORT_SYMBOL_GPL(cfg80211_wext_siwscan
);
1040 static void ieee80211_scan_add_ies(struct iw_request_info
*info
,
1041 struct cfg80211_bss
*bss
,
1042 char **current_ev
, char *end_buf
)
1044 u8
*pos
, *end
, *next
;
1045 struct iw_event iwe
;
1047 if (!bss
->information_elements
||
1048 !bss
->len_information_elements
)
1052 * If needed, fragment the IEs buffer (at IE boundaries) into short
1053 * enough fragments to fit into IW_GENERIC_IE_MAX octet messages.
1055 pos
= bss
->information_elements
;
1056 end
= pos
+ bss
->len_information_elements
;
1058 while (end
- pos
> IW_GENERIC_IE_MAX
) {
1059 next
= pos
+ 2 + pos
[1];
1060 while (next
+ 2 + next
[1] - pos
< IW_GENERIC_IE_MAX
)
1061 next
= next
+ 2 + next
[1];
1063 memset(&iwe
, 0, sizeof(iwe
));
1064 iwe
.cmd
= IWEVGENIE
;
1065 iwe
.u
.data
.length
= next
- pos
;
1066 *current_ev
= iwe_stream_add_point(info
, *current_ev
,
1067 end_buf
, &iwe
, pos
);
1073 memset(&iwe
, 0, sizeof(iwe
));
1074 iwe
.cmd
= IWEVGENIE
;
1075 iwe
.u
.data
.length
= end
- pos
;
1076 *current_ev
= iwe_stream_add_point(info
, *current_ev
,
1077 end_buf
, &iwe
, pos
);
1081 static inline unsigned int elapsed_jiffies_msecs(unsigned long start
)
1083 unsigned long end
= jiffies
;
1086 return jiffies_to_msecs(end
- start
);
1088 return jiffies_to_msecs(end
+ (MAX_JIFFY_OFFSET
- start
) + 1);
1092 ieee80211_bss(struct wiphy
*wiphy
, struct iw_request_info
*info
,
1093 struct cfg80211_internal_bss
*bss
, char *current_ev
,
1096 struct iw_event iwe
;
1098 u8
*ie
= bss
->pub
.information_elements
;
1099 int rem
= bss
->pub
.len_information_elements
, i
, sig
;
1100 bool ismesh
= false;
1102 memset(&iwe
, 0, sizeof(iwe
));
1103 iwe
.cmd
= SIOCGIWAP
;
1104 iwe
.u
.ap_addr
.sa_family
= ARPHRD_ETHER
;
1105 memcpy(iwe
.u
.ap_addr
.sa_data
, bss
->pub
.bssid
, ETH_ALEN
);
1106 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
, &iwe
,
1109 memset(&iwe
, 0, sizeof(iwe
));
1110 iwe
.cmd
= SIOCGIWFREQ
;
1111 iwe
.u
.freq
.m
= ieee80211_frequency_to_channel(bss
->pub
.channel
->center_freq
);
1113 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
, &iwe
,
1116 memset(&iwe
, 0, sizeof(iwe
));
1117 iwe
.cmd
= SIOCGIWFREQ
;
1118 iwe
.u
.freq
.m
= bss
->pub
.channel
->center_freq
;
1120 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
, &iwe
,
1123 if (wiphy
->signal_type
!= CFG80211_SIGNAL_TYPE_NONE
) {
1124 memset(&iwe
, 0, sizeof(iwe
));
1126 iwe
.u
.qual
.updated
= IW_QUAL_LEVEL_UPDATED
|
1127 IW_QUAL_NOISE_INVALID
|
1128 IW_QUAL_QUAL_UPDATED
;
1129 switch (wiphy
->signal_type
) {
1130 case CFG80211_SIGNAL_TYPE_MBM
:
1131 sig
= bss
->pub
.signal
/ 100;
1132 iwe
.u
.qual
.level
= sig
;
1133 iwe
.u
.qual
.updated
|= IW_QUAL_DBM
;
1134 if (sig
< -110) /* rather bad */
1136 else if (sig
> -40) /* perfect */
1138 /* will give a range of 0 .. 70 */
1139 iwe
.u
.qual
.qual
= sig
+ 110;
1141 case CFG80211_SIGNAL_TYPE_UNSPEC
:
1142 iwe
.u
.qual
.level
= bss
->pub
.signal
;
1143 /* will give range 0 .. 100 */
1144 iwe
.u
.qual
.qual
= bss
->pub
.signal
;
1150 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
,
1151 &iwe
, IW_EV_QUAL_LEN
);
1154 memset(&iwe
, 0, sizeof(iwe
));
1155 iwe
.cmd
= SIOCGIWENCODE
;
1156 if (bss
->pub
.capability
& WLAN_CAPABILITY_PRIVACY
)
1157 iwe
.u
.data
.flags
= IW_ENCODE_ENABLED
| IW_ENCODE_NOKEY
;
1159 iwe
.u
.data
.flags
= IW_ENCODE_DISABLED
;
1160 iwe
.u
.data
.length
= 0;
1161 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1166 if (ie
[1] > rem
- 2)
1171 memset(&iwe
, 0, sizeof(iwe
));
1172 iwe
.cmd
= SIOCGIWESSID
;
1173 iwe
.u
.data
.length
= ie
[1];
1174 iwe
.u
.data
.flags
= 1;
1175 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1178 case WLAN_EID_MESH_ID
:
1179 memset(&iwe
, 0, sizeof(iwe
));
1180 iwe
.cmd
= SIOCGIWESSID
;
1181 iwe
.u
.data
.length
= ie
[1];
1182 iwe
.u
.data
.flags
= 1;
1183 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1186 case WLAN_EID_MESH_CONFIG
:
1188 if (ie
[1] != sizeof(struct ieee80211_meshconf_ie
))
1190 buf
= kmalloc(50, GFP_ATOMIC
);
1194 memset(&iwe
, 0, sizeof(iwe
));
1195 iwe
.cmd
= IWEVCUSTOM
;
1196 sprintf(buf
, "Mesh Network Path Selection Protocol ID: "
1198 iwe
.u
.data
.length
= strlen(buf
);
1199 current_ev
= iwe_stream_add_point(info
, current_ev
,
1202 sprintf(buf
, "Path Selection Metric ID: 0x%02X",
1204 iwe
.u
.data
.length
= strlen(buf
);
1205 current_ev
= iwe_stream_add_point(info
, current_ev
,
1208 sprintf(buf
, "Congestion Control Mode ID: 0x%02X",
1210 iwe
.u
.data
.length
= strlen(buf
);
1211 current_ev
= iwe_stream_add_point(info
, current_ev
,
1214 sprintf(buf
, "Synchronization ID: 0x%02X", cfg
[3]);
1215 iwe
.u
.data
.length
= strlen(buf
);
1216 current_ev
= iwe_stream_add_point(info
, current_ev
,
1219 sprintf(buf
, "Authentication ID: 0x%02X", cfg
[4]);
1220 iwe
.u
.data
.length
= strlen(buf
);
1221 current_ev
= iwe_stream_add_point(info
, current_ev
,
1224 sprintf(buf
, "Formation Info: 0x%02X", cfg
[5]);
1225 iwe
.u
.data
.length
= strlen(buf
);
1226 current_ev
= iwe_stream_add_point(info
, current_ev
,
1229 sprintf(buf
, "Capabilities: 0x%02X", cfg
[6]);
1230 iwe
.u
.data
.length
= strlen(buf
);
1231 current_ev
= iwe_stream_add_point(info
, current_ev
,
1236 case WLAN_EID_SUPP_RATES
:
1237 case WLAN_EID_EXT_SUPP_RATES
:
1238 /* display all supported rates in readable format */
1239 p
= current_ev
+ iwe_stream_lcp_len(info
);
1241 memset(&iwe
, 0, sizeof(iwe
));
1242 iwe
.cmd
= SIOCGIWRATE
;
1243 /* Those two flags are ignored... */
1244 iwe
.u
.bitrate
.fixed
= iwe
.u
.bitrate
.disabled
= 0;
1246 for (i
= 0; i
< ie
[1]; i
++) {
1247 iwe
.u
.bitrate
.value
=
1248 ((ie
[i
+ 2] & 0x7f) * 500000);
1249 p
= iwe_stream_add_value(info
, current_ev
, p
,
1250 end_buf
, &iwe
, IW_EV_PARAM_LEN
);
1259 if (bss
->pub
.capability
& (WLAN_CAPABILITY_ESS
| WLAN_CAPABILITY_IBSS
) ||
1261 memset(&iwe
, 0, sizeof(iwe
));
1262 iwe
.cmd
= SIOCGIWMODE
;
1264 iwe
.u
.mode
= IW_MODE_MESH
;
1265 else if (bss
->pub
.capability
& WLAN_CAPABILITY_ESS
)
1266 iwe
.u
.mode
= IW_MODE_MASTER
;
1268 iwe
.u
.mode
= IW_MODE_ADHOC
;
1269 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
,
1270 &iwe
, IW_EV_UINT_LEN
);
1273 buf
= kmalloc(30, GFP_ATOMIC
);
1275 memset(&iwe
, 0, sizeof(iwe
));
1276 iwe
.cmd
= IWEVCUSTOM
;
1277 sprintf(buf
, "tsf=%016llx", (unsigned long long)(bss
->pub
.tsf
));
1278 iwe
.u
.data
.length
= strlen(buf
);
1279 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1281 memset(&iwe
, 0, sizeof(iwe
));
1282 iwe
.cmd
= IWEVCUSTOM
;
1283 sprintf(buf
, " Last beacon: %ums ago",
1284 elapsed_jiffies_msecs(bss
->ts
));
1285 iwe
.u
.data
.length
= strlen(buf
);
1286 current_ev
= iwe_stream_add_point(info
, current_ev
,
1287 end_buf
, &iwe
, buf
);
1291 ieee80211_scan_add_ies(info
, &bss
->pub
, ¤t_ev
, end_buf
);
1297 static int ieee80211_scan_results(struct cfg80211_registered_device
*dev
,
1298 struct iw_request_info
*info
,
1299 char *buf
, size_t len
)
1301 char *current_ev
= buf
;
1302 char *end_buf
= buf
+ len
;
1303 struct cfg80211_internal_bss
*bss
;
1305 spin_lock_bh(&dev
->bss_lock
);
1306 cfg80211_bss_expire(dev
);
1308 list_for_each_entry(bss
, &dev
->bss_list
, list
) {
1309 if (buf
+ len
- current_ev
<= IW_EV_ADDR_LEN
) {
1310 spin_unlock_bh(&dev
->bss_lock
);
1313 current_ev
= ieee80211_bss(&dev
->wiphy
, info
, bss
,
1314 current_ev
, end_buf
);
1316 spin_unlock_bh(&dev
->bss_lock
);
1317 return current_ev
- buf
;
1321 int cfg80211_wext_giwscan(struct net_device
*dev
,
1322 struct iw_request_info
*info
,
1323 struct iw_point
*data
, char *extra
)
1325 struct cfg80211_registered_device
*rdev
;
1328 if (!netif_running(dev
))
1331 rdev
= cfg80211_get_dev_from_ifindex(dev_net(dev
), dev
->ifindex
);
1334 return PTR_ERR(rdev
);
1336 if (rdev
->scan_req
) {
1341 res
= ieee80211_scan_results(rdev
, info
, extra
, data
->length
);
1349 cfg80211_unlock_rdev(rdev
);
1352 EXPORT_SYMBOL_GPL(cfg80211_wext_giwscan
);