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"
22 #define IEEE80211_SCAN_RESULT_EXPIRE (30 * HZ)
24 static void bss_release(struct kref
*ref
)
26 struct cfg80211_bss_ies
*ies
;
27 struct cfg80211_internal_bss
*bss
;
29 bss
= container_of(ref
, struct cfg80211_internal_bss
, ref
);
31 if (WARN_ON(atomic_read(&bss
->hold
)))
34 ies
= (void *)rcu_access_pointer(bss
->pub
.beacon_ies
);
36 kfree_rcu(ies
, rcu_head
);
37 ies
= (void *)rcu_access_pointer(bss
->pub
.proberesp_ies
);
39 kfree_rcu(ies
, rcu_head
);
44 static inline void bss_ref_get(struct cfg80211_internal_bss
*bss
)
49 static inline void bss_ref_put(struct cfg80211_internal_bss
*bss
)
51 kref_put(&bss
->ref
, bss_release
);
54 static void __cfg80211_unlink_bss(struct cfg80211_registered_device
*dev
,
55 struct cfg80211_internal_bss
*bss
)
57 lockdep_assert_held(&dev
->bss_lock
);
59 list_del_init(&bss
->list
);
60 rb_erase(&bss
->rbn
, &dev
->bss_tree
);
64 static void __cfg80211_bss_expire(struct cfg80211_registered_device
*dev
,
65 unsigned long expire_time
)
67 struct cfg80211_internal_bss
*bss
, *tmp
;
70 lockdep_assert_held(&dev
->bss_lock
);
72 list_for_each_entry_safe(bss
, tmp
, &dev
->bss_list
, list
) {
73 if (atomic_read(&bss
->hold
))
75 if (!time_after(expire_time
, bss
->ts
))
78 __cfg80211_unlink_bss(dev
, bss
);
83 dev
->bss_generation
++;
86 void ___cfg80211_scan_done(struct cfg80211_registered_device
*rdev
, bool leak
)
88 struct cfg80211_scan_request
*request
;
89 struct wireless_dev
*wdev
;
90 #ifdef CONFIG_CFG80211_WEXT
91 union iwreq_data wrqu
;
94 ASSERT_RDEV_LOCK(rdev
);
96 request
= rdev
->scan_req
;
101 wdev
= request
->wdev
;
104 * This must be before sending the other events!
105 * Otherwise, wpa_supplicant gets completely confused with
109 cfg80211_sme_scan_done(wdev
->netdev
);
111 if (request
->aborted
) {
112 nl80211_send_scan_aborted(rdev
, wdev
);
114 if (request
->flags
& NL80211_SCAN_FLAG_FLUSH
) {
115 /* flush entries from previous scans */
116 spin_lock_bh(&rdev
->bss_lock
);
117 __cfg80211_bss_expire(rdev
, request
->scan_start
);
118 spin_unlock_bh(&rdev
->bss_lock
);
120 nl80211_send_scan_done(rdev
, wdev
);
123 #ifdef CONFIG_CFG80211_WEXT
124 if (wdev
->netdev
&& !request
->aborted
) {
125 memset(&wrqu
, 0, sizeof(wrqu
));
127 wireless_send_event(wdev
->netdev
, SIOCGIWSCAN
, &wrqu
, NULL
);
132 dev_put(wdev
->netdev
);
134 rdev
->scan_req
= NULL
;
137 * OK. If this is invoked with "leak" then we can't
138 * free this ... but we've cleaned it up anyway. The
139 * driver failed to call the scan_done callback, so
140 * all bets are off, it might still be trying to use
141 * the scan request or not ... if it accesses the dev
142 * in there (it shouldn't anyway) then it may crash.
148 void __cfg80211_scan_done(struct work_struct
*wk
)
150 struct cfg80211_registered_device
*rdev
;
152 rdev
= container_of(wk
, struct cfg80211_registered_device
,
155 cfg80211_lock_rdev(rdev
);
156 ___cfg80211_scan_done(rdev
, false);
157 cfg80211_unlock_rdev(rdev
);
160 void cfg80211_scan_done(struct cfg80211_scan_request
*request
, bool aborted
)
162 trace_cfg80211_scan_done(request
, aborted
);
163 WARN_ON(request
!= wiphy_to_dev(request
->wiphy
)->scan_req
);
165 request
->aborted
= aborted
;
166 queue_work(cfg80211_wq
, &wiphy_to_dev(request
->wiphy
)->scan_done_wk
);
168 EXPORT_SYMBOL(cfg80211_scan_done
);
170 void __cfg80211_sched_scan_results(struct work_struct
*wk
)
172 struct cfg80211_registered_device
*rdev
;
173 struct cfg80211_sched_scan_request
*request
;
175 rdev
= container_of(wk
, struct cfg80211_registered_device
,
176 sched_scan_results_wk
);
178 request
= rdev
->sched_scan_req
;
180 mutex_lock(&rdev
->sched_scan_mtx
);
182 /* we don't have sched_scan_req anymore if the scan is stopping */
184 if (request
->flags
& NL80211_SCAN_FLAG_FLUSH
) {
185 /* flush entries from previous scans */
186 spin_lock_bh(&rdev
->bss_lock
);
187 __cfg80211_bss_expire(rdev
, request
->scan_start
);
188 spin_unlock_bh(&rdev
->bss_lock
);
189 request
->scan_start
=
190 jiffies
+ msecs_to_jiffies(request
->interval
);
192 nl80211_send_sched_scan_results(rdev
, request
->dev
);
195 mutex_unlock(&rdev
->sched_scan_mtx
);
198 void cfg80211_sched_scan_results(struct wiphy
*wiphy
)
200 trace_cfg80211_sched_scan_results(wiphy
);
201 /* ignore if we're not scanning */
202 if (wiphy_to_dev(wiphy
)->sched_scan_req
)
203 queue_work(cfg80211_wq
,
204 &wiphy_to_dev(wiphy
)->sched_scan_results_wk
);
206 EXPORT_SYMBOL(cfg80211_sched_scan_results
);
208 void cfg80211_sched_scan_stopped(struct wiphy
*wiphy
)
210 struct cfg80211_registered_device
*rdev
= wiphy_to_dev(wiphy
);
212 trace_cfg80211_sched_scan_stopped(wiphy
);
214 mutex_lock(&rdev
->sched_scan_mtx
);
215 __cfg80211_stop_sched_scan(rdev
, true);
216 mutex_unlock(&rdev
->sched_scan_mtx
);
218 EXPORT_SYMBOL(cfg80211_sched_scan_stopped
);
220 int __cfg80211_stop_sched_scan(struct cfg80211_registered_device
*rdev
,
221 bool driver_initiated
)
223 struct net_device
*dev
;
225 lockdep_assert_held(&rdev
->sched_scan_mtx
);
227 if (!rdev
->sched_scan_req
)
230 dev
= rdev
->sched_scan_req
->dev
;
232 if (!driver_initiated
) {
233 int err
= rdev_sched_scan_stop(rdev
, dev
);
238 nl80211_send_sched_scan(rdev
, dev
, NL80211_CMD_SCHED_SCAN_STOPPED
);
240 kfree(rdev
->sched_scan_req
);
241 rdev
->sched_scan_req
= NULL
;
246 void cfg80211_bss_age(struct cfg80211_registered_device
*dev
,
247 unsigned long age_secs
)
249 struct cfg80211_internal_bss
*bss
;
250 unsigned long age_jiffies
= msecs_to_jiffies(age_secs
* MSEC_PER_SEC
);
252 spin_lock_bh(&dev
->bss_lock
);
253 list_for_each_entry(bss
, &dev
->bss_list
, list
)
254 bss
->ts
-= age_jiffies
;
255 spin_unlock_bh(&dev
->bss_lock
);
258 void cfg80211_bss_expire(struct cfg80211_registered_device
*dev
)
260 __cfg80211_bss_expire(dev
, jiffies
- IEEE80211_SCAN_RESULT_EXPIRE
);
263 const u8
*cfg80211_find_ie(u8 eid
, const u8
*ies
, int len
)
265 while (len
> 2 && ies
[0] != eid
) {
271 if (len
< 2 + ies
[1])
275 EXPORT_SYMBOL(cfg80211_find_ie
);
277 const u8
*cfg80211_find_vendor_ie(unsigned int oui
, u8 oui_type
,
278 const u8
*ies
, int len
)
280 struct ieee80211_vendor_ie
*ie
;
281 const u8
*pos
= ies
, *end
= ies
+ len
;
285 pos
= cfg80211_find_ie(WLAN_EID_VENDOR_SPECIFIC
, pos
,
290 if (end
- pos
< sizeof(*ie
))
293 ie
= (struct ieee80211_vendor_ie
*)pos
;
294 ie_oui
= ie
->oui
[0] << 16 | ie
->oui
[1] << 8 | ie
->oui
[2];
295 if (ie_oui
== oui
&& ie
->oui_type
== oui_type
)
302 EXPORT_SYMBOL(cfg80211_find_vendor_ie
);
304 static bool is_bss(struct cfg80211_bss
*a
, const u8
*bssid
,
305 const u8
*ssid
, size_t ssid_len
)
307 const struct cfg80211_bss_ies
*ies
;
310 if (bssid
&& !ether_addr_equal(a
->bssid
, bssid
))
316 ies
= rcu_access_pointer(a
->ies
);
319 ssidie
= cfg80211_find_ie(WLAN_EID_SSID
, ies
->data
, ies
->len
);
322 if (ssidie
[1] != ssid_len
)
324 return memcmp(ssidie
+ 2, ssid
, ssid_len
) == 0;
328 * enum bss_compare_mode - BSS compare mode
329 * @BSS_CMP_REGULAR: regular compare mode (for insertion and normal find)
330 * @BSS_CMP_HIDE_ZLEN: find hidden SSID with zero-length mode
331 * @BSS_CMP_HIDE_NUL: find hidden SSID with NUL-ed out mode
333 enum bss_compare_mode
{
339 static int cmp_bss(struct cfg80211_bss
*a
,
340 struct cfg80211_bss
*b
,
341 enum bss_compare_mode mode
)
343 const struct cfg80211_bss_ies
*a_ies
, *b_ies
;
344 const u8
*ie1
= NULL
;
345 const u8
*ie2
= NULL
;
348 if (a
->channel
!= b
->channel
)
349 return b
->channel
->center_freq
- a
->channel
->center_freq
;
351 a_ies
= rcu_access_pointer(a
->ies
);
354 b_ies
= rcu_access_pointer(b
->ies
);
358 if (WLAN_CAPABILITY_IS_STA_BSS(a
->capability
))
359 ie1
= cfg80211_find_ie(WLAN_EID_MESH_ID
,
360 a_ies
->data
, a_ies
->len
);
361 if (WLAN_CAPABILITY_IS_STA_BSS(b
->capability
))
362 ie2
= cfg80211_find_ie(WLAN_EID_MESH_ID
,
363 b_ies
->data
, b_ies
->len
);
367 if (ie1
[1] == ie2
[1])
368 mesh_id_cmp
= memcmp(ie1
+ 2, ie2
+ 2, ie1
[1]);
370 mesh_id_cmp
= ie2
[1] - ie1
[1];
372 ie1
= cfg80211_find_ie(WLAN_EID_MESH_CONFIG
,
373 a_ies
->data
, a_ies
->len
);
374 ie2
= cfg80211_find_ie(WLAN_EID_MESH_CONFIG
,
375 b_ies
->data
, b_ies
->len
);
379 if (ie1
[1] != ie2
[1])
380 return ie2
[1] - ie1
[1];
381 return memcmp(ie1
+ 2, ie2
+ 2, ie1
[1]);
386 * we can't use compare_ether_addr here since we need a < > operator.
387 * The binary return value of compare_ether_addr isn't enough
389 r
= memcmp(a
->bssid
, b
->bssid
, sizeof(a
->bssid
));
393 ie1
= cfg80211_find_ie(WLAN_EID_SSID
, a_ies
->data
, a_ies
->len
);
394 ie2
= cfg80211_find_ie(WLAN_EID_SSID
, b_ies
->data
, b_ies
->len
);
400 * Note that with "hide_ssid", the function returns a match if
401 * the already-present BSS ("b") is a hidden SSID beacon for
405 /* sort missing IE before (left of) present IE */
412 case BSS_CMP_HIDE_ZLEN
:
414 * In ZLEN mode we assume the BSS entry we're
415 * looking for has a zero-length SSID. So if
416 * the one we're looking at right now has that,
417 * return 0. Otherwise, return the difference
418 * in length, but since we're looking for the
419 * 0-length it's really equivalent to returning
420 * the length of the one we're looking at.
422 * No content comparison is needed as we assume
423 * the content length is zero.
426 case BSS_CMP_REGULAR
:
428 /* sort by length first, then by contents */
429 if (ie1
[1] != ie2
[1])
430 return ie2
[1] - ie1
[1];
431 return memcmp(ie1
+ 2, ie2
+ 2, ie1
[1]);
432 case BSS_CMP_HIDE_NUL
:
433 if (ie1
[1] != ie2
[1])
434 return ie2
[1] - ie1
[1];
435 /* this is equivalent to memcmp(zeroes, ie2 + 2, len) */
436 for (i
= 0; i
< ie2
[1]; i
++)
443 struct cfg80211_bss
*cfg80211_get_bss(struct wiphy
*wiphy
,
444 struct ieee80211_channel
*channel
,
446 const u8
*ssid
, size_t ssid_len
,
447 u16 capa_mask
, u16 capa_val
)
449 struct cfg80211_registered_device
*dev
= wiphy_to_dev(wiphy
);
450 struct cfg80211_internal_bss
*bss
, *res
= NULL
;
451 unsigned long now
= jiffies
;
453 trace_cfg80211_get_bss(wiphy
, channel
, bssid
, ssid
, ssid_len
, capa_mask
,
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
);
477 trace_cfg80211_return_bss(&res
->pub
);
480 EXPORT_SYMBOL(cfg80211_get_bss
);
482 static void rb_insert_bss(struct cfg80211_registered_device
*dev
,
483 struct cfg80211_internal_bss
*bss
)
485 struct rb_node
**p
= &dev
->bss_tree
.rb_node
;
486 struct rb_node
*parent
= NULL
;
487 struct cfg80211_internal_bss
*tbss
;
492 tbss
= rb_entry(parent
, struct cfg80211_internal_bss
, rbn
);
494 cmp
= cmp_bss(&bss
->pub
, &tbss
->pub
, BSS_CMP_REGULAR
);
497 /* will sort of leak this BSS */
507 rb_link_node(&bss
->rbn
, parent
, p
);
508 rb_insert_color(&bss
->rbn
, &dev
->bss_tree
);
511 static struct cfg80211_internal_bss
*
512 rb_find_bss(struct cfg80211_registered_device
*dev
,
513 struct cfg80211_internal_bss
*res
,
514 enum bss_compare_mode mode
)
516 struct rb_node
*n
= dev
->bss_tree
.rb_node
;
517 struct cfg80211_internal_bss
*bss
;
521 bss
= rb_entry(n
, struct cfg80211_internal_bss
, rbn
);
522 r
= cmp_bss(&res
->pub
, &bss
->pub
, mode
);
536 copy_hidden_ies(struct cfg80211_internal_bss
*res
,
537 struct cfg80211_internal_bss
*hidden
)
539 const struct cfg80211_bss_ies
*ies
;
541 if (rcu_access_pointer(res
->pub
.beacon_ies
))
544 ies
= rcu_access_pointer(hidden
->pub
.beacon_ies
);
548 ies
= kmemdup(ies
, sizeof(*ies
) + ies
->len
, GFP_ATOMIC
);
551 rcu_assign_pointer(res
->pub
.beacon_ies
, ies
);
554 static struct cfg80211_internal_bss
*
555 cfg80211_bss_update(struct cfg80211_registered_device
*dev
,
556 struct cfg80211_internal_bss
*tmp
)
558 struct cfg80211_internal_bss
*found
= NULL
;
560 if (WARN_ON(!tmp
->pub
.channel
))
565 spin_lock_bh(&dev
->bss_lock
);
567 if (WARN_ON(!rcu_access_pointer(tmp
->pub
.ies
))) {
568 spin_unlock_bh(&dev
->bss_lock
);
572 found
= rb_find_bss(dev
, tmp
, BSS_CMP_REGULAR
);
575 found
->pub
.beacon_interval
= tmp
->pub
.beacon_interval
;
576 found
->pub
.tsf
= tmp
->pub
.tsf
;
577 found
->pub
.signal
= tmp
->pub
.signal
;
578 found
->pub
.capability
= tmp
->pub
.capability
;
582 if (rcu_access_pointer(tmp
->pub
.proberesp_ies
)) {
583 const struct cfg80211_bss_ies
*old
;
585 old
= rcu_access_pointer(found
->pub
.proberesp_ies
);
587 rcu_assign_pointer(found
->pub
.proberesp_ies
,
588 tmp
->pub
.proberesp_ies
);
589 /* Override possible earlier Beacon frame IEs */
590 rcu_assign_pointer(found
->pub
.ies
,
591 tmp
->pub
.proberesp_ies
);
593 kfree_rcu((struct cfg80211_bss_ies
*)old
,
595 } else if (rcu_access_pointer(tmp
->pub
.beacon_ies
)) {
596 const struct cfg80211_bss_ies
*old
;
598 old
= rcu_access_pointer(found
->pub
.beacon_ies
);
600 rcu_assign_pointer(found
->pub
.beacon_ies
,
601 tmp
->pub
.beacon_ies
);
603 /* Override IEs if they were from a beacon before */
604 if (old
== rcu_access_pointer(found
->pub
.ies
))
605 rcu_assign_pointer(found
->pub
.ies
,
606 tmp
->pub
.beacon_ies
);
609 kfree_rcu((struct cfg80211_bss_ies
*)old
,
613 struct cfg80211_internal_bss
*new;
614 struct cfg80211_internal_bss
*hidden
;
615 struct cfg80211_bss_ies
*ies
;
617 /* First check if the beacon is a probe response from
618 * a hidden bss. If so, copy beacon ies (with nullified
619 * ssid) into the probe response bss entry (with real ssid).
620 * It is required basically for PSM implementation
621 * (probe responses do not contain tim ie) */
623 /* TODO: The code is not trying to update existing probe
624 * response bss entries when beacon ies are
625 * getting changed. */
626 hidden
= rb_find_bss(dev
, tmp
, BSS_CMP_HIDE_ZLEN
);
628 copy_hidden_ies(tmp
, hidden
);
630 hidden
= rb_find_bss(dev
, tmp
, BSS_CMP_HIDE_NUL
);
632 copy_hidden_ies(tmp
, hidden
);
636 * create a copy -- the "res" variable that is passed in
637 * is allocated on the stack since it's not needed in the
638 * more common case of an update
640 new = kzalloc(sizeof(*new) + dev
->wiphy
.bss_priv_size
,
643 ies
= (void *)rcu_dereference(tmp
->pub
.beacon_ies
);
645 kfree_rcu(ies
, rcu_head
);
646 ies
= (void *)rcu_dereference(tmp
->pub
.proberesp_ies
);
648 kfree_rcu(ies
, rcu_head
);
649 spin_unlock_bh(&dev
->bss_lock
);
652 memcpy(new, tmp
, sizeof(*new));
653 kref_init(&new->ref
);
654 list_add_tail(&new->list
, &dev
->bss_list
);
655 rb_insert_bss(dev
, new);
659 dev
->bss_generation
++;
660 spin_unlock_bh(&dev
->bss_lock
);
666 static struct ieee80211_channel
*
667 cfg80211_get_bss_channel(struct wiphy
*wiphy
, const u8
*ie
, size_t ielen
,
668 struct ieee80211_channel
*channel
)
672 int channel_number
= -1;
674 tmp
= cfg80211_find_ie(WLAN_EID_DS_PARAMS
, ie
, ielen
);
675 if (tmp
&& tmp
[1] == 1) {
676 channel_number
= tmp
[2];
678 tmp
= cfg80211_find_ie(WLAN_EID_HT_OPERATION
, ie
, ielen
);
679 if (tmp
&& tmp
[1] >= sizeof(struct ieee80211_ht_operation
)) {
680 struct ieee80211_ht_operation
*htop
= (void *)(tmp
+ 2);
682 channel_number
= htop
->primary_chan
;
686 if (channel_number
< 0)
689 freq
= ieee80211_channel_to_frequency(channel_number
, channel
->band
);
690 channel
= ieee80211_get_channel(wiphy
, freq
);
693 if (channel
->flags
& IEEE80211_CHAN_DISABLED
)
699 cfg80211_inform_bss(struct wiphy
*wiphy
,
700 struct ieee80211_channel
*channel
,
701 const u8
*bssid
, u64 tsf
, u16 capability
,
702 u16 beacon_interval
, const u8
*ie
, size_t ielen
,
703 s32 signal
, gfp_t gfp
)
705 struct cfg80211_bss_ies
*ies
;
706 struct cfg80211_internal_bss tmp
= {}, *res
;
711 if (WARN_ON(wiphy
->signal_type
== CFG80211_SIGNAL_TYPE_UNSPEC
&&
712 (signal
< 0 || signal
> 100)))
715 channel
= cfg80211_get_bss_channel(wiphy
, ie
, ielen
, channel
);
719 memcpy(tmp
.pub
.bssid
, bssid
, ETH_ALEN
);
720 tmp
.pub
.channel
= channel
;
721 tmp
.pub
.signal
= signal
;
723 tmp
.pub
.beacon_interval
= beacon_interval
;
724 tmp
.pub
.capability
= capability
;
726 * Since we do not know here whether the IEs are from a Beacon or Probe
727 * Response frame, we need to pick one of the options and only use it
728 * with the driver that does not provide the full Beacon/Probe Response
729 * frame. Use Beacon frame pointer to avoid indicating that this should
730 * override the IEs pointer should we have received an earlier
731 * indication of Probe Response data.
733 ies
= kmalloc(sizeof(*ies
) + ielen
, gfp
);
737 memcpy(ies
->data
, ie
, ielen
);
739 rcu_assign_pointer(tmp
.pub
.beacon_ies
, ies
);
740 rcu_assign_pointer(tmp
.pub
.ies
, ies
);
742 res
= cfg80211_bss_update(wiphy_to_dev(wiphy
), &tmp
);
746 if (res
->pub
.capability
& WLAN_CAPABILITY_ESS
)
747 regulatory_hint_found_beacon(wiphy
, channel
, gfp
);
749 trace_cfg80211_return_bss(&res
->pub
);
750 /* cfg80211_bss_update gives us a referenced result */
753 EXPORT_SYMBOL(cfg80211_inform_bss
);
755 struct cfg80211_bss
*
756 cfg80211_inform_bss_frame(struct wiphy
*wiphy
,
757 struct ieee80211_channel
*channel
,
758 struct ieee80211_mgmt
*mgmt
, size_t len
,
759 s32 signal
, gfp_t gfp
)
761 struct cfg80211_internal_bss tmp
= {}, *res
;
762 struct cfg80211_bss_ies
*ies
;
763 size_t ielen
= len
- offsetof(struct ieee80211_mgmt
,
764 u
.probe_resp
.variable
);
766 BUILD_BUG_ON(offsetof(struct ieee80211_mgmt
, u
.probe_resp
.variable
) !=
767 offsetof(struct ieee80211_mgmt
, u
.beacon
.variable
));
769 trace_cfg80211_inform_bss_frame(wiphy
, channel
, mgmt
, len
, signal
);
777 if (WARN_ON(wiphy
->signal_type
== CFG80211_SIGNAL_TYPE_UNSPEC
&&
778 (signal
< 0 || signal
> 100)))
781 if (WARN_ON(len
< offsetof(struct ieee80211_mgmt
, u
.probe_resp
.variable
)))
784 channel
= cfg80211_get_bss_channel(wiphy
, mgmt
->u
.beacon
.variable
,
789 ies
= kmalloc(sizeof(*ies
) + ielen
, gfp
);
793 memcpy(ies
->data
, mgmt
->u
.probe_resp
.variable
, ielen
);
795 if (ieee80211_is_probe_resp(mgmt
->frame_control
))
796 rcu_assign_pointer(tmp
.pub
.proberesp_ies
, ies
);
798 rcu_assign_pointer(tmp
.pub
.beacon_ies
, ies
);
799 rcu_assign_pointer(tmp
.pub
.ies
, ies
);
801 memcpy(tmp
.pub
.bssid
, mgmt
->bssid
, ETH_ALEN
);
802 tmp
.pub
.channel
= channel
;
803 tmp
.pub
.signal
= signal
;
804 tmp
.pub
.tsf
= le64_to_cpu(mgmt
->u
.probe_resp
.timestamp
);
805 tmp
.pub
.beacon_interval
= le16_to_cpu(mgmt
->u
.probe_resp
.beacon_int
);
806 tmp
.pub
.capability
= le16_to_cpu(mgmt
->u
.probe_resp
.capab_info
);
808 res
= cfg80211_bss_update(wiphy_to_dev(wiphy
), &tmp
);
812 if (res
->pub
.capability
& WLAN_CAPABILITY_ESS
)
813 regulatory_hint_found_beacon(wiphy
, channel
, gfp
);
815 trace_cfg80211_return_bss(&res
->pub
);
816 /* cfg80211_bss_update gives us a referenced result */
819 EXPORT_SYMBOL(cfg80211_inform_bss_frame
);
821 void cfg80211_ref_bss(struct cfg80211_bss
*pub
)
823 struct cfg80211_internal_bss
*bss
;
828 bss
= container_of(pub
, struct cfg80211_internal_bss
, pub
);
831 EXPORT_SYMBOL(cfg80211_ref_bss
);
833 void cfg80211_put_bss(struct cfg80211_bss
*pub
)
835 struct cfg80211_internal_bss
*bss
;
840 bss
= container_of(pub
, struct cfg80211_internal_bss
, pub
);
843 EXPORT_SYMBOL(cfg80211_put_bss
);
845 void cfg80211_unlink_bss(struct wiphy
*wiphy
, struct cfg80211_bss
*pub
)
847 struct cfg80211_registered_device
*dev
= wiphy_to_dev(wiphy
);
848 struct cfg80211_internal_bss
*bss
;
853 bss
= container_of(pub
, struct cfg80211_internal_bss
, pub
);
855 spin_lock_bh(&dev
->bss_lock
);
856 if (!list_empty(&bss
->list
)) {
857 __cfg80211_unlink_bss(dev
, bss
);
858 dev
->bss_generation
++;
860 spin_unlock_bh(&dev
->bss_lock
);
862 EXPORT_SYMBOL(cfg80211_unlink_bss
);
864 #ifdef CONFIG_CFG80211_WEXT
865 int cfg80211_wext_siwscan(struct net_device
*dev
,
866 struct iw_request_info
*info
,
867 union iwreq_data
*wrqu
, char *extra
)
869 struct cfg80211_registered_device
*rdev
;
871 struct iw_scan_req
*wreq
= NULL
;
872 struct cfg80211_scan_request
*creq
= NULL
;
873 int i
, err
, n_channels
= 0;
874 enum ieee80211_band band
;
876 if (!netif_running(dev
))
879 if (wrqu
->data
.length
== sizeof(struct iw_scan_req
))
880 wreq
= (struct iw_scan_req
*)extra
;
882 rdev
= cfg80211_get_dev_from_ifindex(dev_net(dev
), dev
->ifindex
);
885 return PTR_ERR(rdev
);
887 if (rdev
->scan_req
) {
892 wiphy
= &rdev
->wiphy
;
894 /* Determine number of channels, needed to allocate creq */
895 if (wreq
&& wreq
->num_channels
)
896 n_channels
= wreq
->num_channels
;
898 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++)
899 if (wiphy
->bands
[band
])
900 n_channels
+= wiphy
->bands
[band
]->n_channels
;
903 creq
= kzalloc(sizeof(*creq
) + sizeof(struct cfg80211_ssid
) +
904 n_channels
* sizeof(void *),
912 creq
->wdev
= dev
->ieee80211_ptr
;
913 /* SSIDs come after channels */
914 creq
->ssids
= (void *)&creq
->channels
[n_channels
];
915 creq
->n_channels
= n_channels
;
917 creq
->scan_start
= jiffies
;
919 /* translate "Scan on frequencies" request */
921 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++) {
924 if (!wiphy
->bands
[band
])
927 for (j
= 0; j
< wiphy
->bands
[band
]->n_channels
; j
++) {
928 /* ignore disabled channels */
929 if (wiphy
->bands
[band
]->channels
[j
].flags
&
930 IEEE80211_CHAN_DISABLED
)
933 /* If we have a wireless request structure and the
934 * wireless request specifies frequencies, then search
935 * for the matching hardware channel.
937 if (wreq
&& wreq
->num_channels
) {
939 int wiphy_freq
= wiphy
->bands
[band
]->channels
[j
].center_freq
;
940 for (k
= 0; k
< wreq
->num_channels
; k
++) {
941 int wext_freq
= cfg80211_wext_freq(wiphy
, &wreq
->channel_list
[k
]);
942 if (wext_freq
== wiphy_freq
)
943 goto wext_freq_found
;
945 goto wext_freq_not_found
;
949 creq
->channels
[i
] = &wiphy
->bands
[band
]->channels
[j
];
951 wext_freq_not_found
: ;
954 /* No channels found? */
960 /* Set real number of channels specified in creq->channels[] */
961 creq
->n_channels
= i
;
963 /* translate "Scan for SSID" request */
965 if (wrqu
->data
.flags
& IW_SCAN_THIS_ESSID
) {
966 if (wreq
->essid_len
> IEEE80211_MAX_SSID_LEN
) {
970 memcpy(creq
->ssids
[0].ssid
, wreq
->essid
, wreq
->essid_len
);
971 creq
->ssids
[0].ssid_len
= wreq
->essid_len
;
973 if (wreq
->scan_type
== IW_SCAN_TYPE_PASSIVE
)
977 for (i
= 0; i
< IEEE80211_NUM_BANDS
; i
++)
979 creq
->rates
[i
] = (1 << wiphy
->bands
[i
]->n_bitrates
) - 1;
981 rdev
->scan_req
= creq
;
982 err
= rdev_scan(rdev
, creq
);
984 rdev
->scan_req
= NULL
;
985 /* creq will be freed below */
987 nl80211_send_scan_start(rdev
, dev
->ieee80211_ptr
);
988 /* creq now owned by driver */
994 cfg80211_unlock_rdev(rdev
);
997 EXPORT_SYMBOL_GPL(cfg80211_wext_siwscan
);
999 static void ieee80211_scan_add_ies(struct iw_request_info
*info
,
1000 const struct cfg80211_bss_ies
*ies
,
1001 char **current_ev
, char *end_buf
)
1003 const u8
*pos
, *end
, *next
;
1004 struct iw_event iwe
;
1010 * If needed, fragment the IEs buffer (at IE boundaries) into short
1011 * enough fragments to fit into IW_GENERIC_IE_MAX octet messages.
1014 end
= pos
+ ies
->len
;
1016 while (end
- pos
> IW_GENERIC_IE_MAX
) {
1017 next
= pos
+ 2 + pos
[1];
1018 while (next
+ 2 + next
[1] - pos
< IW_GENERIC_IE_MAX
)
1019 next
= next
+ 2 + next
[1];
1021 memset(&iwe
, 0, sizeof(iwe
));
1022 iwe
.cmd
= IWEVGENIE
;
1023 iwe
.u
.data
.length
= next
- pos
;
1024 *current_ev
= iwe_stream_add_point(info
, *current_ev
,
1032 memset(&iwe
, 0, sizeof(iwe
));
1033 iwe
.cmd
= IWEVGENIE
;
1034 iwe
.u
.data
.length
= end
- pos
;
1035 *current_ev
= iwe_stream_add_point(info
, *current_ev
,
1041 static inline unsigned int elapsed_jiffies_msecs(unsigned long start
)
1043 unsigned long end
= jiffies
;
1046 return jiffies_to_msecs(end
- start
);
1048 return jiffies_to_msecs(end
+ (MAX_JIFFY_OFFSET
- start
) + 1);
1052 ieee80211_bss(struct wiphy
*wiphy
, struct iw_request_info
*info
,
1053 struct cfg80211_internal_bss
*bss
, char *current_ev
,
1056 const struct cfg80211_bss_ies
*ies
;
1057 struct iw_event iwe
;
1061 bool ismesh
= false;
1063 memset(&iwe
, 0, sizeof(iwe
));
1064 iwe
.cmd
= SIOCGIWAP
;
1065 iwe
.u
.ap_addr
.sa_family
= ARPHRD_ETHER
;
1066 memcpy(iwe
.u
.ap_addr
.sa_data
, bss
->pub
.bssid
, ETH_ALEN
);
1067 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
, &iwe
,
1070 memset(&iwe
, 0, sizeof(iwe
));
1071 iwe
.cmd
= SIOCGIWFREQ
;
1072 iwe
.u
.freq
.m
= ieee80211_frequency_to_channel(bss
->pub
.channel
->center_freq
);
1074 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
, &iwe
,
1077 memset(&iwe
, 0, sizeof(iwe
));
1078 iwe
.cmd
= SIOCGIWFREQ
;
1079 iwe
.u
.freq
.m
= bss
->pub
.channel
->center_freq
;
1081 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
, &iwe
,
1084 if (wiphy
->signal_type
!= CFG80211_SIGNAL_TYPE_NONE
) {
1085 memset(&iwe
, 0, sizeof(iwe
));
1087 iwe
.u
.qual
.updated
= IW_QUAL_LEVEL_UPDATED
|
1088 IW_QUAL_NOISE_INVALID
|
1089 IW_QUAL_QUAL_UPDATED
;
1090 switch (wiphy
->signal_type
) {
1091 case CFG80211_SIGNAL_TYPE_MBM
:
1092 sig
= bss
->pub
.signal
/ 100;
1093 iwe
.u
.qual
.level
= sig
;
1094 iwe
.u
.qual
.updated
|= IW_QUAL_DBM
;
1095 if (sig
< -110) /* rather bad */
1097 else if (sig
> -40) /* perfect */
1099 /* will give a range of 0 .. 70 */
1100 iwe
.u
.qual
.qual
= sig
+ 110;
1102 case CFG80211_SIGNAL_TYPE_UNSPEC
:
1103 iwe
.u
.qual
.level
= bss
->pub
.signal
;
1104 /* will give range 0 .. 100 */
1105 iwe
.u
.qual
.qual
= bss
->pub
.signal
;
1111 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
,
1112 &iwe
, IW_EV_QUAL_LEN
);
1115 memset(&iwe
, 0, sizeof(iwe
));
1116 iwe
.cmd
= SIOCGIWENCODE
;
1117 if (bss
->pub
.capability
& WLAN_CAPABILITY_PRIVACY
)
1118 iwe
.u
.data
.flags
= IW_ENCODE_ENABLED
| IW_ENCODE_NOKEY
;
1120 iwe
.u
.data
.flags
= IW_ENCODE_DISABLED
;
1121 iwe
.u
.data
.length
= 0;
1122 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1126 ies
= rcu_dereference(bss
->pub
.ies
);
1135 while (ies
&& rem
>= 2) {
1137 if (ie
[1] > rem
- 2)
1142 memset(&iwe
, 0, sizeof(iwe
));
1143 iwe
.cmd
= SIOCGIWESSID
;
1144 iwe
.u
.data
.length
= ie
[1];
1145 iwe
.u
.data
.flags
= 1;
1146 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1147 &iwe
, (u8
*)ie
+ 2);
1149 case WLAN_EID_MESH_ID
:
1150 memset(&iwe
, 0, sizeof(iwe
));
1151 iwe
.cmd
= SIOCGIWESSID
;
1152 iwe
.u
.data
.length
= ie
[1];
1153 iwe
.u
.data
.flags
= 1;
1154 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1155 &iwe
, (u8
*)ie
+ 2);
1157 case WLAN_EID_MESH_CONFIG
:
1159 if (ie
[1] != sizeof(struct ieee80211_meshconf_ie
))
1161 buf
= kmalloc(50, GFP_ATOMIC
);
1165 memset(&iwe
, 0, sizeof(iwe
));
1166 iwe
.cmd
= IWEVCUSTOM
;
1167 sprintf(buf
, "Mesh Network Path Selection Protocol ID: "
1169 iwe
.u
.data
.length
= strlen(buf
);
1170 current_ev
= iwe_stream_add_point(info
, current_ev
,
1173 sprintf(buf
, "Path Selection Metric ID: 0x%02X",
1175 iwe
.u
.data
.length
= strlen(buf
);
1176 current_ev
= iwe_stream_add_point(info
, current_ev
,
1179 sprintf(buf
, "Congestion Control Mode ID: 0x%02X",
1181 iwe
.u
.data
.length
= strlen(buf
);
1182 current_ev
= iwe_stream_add_point(info
, current_ev
,
1185 sprintf(buf
, "Synchronization ID: 0x%02X", cfg
[3]);
1186 iwe
.u
.data
.length
= strlen(buf
);
1187 current_ev
= iwe_stream_add_point(info
, current_ev
,
1190 sprintf(buf
, "Authentication ID: 0x%02X", cfg
[4]);
1191 iwe
.u
.data
.length
= strlen(buf
);
1192 current_ev
= iwe_stream_add_point(info
, current_ev
,
1195 sprintf(buf
, "Formation Info: 0x%02X", cfg
[5]);
1196 iwe
.u
.data
.length
= strlen(buf
);
1197 current_ev
= iwe_stream_add_point(info
, current_ev
,
1200 sprintf(buf
, "Capabilities: 0x%02X", cfg
[6]);
1201 iwe
.u
.data
.length
= strlen(buf
);
1202 current_ev
= iwe_stream_add_point(info
, current_ev
,
1207 case WLAN_EID_SUPP_RATES
:
1208 case WLAN_EID_EXT_SUPP_RATES
:
1209 /* display all supported rates in readable format */
1210 p
= current_ev
+ iwe_stream_lcp_len(info
);
1212 memset(&iwe
, 0, sizeof(iwe
));
1213 iwe
.cmd
= SIOCGIWRATE
;
1214 /* Those two flags are ignored... */
1215 iwe
.u
.bitrate
.fixed
= iwe
.u
.bitrate
.disabled
= 0;
1217 for (i
= 0; i
< ie
[1]; i
++) {
1218 iwe
.u
.bitrate
.value
=
1219 ((ie
[i
+ 2] & 0x7f) * 500000);
1220 p
= iwe_stream_add_value(info
, current_ev
, p
,
1221 end_buf
, &iwe
, IW_EV_PARAM_LEN
);
1230 if (bss
->pub
.capability
& (WLAN_CAPABILITY_ESS
| WLAN_CAPABILITY_IBSS
) ||
1232 memset(&iwe
, 0, sizeof(iwe
));
1233 iwe
.cmd
= SIOCGIWMODE
;
1235 iwe
.u
.mode
= IW_MODE_MESH
;
1236 else if (bss
->pub
.capability
& WLAN_CAPABILITY_ESS
)
1237 iwe
.u
.mode
= IW_MODE_MASTER
;
1239 iwe
.u
.mode
= IW_MODE_ADHOC
;
1240 current_ev
= iwe_stream_add_event(info
, current_ev
, end_buf
,
1241 &iwe
, IW_EV_UINT_LEN
);
1244 buf
= kmalloc(30, GFP_ATOMIC
);
1246 memset(&iwe
, 0, sizeof(iwe
));
1247 iwe
.cmd
= IWEVCUSTOM
;
1248 sprintf(buf
, "tsf=%016llx", (unsigned long long)(bss
->pub
.tsf
));
1249 iwe
.u
.data
.length
= strlen(buf
);
1250 current_ev
= iwe_stream_add_point(info
, current_ev
, end_buf
,
1252 memset(&iwe
, 0, sizeof(iwe
));
1253 iwe
.cmd
= IWEVCUSTOM
;
1254 sprintf(buf
, " Last beacon: %ums ago",
1255 elapsed_jiffies_msecs(bss
->ts
));
1256 iwe
.u
.data
.length
= strlen(buf
);
1257 current_ev
= iwe_stream_add_point(info
, current_ev
,
1258 end_buf
, &iwe
, buf
);
1262 ieee80211_scan_add_ies(info
, ies
, ¤t_ev
, end_buf
);
1269 static int ieee80211_scan_results(struct cfg80211_registered_device
*dev
,
1270 struct iw_request_info
*info
,
1271 char *buf
, size_t len
)
1273 char *current_ev
= buf
;
1274 char *end_buf
= buf
+ len
;
1275 struct cfg80211_internal_bss
*bss
;
1277 spin_lock_bh(&dev
->bss_lock
);
1278 cfg80211_bss_expire(dev
);
1280 list_for_each_entry(bss
, &dev
->bss_list
, list
) {
1281 if (buf
+ len
- current_ev
<= IW_EV_ADDR_LEN
) {
1282 spin_unlock_bh(&dev
->bss_lock
);
1285 current_ev
= ieee80211_bss(&dev
->wiphy
, info
, bss
,
1286 current_ev
, end_buf
);
1288 spin_unlock_bh(&dev
->bss_lock
);
1289 return current_ev
- buf
;
1293 int cfg80211_wext_giwscan(struct net_device
*dev
,
1294 struct iw_request_info
*info
,
1295 struct iw_point
*data
, char *extra
)
1297 struct cfg80211_registered_device
*rdev
;
1300 if (!netif_running(dev
))
1303 rdev
= cfg80211_get_dev_from_ifindex(dev_net(dev
), dev
->ifindex
);
1306 return PTR_ERR(rdev
);
1308 if (rdev
->scan_req
) {
1313 res
= ieee80211_scan_results(rdev
, info
, extra
, data
->length
);
1321 cfg80211_unlock_rdev(rdev
);
1324 EXPORT_SYMBOL_GPL(cfg80211_wext_giwscan
);