2 * IBSS mode implementation
3 * Copyright 2003-2008, Jouni Malinen <j@w1.fi>
4 * Copyright 2004, Instant802 Networks, Inc.
5 * Copyright 2005, Devicescape Software, Inc.
6 * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
7 * Copyright 2007, Michael Wu <flamingice@sourmilk.net>
8 * Copyright 2009, Johannes Berg <johannes@sipsolutions.net>
9 * Copyright 2013-2014 Intel Mobile Communications GmbH
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License version 2 as
13 * published by the Free Software Foundation.
16 #include <linux/delay.h>
17 #include <linux/slab.h>
18 #include <linux/if_ether.h>
19 #include <linux/skbuff.h>
20 #include <linux/if_arp.h>
21 #include <linux/etherdevice.h>
22 #include <linux/rtnetlink.h>
23 #include <net/mac80211.h>
25 #include "ieee80211_i.h"
26 #include "driver-ops.h"
29 #define IEEE80211_SCAN_INTERVAL (2 * HZ)
30 #define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ)
32 #define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ)
33 #define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ)
34 #define IEEE80211_IBSS_RSN_INACTIVITY_LIMIT (10 * HZ)
36 #define IEEE80211_IBSS_MAX_STA_ENTRIES 128
38 static struct beacon_data
*
39 ieee80211_ibss_build_presp(struct ieee80211_sub_if_data
*sdata
,
40 const int beacon_int
, const u32 basic_rates
,
41 const u16 capability
, u64 tsf
,
42 struct cfg80211_chan_def
*chandef
,
43 bool *have_higher_than_11mbit
,
44 struct cfg80211_csa_settings
*csa_settings
)
46 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
47 struct ieee80211_local
*local
= sdata
->local
;
48 int rates_n
= 0, i
, ri
;
49 struct ieee80211_mgmt
*mgmt
;
51 struct ieee80211_supported_band
*sband
;
52 u32 rate_flags
, rates
= 0, rates_added
= 0;
53 struct beacon_data
*presp
;
57 /* Build IBSS probe response */
58 frame_len
= sizeof(struct ieee80211_hdr_3addr
) +
59 12 /* struct ieee80211_mgmt.u.beacon */ +
60 2 + IEEE80211_MAX_SSID_LEN
/* max SSID */ +
61 2 + 8 /* max Supported Rates */ +
62 3 /* max DS params */ +
64 5 /* Channel Switch Announcement */ +
65 2 + (IEEE80211_MAX_SUPP_RATES
- 8) +
66 2 + sizeof(struct ieee80211_ht_cap
) +
67 2 + sizeof(struct ieee80211_ht_operation
) +
69 presp
= kzalloc(sizeof(*presp
) + frame_len
, GFP_KERNEL
);
73 presp
->head
= (void *)(presp
+ 1);
75 mgmt
= (void *) presp
->head
;
76 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
77 IEEE80211_STYPE_PROBE_RESP
);
78 eth_broadcast_addr(mgmt
->da
);
79 memcpy(mgmt
->sa
, sdata
->vif
.addr
, ETH_ALEN
);
80 memcpy(mgmt
->bssid
, ifibss
->bssid
, ETH_ALEN
);
81 mgmt
->u
.beacon
.beacon_int
= cpu_to_le16(beacon_int
);
82 mgmt
->u
.beacon
.timestamp
= cpu_to_le64(tsf
);
83 mgmt
->u
.beacon
.capab_info
= cpu_to_le16(capability
);
85 pos
= (u8
*)mgmt
+ offsetof(struct ieee80211_mgmt
, u
.beacon
.variable
);
87 *pos
++ = WLAN_EID_SSID
;
88 *pos
++ = ifibss
->ssid_len
;
89 memcpy(pos
, ifibss
->ssid
, ifibss
->ssid_len
);
90 pos
+= ifibss
->ssid_len
;
92 sband
= local
->hw
.wiphy
->bands
[chandef
->chan
->band
];
93 rate_flags
= ieee80211_chandef_rate_flags(chandef
);
94 shift
= ieee80211_chandef_get_shift(chandef
);
96 if (have_higher_than_11mbit
)
97 *have_higher_than_11mbit
= false;
99 for (i
= 0; i
< sband
->n_bitrates
; i
++) {
100 if ((rate_flags
& sband
->bitrates
[i
].flags
) != rate_flags
)
102 if (sband
->bitrates
[i
].bitrate
> 110 &&
103 have_higher_than_11mbit
)
104 *have_higher_than_11mbit
= true;
110 *pos
++ = WLAN_EID_SUPP_RATES
;
111 *pos
++ = min_t(int, 8, rates_n
);
112 for (ri
= 0; ri
< sband
->n_bitrates
; ri
++) {
113 int rate
= DIV_ROUND_UP(sband
->bitrates
[ri
].bitrate
,
116 if (!(rates
& BIT(ri
)))
119 if (basic_rates
& BIT(ri
))
121 *pos
++ = basic
| (u8
) rate
;
122 if (++rates_added
== 8) {
123 ri
++; /* continue at next rate for EXT_SUPP_RATES */
128 if (sband
->band
== IEEE80211_BAND_2GHZ
) {
129 *pos
++ = WLAN_EID_DS_PARAMS
;
131 *pos
++ = ieee80211_frequency_to_channel(
132 chandef
->chan
->center_freq
);
135 *pos
++ = WLAN_EID_IBSS_PARAMS
;
137 /* FIX: set ATIM window based on scan results */
142 *pos
++ = WLAN_EID_CHANNEL_SWITCH
;
144 *pos
++ = csa_settings
->block_tx
? 1 : 0;
145 *pos
++ = ieee80211_frequency_to_channel(
146 csa_settings
->chandef
.chan
->center_freq
);
147 presp
->csa_counter_offsets
[0] = (pos
- presp
->head
);
148 *pos
++ = csa_settings
->count
;
149 presp
->csa_current_counter
= csa_settings
->count
;
152 /* put the remaining rates in WLAN_EID_EXT_SUPP_RATES */
154 *pos
++ = WLAN_EID_EXT_SUPP_RATES
;
155 *pos
++ = rates_n
- 8;
156 for (; ri
< sband
->n_bitrates
; ri
++) {
157 int rate
= DIV_ROUND_UP(sband
->bitrates
[ri
].bitrate
,
160 if (!(rates
& BIT(ri
)))
163 if (basic_rates
& BIT(ri
))
165 *pos
++ = basic
| (u8
) rate
;
169 if (ifibss
->ie_len
) {
170 memcpy(pos
, ifibss
->ie
, ifibss
->ie_len
);
171 pos
+= ifibss
->ie_len
;
174 /* add HT capability and information IEs */
175 if (chandef
->width
!= NL80211_CHAN_WIDTH_20_NOHT
&&
176 chandef
->width
!= NL80211_CHAN_WIDTH_5
&&
177 chandef
->width
!= NL80211_CHAN_WIDTH_10
&&
178 sband
->ht_cap
.ht_supported
) {
179 struct ieee80211_sta_ht_cap ht_cap
;
181 memcpy(&ht_cap
, &sband
->ht_cap
, sizeof(ht_cap
));
182 ieee80211_apply_htcap_overrides(sdata
, &ht_cap
);
184 pos
= ieee80211_ie_build_ht_cap(pos
, &ht_cap
, ht_cap
.cap
);
186 * Note: According to 802.11n-2009 9.13.3.1, HT Protection
187 * field and RIFS Mode are reserved in IBSS mode, therefore
190 pos
= ieee80211_ie_build_ht_oper(pos
, &sband
->ht_cap
,
193 /* add VHT capability and information IEs */
194 if (chandef
->width
!= NL80211_CHAN_WIDTH_20
&&
195 chandef
->width
!= NL80211_CHAN_WIDTH_40
&&
196 sband
->vht_cap
.vht_supported
) {
197 pos
= ieee80211_ie_build_vht_cap(pos
, &sband
->vht_cap
,
199 pos
= ieee80211_ie_build_vht_oper(pos
, &sband
->vht_cap
,
204 if (local
->hw
.queues
>= IEEE80211_NUM_ACS
)
205 pos
= ieee80211_add_wmm_info_ie(pos
, 0); /* U-APSD not in use */
207 presp
->head_len
= pos
- presp
->head
;
208 if (WARN_ON(presp
->head_len
> frame_len
))
217 static void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data
*sdata
,
218 const u8
*bssid
, const int beacon_int
,
219 struct cfg80211_chan_def
*req_chandef
,
220 const u32 basic_rates
,
221 const u16 capability
, u64 tsf
,
224 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
225 struct ieee80211_local
*local
= sdata
->local
;
226 struct ieee80211_mgmt
*mgmt
;
227 struct cfg80211_bss
*bss
;
229 struct cfg80211_chan_def chandef
;
230 struct ieee80211_channel
*chan
;
231 struct beacon_data
*presp
;
232 struct cfg80211_inform_bss bss_meta
= {};
233 bool have_higher_than_11mbit
;
237 sdata_assert_lock(sdata
);
239 /* Reset own TSF to allow time synchronization work. */
240 drv_reset_tsf(local
, sdata
);
242 if (!ether_addr_equal(ifibss
->bssid
, bssid
))
243 sta_info_flush(sdata
);
245 /* if merging, indicate to driver that we leave the old IBSS */
246 if (sdata
->vif
.bss_conf
.ibss_joined
) {
247 sdata
->vif
.bss_conf
.ibss_joined
= false;
248 sdata
->vif
.bss_conf
.ibss_creator
= false;
249 sdata
->vif
.bss_conf
.enable_beacon
= false;
250 netif_carrier_off(sdata
->dev
);
251 ieee80211_bss_info_change_notify(sdata
,
253 BSS_CHANGED_BEACON_ENABLED
);
254 drv_leave_ibss(local
, sdata
);
257 presp
= rcu_dereference_protected(ifibss
->presp
,
258 lockdep_is_held(&sdata
->wdev
.mtx
));
259 RCU_INIT_POINTER(ifibss
->presp
, NULL
);
261 kfree_rcu(presp
, rcu_head
);
263 /* make a copy of the chandef, it could be modified below. */
264 chandef
= *req_chandef
;
266 if (!cfg80211_reg_can_beacon(local
->hw
.wiphy
, &chandef
,
267 NL80211_IFTYPE_ADHOC
)) {
268 if (chandef
.width
== NL80211_CHAN_WIDTH_5
||
269 chandef
.width
== NL80211_CHAN_WIDTH_10
||
270 chandef
.width
== NL80211_CHAN_WIDTH_20_NOHT
||
271 chandef
.width
== NL80211_CHAN_WIDTH_20
) {
273 "Failed to join IBSS, beacons forbidden\n");
276 chandef
.width
= NL80211_CHAN_WIDTH_20
;
277 chandef
.center_freq1
= chan
->center_freq
;
278 /* check again for downgraded chandef */
279 if (!cfg80211_reg_can_beacon(local
->hw
.wiphy
, &chandef
,
280 NL80211_IFTYPE_ADHOC
)) {
282 "Failed to join IBSS, beacons forbidden\n");
287 err
= cfg80211_chandef_dfs_required(sdata
->local
->hw
.wiphy
,
288 &chandef
, NL80211_IFTYPE_ADHOC
);
291 "Failed to join IBSS, invalid chandef\n");
294 if (err
> 0 && !ifibss
->userspace_handles_dfs
) {
296 "Failed to join IBSS, DFS channel without control program\n");
300 radar_required
= err
;
302 mutex_lock(&local
->mtx
);
303 if (ieee80211_vif_use_channel(sdata
, &chandef
,
304 ifibss
->fixed_channel
?
305 IEEE80211_CHANCTX_SHARED
:
306 IEEE80211_CHANCTX_EXCLUSIVE
)) {
307 sdata_info(sdata
, "Failed to join IBSS, no channel context\n");
308 mutex_unlock(&local
->mtx
);
311 sdata
->radar_required
= radar_required
;
312 mutex_unlock(&local
->mtx
);
314 memcpy(ifibss
->bssid
, bssid
, ETH_ALEN
);
316 presp
= ieee80211_ibss_build_presp(sdata
, beacon_int
, basic_rates
,
317 capability
, tsf
, &chandef
,
318 &have_higher_than_11mbit
, NULL
);
322 rcu_assign_pointer(ifibss
->presp
, presp
);
323 mgmt
= (void *)presp
->head
;
325 sdata
->vif
.bss_conf
.enable_beacon
= true;
326 sdata
->vif
.bss_conf
.beacon_int
= beacon_int
;
327 sdata
->vif
.bss_conf
.basic_rates
= basic_rates
;
328 sdata
->vif
.bss_conf
.ssid_len
= ifibss
->ssid_len
;
329 memcpy(sdata
->vif
.bss_conf
.ssid
, ifibss
->ssid
, ifibss
->ssid_len
);
330 bss_change
= BSS_CHANGED_BEACON_INT
;
331 bss_change
|= ieee80211_reset_erp_info(sdata
);
332 bss_change
|= BSS_CHANGED_BSSID
;
333 bss_change
|= BSS_CHANGED_BEACON
;
334 bss_change
|= BSS_CHANGED_BEACON_ENABLED
;
335 bss_change
|= BSS_CHANGED_BASIC_RATES
;
336 bss_change
|= BSS_CHANGED_HT
;
337 bss_change
|= BSS_CHANGED_IBSS
;
338 bss_change
|= BSS_CHANGED_SSID
;
341 * In 5 GHz/802.11a, we can always use short slot time.
342 * (IEEE 802.11-2012 18.3.8.7)
344 * In 2.4GHz, we must always use long slots in IBSS for compatibility
346 * (IEEE 802.11-2012 19.4.5)
348 * HT follows these specifications (IEEE 802.11-2012 20.3.18)
350 sdata
->vif
.bss_conf
.use_short_slot
= chan
->band
== IEEE80211_BAND_5GHZ
;
351 bss_change
|= BSS_CHANGED_ERP_SLOT
;
353 /* cf. IEEE 802.11 9.2.12 */
354 if (chan
->band
== IEEE80211_BAND_2GHZ
&& have_higher_than_11mbit
)
355 sdata
->flags
|= IEEE80211_SDATA_OPERATING_GMODE
;
357 sdata
->flags
&= ~IEEE80211_SDATA_OPERATING_GMODE
;
359 ieee80211_set_wmm_default(sdata
, true, false);
361 sdata
->vif
.bss_conf
.ibss_joined
= true;
362 sdata
->vif
.bss_conf
.ibss_creator
= creator
;
364 err
= drv_join_ibss(local
, sdata
);
366 sdata
->vif
.bss_conf
.ibss_joined
= false;
367 sdata
->vif
.bss_conf
.ibss_creator
= false;
368 sdata
->vif
.bss_conf
.enable_beacon
= false;
369 sdata
->vif
.bss_conf
.ssid_len
= 0;
370 RCU_INIT_POINTER(ifibss
->presp
, NULL
);
371 kfree_rcu(presp
, rcu_head
);
372 mutex_lock(&local
->mtx
);
373 ieee80211_vif_release_channel(sdata
);
374 mutex_unlock(&local
->mtx
);
375 sdata_info(sdata
, "Failed to join IBSS, driver failure: %d\n",
380 ieee80211_bss_info_change_notify(sdata
, bss_change
);
382 ifibss
->state
= IEEE80211_IBSS_MLME_JOINED
;
383 mod_timer(&ifibss
->timer
,
384 round_jiffies(jiffies
+ IEEE80211_IBSS_MERGE_INTERVAL
));
386 bss_meta
.chan
= chan
;
387 bss_meta
.scan_width
= cfg80211_chandef_to_scan_width(&chandef
);
388 bss
= cfg80211_inform_bss_frame_data(local
->hw
.wiphy
, &bss_meta
, mgmt
,
389 presp
->head_len
, GFP_KERNEL
);
391 cfg80211_put_bss(local
->hw
.wiphy
, bss
);
392 netif_carrier_on(sdata
->dev
);
393 cfg80211_ibss_joined(sdata
->dev
, ifibss
->bssid
, chan
, GFP_KERNEL
);
396 static void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data
*sdata
,
397 struct ieee80211_bss
*bss
)
399 struct cfg80211_bss
*cbss
=
400 container_of((void *)bss
, struct cfg80211_bss
, priv
);
401 struct ieee80211_supported_band
*sband
;
402 struct cfg80211_chan_def chandef
;
405 u16 beacon_int
= cbss
->beacon_interval
;
406 const struct cfg80211_bss_ies
*ies
;
407 enum nl80211_channel_type chan_type
;
412 sdata_assert_lock(sdata
);
417 switch (sdata
->u
.ibss
.chandef
.width
) {
418 case NL80211_CHAN_WIDTH_20_NOHT
:
419 case NL80211_CHAN_WIDTH_20
:
420 case NL80211_CHAN_WIDTH_40
:
421 chan_type
= cfg80211_get_chandef_type(&sdata
->u
.ibss
.chandef
);
422 cfg80211_chandef_create(&chandef
, cbss
->channel
, chan_type
);
424 case NL80211_CHAN_WIDTH_5
:
425 case NL80211_CHAN_WIDTH_10
:
426 cfg80211_chandef_create(&chandef
, cbss
->channel
,
427 NL80211_CHAN_WIDTH_20_NOHT
);
428 chandef
.width
= sdata
->u
.ibss
.chandef
.width
;
430 case NL80211_CHAN_WIDTH_80
:
431 case NL80211_CHAN_WIDTH_160
:
432 chandef
= sdata
->u
.ibss
.chandef
;
433 chandef
.chan
= cbss
->channel
;
436 /* fall back to 20 MHz for unsupported modes */
437 cfg80211_chandef_create(&chandef
, cbss
->channel
,
438 NL80211_CHAN_WIDTH_20_NOHT
);
442 sband
= sdata
->local
->hw
.wiphy
->bands
[cbss
->channel
->band
];
443 rate_flags
= ieee80211_chandef_rate_flags(&sdata
->u
.ibss
.chandef
);
444 shift
= ieee80211_vif_get_shift(&sdata
->vif
);
448 for (i
= 0; i
< bss
->supp_rates_len
; i
++) {
449 int rate
= bss
->supp_rates
[i
] & 0x7f;
450 bool is_basic
= !!(bss
->supp_rates
[i
] & 0x80);
452 for (j
= 0; j
< sband
->n_bitrates
; j
++) {
454 if ((rate_flags
& sband
->bitrates
[j
].flags
)
458 brate
= DIV_ROUND_UP(sband
->bitrates
[j
].bitrate
,
462 basic_rates
|= BIT(j
);
469 ies
= rcu_dereference(cbss
->ies
);
473 __ieee80211_sta_join_ibss(sdata
, cbss
->bssid
,
481 int ieee80211_ibss_csa_beacon(struct ieee80211_sub_if_data
*sdata
,
482 struct cfg80211_csa_settings
*csa_settings
)
484 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
485 struct beacon_data
*presp
, *old_presp
;
486 struct cfg80211_bss
*cbss
;
487 const struct cfg80211_bss_ies
*ies
;
492 sdata_assert_lock(sdata
);
495 capability
= WLAN_CAPABILITY_PRIVACY
;
497 cbss
= cfg80211_get_bss(sdata
->local
->hw
.wiphy
, ifibss
->chandef
.chan
,
498 ifibss
->bssid
, ifibss
->ssid
,
499 ifibss
->ssid_len
, IEEE80211_BSS_TYPE_IBSS
,
500 IEEE80211_PRIVACY(ifibss
->privacy
));
502 if (WARN_ON(!cbss
)) {
508 ies
= rcu_dereference(cbss
->ies
);
511 cfg80211_put_bss(sdata
->local
->hw
.wiphy
, cbss
);
513 old_presp
= rcu_dereference_protected(ifibss
->presp
,
514 lockdep_is_held(&sdata
->wdev
.mtx
));
516 presp
= ieee80211_ibss_build_presp(sdata
,
517 sdata
->vif
.bss_conf
.beacon_int
,
518 sdata
->vif
.bss_conf
.basic_rates
,
519 capability
, tsf
, &ifibss
->chandef
,
526 rcu_assign_pointer(ifibss
->presp
, presp
);
528 kfree_rcu(old_presp
, rcu_head
);
530 return BSS_CHANGED_BEACON
;
535 int ieee80211_ibss_finish_csa(struct ieee80211_sub_if_data
*sdata
)
537 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
538 struct cfg80211_bss
*cbss
;
539 int err
, changed
= 0;
541 sdata_assert_lock(sdata
);
543 /* update cfg80211 bss information with the new channel */
544 if (!is_zero_ether_addr(ifibss
->bssid
)) {
545 cbss
= cfg80211_get_bss(sdata
->local
->hw
.wiphy
,
546 ifibss
->chandef
.chan
,
547 ifibss
->bssid
, ifibss
->ssid
,
549 IEEE80211_BSS_TYPE_IBSS
,
550 IEEE80211_PRIVACY(ifibss
->privacy
));
551 /* XXX: should not really modify cfg80211 data */
553 cbss
->channel
= sdata
->csa_chandef
.chan
;
554 cfg80211_put_bss(sdata
->local
->hw
.wiphy
, cbss
);
558 ifibss
->chandef
= sdata
->csa_chandef
;
560 /* generate the beacon */
561 err
= ieee80211_ibss_csa_beacon(sdata
, NULL
);
570 void ieee80211_ibss_stop(struct ieee80211_sub_if_data
*sdata
)
572 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
574 cancel_work_sync(&ifibss
->csa_connection_drop_work
);
577 static struct sta_info
*ieee80211_ibss_finish_sta(struct sta_info
*sta
)
580 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
583 memcpy(addr
, sta
->sta
.addr
, ETH_ALEN
);
585 ibss_dbg(sdata
, "Adding new IBSS station %pM\n", addr
);
587 sta_info_pre_move_state(sta
, IEEE80211_STA_AUTH
);
588 sta_info_pre_move_state(sta
, IEEE80211_STA_ASSOC
);
589 /* authorize the station only if the network is not RSN protected. If
590 * not wait for the userspace to authorize it */
591 if (!sta
->sdata
->u
.ibss
.control_port
)
592 sta_info_pre_move_state(sta
, IEEE80211_STA_AUTHORIZED
);
594 rate_control_rate_init(sta
);
596 /* If it fails, maybe we raced another insertion? */
597 if (sta_info_insert_rcu(sta
))
598 return sta_info_get(sdata
, addr
);
602 static struct sta_info
*
603 ieee80211_ibss_add_sta(struct ieee80211_sub_if_data
*sdata
, const u8
*bssid
,
604 const u8
*addr
, u32 supp_rates
)
607 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
608 struct ieee80211_local
*local
= sdata
->local
;
609 struct sta_info
*sta
;
610 struct ieee80211_chanctx_conf
*chanctx_conf
;
611 struct ieee80211_supported_band
*sband
;
612 enum nl80211_bss_scan_width scan_width
;
616 * XXX: Consider removing the least recently used entry and
617 * allow new one to be added.
619 if (local
->num_sta
>= IEEE80211_IBSS_MAX_STA_ENTRIES
) {
620 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
626 if (ifibss
->state
== IEEE80211_IBSS_MLME_SEARCH
) {
631 if (!ether_addr_equal(bssid
, sdata
->u
.ibss
.bssid
)) {
637 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
638 if (WARN_ON_ONCE(!chanctx_conf
))
640 band
= chanctx_conf
->def
.chan
->band
;
641 scan_width
= cfg80211_chandef_to_scan_width(&chanctx_conf
->def
);
644 sta
= sta_info_alloc(sdata
, addr
, GFP_KERNEL
);
650 sta
->rx_stats
.last_rx
= jiffies
;
652 /* make sure mandatory rates are always added */
653 sband
= local
->hw
.wiphy
->bands
[band
];
654 sta
->sta
.supp_rates
[band
] = supp_rates
|
655 ieee80211_mandatory_rates(sband
, scan_width
);
657 return ieee80211_ibss_finish_sta(sta
);
660 static int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data
*sdata
)
662 struct ieee80211_local
*local
= sdata
->local
;
664 struct sta_info
*sta
;
666 sdata_assert_lock(sdata
);
670 list_for_each_entry_rcu(sta
, &local
->sta_list
, list
) {
671 if (sta
->sdata
== sdata
&&
672 time_after(sta
->rx_stats
.last_rx
+
673 IEEE80211_IBSS_MERGE_INTERVAL
,
685 static void ieee80211_ibss_disconnect(struct ieee80211_sub_if_data
*sdata
)
687 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
688 struct ieee80211_local
*local
= sdata
->local
;
689 struct cfg80211_bss
*cbss
;
690 struct beacon_data
*presp
;
691 struct sta_info
*sta
;
693 if (!is_zero_ether_addr(ifibss
->bssid
)) {
694 cbss
= cfg80211_get_bss(local
->hw
.wiphy
, ifibss
->chandef
.chan
,
695 ifibss
->bssid
, ifibss
->ssid
,
697 IEEE80211_BSS_TYPE_IBSS
,
698 IEEE80211_PRIVACY(ifibss
->privacy
));
701 cfg80211_unlink_bss(local
->hw
.wiphy
, cbss
);
702 cfg80211_put_bss(sdata
->local
->hw
.wiphy
, cbss
);
706 ifibss
->state
= IEEE80211_IBSS_MLME_SEARCH
;
708 sta_info_flush(sdata
);
710 spin_lock_bh(&ifibss
->incomplete_lock
);
711 while (!list_empty(&ifibss
->incomplete_stations
)) {
712 sta
= list_first_entry(&ifibss
->incomplete_stations
,
713 struct sta_info
, list
);
714 list_del(&sta
->list
);
715 spin_unlock_bh(&ifibss
->incomplete_lock
);
717 sta_info_free(local
, sta
);
718 spin_lock_bh(&ifibss
->incomplete_lock
);
720 spin_unlock_bh(&ifibss
->incomplete_lock
);
722 netif_carrier_off(sdata
->dev
);
724 sdata
->vif
.bss_conf
.ibss_joined
= false;
725 sdata
->vif
.bss_conf
.ibss_creator
= false;
726 sdata
->vif
.bss_conf
.enable_beacon
= false;
727 sdata
->vif
.bss_conf
.ssid_len
= 0;
730 presp
= rcu_dereference_protected(ifibss
->presp
,
731 lockdep_is_held(&sdata
->wdev
.mtx
));
732 RCU_INIT_POINTER(sdata
->u
.ibss
.presp
, NULL
);
734 kfree_rcu(presp
, rcu_head
);
736 clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED
, &sdata
->state
);
737 ieee80211_bss_info_change_notify(sdata
, BSS_CHANGED_BEACON_ENABLED
|
739 drv_leave_ibss(local
, sdata
);
740 mutex_lock(&local
->mtx
);
741 ieee80211_vif_release_channel(sdata
);
742 mutex_unlock(&local
->mtx
);
745 static void ieee80211_csa_connection_drop_work(struct work_struct
*work
)
747 struct ieee80211_sub_if_data
*sdata
=
748 container_of(work
, struct ieee80211_sub_if_data
,
749 u
.ibss
.csa_connection_drop_work
);
753 ieee80211_ibss_disconnect(sdata
);
755 skb_queue_purge(&sdata
->skb_queue
);
757 /* trigger a scan to find another IBSS network to join */
758 ieee80211_queue_work(&sdata
->local
->hw
, &sdata
->work
);
763 static void ieee80211_ibss_csa_mark_radar(struct ieee80211_sub_if_data
*sdata
)
765 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
768 /* if the current channel is a DFS channel, mark the channel as
771 err
= cfg80211_chandef_dfs_required(sdata
->local
->hw
.wiphy
,
773 NL80211_IFTYPE_ADHOC
);
775 cfg80211_radar_event(sdata
->local
->hw
.wiphy
, &ifibss
->chandef
,
780 ieee80211_ibss_process_chanswitch(struct ieee80211_sub_if_data
*sdata
,
781 struct ieee802_11_elems
*elems
,
784 struct cfg80211_csa_settings params
;
785 struct ieee80211_csa_ie csa_ie
;
786 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
787 enum nl80211_channel_type ch_type
;
791 sdata_assert_lock(sdata
);
793 sta_flags
= IEEE80211_STA_DISABLE_VHT
;
794 switch (ifibss
->chandef
.width
) {
795 case NL80211_CHAN_WIDTH_5
:
796 case NL80211_CHAN_WIDTH_10
:
797 case NL80211_CHAN_WIDTH_20_NOHT
:
798 sta_flags
|= IEEE80211_STA_DISABLE_HT
;
800 case NL80211_CHAN_WIDTH_20
:
801 sta_flags
|= IEEE80211_STA_DISABLE_40MHZ
;
807 memset(¶ms
, 0, sizeof(params
));
808 memset(&csa_ie
, 0, sizeof(csa_ie
));
809 err
= ieee80211_parse_ch_switch_ie(sdata
, elems
,
810 ifibss
->chandef
.chan
->band
,
811 sta_flags
, ifibss
->bssid
, &csa_ie
);
812 /* can't switch to destination channel, fail */
816 /* did not contain a CSA */
820 /* channel switch is not supported, disconnect */
821 if (!(sdata
->local
->hw
.wiphy
->flags
& WIPHY_FLAG_HAS_CHANNEL_SWITCH
))
824 params
.count
= csa_ie
.count
;
825 params
.chandef
= csa_ie
.chandef
;
827 switch (ifibss
->chandef
.width
) {
828 case NL80211_CHAN_WIDTH_20_NOHT
:
829 case NL80211_CHAN_WIDTH_20
:
830 case NL80211_CHAN_WIDTH_40
:
831 /* keep our current HT mode (HT20/HT40+/HT40-), even if
832 * another mode has been announced. The mode is not adopted
833 * within the beacon while doing CSA and we should therefore
834 * keep the mode which we announce.
836 ch_type
= cfg80211_get_chandef_type(&ifibss
->chandef
);
837 cfg80211_chandef_create(¶ms
.chandef
, params
.chandef
.chan
,
840 case NL80211_CHAN_WIDTH_5
:
841 case NL80211_CHAN_WIDTH_10
:
842 if (params
.chandef
.width
!= ifibss
->chandef
.width
) {
844 "IBSS %pM received channel switch from incompatible channel width (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n",
846 params
.chandef
.chan
->center_freq
,
847 params
.chandef
.width
,
848 params
.chandef
.center_freq1
,
849 params
.chandef
.center_freq2
);
854 /* should not happen, sta_flags should prevent VHT modes. */
859 if (!cfg80211_reg_can_beacon(sdata
->local
->hw
.wiphy
, ¶ms
.chandef
,
860 NL80211_IFTYPE_ADHOC
)) {
862 "IBSS %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n",
864 params
.chandef
.chan
->center_freq
,
865 params
.chandef
.width
,
866 params
.chandef
.center_freq1
,
867 params
.chandef
.center_freq2
);
871 err
= cfg80211_chandef_dfs_required(sdata
->local
->hw
.wiphy
,
873 NL80211_IFTYPE_ADHOC
);
876 if (err
> 0 && !ifibss
->userspace_handles_dfs
) {
877 /* IBSS-DFS only allowed with a control program */
881 params
.radar_required
= err
;
883 if (cfg80211_chandef_identical(¶ms
.chandef
,
884 &sdata
->vif
.bss_conf
.chandef
)) {
886 "received csa with an identical chandef, ignoring\n");
890 /* all checks done, now perform the channel switch. */
892 "received channel switch announcement to go to channel %d MHz\n",
893 params
.chandef
.chan
->center_freq
);
895 params
.block_tx
= !!csa_ie
.mode
;
897 if (ieee80211_channel_switch(sdata
->local
->hw
.wiphy
, sdata
->dev
,
901 ieee80211_ibss_csa_mark_radar(sdata
);
905 ibss_dbg(sdata
, "Can't handle channel switch, disconnect\n");
906 ieee80211_queue_work(&sdata
->local
->hw
,
907 &ifibss
->csa_connection_drop_work
);
909 ieee80211_ibss_csa_mark_radar(sdata
);
915 ieee80211_rx_mgmt_spectrum_mgmt(struct ieee80211_sub_if_data
*sdata
,
916 struct ieee80211_mgmt
*mgmt
, size_t len
,
917 struct ieee80211_rx_status
*rx_status
,
918 struct ieee802_11_elems
*elems
)
922 if (len
< IEEE80211_MIN_ACTION_SIZE
+ 1)
925 /* CSA is the only action we handle for now */
926 if (mgmt
->u
.action
.u
.measurement
.action_code
!=
927 WLAN_ACTION_SPCT_CHL_SWITCH
)
930 required_len
= IEEE80211_MIN_ACTION_SIZE
+
931 sizeof(mgmt
->u
.action
.u
.chan_switch
);
932 if (len
< required_len
)
935 if (!sdata
->vif
.csa_active
)
936 ieee80211_ibss_process_chanswitch(sdata
, elems
, false);
939 static void ieee80211_rx_mgmt_deauth_ibss(struct ieee80211_sub_if_data
*sdata
,
940 struct ieee80211_mgmt
*mgmt
,
943 u16 reason
= le16_to_cpu(mgmt
->u
.deauth
.reason_code
);
945 if (len
< IEEE80211_DEAUTH_FRAME_LEN
)
948 ibss_dbg(sdata
, "RX DeAuth SA=%pM DA=%pM BSSID=%pM (reason: %d)\n",
949 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
, reason
);
950 sta_info_destroy_addr(sdata
, mgmt
->sa
);
953 static void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data
*sdata
,
954 struct ieee80211_mgmt
*mgmt
,
957 u16 auth_alg
, auth_transaction
;
959 sdata_assert_lock(sdata
);
964 auth_alg
= le16_to_cpu(mgmt
->u
.auth
.auth_alg
);
965 auth_transaction
= le16_to_cpu(mgmt
->u
.auth
.auth_transaction
);
968 "RX Auth SA=%pM DA=%pM BSSID=%pM (auth_transaction=%d)\n",
969 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
, auth_transaction
);
971 if (auth_alg
!= WLAN_AUTH_OPEN
|| auth_transaction
!= 1)
975 * IEEE 802.11 standard does not require authentication in IBSS
976 * networks and most implementations do not seem to use it.
977 * However, try to reply to authentication attempts if someone
978 * has actually implemented this.
980 ieee80211_send_auth(sdata
, 2, WLAN_AUTH_OPEN
, 0, NULL
, 0,
981 mgmt
->sa
, sdata
->u
.ibss
.bssid
, NULL
, 0, 0, 0);
984 static void ieee80211_update_sta_info(struct ieee80211_sub_if_data
*sdata
,
985 struct ieee80211_mgmt
*mgmt
, size_t len
,
986 struct ieee80211_rx_status
*rx_status
,
987 struct ieee802_11_elems
*elems
,
988 struct ieee80211_channel
*channel
)
990 struct sta_info
*sta
;
991 enum ieee80211_band band
= rx_status
->band
;
992 enum nl80211_bss_scan_width scan_width
;
993 struct ieee80211_local
*local
= sdata
->local
;
994 struct ieee80211_supported_band
*sband
= local
->hw
.wiphy
->bands
[band
];
995 bool rates_updated
= false;
998 if (sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
)
1001 if (!ether_addr_equal(mgmt
->bssid
, sdata
->u
.ibss
.bssid
))
1005 sta
= sta_info_get(sdata
, mgmt
->sa
);
1007 if (elems
->supp_rates
) {
1008 supp_rates
= ieee80211_sta_get_rates(sdata
, elems
,
1013 prev_rates
= sta
->sta
.supp_rates
[band
];
1014 /* make sure mandatory rates are always added */
1015 scan_width
= NL80211_BSS_CHAN_WIDTH_20
;
1016 if (rx_status
->flag
& RX_FLAG_5MHZ
)
1017 scan_width
= NL80211_BSS_CHAN_WIDTH_5
;
1018 if (rx_status
->flag
& RX_FLAG_10MHZ
)
1019 scan_width
= NL80211_BSS_CHAN_WIDTH_10
;
1021 sta
->sta
.supp_rates
[band
] = supp_rates
|
1022 ieee80211_mandatory_rates(sband
, scan_width
);
1023 if (sta
->sta
.supp_rates
[band
] != prev_rates
) {
1025 "updated supp_rates set for %pM based on beacon/probe_resp (0x%x -> 0x%x)\n",
1026 sta
->sta
.addr
, prev_rates
,
1027 sta
->sta
.supp_rates
[band
]);
1028 rates_updated
= true;
1032 sta
= ieee80211_ibss_add_sta(sdata
, mgmt
->bssid
,
1033 mgmt
->sa
, supp_rates
);
1037 if (sta
&& !sta
->sta
.wme
&&
1038 elems
->wmm_info
&& local
->hw
.queues
>= IEEE80211_NUM_ACS
) {
1039 sta
->sta
.wme
= true;
1040 ieee80211_check_fast_xmit(sta
);
1043 if (sta
&& elems
->ht_operation
&& elems
->ht_cap_elem
&&
1044 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_20_NOHT
&&
1045 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_5
&&
1046 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_10
) {
1047 /* we both use HT */
1048 struct ieee80211_ht_cap htcap_ie
;
1049 struct cfg80211_chan_def chandef
;
1050 enum ieee80211_sta_rx_bandwidth bw
= sta
->sta
.bandwidth
;
1052 ieee80211_ht_oper_to_chandef(channel
,
1053 elems
->ht_operation
,
1056 memcpy(&htcap_ie
, elems
->ht_cap_elem
, sizeof(htcap_ie
));
1057 rates_updated
|= ieee80211_ht_cap_ie_to_sta_ht_cap(sdata
, sband
,
1061 if (elems
->vht_operation
&& elems
->vht_cap_elem
&&
1062 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_20
&&
1063 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_40
) {
1064 /* we both use VHT */
1065 struct ieee80211_vht_cap cap_ie
;
1066 struct ieee80211_sta_vht_cap cap
= sta
->sta
.vht_cap
;
1068 ieee80211_vht_oper_to_chandef(channel
,
1069 elems
->vht_operation
,
1071 memcpy(&cap_ie
, elems
->vht_cap_elem
, sizeof(cap_ie
));
1072 ieee80211_vht_cap_ie_to_sta_vht_cap(sdata
, sband
,
1074 if (memcmp(&cap
, &sta
->sta
.vht_cap
, sizeof(cap
)))
1075 rates_updated
|= true;
1078 if (bw
!= sta
->sta
.bandwidth
)
1079 rates_updated
|= true;
1081 if (!cfg80211_chandef_compatible(&sdata
->u
.ibss
.chandef
,
1086 if (sta
&& rates_updated
) {
1087 u32 changed
= IEEE80211_RC_SUPP_RATES_CHANGED
;
1088 u8 rx_nss
= sta
->sta
.rx_nss
;
1090 /* Force rx_nss recalculation */
1091 sta
->sta
.rx_nss
= 0;
1092 rate_control_rate_init(sta
);
1093 if (sta
->sta
.rx_nss
!= rx_nss
)
1094 changed
|= IEEE80211_RC_NSS_CHANGED
;
1096 drv_sta_rc_update(local
, sdata
, &sta
->sta
, changed
);
1102 static void ieee80211_rx_bss_info(struct ieee80211_sub_if_data
*sdata
,
1103 struct ieee80211_mgmt
*mgmt
, size_t len
,
1104 struct ieee80211_rx_status
*rx_status
,
1105 struct ieee802_11_elems
*elems
)
1107 struct ieee80211_local
*local
= sdata
->local
;
1108 struct cfg80211_bss
*cbss
;
1109 struct ieee80211_bss
*bss
;
1110 struct ieee80211_channel
*channel
;
1111 u64 beacon_timestamp
, rx_timestamp
;
1113 enum ieee80211_band band
= rx_status
->band
;
1115 channel
= ieee80211_get_channel(local
->hw
.wiphy
, rx_status
->freq
);
1119 ieee80211_update_sta_info(sdata
, mgmt
, len
, rx_status
, elems
, channel
);
1121 bss
= ieee80211_bss_info_update(local
, rx_status
, mgmt
, len
, elems
,
1126 cbss
= container_of((void *)bss
, struct cfg80211_bss
, priv
);
1128 /* same for beacon and probe response */
1129 beacon_timestamp
= le64_to_cpu(mgmt
->u
.beacon
.timestamp
);
1131 /* check if we need to merge IBSS */
1134 if (!(cbss
->capability
& WLAN_CAPABILITY_IBSS
))
1137 /* different channel */
1138 if (sdata
->u
.ibss
.fixed_channel
&&
1139 sdata
->u
.ibss
.chandef
.chan
!= cbss
->channel
)
1142 /* different SSID */
1143 if (elems
->ssid_len
!= sdata
->u
.ibss
.ssid_len
||
1144 memcmp(elems
->ssid
, sdata
->u
.ibss
.ssid
,
1145 sdata
->u
.ibss
.ssid_len
))
1148 /* process channel switch */
1149 if (sdata
->vif
.csa_active
||
1150 ieee80211_ibss_process_chanswitch(sdata
, elems
, true))
1154 if (ether_addr_equal(cbss
->bssid
, sdata
->u
.ibss
.bssid
))
1157 /* we use a fixed BSSID */
1158 if (sdata
->u
.ibss
.fixed_bssid
)
1161 if (ieee80211_have_rx_timestamp(rx_status
)) {
1162 /* time when timestamp field was received */
1164 ieee80211_calculate_rx_timestamp(local
, rx_status
,
1168 * second best option: get current TSF
1169 * (will return -1 if not supported)
1171 rx_timestamp
= drv_get_tsf(local
, sdata
);
1175 "RX beacon SA=%pM BSSID=%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n",
1176 mgmt
->sa
, mgmt
->bssid
,
1177 (unsigned long long)rx_timestamp
,
1178 (unsigned long long)beacon_timestamp
,
1179 (unsigned long long)(rx_timestamp
- beacon_timestamp
),
1182 if (beacon_timestamp
> rx_timestamp
) {
1184 "beacon TSF higher than local TSF - IBSS merge with BSSID %pM\n",
1186 ieee80211_sta_join_ibss(sdata
, bss
);
1187 supp_rates
= ieee80211_sta_get_rates(sdata
, elems
, band
, NULL
);
1188 ieee80211_ibss_add_sta(sdata
, mgmt
->bssid
, mgmt
->sa
,
1194 ieee80211_rx_bss_put(local
, bss
);
1197 void ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data
*sdata
,
1198 const u8
*bssid
, const u8
*addr
,
1201 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1202 struct ieee80211_local
*local
= sdata
->local
;
1203 struct sta_info
*sta
;
1204 struct ieee80211_chanctx_conf
*chanctx_conf
;
1205 struct ieee80211_supported_band
*sband
;
1206 enum nl80211_bss_scan_width scan_width
;
1210 * XXX: Consider removing the least recently used entry and
1211 * allow new one to be added.
1213 if (local
->num_sta
>= IEEE80211_IBSS_MAX_STA_ENTRIES
) {
1214 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
1219 if (ifibss
->state
== IEEE80211_IBSS_MLME_SEARCH
)
1222 if (!ether_addr_equal(bssid
, sdata
->u
.ibss
.bssid
))
1226 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
1227 if (WARN_ON_ONCE(!chanctx_conf
)) {
1231 band
= chanctx_conf
->def
.chan
->band
;
1232 scan_width
= cfg80211_chandef_to_scan_width(&chanctx_conf
->def
);
1235 sta
= sta_info_alloc(sdata
, addr
, GFP_ATOMIC
);
1239 sta
->rx_stats
.last_rx
= jiffies
;
1241 /* make sure mandatory rates are always added */
1242 sband
= local
->hw
.wiphy
->bands
[band
];
1243 sta
->sta
.supp_rates
[band
] = supp_rates
|
1244 ieee80211_mandatory_rates(sband
, scan_width
);
1246 spin_lock(&ifibss
->incomplete_lock
);
1247 list_add(&sta
->list
, &ifibss
->incomplete_stations
);
1248 spin_unlock(&ifibss
->incomplete_lock
);
1249 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
1252 static void ieee80211_ibss_sta_expire(struct ieee80211_sub_if_data
*sdata
)
1254 struct ieee80211_local
*local
= sdata
->local
;
1255 struct sta_info
*sta
, *tmp
;
1256 unsigned long exp_time
= IEEE80211_IBSS_INACTIVITY_LIMIT
;
1257 unsigned long exp_rsn
= IEEE80211_IBSS_RSN_INACTIVITY_LIMIT
;
1259 mutex_lock(&local
->sta_mtx
);
1261 list_for_each_entry_safe(sta
, tmp
, &local
->sta_list
, list
) {
1262 if (sdata
!= sta
->sdata
)
1265 if (time_after(jiffies
, sta
->rx_stats
.last_rx
+ exp_time
) ||
1266 (time_after(jiffies
, sta
->rx_stats
.last_rx
+ exp_rsn
) &&
1267 sta
->sta_state
!= IEEE80211_STA_AUTHORIZED
)) {
1268 sta_dbg(sta
->sdata
, "expiring inactive %sSTA %pM\n",
1269 sta
->sta_state
!= IEEE80211_STA_AUTHORIZED
?
1270 "not authorized " : "", sta
->sta
.addr
);
1272 WARN_ON(__sta_info_destroy(sta
));
1276 mutex_unlock(&local
->sta_mtx
);
1280 * This function is called with state == IEEE80211_IBSS_MLME_JOINED
1283 static void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data
*sdata
)
1285 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1286 enum nl80211_bss_scan_width scan_width
;
1288 sdata_assert_lock(sdata
);
1290 mod_timer(&ifibss
->timer
,
1291 round_jiffies(jiffies
+ IEEE80211_IBSS_MERGE_INTERVAL
));
1293 ieee80211_ibss_sta_expire(sdata
);
1295 if (time_before(jiffies
, ifibss
->last_scan_completed
+
1296 IEEE80211_IBSS_MERGE_INTERVAL
))
1299 if (ieee80211_sta_active_ibss(sdata
))
1302 if (ifibss
->fixed_channel
)
1306 "No active IBSS STAs - trying to scan for other IBSS networks with same SSID (merge)\n");
1308 scan_width
= cfg80211_chandef_to_scan_width(&ifibss
->chandef
);
1309 ieee80211_request_ibss_scan(sdata
, ifibss
->ssid
, ifibss
->ssid_len
,
1310 NULL
, 0, scan_width
);
1313 static void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data
*sdata
)
1315 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1320 sdata_assert_lock(sdata
);
1322 if (ifibss
->fixed_bssid
) {
1323 memcpy(bssid
, ifibss
->bssid
, ETH_ALEN
);
1325 /* Generate random, not broadcast, locally administered BSSID. Mix in
1326 * own MAC address to make sure that devices that do not have proper
1327 * random number generator get different BSSID. */
1328 get_random_bytes(bssid
, ETH_ALEN
);
1329 for (i
= 0; i
< ETH_ALEN
; i
++)
1330 bssid
[i
] ^= sdata
->vif
.addr
[i
];
1335 sdata_info(sdata
, "Creating new IBSS network, BSSID %pM\n", bssid
);
1337 capability
= WLAN_CAPABILITY_IBSS
;
1339 if (ifibss
->privacy
)
1340 capability
|= WLAN_CAPABILITY_PRIVACY
;
1342 __ieee80211_sta_join_ibss(sdata
, bssid
, sdata
->vif
.bss_conf
.beacon_int
,
1343 &ifibss
->chandef
, ifibss
->basic_rates
,
1344 capability
, 0, true);
1347 static unsigned ibss_setup_channels(struct wiphy
*wiphy
,
1348 struct ieee80211_channel
**channels
,
1349 unsigned int channels_max
,
1350 u32 center_freq
, u32 width
)
1352 struct ieee80211_channel
*chan
= NULL
;
1353 unsigned int n_chan
= 0;
1354 u32 start_freq
, end_freq
, freq
;
1357 start_freq
= center_freq
;
1358 end_freq
= center_freq
;
1360 start_freq
= center_freq
- width
/ 2 + 10;
1361 end_freq
= center_freq
+ width
/ 2 - 10;
1364 for (freq
= start_freq
; freq
<= end_freq
; freq
+= 20) {
1365 chan
= ieee80211_get_channel(wiphy
, freq
);
1368 if (n_chan
>= channels_max
)
1371 channels
[n_chan
] = chan
;
1379 ieee80211_ibss_setup_scan_channels(struct wiphy
*wiphy
,
1380 const struct cfg80211_chan_def
*chandef
,
1381 struct ieee80211_channel
**channels
,
1382 unsigned int channels_max
)
1384 unsigned int n_chan
= 0;
1385 u32 width
, cf1
, cf2
= 0;
1387 switch (chandef
->width
) {
1388 case NL80211_CHAN_WIDTH_40
:
1391 case NL80211_CHAN_WIDTH_80P80
:
1392 cf2
= chandef
->center_freq2
;
1394 case NL80211_CHAN_WIDTH_80
:
1397 case NL80211_CHAN_WIDTH_160
:
1405 cf1
= chandef
->center_freq1
;
1407 n_chan
= ibss_setup_channels(wiphy
, channels
, channels_max
, cf1
, width
);
1410 n_chan
+= ibss_setup_channels(wiphy
, &channels
[n_chan
],
1411 channels_max
- n_chan
, cf2
,
1418 * This function is called with state == IEEE80211_IBSS_MLME_SEARCH
1421 static void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data
*sdata
)
1423 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1424 struct ieee80211_local
*local
= sdata
->local
;
1425 struct cfg80211_bss
*cbss
;
1426 struct ieee80211_channel
*chan
= NULL
;
1427 const u8
*bssid
= NULL
;
1428 enum nl80211_bss_scan_width scan_width
;
1431 sdata_assert_lock(sdata
);
1433 active_ibss
= ieee80211_sta_active_ibss(sdata
);
1434 ibss_dbg(sdata
, "sta_find_ibss (active_ibss=%d)\n", active_ibss
);
1439 if (ifibss
->fixed_bssid
)
1440 bssid
= ifibss
->bssid
;
1441 if (ifibss
->fixed_channel
)
1442 chan
= ifibss
->chandef
.chan
;
1443 if (!is_zero_ether_addr(ifibss
->bssid
))
1444 bssid
= ifibss
->bssid
;
1445 cbss
= cfg80211_get_bss(local
->hw
.wiphy
, chan
, bssid
,
1446 ifibss
->ssid
, ifibss
->ssid_len
,
1447 IEEE80211_BSS_TYPE_IBSS
,
1448 IEEE80211_PRIVACY(ifibss
->privacy
));
1451 struct ieee80211_bss
*bss
;
1453 bss
= (void *)cbss
->priv
;
1455 "sta_find_ibss: selected %pM current %pM\n",
1456 cbss
->bssid
, ifibss
->bssid
);
1458 "Selected IBSS BSSID %pM based on configured SSID\n",
1461 ieee80211_sta_join_ibss(sdata
, bss
);
1462 ieee80211_rx_bss_put(local
, bss
);
1466 /* if a fixed bssid and a fixed freq have been provided create the IBSS
1467 * directly and do not waste time scanning
1469 if (ifibss
->fixed_bssid
&& ifibss
->fixed_channel
) {
1470 sdata_info(sdata
, "Created IBSS using preconfigured BSSID %pM\n",
1472 ieee80211_sta_create_ibss(sdata
);
1477 ibss_dbg(sdata
, "sta_find_ibss: did not try to join ibss\n");
1479 /* Selected IBSS not found in current scan results - try to scan */
1480 if (time_after(jiffies
, ifibss
->last_scan_completed
+
1481 IEEE80211_SCAN_INTERVAL
)) {
1482 struct ieee80211_channel
*channels
[8];
1485 sdata_info(sdata
, "Trigger new scan to find an IBSS to join\n");
1487 num
= ieee80211_ibss_setup_scan_channels(local
->hw
.wiphy
,
1490 ARRAY_SIZE(channels
));
1491 scan_width
= cfg80211_chandef_to_scan_width(&ifibss
->chandef
);
1492 ieee80211_request_ibss_scan(sdata
, ifibss
->ssid
,
1493 ifibss
->ssid_len
, channels
, num
,
1496 int interval
= IEEE80211_SCAN_INTERVAL
;
1498 if (time_after(jiffies
, ifibss
->ibss_join_req
+
1499 IEEE80211_IBSS_JOIN_TIMEOUT
))
1500 ieee80211_sta_create_ibss(sdata
);
1502 mod_timer(&ifibss
->timer
,
1503 round_jiffies(jiffies
+ interval
));
1507 static void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data
*sdata
,
1508 struct sk_buff
*req
)
1510 struct ieee80211_mgmt
*mgmt
= (void *)req
->data
;
1511 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1512 struct ieee80211_local
*local
= sdata
->local
;
1513 int tx_last_beacon
, len
= req
->len
;
1514 struct sk_buff
*skb
;
1515 struct beacon_data
*presp
;
1518 sdata_assert_lock(sdata
);
1520 presp
= rcu_dereference_protected(ifibss
->presp
,
1521 lockdep_is_held(&sdata
->wdev
.mtx
));
1523 if (ifibss
->state
!= IEEE80211_IBSS_MLME_JOINED
||
1524 len
< 24 + 2 || !presp
)
1527 tx_last_beacon
= drv_tx_last_beacon(local
);
1530 "RX ProbeReq SA=%pM DA=%pM BSSID=%pM (tx_last_beacon=%d)\n",
1531 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
, tx_last_beacon
);
1533 if (!tx_last_beacon
&& is_multicast_ether_addr(mgmt
->da
))
1536 if (!ether_addr_equal(mgmt
->bssid
, ifibss
->bssid
) &&
1537 !is_broadcast_ether_addr(mgmt
->bssid
))
1540 end
= ((u8
*) mgmt
) + len
;
1541 pos
= mgmt
->u
.probe_req
.variable
;
1542 if (pos
[0] != WLAN_EID_SSID
||
1543 pos
+ 2 + pos
[1] > end
) {
1544 ibss_dbg(sdata
, "Invalid SSID IE in ProbeReq from %pM\n",
1549 (pos
[1] != ifibss
->ssid_len
||
1550 memcmp(pos
+ 2, ifibss
->ssid
, ifibss
->ssid_len
))) {
1551 /* Ignore ProbeReq for foreign SSID */
1555 /* Reply with ProbeResp */
1556 skb
= dev_alloc_skb(local
->tx_headroom
+ presp
->head_len
);
1560 skb_reserve(skb
, local
->tx_headroom
);
1561 memcpy(skb_put(skb
, presp
->head_len
), presp
->head
, presp
->head_len
);
1563 memcpy(((struct ieee80211_mgmt
*) skb
->data
)->da
, mgmt
->sa
, ETH_ALEN
);
1564 ibss_dbg(sdata
, "Sending ProbeResp to %pM\n", mgmt
->sa
);
1565 IEEE80211_SKB_CB(skb
)->flags
|= IEEE80211_TX_INTFL_DONT_ENCRYPT
;
1567 /* avoid excessive retries for probe request to wildcard SSIDs */
1569 IEEE80211_SKB_CB(skb
)->flags
|= IEEE80211_TX_CTL_NO_ACK
;
1571 ieee80211_tx_skb(sdata
, skb
);
1575 void ieee80211_rx_mgmt_probe_beacon(struct ieee80211_sub_if_data
*sdata
,
1576 struct ieee80211_mgmt
*mgmt
, size_t len
,
1577 struct ieee80211_rx_status
*rx_status
)
1580 struct ieee802_11_elems elems
;
1582 BUILD_BUG_ON(offsetof(typeof(mgmt
->u
.probe_resp
), variable
) !=
1583 offsetof(typeof(mgmt
->u
.beacon
), variable
));
1586 * either beacon or probe_resp but the variable field is at the
1589 baselen
= (u8
*) mgmt
->u
.probe_resp
.variable
- (u8
*) mgmt
;
1593 ieee802_11_parse_elems(mgmt
->u
.probe_resp
.variable
, len
- baselen
,
1596 ieee80211_rx_bss_info(sdata
, mgmt
, len
, rx_status
, &elems
);
1599 void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data
*sdata
,
1600 struct sk_buff
*skb
)
1602 struct ieee80211_rx_status
*rx_status
;
1603 struct ieee80211_mgmt
*mgmt
;
1605 struct ieee802_11_elems elems
;
1608 rx_status
= IEEE80211_SKB_RXCB(skb
);
1609 mgmt
= (struct ieee80211_mgmt
*) skb
->data
;
1610 fc
= le16_to_cpu(mgmt
->frame_control
);
1614 if (!sdata
->u
.ibss
.ssid_len
)
1615 goto mgmt_out
; /* not ready to merge yet */
1617 switch (fc
& IEEE80211_FCTL_STYPE
) {
1618 case IEEE80211_STYPE_PROBE_REQ
:
1619 ieee80211_rx_mgmt_probe_req(sdata
, skb
);
1621 case IEEE80211_STYPE_PROBE_RESP
:
1622 case IEEE80211_STYPE_BEACON
:
1623 ieee80211_rx_mgmt_probe_beacon(sdata
, mgmt
, skb
->len
,
1626 case IEEE80211_STYPE_AUTH
:
1627 ieee80211_rx_mgmt_auth_ibss(sdata
, mgmt
, skb
->len
);
1629 case IEEE80211_STYPE_DEAUTH
:
1630 ieee80211_rx_mgmt_deauth_ibss(sdata
, mgmt
, skb
->len
);
1632 case IEEE80211_STYPE_ACTION
:
1633 switch (mgmt
->u
.action
.category
) {
1634 case WLAN_CATEGORY_SPECTRUM_MGMT
:
1635 ies_len
= skb
->len
-
1636 offsetof(struct ieee80211_mgmt
,
1637 u
.action
.u
.chan_switch
.variable
);
1642 ieee802_11_parse_elems(
1643 mgmt
->u
.action
.u
.chan_switch
.variable
,
1644 ies_len
, true, &elems
);
1646 if (elems
.parse_error
)
1649 ieee80211_rx_mgmt_spectrum_mgmt(sdata
, mgmt
, skb
->len
,
1656 sdata_unlock(sdata
);
1659 void ieee80211_ibss_work(struct ieee80211_sub_if_data
*sdata
)
1661 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1662 struct sta_info
*sta
;
1667 * Work could be scheduled after scan or similar
1668 * when we aren't even joined (or trying) with a
1671 if (!ifibss
->ssid_len
)
1674 spin_lock_bh(&ifibss
->incomplete_lock
);
1675 while (!list_empty(&ifibss
->incomplete_stations
)) {
1676 sta
= list_first_entry(&ifibss
->incomplete_stations
,
1677 struct sta_info
, list
);
1678 list_del(&sta
->list
);
1679 spin_unlock_bh(&ifibss
->incomplete_lock
);
1681 ieee80211_ibss_finish_sta(sta
);
1683 spin_lock_bh(&ifibss
->incomplete_lock
);
1685 spin_unlock_bh(&ifibss
->incomplete_lock
);
1687 switch (ifibss
->state
) {
1688 case IEEE80211_IBSS_MLME_SEARCH
:
1689 ieee80211_sta_find_ibss(sdata
);
1691 case IEEE80211_IBSS_MLME_JOINED
:
1692 ieee80211_sta_merge_ibss(sdata
);
1700 sdata_unlock(sdata
);
1703 static void ieee80211_ibss_timer(unsigned long data
)
1705 struct ieee80211_sub_if_data
*sdata
=
1706 (struct ieee80211_sub_if_data
*) data
;
1708 ieee80211_queue_work(&sdata
->local
->hw
, &sdata
->work
);
1711 void ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data
*sdata
)
1713 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1715 setup_timer(&ifibss
->timer
, ieee80211_ibss_timer
,
1716 (unsigned long) sdata
);
1717 INIT_LIST_HEAD(&ifibss
->incomplete_stations
);
1718 spin_lock_init(&ifibss
->incomplete_lock
);
1719 INIT_WORK(&ifibss
->csa_connection_drop_work
,
1720 ieee80211_csa_connection_drop_work
);
1723 /* scan finished notification */
1724 void ieee80211_ibss_notify_scan_completed(struct ieee80211_local
*local
)
1726 struct ieee80211_sub_if_data
*sdata
;
1728 mutex_lock(&local
->iflist_mtx
);
1729 list_for_each_entry(sdata
, &local
->interfaces
, list
) {
1730 if (!ieee80211_sdata_running(sdata
))
1732 if (sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
)
1734 sdata
->u
.ibss
.last_scan_completed
= jiffies
;
1735 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
1737 mutex_unlock(&local
->iflist_mtx
);
1740 int ieee80211_ibss_join(struct ieee80211_sub_if_data
*sdata
,
1741 struct cfg80211_ibss_params
*params
)
1745 struct ieee80211_supported_band
*sband
;
1746 enum ieee80211_chanctx_mode chanmode
;
1747 struct ieee80211_local
*local
= sdata
->local
;
1748 int radar_detect_width
= 0;
1752 ret
= cfg80211_chandef_dfs_required(local
->hw
.wiphy
,
1754 sdata
->wdev
.iftype
);
1759 if (!params
->userspace_handles_dfs
)
1761 radar_detect_width
= BIT(params
->chandef
.width
);
1764 chanmode
= (params
->channel_fixed
&& !ret
) ?
1765 IEEE80211_CHANCTX_SHARED
: IEEE80211_CHANCTX_EXCLUSIVE
;
1767 mutex_lock(&local
->chanctx_mtx
);
1768 ret
= ieee80211_check_combinations(sdata
, ¶ms
->chandef
, chanmode
,
1769 radar_detect_width
);
1770 mutex_unlock(&local
->chanctx_mtx
);
1774 if (params
->bssid
) {
1775 memcpy(sdata
->u
.ibss
.bssid
, params
->bssid
, ETH_ALEN
);
1776 sdata
->u
.ibss
.fixed_bssid
= true;
1778 sdata
->u
.ibss
.fixed_bssid
= false;
1780 sdata
->u
.ibss
.privacy
= params
->privacy
;
1781 sdata
->u
.ibss
.control_port
= params
->control_port
;
1782 sdata
->u
.ibss
.userspace_handles_dfs
= params
->userspace_handles_dfs
;
1783 sdata
->u
.ibss
.basic_rates
= params
->basic_rates
;
1784 sdata
->u
.ibss
.last_scan_completed
= jiffies
;
1786 /* fix basic_rates if channel does not support these rates */
1787 rate_flags
= ieee80211_chandef_rate_flags(¶ms
->chandef
);
1788 sband
= local
->hw
.wiphy
->bands
[params
->chandef
.chan
->band
];
1789 for (i
= 0; i
< sband
->n_bitrates
; i
++) {
1790 if ((rate_flags
& sband
->bitrates
[i
].flags
) != rate_flags
)
1791 sdata
->u
.ibss
.basic_rates
&= ~BIT(i
);
1793 memcpy(sdata
->vif
.bss_conf
.mcast_rate
, params
->mcast_rate
,
1794 sizeof(params
->mcast_rate
));
1796 sdata
->vif
.bss_conf
.beacon_int
= params
->beacon_interval
;
1798 sdata
->u
.ibss
.chandef
= params
->chandef
;
1799 sdata
->u
.ibss
.fixed_channel
= params
->channel_fixed
;
1802 sdata
->u
.ibss
.ie
= kmemdup(params
->ie
, params
->ie_len
,
1804 if (sdata
->u
.ibss
.ie
)
1805 sdata
->u
.ibss
.ie_len
= params
->ie_len
;
1808 sdata
->u
.ibss
.state
= IEEE80211_IBSS_MLME_SEARCH
;
1809 sdata
->u
.ibss
.ibss_join_req
= jiffies
;
1811 memcpy(sdata
->u
.ibss
.ssid
, params
->ssid
, params
->ssid_len
);
1812 sdata
->u
.ibss
.ssid_len
= params
->ssid_len
;
1814 memcpy(&sdata
->u
.ibss
.ht_capa
, ¶ms
->ht_capa
,
1815 sizeof(sdata
->u
.ibss
.ht_capa
));
1816 memcpy(&sdata
->u
.ibss
.ht_capa_mask
, ¶ms
->ht_capa_mask
,
1817 sizeof(sdata
->u
.ibss
.ht_capa_mask
));
1820 * 802.11n-2009 9.13.3.1: In an IBSS, the HT Protection field is
1821 * reserved, but an HT STA shall protect HT transmissions as though
1822 * the HT Protection field were set to non-HT mixed mode.
1824 * In an IBSS, the RIFS Mode field of the HT Operation element is
1825 * also reserved, but an HT STA shall operate as though this field
1829 sdata
->vif
.bss_conf
.ht_operation_mode
|=
1830 IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED
1831 | IEEE80211_HT_PARAM_RIFS_MODE
;
1833 changed
|= BSS_CHANGED_HT
;
1834 ieee80211_bss_info_change_notify(sdata
, changed
);
1836 sdata
->smps_mode
= IEEE80211_SMPS_OFF
;
1837 sdata
->needed_rx_chains
= local
->rx_chains
;
1839 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
1844 int ieee80211_ibss_leave(struct ieee80211_sub_if_data
*sdata
)
1846 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1848 ieee80211_ibss_disconnect(sdata
);
1849 ifibss
->ssid_len
= 0;
1850 eth_zero_addr(ifibss
->bssid
);
1853 kfree(sdata
->u
.ibss
.ie
);
1855 /* on the next join, re-program HT parameters */
1856 memset(&ifibss
->ht_capa
, 0, sizeof(ifibss
->ht_capa
));
1857 memset(&ifibss
->ht_capa_mask
, 0, sizeof(ifibss
->ht_capa_mask
));
1861 skb_queue_purge(&sdata
->skb_queue
);
1863 del_timer_sync(&sdata
->u
.ibss
.timer
);