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_80P80
:
432 case NL80211_CHAN_WIDTH_160
:
433 chandef
= sdata
->u
.ibss
.chandef
;
434 chandef
.chan
= cbss
->channel
;
437 /* fall back to 20 MHz for unsupported modes */
438 cfg80211_chandef_create(&chandef
, cbss
->channel
,
439 NL80211_CHAN_WIDTH_20_NOHT
);
443 sband
= sdata
->local
->hw
.wiphy
->bands
[cbss
->channel
->band
];
444 rate_flags
= ieee80211_chandef_rate_flags(&sdata
->u
.ibss
.chandef
);
445 shift
= ieee80211_vif_get_shift(&sdata
->vif
);
449 for (i
= 0; i
< bss
->supp_rates_len
; i
++) {
450 int rate
= bss
->supp_rates
[i
] & 0x7f;
451 bool is_basic
= !!(bss
->supp_rates
[i
] & 0x80);
453 for (j
= 0; j
< sband
->n_bitrates
; j
++) {
455 if ((rate_flags
& sband
->bitrates
[j
].flags
)
459 brate
= DIV_ROUND_UP(sband
->bitrates
[j
].bitrate
,
463 basic_rates
|= BIT(j
);
470 ies
= rcu_dereference(cbss
->ies
);
474 __ieee80211_sta_join_ibss(sdata
, cbss
->bssid
,
482 int ieee80211_ibss_csa_beacon(struct ieee80211_sub_if_data
*sdata
,
483 struct cfg80211_csa_settings
*csa_settings
)
485 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
486 struct beacon_data
*presp
, *old_presp
;
487 struct cfg80211_bss
*cbss
;
488 const struct cfg80211_bss_ies
*ies
;
493 sdata_assert_lock(sdata
);
496 capability
= WLAN_CAPABILITY_PRIVACY
;
498 cbss
= cfg80211_get_bss(sdata
->local
->hw
.wiphy
, ifibss
->chandef
.chan
,
499 ifibss
->bssid
, ifibss
->ssid
,
500 ifibss
->ssid_len
, IEEE80211_BSS_TYPE_IBSS
,
501 IEEE80211_PRIVACY(ifibss
->privacy
));
503 if (WARN_ON(!cbss
)) {
509 ies
= rcu_dereference(cbss
->ies
);
512 cfg80211_put_bss(sdata
->local
->hw
.wiphy
, cbss
);
514 old_presp
= rcu_dereference_protected(ifibss
->presp
,
515 lockdep_is_held(&sdata
->wdev
.mtx
));
517 presp
= ieee80211_ibss_build_presp(sdata
,
518 sdata
->vif
.bss_conf
.beacon_int
,
519 sdata
->vif
.bss_conf
.basic_rates
,
520 capability
, tsf
, &ifibss
->chandef
,
527 rcu_assign_pointer(ifibss
->presp
, presp
);
529 kfree_rcu(old_presp
, rcu_head
);
531 return BSS_CHANGED_BEACON
;
536 int ieee80211_ibss_finish_csa(struct ieee80211_sub_if_data
*sdata
)
538 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
539 struct cfg80211_bss
*cbss
;
540 int err
, changed
= 0;
542 sdata_assert_lock(sdata
);
544 /* update cfg80211 bss information with the new channel */
545 if (!is_zero_ether_addr(ifibss
->bssid
)) {
546 cbss
= cfg80211_get_bss(sdata
->local
->hw
.wiphy
,
547 ifibss
->chandef
.chan
,
548 ifibss
->bssid
, ifibss
->ssid
,
550 IEEE80211_BSS_TYPE_IBSS
,
551 IEEE80211_PRIVACY(ifibss
->privacy
));
552 /* XXX: should not really modify cfg80211 data */
554 cbss
->channel
= sdata
->csa_chandef
.chan
;
555 cfg80211_put_bss(sdata
->local
->hw
.wiphy
, cbss
);
559 ifibss
->chandef
= sdata
->csa_chandef
;
561 /* generate the beacon */
562 err
= ieee80211_ibss_csa_beacon(sdata
, NULL
);
571 void ieee80211_ibss_stop(struct ieee80211_sub_if_data
*sdata
)
573 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
575 cancel_work_sync(&ifibss
->csa_connection_drop_work
);
578 static struct sta_info
*ieee80211_ibss_finish_sta(struct sta_info
*sta
)
581 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
584 memcpy(addr
, sta
->sta
.addr
, ETH_ALEN
);
586 ibss_dbg(sdata
, "Adding new IBSS station %pM\n", addr
);
588 sta_info_pre_move_state(sta
, IEEE80211_STA_AUTH
);
589 sta_info_pre_move_state(sta
, IEEE80211_STA_ASSOC
);
590 /* authorize the station only if the network is not RSN protected. If
591 * not wait for the userspace to authorize it */
592 if (!sta
->sdata
->u
.ibss
.control_port
)
593 sta_info_pre_move_state(sta
, IEEE80211_STA_AUTHORIZED
);
595 rate_control_rate_init(sta
);
597 /* If it fails, maybe we raced another insertion? */
598 if (sta_info_insert_rcu(sta
))
599 return sta_info_get(sdata
, addr
);
603 static struct sta_info
*
604 ieee80211_ibss_add_sta(struct ieee80211_sub_if_data
*sdata
, const u8
*bssid
,
605 const u8
*addr
, u32 supp_rates
)
608 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
609 struct ieee80211_local
*local
= sdata
->local
;
610 struct sta_info
*sta
;
611 struct ieee80211_chanctx_conf
*chanctx_conf
;
612 struct ieee80211_supported_band
*sband
;
613 enum nl80211_bss_scan_width scan_width
;
617 * XXX: Consider removing the least recently used entry and
618 * allow new one to be added.
620 if (local
->num_sta
>= IEEE80211_IBSS_MAX_STA_ENTRIES
) {
621 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
627 if (ifibss
->state
== IEEE80211_IBSS_MLME_SEARCH
) {
632 if (!ether_addr_equal(bssid
, sdata
->u
.ibss
.bssid
)) {
638 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
639 if (WARN_ON_ONCE(!chanctx_conf
))
641 band
= chanctx_conf
->def
.chan
->band
;
642 scan_width
= cfg80211_chandef_to_scan_width(&chanctx_conf
->def
);
645 sta
= sta_info_alloc(sdata
, addr
, GFP_KERNEL
);
651 sta
->rx_stats
.last_rx
= jiffies
;
653 /* make sure mandatory rates are always added */
654 sband
= local
->hw
.wiphy
->bands
[band
];
655 sta
->sta
.supp_rates
[band
] = supp_rates
|
656 ieee80211_mandatory_rates(sband
, scan_width
);
658 return ieee80211_ibss_finish_sta(sta
);
661 static int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data
*sdata
)
663 struct ieee80211_local
*local
= sdata
->local
;
665 struct sta_info
*sta
;
667 sdata_assert_lock(sdata
);
671 list_for_each_entry_rcu(sta
, &local
->sta_list
, list
) {
672 if (sta
->sdata
== sdata
&&
673 time_after(sta
->rx_stats
.last_rx
+
674 IEEE80211_IBSS_MERGE_INTERVAL
,
686 static void ieee80211_ibss_disconnect(struct ieee80211_sub_if_data
*sdata
)
688 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
689 struct ieee80211_local
*local
= sdata
->local
;
690 struct cfg80211_bss
*cbss
;
691 struct beacon_data
*presp
;
692 struct sta_info
*sta
;
694 if (!is_zero_ether_addr(ifibss
->bssid
)) {
695 cbss
= cfg80211_get_bss(local
->hw
.wiphy
, ifibss
->chandef
.chan
,
696 ifibss
->bssid
, ifibss
->ssid
,
698 IEEE80211_BSS_TYPE_IBSS
,
699 IEEE80211_PRIVACY(ifibss
->privacy
));
702 cfg80211_unlink_bss(local
->hw
.wiphy
, cbss
);
703 cfg80211_put_bss(sdata
->local
->hw
.wiphy
, cbss
);
707 ifibss
->state
= IEEE80211_IBSS_MLME_SEARCH
;
709 sta_info_flush(sdata
);
711 spin_lock_bh(&ifibss
->incomplete_lock
);
712 while (!list_empty(&ifibss
->incomplete_stations
)) {
713 sta
= list_first_entry(&ifibss
->incomplete_stations
,
714 struct sta_info
, list
);
715 list_del(&sta
->list
);
716 spin_unlock_bh(&ifibss
->incomplete_lock
);
718 sta_info_free(local
, sta
);
719 spin_lock_bh(&ifibss
->incomplete_lock
);
721 spin_unlock_bh(&ifibss
->incomplete_lock
);
723 netif_carrier_off(sdata
->dev
);
725 sdata
->vif
.bss_conf
.ibss_joined
= false;
726 sdata
->vif
.bss_conf
.ibss_creator
= false;
727 sdata
->vif
.bss_conf
.enable_beacon
= false;
728 sdata
->vif
.bss_conf
.ssid_len
= 0;
731 presp
= rcu_dereference_protected(ifibss
->presp
,
732 lockdep_is_held(&sdata
->wdev
.mtx
));
733 RCU_INIT_POINTER(sdata
->u
.ibss
.presp
, NULL
);
735 kfree_rcu(presp
, rcu_head
);
737 clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED
, &sdata
->state
);
738 ieee80211_bss_info_change_notify(sdata
, BSS_CHANGED_BEACON_ENABLED
|
740 drv_leave_ibss(local
, sdata
);
741 mutex_lock(&local
->mtx
);
742 ieee80211_vif_release_channel(sdata
);
743 mutex_unlock(&local
->mtx
);
746 static void ieee80211_csa_connection_drop_work(struct work_struct
*work
)
748 struct ieee80211_sub_if_data
*sdata
=
749 container_of(work
, struct ieee80211_sub_if_data
,
750 u
.ibss
.csa_connection_drop_work
);
754 ieee80211_ibss_disconnect(sdata
);
756 skb_queue_purge(&sdata
->skb_queue
);
758 /* trigger a scan to find another IBSS network to join */
759 ieee80211_queue_work(&sdata
->local
->hw
, &sdata
->work
);
764 static void ieee80211_ibss_csa_mark_radar(struct ieee80211_sub_if_data
*sdata
)
766 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
769 /* if the current channel is a DFS channel, mark the channel as
772 err
= cfg80211_chandef_dfs_required(sdata
->local
->hw
.wiphy
,
774 NL80211_IFTYPE_ADHOC
);
776 cfg80211_radar_event(sdata
->local
->hw
.wiphy
, &ifibss
->chandef
,
781 ieee80211_ibss_process_chanswitch(struct ieee80211_sub_if_data
*sdata
,
782 struct ieee802_11_elems
*elems
,
785 struct cfg80211_csa_settings params
;
786 struct ieee80211_csa_ie csa_ie
;
787 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
788 enum nl80211_channel_type ch_type
;
792 sdata_assert_lock(sdata
);
794 sta_flags
= IEEE80211_STA_DISABLE_VHT
;
795 switch (ifibss
->chandef
.width
) {
796 case NL80211_CHAN_WIDTH_5
:
797 case NL80211_CHAN_WIDTH_10
:
798 case NL80211_CHAN_WIDTH_20_NOHT
:
799 sta_flags
|= IEEE80211_STA_DISABLE_HT
;
801 case NL80211_CHAN_WIDTH_20
:
802 sta_flags
|= IEEE80211_STA_DISABLE_40MHZ
;
808 memset(¶ms
, 0, sizeof(params
));
809 memset(&csa_ie
, 0, sizeof(csa_ie
));
810 err
= ieee80211_parse_ch_switch_ie(sdata
, elems
,
811 ifibss
->chandef
.chan
->band
,
812 sta_flags
, ifibss
->bssid
, &csa_ie
);
813 /* can't switch to destination channel, fail */
817 /* did not contain a CSA */
821 /* channel switch is not supported, disconnect */
822 if (!(sdata
->local
->hw
.wiphy
->flags
& WIPHY_FLAG_HAS_CHANNEL_SWITCH
))
825 params
.count
= csa_ie
.count
;
826 params
.chandef
= csa_ie
.chandef
;
828 switch (ifibss
->chandef
.width
) {
829 case NL80211_CHAN_WIDTH_20_NOHT
:
830 case NL80211_CHAN_WIDTH_20
:
831 case NL80211_CHAN_WIDTH_40
:
832 /* keep our current HT mode (HT20/HT40+/HT40-), even if
833 * another mode has been announced. The mode is not adopted
834 * within the beacon while doing CSA and we should therefore
835 * keep the mode which we announce.
837 ch_type
= cfg80211_get_chandef_type(&ifibss
->chandef
);
838 cfg80211_chandef_create(¶ms
.chandef
, params
.chandef
.chan
,
841 case NL80211_CHAN_WIDTH_5
:
842 case NL80211_CHAN_WIDTH_10
:
843 if (params
.chandef
.width
!= ifibss
->chandef
.width
) {
845 "IBSS %pM received channel switch from incompatible channel width (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n",
847 params
.chandef
.chan
->center_freq
,
848 params
.chandef
.width
,
849 params
.chandef
.center_freq1
,
850 params
.chandef
.center_freq2
);
855 /* should not happen, sta_flags should prevent VHT modes. */
860 if (!cfg80211_reg_can_beacon(sdata
->local
->hw
.wiphy
, ¶ms
.chandef
,
861 NL80211_IFTYPE_ADHOC
)) {
863 "IBSS %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n",
865 params
.chandef
.chan
->center_freq
,
866 params
.chandef
.width
,
867 params
.chandef
.center_freq1
,
868 params
.chandef
.center_freq2
);
872 err
= cfg80211_chandef_dfs_required(sdata
->local
->hw
.wiphy
,
874 NL80211_IFTYPE_ADHOC
);
877 if (err
> 0 && !ifibss
->userspace_handles_dfs
) {
878 /* IBSS-DFS only allowed with a control program */
882 params
.radar_required
= err
;
884 if (cfg80211_chandef_identical(¶ms
.chandef
,
885 &sdata
->vif
.bss_conf
.chandef
)) {
887 "received csa with an identical chandef, ignoring\n");
891 /* all checks done, now perform the channel switch. */
893 "received channel switch announcement to go to channel %d MHz\n",
894 params
.chandef
.chan
->center_freq
);
896 params
.block_tx
= !!csa_ie
.mode
;
898 if (ieee80211_channel_switch(sdata
->local
->hw
.wiphy
, sdata
->dev
,
902 ieee80211_ibss_csa_mark_radar(sdata
);
906 ibss_dbg(sdata
, "Can't handle channel switch, disconnect\n");
907 ieee80211_queue_work(&sdata
->local
->hw
,
908 &ifibss
->csa_connection_drop_work
);
910 ieee80211_ibss_csa_mark_radar(sdata
);
916 ieee80211_rx_mgmt_spectrum_mgmt(struct ieee80211_sub_if_data
*sdata
,
917 struct ieee80211_mgmt
*mgmt
, size_t len
,
918 struct ieee80211_rx_status
*rx_status
,
919 struct ieee802_11_elems
*elems
)
923 if (len
< IEEE80211_MIN_ACTION_SIZE
+ 1)
926 /* CSA is the only action we handle for now */
927 if (mgmt
->u
.action
.u
.measurement
.action_code
!=
928 WLAN_ACTION_SPCT_CHL_SWITCH
)
931 required_len
= IEEE80211_MIN_ACTION_SIZE
+
932 sizeof(mgmt
->u
.action
.u
.chan_switch
);
933 if (len
< required_len
)
936 if (!sdata
->vif
.csa_active
)
937 ieee80211_ibss_process_chanswitch(sdata
, elems
, false);
940 static void ieee80211_rx_mgmt_deauth_ibss(struct ieee80211_sub_if_data
*sdata
,
941 struct ieee80211_mgmt
*mgmt
,
944 u16 reason
= le16_to_cpu(mgmt
->u
.deauth
.reason_code
);
946 if (len
< IEEE80211_DEAUTH_FRAME_LEN
)
949 ibss_dbg(sdata
, "RX DeAuth SA=%pM DA=%pM BSSID=%pM (reason: %d)\n",
950 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
, reason
);
951 sta_info_destroy_addr(sdata
, mgmt
->sa
);
954 static void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data
*sdata
,
955 struct ieee80211_mgmt
*mgmt
,
958 u16 auth_alg
, auth_transaction
;
960 sdata_assert_lock(sdata
);
965 auth_alg
= le16_to_cpu(mgmt
->u
.auth
.auth_alg
);
966 auth_transaction
= le16_to_cpu(mgmt
->u
.auth
.auth_transaction
);
969 "RX Auth SA=%pM DA=%pM BSSID=%pM (auth_transaction=%d)\n",
970 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
, auth_transaction
);
972 if (auth_alg
!= WLAN_AUTH_OPEN
|| auth_transaction
!= 1)
976 * IEEE 802.11 standard does not require authentication in IBSS
977 * networks and most implementations do not seem to use it.
978 * However, try to reply to authentication attempts if someone
979 * has actually implemented this.
981 ieee80211_send_auth(sdata
, 2, WLAN_AUTH_OPEN
, 0, NULL
, 0,
982 mgmt
->sa
, sdata
->u
.ibss
.bssid
, NULL
, 0, 0, 0);
985 static void ieee80211_update_sta_info(struct ieee80211_sub_if_data
*sdata
,
986 struct ieee80211_mgmt
*mgmt
, size_t len
,
987 struct ieee80211_rx_status
*rx_status
,
988 struct ieee802_11_elems
*elems
,
989 struct ieee80211_channel
*channel
)
991 struct sta_info
*sta
;
992 enum ieee80211_band band
= rx_status
->band
;
993 enum nl80211_bss_scan_width scan_width
;
994 struct ieee80211_local
*local
= sdata
->local
;
995 struct ieee80211_supported_band
*sband
= local
->hw
.wiphy
->bands
[band
];
996 bool rates_updated
= false;
999 if (sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
)
1002 if (!ether_addr_equal(mgmt
->bssid
, sdata
->u
.ibss
.bssid
))
1006 sta
= sta_info_get(sdata
, mgmt
->sa
);
1008 if (elems
->supp_rates
) {
1009 supp_rates
= ieee80211_sta_get_rates(sdata
, elems
,
1014 prev_rates
= sta
->sta
.supp_rates
[band
];
1015 /* make sure mandatory rates are always added */
1016 scan_width
= NL80211_BSS_CHAN_WIDTH_20
;
1017 if (rx_status
->flag
& RX_FLAG_5MHZ
)
1018 scan_width
= NL80211_BSS_CHAN_WIDTH_5
;
1019 if (rx_status
->flag
& RX_FLAG_10MHZ
)
1020 scan_width
= NL80211_BSS_CHAN_WIDTH_10
;
1022 sta
->sta
.supp_rates
[band
] = supp_rates
|
1023 ieee80211_mandatory_rates(sband
, scan_width
);
1024 if (sta
->sta
.supp_rates
[band
] != prev_rates
) {
1026 "updated supp_rates set for %pM based on beacon/probe_resp (0x%x -> 0x%x)\n",
1027 sta
->sta
.addr
, prev_rates
,
1028 sta
->sta
.supp_rates
[band
]);
1029 rates_updated
= true;
1033 sta
= ieee80211_ibss_add_sta(sdata
, mgmt
->bssid
,
1034 mgmt
->sa
, supp_rates
);
1038 if (sta
&& !sta
->sta
.wme
&&
1039 elems
->wmm_info
&& local
->hw
.queues
>= IEEE80211_NUM_ACS
) {
1040 sta
->sta
.wme
= true;
1041 ieee80211_check_fast_xmit(sta
);
1044 if (sta
&& elems
->ht_operation
&& elems
->ht_cap_elem
&&
1045 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_20_NOHT
&&
1046 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_5
&&
1047 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_10
) {
1048 /* we both use HT */
1049 struct ieee80211_ht_cap htcap_ie
;
1050 struct cfg80211_chan_def chandef
;
1051 enum ieee80211_sta_rx_bandwidth bw
= sta
->sta
.bandwidth
;
1053 ieee80211_ht_oper_to_chandef(channel
,
1054 elems
->ht_operation
,
1057 memcpy(&htcap_ie
, elems
->ht_cap_elem
, sizeof(htcap_ie
));
1058 rates_updated
|= ieee80211_ht_cap_ie_to_sta_ht_cap(sdata
, sband
,
1062 if (elems
->vht_operation
&& elems
->vht_cap_elem
&&
1063 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_20
&&
1064 sdata
->u
.ibss
.chandef
.width
!= NL80211_CHAN_WIDTH_40
) {
1065 /* we both use VHT */
1066 struct ieee80211_vht_cap cap_ie
;
1067 struct ieee80211_sta_vht_cap cap
= sta
->sta
.vht_cap
;
1069 ieee80211_vht_oper_to_chandef(channel
,
1070 elems
->vht_operation
,
1072 memcpy(&cap_ie
, elems
->vht_cap_elem
, sizeof(cap_ie
));
1073 ieee80211_vht_cap_ie_to_sta_vht_cap(sdata
, sband
,
1075 if (memcmp(&cap
, &sta
->sta
.vht_cap
, sizeof(cap
)))
1076 rates_updated
|= true;
1079 if (bw
!= sta
->sta
.bandwidth
)
1080 rates_updated
|= true;
1082 if (!cfg80211_chandef_compatible(&sdata
->u
.ibss
.chandef
,
1087 if (sta
&& rates_updated
) {
1088 u32 changed
= IEEE80211_RC_SUPP_RATES_CHANGED
;
1089 u8 rx_nss
= sta
->sta
.rx_nss
;
1091 /* Force rx_nss recalculation */
1092 sta
->sta
.rx_nss
= 0;
1093 rate_control_rate_init(sta
);
1094 if (sta
->sta
.rx_nss
!= rx_nss
)
1095 changed
|= IEEE80211_RC_NSS_CHANGED
;
1097 drv_sta_rc_update(local
, sdata
, &sta
->sta
, changed
);
1103 static void ieee80211_rx_bss_info(struct ieee80211_sub_if_data
*sdata
,
1104 struct ieee80211_mgmt
*mgmt
, size_t len
,
1105 struct ieee80211_rx_status
*rx_status
,
1106 struct ieee802_11_elems
*elems
)
1108 struct ieee80211_local
*local
= sdata
->local
;
1109 struct cfg80211_bss
*cbss
;
1110 struct ieee80211_bss
*bss
;
1111 struct ieee80211_channel
*channel
;
1112 u64 beacon_timestamp
, rx_timestamp
;
1114 enum ieee80211_band band
= rx_status
->band
;
1116 channel
= ieee80211_get_channel(local
->hw
.wiphy
, rx_status
->freq
);
1120 ieee80211_update_sta_info(sdata
, mgmt
, len
, rx_status
, elems
, channel
);
1122 bss
= ieee80211_bss_info_update(local
, rx_status
, mgmt
, len
, elems
,
1127 cbss
= container_of((void *)bss
, struct cfg80211_bss
, priv
);
1129 /* same for beacon and probe response */
1130 beacon_timestamp
= le64_to_cpu(mgmt
->u
.beacon
.timestamp
);
1132 /* check if we need to merge IBSS */
1135 if (!(cbss
->capability
& WLAN_CAPABILITY_IBSS
))
1138 /* different channel */
1139 if (sdata
->u
.ibss
.fixed_channel
&&
1140 sdata
->u
.ibss
.chandef
.chan
!= cbss
->channel
)
1143 /* different SSID */
1144 if (elems
->ssid_len
!= sdata
->u
.ibss
.ssid_len
||
1145 memcmp(elems
->ssid
, sdata
->u
.ibss
.ssid
,
1146 sdata
->u
.ibss
.ssid_len
))
1149 /* process channel switch */
1150 if (sdata
->vif
.csa_active
||
1151 ieee80211_ibss_process_chanswitch(sdata
, elems
, true))
1155 if (ether_addr_equal(cbss
->bssid
, sdata
->u
.ibss
.bssid
))
1158 /* we use a fixed BSSID */
1159 if (sdata
->u
.ibss
.fixed_bssid
)
1162 if (ieee80211_have_rx_timestamp(rx_status
)) {
1163 /* time when timestamp field was received */
1165 ieee80211_calculate_rx_timestamp(local
, rx_status
,
1169 * second best option: get current TSF
1170 * (will return -1 if not supported)
1172 rx_timestamp
= drv_get_tsf(local
, sdata
);
1176 "RX beacon SA=%pM BSSID=%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n",
1177 mgmt
->sa
, mgmt
->bssid
,
1178 (unsigned long long)rx_timestamp
,
1179 (unsigned long long)beacon_timestamp
,
1180 (unsigned long long)(rx_timestamp
- beacon_timestamp
),
1183 if (beacon_timestamp
> rx_timestamp
) {
1185 "beacon TSF higher than local TSF - IBSS merge with BSSID %pM\n",
1187 ieee80211_sta_join_ibss(sdata
, bss
);
1188 supp_rates
= ieee80211_sta_get_rates(sdata
, elems
, band
, NULL
);
1189 ieee80211_ibss_add_sta(sdata
, mgmt
->bssid
, mgmt
->sa
,
1195 ieee80211_rx_bss_put(local
, bss
);
1198 void ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data
*sdata
,
1199 const u8
*bssid
, const u8
*addr
,
1202 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1203 struct ieee80211_local
*local
= sdata
->local
;
1204 struct sta_info
*sta
;
1205 struct ieee80211_chanctx_conf
*chanctx_conf
;
1206 struct ieee80211_supported_band
*sband
;
1207 enum nl80211_bss_scan_width scan_width
;
1211 * XXX: Consider removing the least recently used entry and
1212 * allow new one to be added.
1214 if (local
->num_sta
>= IEEE80211_IBSS_MAX_STA_ENTRIES
) {
1215 net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n",
1220 if (ifibss
->state
== IEEE80211_IBSS_MLME_SEARCH
)
1223 if (!ether_addr_equal(bssid
, sdata
->u
.ibss
.bssid
))
1227 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
1228 if (WARN_ON_ONCE(!chanctx_conf
)) {
1232 band
= chanctx_conf
->def
.chan
->band
;
1233 scan_width
= cfg80211_chandef_to_scan_width(&chanctx_conf
->def
);
1236 sta
= sta_info_alloc(sdata
, addr
, GFP_ATOMIC
);
1240 sta
->rx_stats
.last_rx
= jiffies
;
1242 /* make sure mandatory rates are always added */
1243 sband
= local
->hw
.wiphy
->bands
[band
];
1244 sta
->sta
.supp_rates
[band
] = supp_rates
|
1245 ieee80211_mandatory_rates(sband
, scan_width
);
1247 spin_lock(&ifibss
->incomplete_lock
);
1248 list_add(&sta
->list
, &ifibss
->incomplete_stations
);
1249 spin_unlock(&ifibss
->incomplete_lock
);
1250 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
1253 static void ieee80211_ibss_sta_expire(struct ieee80211_sub_if_data
*sdata
)
1255 struct ieee80211_local
*local
= sdata
->local
;
1256 struct sta_info
*sta
, *tmp
;
1257 unsigned long exp_time
= IEEE80211_IBSS_INACTIVITY_LIMIT
;
1258 unsigned long exp_rsn
= IEEE80211_IBSS_RSN_INACTIVITY_LIMIT
;
1260 mutex_lock(&local
->sta_mtx
);
1262 list_for_each_entry_safe(sta
, tmp
, &local
->sta_list
, list
) {
1263 if (sdata
!= sta
->sdata
)
1266 if (time_after(jiffies
, sta
->rx_stats
.last_rx
+ exp_time
) ||
1267 (time_after(jiffies
, sta
->rx_stats
.last_rx
+ exp_rsn
) &&
1268 sta
->sta_state
!= IEEE80211_STA_AUTHORIZED
)) {
1269 sta_dbg(sta
->sdata
, "expiring inactive %sSTA %pM\n",
1270 sta
->sta_state
!= IEEE80211_STA_AUTHORIZED
?
1271 "not authorized " : "", sta
->sta
.addr
);
1273 WARN_ON(__sta_info_destroy(sta
));
1277 mutex_unlock(&local
->sta_mtx
);
1281 * This function is called with state == IEEE80211_IBSS_MLME_JOINED
1284 static void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data
*sdata
)
1286 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1287 enum nl80211_bss_scan_width scan_width
;
1289 sdata_assert_lock(sdata
);
1291 mod_timer(&ifibss
->timer
,
1292 round_jiffies(jiffies
+ IEEE80211_IBSS_MERGE_INTERVAL
));
1294 ieee80211_ibss_sta_expire(sdata
);
1296 if (time_before(jiffies
, ifibss
->last_scan_completed
+
1297 IEEE80211_IBSS_MERGE_INTERVAL
))
1300 if (ieee80211_sta_active_ibss(sdata
))
1303 if (ifibss
->fixed_channel
)
1307 "No active IBSS STAs - trying to scan for other IBSS networks with same SSID (merge)\n");
1309 scan_width
= cfg80211_chandef_to_scan_width(&ifibss
->chandef
);
1310 ieee80211_request_ibss_scan(sdata
, ifibss
->ssid
, ifibss
->ssid_len
,
1311 NULL
, 0, scan_width
);
1314 static void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data
*sdata
)
1316 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1321 sdata_assert_lock(sdata
);
1323 if (ifibss
->fixed_bssid
) {
1324 memcpy(bssid
, ifibss
->bssid
, ETH_ALEN
);
1326 /* Generate random, not broadcast, locally administered BSSID. Mix in
1327 * own MAC address to make sure that devices that do not have proper
1328 * random number generator get different BSSID. */
1329 get_random_bytes(bssid
, ETH_ALEN
);
1330 for (i
= 0; i
< ETH_ALEN
; i
++)
1331 bssid
[i
] ^= sdata
->vif
.addr
[i
];
1336 sdata_info(sdata
, "Creating new IBSS network, BSSID %pM\n", bssid
);
1338 capability
= WLAN_CAPABILITY_IBSS
;
1340 if (ifibss
->privacy
)
1341 capability
|= WLAN_CAPABILITY_PRIVACY
;
1343 __ieee80211_sta_join_ibss(sdata
, bssid
, sdata
->vif
.bss_conf
.beacon_int
,
1344 &ifibss
->chandef
, ifibss
->basic_rates
,
1345 capability
, 0, true);
1348 static unsigned ibss_setup_channels(struct wiphy
*wiphy
,
1349 struct ieee80211_channel
**channels
,
1350 unsigned int channels_max
,
1351 u32 center_freq
, u32 width
)
1353 struct ieee80211_channel
*chan
= NULL
;
1354 unsigned int n_chan
= 0;
1355 u32 start_freq
, end_freq
, freq
;
1358 start_freq
= center_freq
;
1359 end_freq
= center_freq
;
1361 start_freq
= center_freq
- width
/ 2 + 10;
1362 end_freq
= center_freq
+ width
/ 2 - 10;
1365 for (freq
= start_freq
; freq
<= end_freq
; freq
+= 20) {
1366 chan
= ieee80211_get_channel(wiphy
, freq
);
1369 if (n_chan
>= channels_max
)
1372 channels
[n_chan
] = chan
;
1380 ieee80211_ibss_setup_scan_channels(struct wiphy
*wiphy
,
1381 const struct cfg80211_chan_def
*chandef
,
1382 struct ieee80211_channel
**channels
,
1383 unsigned int channels_max
)
1385 unsigned int n_chan
= 0;
1386 u32 width
, cf1
, cf2
= 0;
1388 switch (chandef
->width
) {
1389 case NL80211_CHAN_WIDTH_40
:
1392 case NL80211_CHAN_WIDTH_80P80
:
1393 cf2
= chandef
->center_freq2
;
1395 case NL80211_CHAN_WIDTH_80
:
1398 case NL80211_CHAN_WIDTH_160
:
1406 cf1
= chandef
->center_freq1
;
1408 n_chan
= ibss_setup_channels(wiphy
, channels
, channels_max
, cf1
, width
);
1411 n_chan
+= ibss_setup_channels(wiphy
, &channels
[n_chan
],
1412 channels_max
- n_chan
, cf2
,
1419 * This function is called with state == IEEE80211_IBSS_MLME_SEARCH
1422 static void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data
*sdata
)
1424 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1425 struct ieee80211_local
*local
= sdata
->local
;
1426 struct cfg80211_bss
*cbss
;
1427 struct ieee80211_channel
*chan
= NULL
;
1428 const u8
*bssid
= NULL
;
1429 enum nl80211_bss_scan_width scan_width
;
1432 sdata_assert_lock(sdata
);
1434 active_ibss
= ieee80211_sta_active_ibss(sdata
);
1435 ibss_dbg(sdata
, "sta_find_ibss (active_ibss=%d)\n", active_ibss
);
1440 if (ifibss
->fixed_bssid
)
1441 bssid
= ifibss
->bssid
;
1442 if (ifibss
->fixed_channel
)
1443 chan
= ifibss
->chandef
.chan
;
1444 if (!is_zero_ether_addr(ifibss
->bssid
))
1445 bssid
= ifibss
->bssid
;
1446 cbss
= cfg80211_get_bss(local
->hw
.wiphy
, chan
, bssid
,
1447 ifibss
->ssid
, ifibss
->ssid_len
,
1448 IEEE80211_BSS_TYPE_IBSS
,
1449 IEEE80211_PRIVACY(ifibss
->privacy
));
1452 struct ieee80211_bss
*bss
;
1454 bss
= (void *)cbss
->priv
;
1456 "sta_find_ibss: selected %pM current %pM\n",
1457 cbss
->bssid
, ifibss
->bssid
);
1459 "Selected IBSS BSSID %pM based on configured SSID\n",
1462 ieee80211_sta_join_ibss(sdata
, bss
);
1463 ieee80211_rx_bss_put(local
, bss
);
1467 /* if a fixed bssid and a fixed freq have been provided create the IBSS
1468 * directly and do not waste time scanning
1470 if (ifibss
->fixed_bssid
&& ifibss
->fixed_channel
) {
1471 sdata_info(sdata
, "Created IBSS using preconfigured BSSID %pM\n",
1473 ieee80211_sta_create_ibss(sdata
);
1478 ibss_dbg(sdata
, "sta_find_ibss: did not try to join ibss\n");
1480 /* Selected IBSS not found in current scan results - try to scan */
1481 if (time_after(jiffies
, ifibss
->last_scan_completed
+
1482 IEEE80211_SCAN_INTERVAL
)) {
1483 struct ieee80211_channel
*channels
[8];
1486 sdata_info(sdata
, "Trigger new scan to find an IBSS to join\n");
1488 num
= ieee80211_ibss_setup_scan_channels(local
->hw
.wiphy
,
1491 ARRAY_SIZE(channels
));
1492 scan_width
= cfg80211_chandef_to_scan_width(&ifibss
->chandef
);
1493 ieee80211_request_ibss_scan(sdata
, ifibss
->ssid
,
1494 ifibss
->ssid_len
, channels
, num
,
1497 int interval
= IEEE80211_SCAN_INTERVAL
;
1499 if (time_after(jiffies
, ifibss
->ibss_join_req
+
1500 IEEE80211_IBSS_JOIN_TIMEOUT
))
1501 ieee80211_sta_create_ibss(sdata
);
1503 mod_timer(&ifibss
->timer
,
1504 round_jiffies(jiffies
+ interval
));
1508 static void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data
*sdata
,
1509 struct sk_buff
*req
)
1511 struct ieee80211_mgmt
*mgmt
= (void *)req
->data
;
1512 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1513 struct ieee80211_local
*local
= sdata
->local
;
1514 int tx_last_beacon
, len
= req
->len
;
1515 struct sk_buff
*skb
;
1516 struct beacon_data
*presp
;
1519 sdata_assert_lock(sdata
);
1521 presp
= rcu_dereference_protected(ifibss
->presp
,
1522 lockdep_is_held(&sdata
->wdev
.mtx
));
1524 if (ifibss
->state
!= IEEE80211_IBSS_MLME_JOINED
||
1525 len
< 24 + 2 || !presp
)
1528 tx_last_beacon
= drv_tx_last_beacon(local
);
1531 "RX ProbeReq SA=%pM DA=%pM BSSID=%pM (tx_last_beacon=%d)\n",
1532 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
, tx_last_beacon
);
1534 if (!tx_last_beacon
&& is_multicast_ether_addr(mgmt
->da
))
1537 if (!ether_addr_equal(mgmt
->bssid
, ifibss
->bssid
) &&
1538 !is_broadcast_ether_addr(mgmt
->bssid
))
1541 end
= ((u8
*) mgmt
) + len
;
1542 pos
= mgmt
->u
.probe_req
.variable
;
1543 if (pos
[0] != WLAN_EID_SSID
||
1544 pos
+ 2 + pos
[1] > end
) {
1545 ibss_dbg(sdata
, "Invalid SSID IE in ProbeReq from %pM\n",
1550 (pos
[1] != ifibss
->ssid_len
||
1551 memcmp(pos
+ 2, ifibss
->ssid
, ifibss
->ssid_len
))) {
1552 /* Ignore ProbeReq for foreign SSID */
1556 /* Reply with ProbeResp */
1557 skb
= dev_alloc_skb(local
->tx_headroom
+ presp
->head_len
);
1561 skb_reserve(skb
, local
->tx_headroom
);
1562 memcpy(skb_put(skb
, presp
->head_len
), presp
->head
, presp
->head_len
);
1564 memcpy(((struct ieee80211_mgmt
*) skb
->data
)->da
, mgmt
->sa
, ETH_ALEN
);
1565 ibss_dbg(sdata
, "Sending ProbeResp to %pM\n", mgmt
->sa
);
1566 IEEE80211_SKB_CB(skb
)->flags
|= IEEE80211_TX_INTFL_DONT_ENCRYPT
;
1568 /* avoid excessive retries for probe request to wildcard SSIDs */
1570 IEEE80211_SKB_CB(skb
)->flags
|= IEEE80211_TX_CTL_NO_ACK
;
1572 ieee80211_tx_skb(sdata
, skb
);
1576 void ieee80211_rx_mgmt_probe_beacon(struct ieee80211_sub_if_data
*sdata
,
1577 struct ieee80211_mgmt
*mgmt
, size_t len
,
1578 struct ieee80211_rx_status
*rx_status
)
1581 struct ieee802_11_elems elems
;
1583 BUILD_BUG_ON(offsetof(typeof(mgmt
->u
.probe_resp
), variable
) !=
1584 offsetof(typeof(mgmt
->u
.beacon
), variable
));
1587 * either beacon or probe_resp but the variable field is at the
1590 baselen
= (u8
*) mgmt
->u
.probe_resp
.variable
- (u8
*) mgmt
;
1594 ieee802_11_parse_elems(mgmt
->u
.probe_resp
.variable
, len
- baselen
,
1597 ieee80211_rx_bss_info(sdata
, mgmt
, len
, rx_status
, &elems
);
1600 void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data
*sdata
,
1601 struct sk_buff
*skb
)
1603 struct ieee80211_rx_status
*rx_status
;
1604 struct ieee80211_mgmt
*mgmt
;
1606 struct ieee802_11_elems elems
;
1609 rx_status
= IEEE80211_SKB_RXCB(skb
);
1610 mgmt
= (struct ieee80211_mgmt
*) skb
->data
;
1611 fc
= le16_to_cpu(mgmt
->frame_control
);
1615 if (!sdata
->u
.ibss
.ssid_len
)
1616 goto mgmt_out
; /* not ready to merge yet */
1618 switch (fc
& IEEE80211_FCTL_STYPE
) {
1619 case IEEE80211_STYPE_PROBE_REQ
:
1620 ieee80211_rx_mgmt_probe_req(sdata
, skb
);
1622 case IEEE80211_STYPE_PROBE_RESP
:
1623 case IEEE80211_STYPE_BEACON
:
1624 ieee80211_rx_mgmt_probe_beacon(sdata
, mgmt
, skb
->len
,
1627 case IEEE80211_STYPE_AUTH
:
1628 ieee80211_rx_mgmt_auth_ibss(sdata
, mgmt
, skb
->len
);
1630 case IEEE80211_STYPE_DEAUTH
:
1631 ieee80211_rx_mgmt_deauth_ibss(sdata
, mgmt
, skb
->len
);
1633 case IEEE80211_STYPE_ACTION
:
1634 switch (mgmt
->u
.action
.category
) {
1635 case WLAN_CATEGORY_SPECTRUM_MGMT
:
1636 ies_len
= skb
->len
-
1637 offsetof(struct ieee80211_mgmt
,
1638 u
.action
.u
.chan_switch
.variable
);
1643 ieee802_11_parse_elems(
1644 mgmt
->u
.action
.u
.chan_switch
.variable
,
1645 ies_len
, true, &elems
);
1647 if (elems
.parse_error
)
1650 ieee80211_rx_mgmt_spectrum_mgmt(sdata
, mgmt
, skb
->len
,
1657 sdata_unlock(sdata
);
1660 void ieee80211_ibss_work(struct ieee80211_sub_if_data
*sdata
)
1662 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1663 struct sta_info
*sta
;
1668 * Work could be scheduled after scan or similar
1669 * when we aren't even joined (or trying) with a
1672 if (!ifibss
->ssid_len
)
1675 spin_lock_bh(&ifibss
->incomplete_lock
);
1676 while (!list_empty(&ifibss
->incomplete_stations
)) {
1677 sta
= list_first_entry(&ifibss
->incomplete_stations
,
1678 struct sta_info
, list
);
1679 list_del(&sta
->list
);
1680 spin_unlock_bh(&ifibss
->incomplete_lock
);
1682 ieee80211_ibss_finish_sta(sta
);
1684 spin_lock_bh(&ifibss
->incomplete_lock
);
1686 spin_unlock_bh(&ifibss
->incomplete_lock
);
1688 switch (ifibss
->state
) {
1689 case IEEE80211_IBSS_MLME_SEARCH
:
1690 ieee80211_sta_find_ibss(sdata
);
1692 case IEEE80211_IBSS_MLME_JOINED
:
1693 ieee80211_sta_merge_ibss(sdata
);
1701 sdata_unlock(sdata
);
1704 static void ieee80211_ibss_timer(unsigned long data
)
1706 struct ieee80211_sub_if_data
*sdata
=
1707 (struct ieee80211_sub_if_data
*) data
;
1709 ieee80211_queue_work(&sdata
->local
->hw
, &sdata
->work
);
1712 void ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data
*sdata
)
1714 struct ieee80211_if_ibss
*ifibss
= &sdata
->u
.ibss
;
1716 setup_timer(&ifibss
->timer
, ieee80211_ibss_timer
,
1717 (unsigned long) sdata
);
1718 INIT_LIST_HEAD(&ifibss
->incomplete_stations
);
1719 spin_lock_init(&ifibss
->incomplete_lock
);
1720 INIT_WORK(&ifibss
->csa_connection_drop_work
,
1721 ieee80211_csa_connection_drop_work
);
1724 /* scan finished notification */
1725 void ieee80211_ibss_notify_scan_completed(struct ieee80211_local
*local
)
1727 struct ieee80211_sub_if_data
*sdata
;
1729 mutex_lock(&local
->iflist_mtx
);
1730 list_for_each_entry(sdata
, &local
->interfaces
, list
) {
1731 if (!ieee80211_sdata_running(sdata
))
1733 if (sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
)
1735 sdata
->u
.ibss
.last_scan_completed
= jiffies
;
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
);