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
10 * Copyright(c) 2016 Intel Deutschland GmbH
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License version 2 as
14 * published by the Free Software Foundation.
17 #include <linux/delay.h>
18 #include <linux/slab.h>
19 #include <linux/if_ether.h>
20 #include <linux/skbuff.h>
21 #include <linux/if_arp.h>
22 #include <linux/etherdevice.h>
23 #include <linux/rtnetlink.h>
24 #include <net/mac80211.h>
26 #include "ieee80211_i.h"
27 #include "driver-ops.h"
30 #define IEEE80211_SCAN_INTERVAL (2 * HZ)
31 #define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ)
33 #define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ)
34 #define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ)
35 #define IEEE80211_IBSS_RSN_INACTIVITY_LIMIT (10 * HZ)
37 #define IEEE80211_IBSS_MAX_STA_ENTRIES 128
39 static struct beacon_data
*
40 ieee80211_ibss_build_presp(struct ieee80211_sub_if_data
*sdata
,
41 const int beacon_int
, const u32 basic_rates
,
42 const u16 capability
, u64 tsf
,
43 struct cfg80211_chan_def
*chandef
,
44 bool *have_higher_than_11mbit
,
45 struct cfg80211_csa_settings
*csa_settings
)
47 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
48 struct ieee80211_local
*local
= sdata
->local
;
49 int rates_n
= 0, i
, ri
;
50 struct ieee80211_mgmt
*mgmt
;
52 struct ieee80211_supported_band
*sband
;
53 u32 rate_flags
, rates
= 0, rates_added
= 0;
54 struct beacon_data
*presp
;
58 /* Build IBSS probe response */
59 frame_len
= sizeof(struct ieee80211_hdr_3addr
) +
60 12 /* struct ieee80211_mgmt.u.beacon */ +
61 2 + IEEE80211_MAX_SSID_LEN
/* max SSID */ +
62 2 + 8 /* max Supported Rates */ +
63 3 /* max DS params */ +
65 5 /* Channel Switch Announcement */ +
66 2 + (IEEE80211_MAX_SUPP_RATES
- 8) +
67 2 + sizeof(struct ieee80211_ht_cap
) +
68 2 + sizeof(struct ieee80211_ht_operation
) +
69 2 + sizeof(struct ieee80211_vht_cap
) +
70 2 + sizeof(struct ieee80211_vht_operation
) +
72 presp
= kzalloc(sizeof(*presp
) + frame_len
, GFP_KERNEL
);
76 presp
->head
= (void *)(presp
+ 1);
78 mgmt
= (void *) presp
->head
;
79 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
80 IEEE80211_STYPE_PROBE_RESP
);
81 eth_broadcast_addr(mgmt
->da
);
82 memcpy(mgmt
->sa
, sdata
->vif
.addr
, ETH_ALEN
);
83 memcpy(mgmt
->bssid
, ifibss
->bssid
, ETH_ALEN
);
84 mgmt
->u
.beacon
.beacon_int
= cpu_to_le16(beacon_int
);
85 mgmt
->u
.beacon
.timestamp
= cpu_to_le64(tsf
);
86 mgmt
->u
.beacon
.capab_info
= cpu_to_le16(capability
);
88 pos
= (u8
*)mgmt
+ offsetof(struct ieee80211_mgmt
, u
.beacon
.variable
);
90 *pos
++ = WLAN_EID_SSID
;
91 *pos
++ = ifibss
->ssid_len
;
92 memcpy(pos
, ifibss
->ssid
, ifibss
->ssid_len
);
93 pos
+= ifibss
->ssid_len
;
95 sband
= local
->hw
.wiphy
->bands
[chandef
->chan
->band
];
96 rate_flags
= ieee80211_chandef_rate_flags(chandef
);
97 shift
= ieee80211_chandef_get_shift(chandef
);
99 if (have_higher_than_11mbit
)
100 *have_higher_than_11mbit
= false;
102 for (i
= 0; i
< sband
->n_bitrates
; i
++) {
103 if ((rate_flags
& sband
->bitrates
[i
].flags
) != rate_flags
)
105 if (sband
->bitrates
[i
].bitrate
> 110 &&
106 have_higher_than_11mbit
)
107 *have_higher_than_11mbit
= true;
113 *pos
++ = WLAN_EID_SUPP_RATES
;
114 *pos
++ = min_t(int, 8, rates_n
);
115 for (ri
= 0; ri
< sband
->n_bitrates
; ri
++) {
116 int rate
= DIV_ROUND_UP(sband
->bitrates
[ri
].bitrate
,
119 if (!(rates
& BIT(ri
)))
122 if (basic_rates
& BIT(ri
))
124 *pos
++ = basic
| (u8
) rate
;
125 if (++rates_added
== 8) {
126 ri
++; /* continue at next rate for EXT_SUPP_RATES */
131 if (sband
->band
== NL80211_BAND_2GHZ
) {
132 *pos
++ = WLAN_EID_DS_PARAMS
;
134 *pos
++ = ieee80211_frequency_to_channel(
135 chandef
->chan
->center_freq
);
138 *pos
++ = WLAN_EID_IBSS_PARAMS
;
140 /* FIX: set ATIM window based on scan results */
145 *pos
++ = WLAN_EID_CHANNEL_SWITCH
;
147 *pos
++ = csa_settings
->block_tx
? 1 : 0;
148 *pos
++ = ieee80211_frequency_to_channel(
149 csa_settings
->chandef
.chan
->center_freq
);
150 presp
->csa_counter_offsets
[0] = (pos
- presp
->head
);
151 *pos
++ = csa_settings
->count
;
152 presp
->csa_current_counter
= csa_settings
->count
;
155 /* put the remaining rates in WLAN_EID_EXT_SUPP_RATES */
157 *pos
++ = WLAN_EID_EXT_SUPP_RATES
;
158 *pos
++ = rates_n
- 8;
159 for (; ri
< sband
->n_bitrates
; ri
++) {
160 int rate
= DIV_ROUND_UP(sband
->bitrates
[ri
].bitrate
,
163 if (!(rates
& BIT(ri
)))
166 if (basic_rates
& BIT(ri
))
168 *pos
++ = basic
| (u8
) rate
;
172 if (ifibss
->ie_len
) {
173 memcpy(pos
, ifibss
->ie
, ifibss
->ie_len
);
174 pos
+= ifibss
->ie_len
;
177 /* add HT capability and information IEs */
178 if (chandef
->width
!= NL80211_CHAN_WIDTH_20_NOHT
&&
179 chandef
->width
!= NL80211_CHAN_WIDTH_5
&&
180 chandef
->width
!= NL80211_CHAN_WIDTH_10
&&
181 sband
->ht_cap
.ht_supported
) {
182 struct ieee80211_sta_ht_cap ht_cap
;
184 memcpy(&ht_cap
, &sband
->ht_cap
, sizeof(ht_cap
));
185 ieee80211_apply_htcap_overrides(sdata
, &ht_cap
);
187 pos
= ieee80211_ie_build_ht_cap(pos
, &ht_cap
, ht_cap
.cap
);
189 * Note: According to 802.11n-2009 9.13.3.1, HT Protection
190 * field and RIFS Mode are reserved in IBSS mode, therefore
193 pos
= ieee80211_ie_build_ht_oper(pos
, &sband
->ht_cap
,
196 /* add VHT capability and information IEs */
197 if (chandef
->width
!= NL80211_CHAN_WIDTH_20
&&
198 chandef
->width
!= NL80211_CHAN_WIDTH_40
&&
199 sband
->vht_cap
.vht_supported
) {
200 pos
= ieee80211_ie_build_vht_cap(pos
, &sband
->vht_cap
,
202 pos
= ieee80211_ie_build_vht_oper(pos
, &sband
->vht_cap
,
207 if (local
->hw
.queues
>= IEEE80211_NUM_ACS
)
208 pos
= ieee80211_add_wmm_info_ie(pos
, 0); /* U-APSD not in use */
210 presp
->head_len
= pos
- presp
->head
;
211 if (WARN_ON(presp
->head_len
> frame_len
))
220 static void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data
*sdata
,
221 const u8
*bssid
, const int beacon_int
,
222 struct cfg80211_chan_def
*req_chandef
,
223 const u32 basic_rates
,
224 const u16 capability
, u64 tsf
,
227 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
228 struct ieee80211_local
*local
= sdata
->local
;
229 struct ieee80211_mgmt
*mgmt
;
230 struct cfg80211_bss
*bss
;
232 struct cfg80211_chan_def chandef
;
233 struct ieee80211_channel
*chan
;
234 struct beacon_data
*presp
;
235 struct cfg80211_inform_bss bss_meta
= {};
236 bool have_higher_than_11mbit
;
240 sdata_assert_lock(sdata
);
242 /* Reset own TSF to allow time synchronization work. */
243 drv_reset_tsf(local
, sdata
);
245 if (!ether_addr_equal(ifibss
->bssid
, bssid
))
246 sta_info_flush(sdata
);
248 /* if merging, indicate to driver that we leave the old IBSS */
249 if (sdata
->vif
.bss_conf
.ibss_joined
) {
250 sdata
->vif
.bss_conf
.ibss_joined
= false;
251 sdata
->vif
.bss_conf
.ibss_creator
= false;
252 sdata
->vif
.bss_conf
.enable_beacon
= false;
253 netif_carrier_off(sdata
->dev
);
254 ieee80211_bss_info_change_notify(sdata
,
256 BSS_CHANGED_BEACON_ENABLED
);
257 drv_leave_ibss(local
, sdata
);
260 presp
= rcu_dereference_protected(ifibss
->presp
,
261 lockdep_is_held(&sdata
->wdev
.mtx
));
262 RCU_INIT_POINTER(ifibss
->presp
, NULL
);
264 kfree_rcu(presp
, rcu_head
);
266 /* make a copy of the chandef, it could be modified below. */
267 chandef
= *req_chandef
;
269 if (!cfg80211_reg_can_beacon(local
->hw
.wiphy
, &chandef
,
270 NL80211_IFTYPE_ADHOC
)) {
271 if (chandef
.width
== NL80211_CHAN_WIDTH_5
||
272 chandef
.width
== NL80211_CHAN_WIDTH_10
||
273 chandef
.width
== NL80211_CHAN_WIDTH_20_NOHT
||
274 chandef
.width
== NL80211_CHAN_WIDTH_20
) {
276 "Failed to join IBSS, beacons forbidden\n");
279 chandef
.width
= NL80211_CHAN_WIDTH_20
;
280 chandef
.center_freq1
= chan
->center_freq
;
281 /* check again for downgraded chandef */
282 if (!cfg80211_reg_can_beacon(local
->hw
.wiphy
, &chandef
,
283 NL80211_IFTYPE_ADHOC
)) {
285 "Failed to join IBSS, beacons forbidden\n");
290 err
= cfg80211_chandef_dfs_required(sdata
->local
->hw
.wiphy
,
291 &chandef
, NL80211_IFTYPE_ADHOC
);
294 "Failed to join IBSS, invalid chandef\n");
297 if (err
> 0 && !ifibss
->userspace_handles_dfs
) {
299 "Failed to join IBSS, DFS channel without control program\n");
303 radar_required
= err
;
305 mutex_lock(&local
->mtx
);
306 if (ieee80211_vif_use_channel(sdata
, &chandef
,
307 ifibss
->fixed_channel
?
308 IEEE80211_CHANCTX_SHARED
:
309 IEEE80211_CHANCTX_EXCLUSIVE
)) {
310 sdata_info(sdata
, "Failed to join IBSS, no channel context\n");
311 mutex_unlock(&local
->mtx
);
314 sdata
->radar_required
= radar_required
;
315 mutex_unlock(&local
->mtx
);
317 memcpy(ifibss
->bssid
, bssid
, ETH_ALEN
);
319 presp
= ieee80211_ibss_build_presp(sdata
, beacon_int
, basic_rates
,
320 capability
, tsf
, &chandef
,
321 &have_higher_than_11mbit
, NULL
);
325 rcu_assign_pointer(ifibss
->presp
, presp
);
326 mgmt
= (void *)presp
->head
;
328 sdata
->vif
.bss_conf
.enable_beacon
= true;
329 sdata
->vif
.bss_conf
.beacon_int
= beacon_int
;
330 sdata
->vif
.bss_conf
.basic_rates
= basic_rates
;
331 sdata
->vif
.bss_conf
.ssid_len
= ifibss
->ssid_len
;
332 memcpy(sdata
->vif
.bss_conf
.ssid
, ifibss
->ssid
, ifibss
->ssid_len
);
333 bss_change
= BSS_CHANGED_BEACON_INT
;
334 bss_change
|= ieee80211_reset_erp_info(sdata
);
335 bss_change
|= BSS_CHANGED_BSSID
;
336 bss_change
|= BSS_CHANGED_BEACON
;
337 bss_change
|= BSS_CHANGED_BEACON_ENABLED
;
338 bss_change
|= BSS_CHANGED_BASIC_RATES
;
339 bss_change
|= BSS_CHANGED_HT
;
340 bss_change
|= BSS_CHANGED_IBSS
;
341 bss_change
|= BSS_CHANGED_SSID
;
344 * In 5 GHz/802.11a, we can always use short slot time.
345 * (IEEE 802.11-2012 18.3.8.7)
347 * In 2.4GHz, we must always use long slots in IBSS for compatibility
349 * (IEEE 802.11-2012 19.4.5)
351 * HT follows these specifications (IEEE 802.11-2012 20.3.18)
353 sdata
->vif
.bss_conf
.use_short_slot
= chan
->band
== NL80211_BAND_5GHZ
;
354 bss_change
|= BSS_CHANGED_ERP_SLOT
;
356 /* cf. IEEE 802.11 9.2.12 */
357 if (chan
->band
== NL80211_BAND_2GHZ
&& have_higher_than_11mbit
)
358 sdata
->flags
|= IEEE80211_SDATA_OPERATING_GMODE
;
360 sdata
->flags
&= ~IEEE80211_SDATA_OPERATING_GMODE
;
362 ieee80211_set_wmm_default(sdata
, true, false);
364 sdata
->vif
.bss_conf
.ibss_joined
= true;
365 sdata
->vif
.bss_conf
.ibss_creator
= creator
;
367 err
= drv_join_ibss(local
, sdata
);
369 sdata
->vif
.bss_conf
.ibss_joined
= false;
370 sdata
->vif
.bss_conf
.ibss_creator
= false;
371 sdata
->vif
.bss_conf
.enable_beacon
= false;
372 sdata
->vif
.bss_conf
.ssid_len
= 0;
373 RCU_INIT_POINTER(ifibss
->presp
, NULL
);
374 kfree_rcu(presp
, rcu_head
);
375 mutex_lock(&local
->mtx
);
376 ieee80211_vif_release_channel(sdata
);
377 mutex_unlock(&local
->mtx
);
378 sdata_info(sdata
, "Failed to join IBSS, driver failure: %d\n",
383 ieee80211_bss_info_change_notify(sdata
, bss_change
);
385 ifibss
->state
= IEEE80211_IBSS_MLME_JOINED
;
386 mod_timer(&ifibss
->timer
,
387 round_jiffies(jiffies
+ IEEE80211_IBSS_MERGE_INTERVAL
));
389 bss_meta
.chan
= chan
;
390 bss_meta
.scan_width
= cfg80211_chandef_to_scan_width(&chandef
);
391 bss
= cfg80211_inform_bss_frame_data(local
->hw
.wiphy
, &bss_meta
, mgmt
,
392 presp
->head_len
, GFP_KERNEL
);
394 cfg80211_put_bss(local
->hw
.wiphy
, bss
);
395 netif_carrier_on(sdata
->dev
);
396 cfg80211_ibss_joined(sdata
->dev
, ifibss
->bssid
, chan
, GFP_KERNEL
);
399 static void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data
*sdata
,
400 struct ieee80211_bss
*bss
)
402 struct cfg80211_bss
*cbss
=
403 container_of((void *)bss
, struct cfg80211_bss
, priv
);
404 struct ieee80211_supported_band
*sband
;
405 struct cfg80211_chan_def chandef
;
408 u16 beacon_int
= cbss
->beacon_interval
;
409 const struct cfg80211_bss_ies
*ies
;
410 enum nl80211_channel_type chan_type
;
415 sdata_assert_lock(sdata
);
420 switch (sdata
->u
.ibss
.chandef
.width
) {
421 case NL80211_CHAN_WIDTH_20_NOHT
:
422 case NL80211_CHAN_WIDTH_20
:
423 case NL80211_CHAN_WIDTH_40
:
424 chan_type
= cfg80211_get_chandef_type(&sdata
->u
.ibss
.chandef
);
425 cfg80211_chandef_create(&chandef
, cbss
->channel
, chan_type
);
427 case NL80211_CHAN_WIDTH_5
:
428 case NL80211_CHAN_WIDTH_10
:
429 cfg80211_chandef_create(&chandef
, cbss
->channel
,
431 chandef
.width
= sdata
->u
.ibss
.chandef
.width
;
433 case NL80211_CHAN_WIDTH_80
:
434 case NL80211_CHAN_WIDTH_80P80
:
435 case NL80211_CHAN_WIDTH_160
:
436 chandef
= sdata
->u
.ibss
.chandef
;
437 chandef
.chan
= cbss
->channel
;
440 /* fall back to 20 MHz for unsupported modes */
441 cfg80211_chandef_create(&chandef
, cbss
->channel
,
446 sband
= sdata
->local
->hw
.wiphy
->bands
[cbss
->channel
->band
];
447 rate_flags
= ieee80211_chandef_rate_flags(&sdata
->u
.ibss
.chandef
);
448 shift
= ieee80211_vif_get_shift(&sdata
->vif
);
452 for (i
= 0; i
< bss
->supp_rates_len
; i
++) {
453 int rate
= bss
->supp_rates
[i
] & 0x7f;
454 bool is_basic
= !!(bss
->supp_rates
[i
] & 0x80);
456 for (j
= 0; j
< sband
->n_bitrates
; j
++) {
458 if ((rate_flags
& sband
->bitrates
[j
].flags
)
462 brate
= DIV_ROUND_UP(sband
->bitrates
[j
].bitrate
,
466 basic_rates
|= BIT(j
);
473 ies
= rcu_dereference(cbss
->ies
);
477 __ieee80211_sta_join_ibss(sdata
, cbss
->bssid
,
485 int ieee80211_ibss_csa_beacon(struct ieee80211_sub_if_data
*sdata
,
486 struct cfg80211_csa_settings
*csa_settings
)
488 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
489 struct beacon_data
*presp
, *old_presp
;
490 struct cfg80211_bss
*cbss
;
491 const struct cfg80211_bss_ies
*ies
;
492 u16 capability
= WLAN_CAPABILITY_IBSS
;
496 sdata_assert_lock(sdata
);
499 capability
|= WLAN_CAPABILITY_PRIVACY
;
501 cbss
= cfg80211_get_bss(sdata
->local
->hw
.wiphy
, ifibss
->chandef
.chan
,
502 ifibss
->bssid
, ifibss
->ssid
,
503 ifibss
->ssid_len
, IEEE80211_BSS_TYPE_IBSS
,
504 IEEE80211_PRIVACY(ifibss
->privacy
));
506 if (WARN_ON(!cbss
)) {
512 ies
= rcu_dereference(cbss
->ies
);
515 cfg80211_put_bss(sdata
->local
->hw
.wiphy
, cbss
);
517 old_presp
= rcu_dereference_protected(ifibss
->presp
,
518 lockdep_is_held(&sdata
->wdev
.mtx
));
520 presp
= ieee80211_ibss_build_presp(sdata
,
521 sdata
->vif
.bss_conf
.beacon_int
,
522 sdata
->vif
.bss_conf
.basic_rates
,
523 capability
, tsf
, &ifibss
->chandef
,
530 rcu_assign_pointer(ifibss
->presp
, presp
);
532 kfree_rcu(old_presp
, rcu_head
);
534 return BSS_CHANGED_BEACON
;
539 int ieee80211_ibss_finish_csa(struct ieee80211_sub_if_data
*sdata
)
541 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
542 struct cfg80211_bss
*cbss
;
543 int err
, changed
= 0;
545 sdata_assert_lock(sdata
);
547 /* update cfg80211 bss information with the new channel */
548 if (!is_zero_ether_addr(ifibss
->bssid
)) {
549 cbss
= cfg80211_get_bss(sdata
->local
->hw
.wiphy
,
550 ifibss
->chandef
.chan
,
551 ifibss
->bssid
, ifibss
->ssid
,
553 IEEE80211_BSS_TYPE_IBSS
,
554 IEEE80211_PRIVACY(ifibss
->privacy
));
555 /* XXX: should not really modify cfg80211 data */
557 cbss
->channel
= sdata
->csa_chandef
.chan
;
558 cfg80211_put_bss(sdata
->local
->hw
.wiphy
, cbss
);
562 ifibss
->chandef
= sdata
->csa_chandef
;
564 /* generate the beacon */
565 err
= ieee80211_ibss_csa_beacon(sdata
, NULL
);
574 void ieee80211_ibss_stop(struct ieee80211_sub_if_data
*sdata
)
576 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
578 cancel_work_sync(&ifibss
->csa_connection_drop_work
);
581 static struct sta_info
*ieee80211_ibss_finish_sta(struct sta_info
*sta
)
584 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
587 memcpy(addr
, sta
->sta
.addr
, ETH_ALEN
);
589 ibss_dbg(sdata
, "Adding new IBSS station %pM\n", addr
);
591 sta_info_pre_move_state(sta
, IEEE80211_STA_AUTH
);
592 sta_info_pre_move_state(sta
, IEEE80211_STA_ASSOC
);
593 /* authorize the station only if the network is not RSN protected. If
594 * not wait for the userspace to authorize it */
595 if (!sta
->sdata
->u
.ibss
.control_port
)
596 sta_info_pre_move_state(sta
, IEEE80211_STA_AUTHORIZED
);
598 rate_control_rate_init(sta
);
600 /* If it fails, maybe we raced another insertion? */
601 if (sta_info_insert_rcu(sta
))
602 return sta_info_get(sdata
, addr
);
606 static struct sta_info
*
607 ieee80211_ibss_add_sta(struct ieee80211_sub_if_data
*sdata
, const u8
*bssid
,
608 const u8
*addr
, u32 supp_rates
)
611 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
612 struct ieee80211_local
*local
= sdata
->local
;
613 struct sta_info
*sta
;
614 struct ieee80211_chanctx_conf
*chanctx_conf
;
615 struct ieee80211_supported_band
*sband
;
616 enum nl80211_bss_scan_width scan_width
;
620 * XXX: Consider removing the least recently used entry and
621 * allow new one to be added.
623 if (local
->num_sta
>= IEEE80211_IBSS_MAX_STA_ENTRIES
) {
624 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
630 if (ifibss
->state
== IEEE80211_IBSS_MLME_SEARCH
) {
635 if (!ether_addr_equal(bssid
, sdata
->u
.ibss
.bssid
)) {
641 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
642 if (WARN_ON_ONCE(!chanctx_conf
))
644 band
= chanctx_conf
->def
.chan
->band
;
645 scan_width
= cfg80211_chandef_to_scan_width(&chanctx_conf
->def
);
648 sta
= sta_info_alloc(sdata
, addr
, GFP_KERNEL
);
654 /* make sure mandatory rates are always added */
655 sband
= local
->hw
.wiphy
->bands
[band
];
656 sta
->sta
.supp_rates
[band
] = supp_rates
|
657 ieee80211_mandatory_rates(sband
, scan_width
);
659 return ieee80211_ibss_finish_sta(sta
);
662 static int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data
*sdata
)
664 struct ieee80211_local
*local
= sdata
->local
;
666 struct sta_info
*sta
;
668 sdata_assert_lock(sdata
);
672 list_for_each_entry_rcu(sta
, &local
->sta_list
, list
) {
673 unsigned long last_active
= ieee80211_sta_last_active(sta
);
675 if (sta
->sdata
== sdata
&&
676 time_is_after_jiffies(last_active
+
677 IEEE80211_IBSS_MERGE_INTERVAL
)) {
688 static void ieee80211_ibss_disconnect(struct ieee80211_sub_if_data
*sdata
)
690 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
691 struct ieee80211_local
*local
= sdata
->local
;
692 struct cfg80211_bss
*cbss
;
693 struct beacon_data
*presp
;
694 struct sta_info
*sta
;
696 if (!is_zero_ether_addr(ifibss
->bssid
)) {
697 cbss
= cfg80211_get_bss(local
->hw
.wiphy
, ifibss
->chandef
.chan
,
698 ifibss
->bssid
, ifibss
->ssid
,
700 IEEE80211_BSS_TYPE_IBSS
,
701 IEEE80211_PRIVACY(ifibss
->privacy
));
704 cfg80211_unlink_bss(local
->hw
.wiphy
, cbss
);
705 cfg80211_put_bss(sdata
->local
->hw
.wiphy
, cbss
);
709 ifibss
->state
= IEEE80211_IBSS_MLME_SEARCH
;
711 sta_info_flush(sdata
);
713 spin_lock_bh(&ifibss
->incomplete_lock
);
714 while (!list_empty(&ifibss
->incomplete_stations
)) {
715 sta
= list_first_entry(&ifibss
->incomplete_stations
,
716 struct sta_info
, list
);
717 list_del(&sta
->list
);
718 spin_unlock_bh(&ifibss
->incomplete_lock
);
720 sta_info_free(local
, sta
);
721 spin_lock_bh(&ifibss
->incomplete_lock
);
723 spin_unlock_bh(&ifibss
->incomplete_lock
);
725 netif_carrier_off(sdata
->dev
);
727 sdata
->vif
.bss_conf
.ibss_joined
= false;
728 sdata
->vif
.bss_conf
.ibss_creator
= false;
729 sdata
->vif
.bss_conf
.enable_beacon
= false;
730 sdata
->vif
.bss_conf
.ssid_len
= 0;
733 presp
= rcu_dereference_protected(ifibss
->presp
,
734 lockdep_is_held(&sdata
->wdev
.mtx
));
735 RCU_INIT_POINTER(sdata
->u
.ibss
.presp
, NULL
);
737 kfree_rcu(presp
, rcu_head
);
739 clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED
, &sdata
->state
);
740 ieee80211_bss_info_change_notify(sdata
, BSS_CHANGED_BEACON_ENABLED
|
742 drv_leave_ibss(local
, sdata
);
743 mutex_lock(&local
->mtx
);
744 ieee80211_vif_release_channel(sdata
);
745 mutex_unlock(&local
->mtx
);
748 static void ieee80211_csa_connection_drop_work(struct work_struct
*work
)
750 struct ieee80211_sub_if_data
*sdata
=
751 container_of(work
, struct ieee80211_sub_if_data
,
752 u
.ibss
.csa_connection_drop_work
);
756 ieee80211_ibss_disconnect(sdata
);
758 skb_queue_purge(&sdata
->skb_queue
);
760 /* trigger a scan to find another IBSS network to join */
761 ieee80211_queue_work(&sdata
->local
->hw
, &sdata
->work
);
766 static void ieee80211_ibss_csa_mark_radar(struct ieee80211_sub_if_data
*sdata
)
768 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
771 /* if the current channel is a DFS channel, mark the channel as
774 err
= cfg80211_chandef_dfs_required(sdata
->local
->hw
.wiphy
,
776 NL80211_IFTYPE_ADHOC
);
778 cfg80211_radar_event(sdata
->local
->hw
.wiphy
, &ifibss
->chandef
,
783 ieee80211_ibss_process_chanswitch(struct ieee80211_sub_if_data
*sdata
,
784 struct ieee802_11_elems
*elems
,
787 struct cfg80211_csa_settings params
;
788 struct ieee80211_csa_ie csa_ie
;
789 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
790 enum nl80211_channel_type ch_type
;
794 sdata_assert_lock(sdata
);
796 sta_flags
= IEEE80211_STA_DISABLE_VHT
;
797 switch (ifibss
->chandef
.width
) {
798 case NL80211_CHAN_WIDTH_5
:
799 case NL80211_CHAN_WIDTH_10
:
800 case NL80211_CHAN_WIDTH_20_NOHT
:
801 sta_flags
|= IEEE80211_STA_DISABLE_HT
;
803 case NL80211_CHAN_WIDTH_20
:
804 sta_flags
|= IEEE80211_STA_DISABLE_40MHZ
;
810 memset(¶ms
, 0, sizeof(params
));
811 err
= ieee80211_parse_ch_switch_ie(sdata
, elems
,
812 ifibss
->chandef
.chan
->band
,
813 sta_flags
, ifibss
->bssid
, &csa_ie
);
814 /* can't switch to destination channel, fail */
818 /* did not contain a CSA */
822 /* channel switch is not supported, disconnect */
823 if (!(sdata
->local
->hw
.wiphy
->flags
& WIPHY_FLAG_HAS_CHANNEL_SWITCH
))
826 params
.count
= csa_ie
.count
;
827 params
.chandef
= csa_ie
.chandef
;
829 switch (ifibss
->chandef
.width
) {
830 case NL80211_CHAN_WIDTH_20_NOHT
:
831 case NL80211_CHAN_WIDTH_20
:
832 case NL80211_CHAN_WIDTH_40
:
833 /* keep our current HT mode (HT20/HT40+/HT40-), even if
834 * another mode has been announced. The mode is not adopted
835 * within the beacon while doing CSA and we should therefore
836 * keep the mode which we announce.
838 ch_type
= cfg80211_get_chandef_type(&ifibss
->chandef
);
839 cfg80211_chandef_create(¶ms
.chandef
, params
.chandef
.chan
,
842 case NL80211_CHAN_WIDTH_5
:
843 case NL80211_CHAN_WIDTH_10
:
844 if (params
.chandef
.width
!= ifibss
->chandef
.width
) {
846 "IBSS %pM received channel switch from incompatible channel width (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n",
848 params
.chandef
.chan
->center_freq
,
849 params
.chandef
.width
,
850 params
.chandef
.center_freq1
,
851 params
.chandef
.center_freq2
);
856 /* should not happen, sta_flags should prevent VHT modes. */
861 if (!cfg80211_reg_can_beacon(sdata
->local
->hw
.wiphy
, ¶ms
.chandef
,
862 NL80211_IFTYPE_ADHOC
)) {
864 "IBSS %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n",
866 params
.chandef
.chan
->center_freq
,
867 params
.chandef
.width
,
868 params
.chandef
.center_freq1
,
869 params
.chandef
.center_freq2
);
873 err
= cfg80211_chandef_dfs_required(sdata
->local
->hw
.wiphy
,
875 NL80211_IFTYPE_ADHOC
);
878 if (err
> 0 && !ifibss
->userspace_handles_dfs
) {
879 /* IBSS-DFS only allowed with a control program */
883 params
.radar_required
= err
;
885 if (cfg80211_chandef_identical(¶ms
.chandef
,
886 &sdata
->vif
.bss_conf
.chandef
)) {
888 "received csa with an identical chandef, ignoring\n");
892 /* all checks done, now perform the channel switch. */
894 "received channel switch announcement to go to channel %d MHz\n",
895 params
.chandef
.chan
->center_freq
);
897 params
.block_tx
= !!csa_ie
.mode
;
899 if (ieee80211_channel_switch(sdata
->local
->hw
.wiphy
, sdata
->dev
,
903 ieee80211_ibss_csa_mark_radar(sdata
);
907 ibss_dbg(sdata
, "Can't handle channel switch, disconnect\n");
908 ieee80211_queue_work(&sdata
->local
->hw
,
909 &ifibss
->csa_connection_drop_work
);
911 ieee80211_ibss_csa_mark_radar(sdata
);
917 ieee80211_rx_mgmt_spectrum_mgmt(struct ieee80211_sub_if_data
*sdata
,
918 struct ieee80211_mgmt
*mgmt
, size_t len
,
919 struct ieee80211_rx_status
*rx_status
,
920 struct ieee802_11_elems
*elems
)
924 if (len
< IEEE80211_MIN_ACTION_SIZE
+ 1)
927 /* CSA is the only action we handle for now */
928 if (mgmt
->u
.action
.u
.measurement
.action_code
!=
929 WLAN_ACTION_SPCT_CHL_SWITCH
)
932 required_len
= IEEE80211_MIN_ACTION_SIZE
+
933 sizeof(mgmt
->u
.action
.u
.chan_switch
);
934 if (len
< required_len
)
937 if (!sdata
->vif
.csa_active
)
938 ieee80211_ibss_process_chanswitch(sdata
, elems
, false);
941 static void ieee80211_rx_mgmt_deauth_ibss(struct ieee80211_sub_if_data
*sdata
,
942 struct ieee80211_mgmt
*mgmt
,
945 u16 reason
= le16_to_cpu(mgmt
->u
.deauth
.reason_code
);
947 if (len
< IEEE80211_DEAUTH_FRAME_LEN
)
950 ibss_dbg(sdata
, "RX DeAuth SA=%pM DA=%pM BSSID=%pM (reason: %d)\n",
951 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
, reason
);
952 sta_info_destroy_addr(sdata
, mgmt
->sa
);
955 static void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data
*sdata
,
956 struct ieee80211_mgmt
*mgmt
,
959 u16 auth_alg
, auth_transaction
;
961 sdata_assert_lock(sdata
);
966 auth_alg
= le16_to_cpu(mgmt
->u
.auth
.auth_alg
);
967 auth_transaction
= le16_to_cpu(mgmt
->u
.auth
.auth_transaction
);
970 "RX Auth SA=%pM DA=%pM BSSID=%pM (auth_transaction=%d)\n",
971 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
, auth_transaction
);
973 if (auth_alg
!= WLAN_AUTH_OPEN
|| auth_transaction
!= 1)
977 * IEEE 802.11 standard does not require authentication in IBSS
978 * networks and most implementations do not seem to use it.
979 * However, try to reply to authentication attempts if someone
980 * has actually implemented this.
982 ieee80211_send_auth(sdata
, 2, WLAN_AUTH_OPEN
, 0, NULL
, 0,
983 mgmt
->sa
, sdata
->u
.ibss
.bssid
, NULL
, 0, 0, 0);
986 static void ieee80211_update_sta_info(struct ieee80211_sub_if_data
*sdata
,
987 struct ieee80211_mgmt
*mgmt
, size_t len
,
988 struct ieee80211_rx_status
*rx_status
,
989 struct ieee802_11_elems
*elems
,
990 struct ieee80211_channel
*channel
)
992 struct sta_info
*sta
;
993 enum nl80211_band band
= rx_status
->band
;
994 enum nl80211_bss_scan_width scan_width
;
995 struct ieee80211_local
*local
= sdata
->local
;
996 struct ieee80211_supported_band
*sband
;
997 bool rates_updated
= false;
1000 if (sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
)
1003 if (!ether_addr_equal(mgmt
->bssid
, sdata
->u
.ibss
.bssid
))
1006 sband
= local
->hw
.wiphy
->bands
[band
];
1007 if (WARN_ON(!sband
))
1011 sta
= sta_info_get(sdata
, mgmt
->sa
);
1013 if (elems
->supp_rates
) {
1014 supp_rates
= ieee80211_sta_get_rates(sdata
, elems
,
1019 prev_rates
= sta
->sta
.supp_rates
[band
];
1020 /* make sure mandatory rates are always added */
1021 scan_width
= NL80211_BSS_CHAN_WIDTH_20
;
1022 if (rx_status
->bw
== RATE_INFO_BW_5
)
1023 scan_width
= NL80211_BSS_CHAN_WIDTH_5
;
1024 else if (rx_status
->bw
== RATE_INFO_BW_10
)
1025 scan_width
= NL80211_BSS_CHAN_WIDTH_10
;
1027 sta
->sta
.supp_rates
[band
] = supp_rates
|
1028 ieee80211_mandatory_rates(sband
, scan_width
);
1029 if (sta
->sta
.supp_rates
[band
] != prev_rates
) {
1031 "updated supp_rates set for %pM based on beacon/probe_resp (0x%x -> 0x%x)\n",
1032 sta
->sta
.addr
, prev_rates
,
1033 sta
->sta
.supp_rates
[band
]);
1034 rates_updated
= true;
1038 sta
= ieee80211_ibss_add_sta(sdata
, mgmt
->bssid
,
1039 mgmt
->sa
, supp_rates
);
1043 if (sta
&& !sta
->sta
.wme
&&
1044 elems
->wmm_info
&& local
->hw
.queues
>= IEEE80211_NUM_ACS
) {
1045 sta
->sta
.wme
= true;
1046 ieee80211_check_fast_xmit(sta
);
1049 if (sta
&& elems
->ht_operation
&& elems
->ht_cap_elem
&&
1050 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_20_NOHT
&&
1051 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_5
&&
1052 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_10
) {
1053 /* we both use HT */
1054 struct ieee80211_ht_cap htcap_ie
;
1055 struct cfg80211_chan_def chandef
;
1056 enum ieee80211_sta_rx_bandwidth bw
= sta
->sta
.bandwidth
;
1058 cfg80211_chandef_create(&chandef
, channel
, NL80211_CHAN_NO_HT
);
1059 ieee80211_chandef_ht_oper(elems
->ht_operation
, &chandef
);
1061 memcpy(&htcap_ie
, elems
->ht_cap_elem
, sizeof(htcap_ie
));
1062 rates_updated
|= ieee80211_ht_cap_ie_to_sta_ht_cap(sdata
, sband
,
1066 if (elems
->vht_operation
&& elems
->vht_cap_elem
&&
1067 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_20
&&
1068 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_40
) {
1069 /* we both use VHT */
1070 struct ieee80211_vht_cap cap_ie
;
1071 struct ieee80211_sta_vht_cap cap
= sta
->sta
.vht_cap
;
1073 ieee80211_chandef_vht_oper(elems
->vht_operation
,
1075 memcpy(&cap_ie
, elems
->vht_cap_elem
, sizeof(cap_ie
));
1076 ieee80211_vht_cap_ie_to_sta_vht_cap(sdata
, sband
,
1078 if (memcmp(&cap
, &sta
->sta
.vht_cap
, sizeof(cap
)))
1079 rates_updated
|= true;
1082 if (bw
!= sta
->sta
.bandwidth
)
1083 rates_updated
|= true;
1085 if (!cfg80211_chandef_compatible(&sdata
->u
.ibss
.chandef
,
1090 if (sta
&& rates_updated
) {
1091 u32 changed
= IEEE80211_RC_SUPP_RATES_CHANGED
;
1092 u8 rx_nss
= sta
->sta
.rx_nss
;
1094 /* Force rx_nss recalculation */
1095 sta
->sta
.rx_nss
= 0;
1096 rate_control_rate_init(sta
);
1097 if (sta
->sta
.rx_nss
!= rx_nss
)
1098 changed
|= IEEE80211_RC_NSS_CHANGED
;
1100 drv_sta_rc_update(local
, sdata
, &sta
->sta
, changed
);
1106 static void ieee80211_rx_bss_info(struct ieee80211_sub_if_data
*sdata
,
1107 struct ieee80211_mgmt
*mgmt
, size_t len
,
1108 struct ieee80211_rx_status
*rx_status
,
1109 struct ieee802_11_elems
*elems
)
1111 struct ieee80211_local
*local
= sdata
->local
;
1112 struct cfg80211_bss
*cbss
;
1113 struct ieee80211_bss
*bss
;
1114 struct ieee80211_channel
*channel
;
1115 u64 beacon_timestamp
, rx_timestamp
;
1117 enum nl80211_band band
= rx_status
->band
;
1119 channel
= ieee80211_get_channel(local
->hw
.wiphy
, rx_status
->freq
);
1123 ieee80211_update_sta_info(sdata
, mgmt
, len
, rx_status
, elems
, channel
);
1125 bss
= ieee80211_bss_info_update(local
, rx_status
, mgmt
, len
, elems
,
1130 cbss
= container_of((void *)bss
, struct cfg80211_bss
, priv
);
1132 /* same for beacon and probe response */
1133 beacon_timestamp
= le64_to_cpu(mgmt
->u
.beacon
.timestamp
);
1135 /* check if we need to merge IBSS */
1138 if (!(cbss
->capability
& WLAN_CAPABILITY_IBSS
))
1141 /* different channel */
1142 if (sdata
->u
.ibss
.fixed_channel
&&
1143 sdata
->u
.ibss
.chandef
.chan
!= cbss
->channel
)
1146 /* different SSID */
1147 if (elems
->ssid_len
!= sdata
->u
.ibss
.ssid_len
||
1148 memcmp(elems
->ssid
, sdata
->u
.ibss
.ssid
,
1149 sdata
->u
.ibss
.ssid_len
))
1152 /* process channel switch */
1153 if (sdata
->vif
.csa_active
||
1154 ieee80211_ibss_process_chanswitch(sdata
, elems
, true))
1158 if (ether_addr_equal(cbss
->bssid
, sdata
->u
.ibss
.bssid
))
1161 /* we use a fixed BSSID */
1162 if (sdata
->u
.ibss
.fixed_bssid
)
1165 if (ieee80211_have_rx_timestamp(rx_status
)) {
1166 /* time when timestamp field was received */
1168 ieee80211_calculate_rx_timestamp(local
, rx_status
,
1172 * second best option: get current TSF
1173 * (will return -1 if not supported)
1175 rx_timestamp
= drv_get_tsf(local
, sdata
);
1179 "RX beacon SA=%pM BSSID=%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n",
1180 mgmt
->sa
, mgmt
->bssid
,
1181 (unsigned long long)rx_timestamp
,
1182 (unsigned long long)beacon_timestamp
,
1183 (unsigned long long)(rx_timestamp
- beacon_timestamp
),
1186 if (beacon_timestamp
> rx_timestamp
) {
1188 "beacon TSF higher than local TSF - IBSS merge with BSSID %pM\n",
1190 ieee80211_sta_join_ibss(sdata
, bss
);
1191 supp_rates
= ieee80211_sta_get_rates(sdata
, elems
, band
, NULL
);
1192 ieee80211_ibss_add_sta(sdata
, mgmt
->bssid
, mgmt
->sa
,
1198 ieee80211_rx_bss_put(local
, bss
);
1201 void ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data
*sdata
,
1202 const u8
*bssid
, const u8
*addr
,
1205 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1206 struct ieee80211_local
*local
= sdata
->local
;
1207 struct sta_info
*sta
;
1208 struct ieee80211_chanctx_conf
*chanctx_conf
;
1209 struct ieee80211_supported_band
*sband
;
1210 enum nl80211_bss_scan_width scan_width
;
1214 * XXX: Consider removing the least recently used entry and
1215 * allow new one to be added.
1217 if (local
->num_sta
>= IEEE80211_IBSS_MAX_STA_ENTRIES
) {
1218 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
1223 if (ifibss
->state
== IEEE80211_IBSS_MLME_SEARCH
)
1226 if (!ether_addr_equal(bssid
, sdata
->u
.ibss
.bssid
))
1230 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
1231 if (WARN_ON_ONCE(!chanctx_conf
)) {
1235 band
= chanctx_conf
->def
.chan
->band
;
1236 scan_width
= cfg80211_chandef_to_scan_width(&chanctx_conf
->def
);
1239 sta
= sta_info_alloc(sdata
, addr
, GFP_ATOMIC
);
1243 /* make sure mandatory rates are always added */
1244 sband
= local
->hw
.wiphy
->bands
[band
];
1245 sta
->sta
.supp_rates
[band
] = supp_rates
|
1246 ieee80211_mandatory_rates(sband
, scan_width
);
1248 spin_lock(&ifibss
->incomplete_lock
);
1249 list_add(&sta
->list
, &ifibss
->incomplete_stations
);
1250 spin_unlock(&ifibss
->incomplete_lock
);
1251 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
1254 static void ieee80211_ibss_sta_expire(struct ieee80211_sub_if_data
*sdata
)
1256 struct ieee80211_local
*local
= sdata
->local
;
1257 struct sta_info
*sta
, *tmp
;
1258 unsigned long exp_time
= IEEE80211_IBSS_INACTIVITY_LIMIT
;
1259 unsigned long exp_rsn
= IEEE80211_IBSS_RSN_INACTIVITY_LIMIT
;
1261 mutex_lock(&local
->sta_mtx
);
1263 list_for_each_entry_safe(sta
, tmp
, &local
->sta_list
, list
) {
1264 unsigned long last_active
= ieee80211_sta_last_active(sta
);
1266 if (sdata
!= sta
->sdata
)
1269 if (time_is_before_jiffies(last_active
+ exp_time
) ||
1270 (time_is_before_jiffies(last_active
+ exp_rsn
) &&
1271 sta
->sta_state
!= IEEE80211_STA_AUTHORIZED
)) {
1272 sta_dbg(sta
->sdata
, "expiring inactive %sSTA %pM\n",
1273 sta
->sta_state
!= IEEE80211_STA_AUTHORIZED
?
1274 "not authorized " : "", sta
->sta
.addr
);
1276 WARN_ON(__sta_info_destroy(sta
));
1280 mutex_unlock(&local
->sta_mtx
);
1284 * This function is called with state == IEEE80211_IBSS_MLME_JOINED
1287 static void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data
*sdata
)
1289 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1290 enum nl80211_bss_scan_width scan_width
;
1292 sdata_assert_lock(sdata
);
1294 mod_timer(&ifibss
->timer
,
1295 round_jiffies(jiffies
+ IEEE80211_IBSS_MERGE_INTERVAL
));
1297 ieee80211_ibss_sta_expire(sdata
);
1299 if (time_before(jiffies
, ifibss
->last_scan_completed
+
1300 IEEE80211_IBSS_MERGE_INTERVAL
))
1303 if (ieee80211_sta_active_ibss(sdata
))
1306 if (ifibss
->fixed_channel
)
1310 "No active IBSS STAs - trying to scan for other IBSS networks with same SSID (merge)\n");
1312 scan_width
= cfg80211_chandef_to_scan_width(&ifibss
->chandef
);
1313 ieee80211_request_ibss_scan(sdata
, ifibss
->ssid
, ifibss
->ssid_len
,
1314 NULL
, 0, scan_width
);
1317 static void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data
*sdata
)
1319 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1324 sdata_assert_lock(sdata
);
1326 if (ifibss
->fixed_bssid
) {
1327 memcpy(bssid
, ifibss
->bssid
, ETH_ALEN
);
1329 /* Generate random, not broadcast, locally administered BSSID. Mix in
1330 * own MAC address to make sure that devices that do not have proper
1331 * random number generator get different BSSID. */
1332 get_random_bytes(bssid
, ETH_ALEN
);
1333 for (i
= 0; i
< ETH_ALEN
; i
++)
1334 bssid
[i
] ^= sdata
->vif
.addr
[i
];
1339 sdata_info(sdata
, "Creating new IBSS network, BSSID %pM\n", bssid
);
1341 capability
= WLAN_CAPABILITY_IBSS
;
1343 if (ifibss
->privacy
)
1344 capability
|= WLAN_CAPABILITY_PRIVACY
;
1346 __ieee80211_sta_join_ibss(sdata
, bssid
, sdata
->vif
.bss_conf
.beacon_int
,
1347 &ifibss
->chandef
, ifibss
->basic_rates
,
1348 capability
, 0, true);
1351 static unsigned ibss_setup_channels(struct wiphy
*wiphy
,
1352 struct ieee80211_channel
**channels
,
1353 unsigned int channels_max
,
1354 u32 center_freq
, u32 width
)
1356 struct ieee80211_channel
*chan
= NULL
;
1357 unsigned int n_chan
= 0;
1358 u32 start_freq
, end_freq
, freq
;
1361 start_freq
= center_freq
;
1362 end_freq
= center_freq
;
1364 start_freq
= center_freq
- width
/ 2 + 10;
1365 end_freq
= center_freq
+ width
/ 2 - 10;
1368 for (freq
= start_freq
; freq
<= end_freq
; freq
+= 20) {
1369 chan
= ieee80211_get_channel(wiphy
, freq
);
1372 if (n_chan
>= channels_max
)
1375 channels
[n_chan
] = chan
;
1383 ieee80211_ibss_setup_scan_channels(struct wiphy
*wiphy
,
1384 const struct cfg80211_chan_def
*chandef
,
1385 struct ieee80211_channel
**channels
,
1386 unsigned int channels_max
)
1388 unsigned int n_chan
= 0;
1389 u32 width
, cf1
, cf2
= 0;
1391 switch (chandef
->width
) {
1392 case NL80211_CHAN_WIDTH_40
:
1395 case NL80211_CHAN_WIDTH_80P80
:
1396 cf2
= chandef
->center_freq2
;
1398 case NL80211_CHAN_WIDTH_80
:
1401 case NL80211_CHAN_WIDTH_160
:
1409 cf1
= chandef
->center_freq1
;
1411 n_chan
= ibss_setup_channels(wiphy
, channels
, channels_max
, cf1
, width
);
1414 n_chan
+= ibss_setup_channels(wiphy
, &channels
[n_chan
],
1415 channels_max
- n_chan
, cf2
,
1422 * This function is called with state == IEEE80211_IBSS_MLME_SEARCH
1425 static void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data
*sdata
)
1427 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1428 struct ieee80211_local
*local
= sdata
->local
;
1429 struct cfg80211_bss
*cbss
;
1430 struct ieee80211_channel
*chan
= NULL
;
1431 const u8
*bssid
= NULL
;
1432 enum nl80211_bss_scan_width scan_width
;
1435 sdata_assert_lock(sdata
);
1437 active_ibss
= ieee80211_sta_active_ibss(sdata
);
1438 ibss_dbg(sdata
, "sta_find_ibss (active_ibss=%d)\n", active_ibss
);
1443 if (ifibss
->fixed_bssid
)
1444 bssid
= ifibss
->bssid
;
1445 if (ifibss
->fixed_channel
)
1446 chan
= ifibss
->chandef
.chan
;
1447 if (!is_zero_ether_addr(ifibss
->bssid
))
1448 bssid
= ifibss
->bssid
;
1449 cbss
= cfg80211_get_bss(local
->hw
.wiphy
, chan
, bssid
,
1450 ifibss
->ssid
, ifibss
->ssid_len
,
1451 IEEE80211_BSS_TYPE_IBSS
,
1452 IEEE80211_PRIVACY(ifibss
->privacy
));
1455 struct ieee80211_bss
*bss
;
1457 bss
= (void *)cbss
->priv
;
1459 "sta_find_ibss: selected %pM current %pM\n",
1460 cbss
->bssid
, ifibss
->bssid
);
1462 "Selected IBSS BSSID %pM based on configured SSID\n",
1465 ieee80211_sta_join_ibss(sdata
, bss
);
1466 ieee80211_rx_bss_put(local
, bss
);
1470 /* if a fixed bssid and a fixed freq have been provided create the IBSS
1471 * directly and do not waste time scanning
1473 if (ifibss
->fixed_bssid
&& ifibss
->fixed_channel
) {
1474 sdata_info(sdata
, "Created IBSS using preconfigured BSSID %pM\n",
1476 ieee80211_sta_create_ibss(sdata
);
1481 ibss_dbg(sdata
, "sta_find_ibss: did not try to join ibss\n");
1483 /* Selected IBSS not found in current scan results - try to scan */
1484 if (time_after(jiffies
, ifibss
->last_scan_completed
+
1485 IEEE80211_SCAN_INTERVAL
)) {
1486 struct ieee80211_channel
*channels
[8];
1489 sdata_info(sdata
, "Trigger new scan to find an IBSS to join\n");
1491 scan_width
= cfg80211_chandef_to_scan_width(&ifibss
->chandef
);
1493 if (ifibss
->fixed_channel
) {
1494 num
= ieee80211_ibss_setup_scan_channels(local
->hw
.wiphy
,
1497 ARRAY_SIZE(channels
));
1498 ieee80211_request_ibss_scan(sdata
, ifibss
->ssid
,
1499 ifibss
->ssid_len
, channels
,
1502 ieee80211_request_ibss_scan(sdata
, ifibss
->ssid
,
1503 ifibss
->ssid_len
, NULL
,
1507 int interval
= IEEE80211_SCAN_INTERVAL
;
1509 if (time_after(jiffies
, ifibss
->ibss_join_req
+
1510 IEEE80211_IBSS_JOIN_TIMEOUT
))
1511 ieee80211_sta_create_ibss(sdata
);
1513 mod_timer(&ifibss
->timer
,
1514 round_jiffies(jiffies
+ interval
));
1518 static void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data
*sdata
,
1519 struct sk_buff
*req
)
1521 struct ieee80211_mgmt
*mgmt
= (void *)req
->data
;
1522 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1523 struct ieee80211_local
*local
= sdata
->local
;
1524 int tx_last_beacon
, len
= req
->len
;
1525 struct sk_buff
*skb
;
1526 struct beacon_data
*presp
;
1529 sdata_assert_lock(sdata
);
1531 presp
= rcu_dereference_protected(ifibss
->presp
,
1532 lockdep_is_held(&sdata
->wdev
.mtx
));
1534 if (ifibss
->state
!= IEEE80211_IBSS_MLME_JOINED
||
1535 len
< 24 + 2 || !presp
)
1538 tx_last_beacon
= drv_tx_last_beacon(local
);
1541 "RX ProbeReq SA=%pM DA=%pM BSSID=%pM (tx_last_beacon=%d)\n",
1542 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
, tx_last_beacon
);
1544 if (!tx_last_beacon
&& is_multicast_ether_addr(mgmt
->da
))
1547 if (!ether_addr_equal(mgmt
->bssid
, ifibss
->bssid
) &&
1548 !is_broadcast_ether_addr(mgmt
->bssid
))
1551 end
= ((u8
*) mgmt
) + len
;
1552 pos
= mgmt
->u
.probe_req
.variable
;
1553 if (pos
[0] != WLAN_EID_SSID
||
1554 pos
+ 2 + pos
[1] > end
) {
1555 ibss_dbg(sdata
, "Invalid SSID IE in ProbeReq from %pM\n",
1560 (pos
[1] != ifibss
->ssid_len
||
1561 memcmp(pos
+ 2, ifibss
->ssid
, ifibss
->ssid_len
))) {
1562 /* Ignore ProbeReq for foreign SSID */
1566 /* Reply with ProbeResp */
1567 skb
= dev_alloc_skb(local
->tx_headroom
+ presp
->head_len
);
1571 skb_reserve(skb
, local
->tx_headroom
);
1572 skb_put_data(skb
, presp
->head
, presp
->head_len
);
1574 memcpy(((struct ieee80211_mgmt
*) skb
->data
)->da
, mgmt
->sa
, ETH_ALEN
);
1575 ibss_dbg(sdata
, "Sending ProbeResp to %pM\n", mgmt
->sa
);
1576 IEEE80211_SKB_CB(skb
)->flags
|= IEEE80211_TX_INTFL_DONT_ENCRYPT
;
1578 /* avoid excessive retries for probe request to wildcard SSIDs */
1580 IEEE80211_SKB_CB(skb
)->flags
|= IEEE80211_TX_CTL_NO_ACK
;
1582 ieee80211_tx_skb(sdata
, skb
);
1586 void ieee80211_rx_mgmt_probe_beacon(struct ieee80211_sub_if_data
*sdata
,
1587 struct ieee80211_mgmt
*mgmt
, size_t len
,
1588 struct ieee80211_rx_status
*rx_status
)
1591 struct ieee802_11_elems elems
;
1593 BUILD_BUG_ON(offsetof(typeof(mgmt
->u
.probe_resp
), variable
) !=
1594 offsetof(typeof(mgmt
->u
.beacon
), variable
));
1597 * either beacon or probe_resp but the variable field is at the
1600 baselen
= (u8
*) mgmt
->u
.probe_resp
.variable
- (u8
*) mgmt
;
1604 ieee802_11_parse_elems(mgmt
->u
.probe_resp
.variable
, len
- baselen
,
1607 ieee80211_rx_bss_info(sdata
, mgmt
, len
, rx_status
, &elems
);
1610 void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data
*sdata
,
1611 struct sk_buff
*skb
)
1613 struct ieee80211_rx_status
*rx_status
;
1614 struct ieee80211_mgmt
*mgmt
;
1616 struct ieee802_11_elems elems
;
1619 rx_status
= IEEE80211_SKB_RXCB(skb
);
1620 mgmt
= (struct ieee80211_mgmt
*) skb
->data
;
1621 fc
= le16_to_cpu(mgmt
->frame_control
);
1625 if (!sdata
->u
.ibss
.ssid_len
)
1626 goto mgmt_out
; /* not ready to merge yet */
1628 switch (fc
& IEEE80211_FCTL_STYPE
) {
1629 case IEEE80211_STYPE_PROBE_REQ
:
1630 ieee80211_rx_mgmt_probe_req(sdata
, skb
);
1632 case IEEE80211_STYPE_PROBE_RESP
:
1633 case IEEE80211_STYPE_BEACON
:
1634 ieee80211_rx_mgmt_probe_beacon(sdata
, mgmt
, skb
->len
,
1637 case IEEE80211_STYPE_AUTH
:
1638 ieee80211_rx_mgmt_auth_ibss(sdata
, mgmt
, skb
->len
);
1640 case IEEE80211_STYPE_DEAUTH
:
1641 ieee80211_rx_mgmt_deauth_ibss(sdata
, mgmt
, skb
->len
);
1643 case IEEE80211_STYPE_ACTION
:
1644 switch (mgmt
->u
.action
.category
) {
1645 case WLAN_CATEGORY_SPECTRUM_MGMT
:
1646 ies_len
= skb
->len
-
1647 offsetof(struct ieee80211_mgmt
,
1648 u
.action
.u
.chan_switch
.variable
);
1653 ieee802_11_parse_elems(
1654 mgmt
->u
.action
.u
.chan_switch
.variable
,
1655 ies_len
, true, &elems
);
1657 if (elems
.parse_error
)
1660 ieee80211_rx_mgmt_spectrum_mgmt(sdata
, mgmt
, skb
->len
,
1667 sdata_unlock(sdata
);
1670 void ieee80211_ibss_work(struct ieee80211_sub_if_data
*sdata
)
1672 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1673 struct sta_info
*sta
;
1678 * Work could be scheduled after scan or similar
1679 * when we aren't even joined (or trying) with a
1682 if (!ifibss
->ssid_len
)
1685 spin_lock_bh(&ifibss
->incomplete_lock
);
1686 while (!list_empty(&ifibss
->incomplete_stations
)) {
1687 sta
= list_first_entry(&ifibss
->incomplete_stations
,
1688 struct sta_info
, list
);
1689 list_del(&sta
->list
);
1690 spin_unlock_bh(&ifibss
->incomplete_lock
);
1692 ieee80211_ibss_finish_sta(sta
);
1694 spin_lock_bh(&ifibss
->incomplete_lock
);
1696 spin_unlock_bh(&ifibss
->incomplete_lock
);
1698 switch (ifibss
->state
) {
1699 case IEEE80211_IBSS_MLME_SEARCH
:
1700 ieee80211_sta_find_ibss(sdata
);
1702 case IEEE80211_IBSS_MLME_JOINED
:
1703 ieee80211_sta_merge_ibss(sdata
);
1711 sdata_unlock(sdata
);
1714 static void ieee80211_ibss_timer(struct timer_list
*t
)
1716 struct ieee80211_sub_if_data
*sdata
=
1717 from_timer(sdata
, t
, u
.ibss
.timer
);
1719 ieee80211_queue_work(&sdata
->local
->hw
, &sdata
->work
);
1722 void ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data
*sdata
)
1724 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1726 timer_setup(&ifibss
->timer
, ieee80211_ibss_timer
, 0);
1727 INIT_LIST_HEAD(&ifibss
->incomplete_stations
);
1728 spin_lock_init(&ifibss
->incomplete_lock
);
1729 INIT_WORK(&ifibss
->csa_connection_drop_work
,
1730 ieee80211_csa_connection_drop_work
);
1733 /* scan finished notification */
1734 void ieee80211_ibss_notify_scan_completed(struct ieee80211_local
*local
)
1736 struct ieee80211_sub_if_data
*sdata
;
1738 mutex_lock(&local
->iflist_mtx
);
1739 list_for_each_entry(sdata
, &local
->interfaces
, list
) {
1740 if (!ieee80211_sdata_running(sdata
))
1742 if (sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
)
1744 sdata
->u
.ibss
.last_scan_completed
= jiffies
;
1746 mutex_unlock(&local
->iflist_mtx
);
1749 int ieee80211_ibss_join(struct ieee80211_sub_if_data
*sdata
,
1750 struct cfg80211_ibss_params
*params
)
1754 struct ieee80211_supported_band
*sband
;
1755 enum ieee80211_chanctx_mode chanmode
;
1756 struct ieee80211_local
*local
= sdata
->local
;
1757 int radar_detect_width
= 0;
1761 ret
= cfg80211_chandef_dfs_required(local
->hw
.wiphy
,
1763 sdata
->wdev
.iftype
);
1768 if (!params
->userspace_handles_dfs
)
1770 radar_detect_width
= BIT(params
->chandef
.width
);
1773 chanmode
= (params
->channel_fixed
&& !ret
) ?
1774 IEEE80211_CHANCTX_SHARED
: IEEE80211_CHANCTX_EXCLUSIVE
;
1776 mutex_lock(&local
->chanctx_mtx
);
1777 ret
= ieee80211_check_combinations(sdata
, ¶ms
->chandef
, chanmode
,
1778 radar_detect_width
);
1779 mutex_unlock(&local
->chanctx_mtx
);
1783 if (params
->bssid
) {
1784 memcpy(sdata
->u
.ibss
.bssid
, params
->bssid
, ETH_ALEN
);
1785 sdata
->u
.ibss
.fixed_bssid
= true;
1787 sdata
->u
.ibss
.fixed_bssid
= false;
1789 sdata
->u
.ibss
.privacy
= params
->privacy
;
1790 sdata
->u
.ibss
.control_port
= params
->control_port
;
1791 sdata
->u
.ibss
.userspace_handles_dfs
= params
->userspace_handles_dfs
;
1792 sdata
->u
.ibss
.basic_rates
= params
->basic_rates
;
1793 sdata
->u
.ibss
.last_scan_completed
= jiffies
;
1795 /* fix basic_rates if channel does not support these rates */
1796 rate_flags
= ieee80211_chandef_rate_flags(¶ms
->chandef
);
1797 sband
= local
->hw
.wiphy
->bands
[params
->chandef
.chan
->band
];
1798 for (i
= 0; i
< sband
->n_bitrates
; i
++) {
1799 if ((rate_flags
& sband
->bitrates
[i
].flags
) != rate_flags
)
1800 sdata
->u
.ibss
.basic_rates
&= ~BIT(i
);
1802 memcpy(sdata
->vif
.bss_conf
.mcast_rate
, params
->mcast_rate
,
1803 sizeof(params
->mcast_rate
));
1805 sdata
->vif
.bss_conf
.beacon_int
= params
->beacon_interval
;
1807 sdata
->u
.ibss
.chandef
= params
->chandef
;
1808 sdata
->u
.ibss
.fixed_channel
= params
->channel_fixed
;
1811 sdata
->u
.ibss
.ie
= kmemdup(params
->ie
, params
->ie_len
,
1813 if (sdata
->u
.ibss
.ie
)
1814 sdata
->u
.ibss
.ie_len
= params
->ie_len
;
1817 sdata
->u
.ibss
.state
= IEEE80211_IBSS_MLME_SEARCH
;
1818 sdata
->u
.ibss
.ibss_join_req
= jiffies
;
1820 memcpy(sdata
->u
.ibss
.ssid
, params
->ssid
, params
->ssid_len
);
1821 sdata
->u
.ibss
.ssid_len
= params
->ssid_len
;
1823 memcpy(&sdata
->u
.ibss
.ht_capa
, ¶ms
->ht_capa
,
1824 sizeof(sdata
->u
.ibss
.ht_capa
));
1825 memcpy(&sdata
->u
.ibss
.ht_capa_mask
, ¶ms
->ht_capa_mask
,
1826 sizeof(sdata
->u
.ibss
.ht_capa_mask
));
1829 * 802.11n-2009 9.13.3.1: In an IBSS, the HT Protection field is
1830 * reserved, but an HT STA shall protect HT transmissions as though
1831 * the HT Protection field were set to non-HT mixed mode.
1833 * In an IBSS, the RIFS Mode field of the HT Operation element is
1834 * also reserved, but an HT STA shall operate as though this field
1838 sdata
->vif
.bss_conf
.ht_operation_mode
|=
1839 IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED
1840 | IEEE80211_HT_PARAM_RIFS_MODE
;
1842 changed
|= BSS_CHANGED_HT
;
1843 ieee80211_bss_info_change_notify(sdata
, changed
);
1845 sdata
->smps_mode
= IEEE80211_SMPS_OFF
;
1846 sdata
->needed_rx_chains
= local
->rx_chains
;
1848 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
1853 int ieee80211_ibss_leave(struct ieee80211_sub_if_data
*sdata
)
1855 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1857 ieee80211_ibss_disconnect(sdata
);
1858 ifibss
->ssid_len
= 0;
1859 eth_zero_addr(ifibss
->bssid
);
1862 kfree(sdata
->u
.ibss
.ie
);
1864 /* on the next join, re-program HT parameters */
1865 memset(&ifibss
->ht_capa
, 0, sizeof(ifibss
->ht_capa
));
1866 memset(&ifibss
->ht_capa_mask
, 0, sizeof(ifibss
->ht_capa_mask
));
1870 skb_queue_purge(&sdata
->skb_queue
);
1872 del_timer_sync(&sdata
->u
.ibss
.timer
);