1 // SPDX-License-Identifier: GPL-2.0-only
3 * Copyright (c) 2008, 2009 open80211s Ltd.
4 * Copyright (C) 2018 - 2020 Intel Corporation
5 * Authors: Luis Carlos Cobo <luisca@cozybit.com>
6 * Javier Cardona <javier@cozybit.com>
9 #include <linux/slab.h>
10 #include <asm/unaligned.h>
11 #include "ieee80211_i.h"
13 #include "driver-ops.h"
15 static int mesh_allocated
;
16 static struct kmem_cache
*rm_cache
;
18 bool mesh_action_is_path_sel(struct ieee80211_mgmt
*mgmt
)
20 return (mgmt
->u
.action
.u
.mesh_action
.action_code
==
21 WLAN_MESH_ACTION_HWMP_PATH_SELECTION
);
24 void ieee80211s_init(void)
27 rm_cache
= kmem_cache_create("mesh_rmc", sizeof(struct rmc_entry
),
31 void ieee80211s_stop(void)
35 kmem_cache_destroy(rm_cache
);
38 static void ieee80211_mesh_housekeeping_timer(struct timer_list
*t
)
40 struct ieee80211_sub_if_data
*sdata
=
41 from_timer(sdata
, t
, u
.mesh
.housekeeping_timer
);
42 struct ieee80211_local
*local
= sdata
->local
;
43 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
45 set_bit(MESH_WORK_HOUSEKEEPING
, &ifmsh
->wrkq_flags
);
47 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
51 * mesh_matches_local - check if the config of a mesh point matches ours
53 * @sdata: local mesh subif
54 * @ie: information elements of a management frame from the mesh peer
56 * This function checks if the mesh configuration of a mesh point matches the
57 * local mesh configuration, i.e. if both nodes belong to the same mesh network.
59 bool mesh_matches_local(struct ieee80211_sub_if_data
*sdata
,
60 struct ieee802_11_elems
*ie
)
62 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
64 struct cfg80211_chan_def sta_chan_def
;
65 struct ieee80211_supported_band
*sband
;
69 * As support for each feature is added, check for matching
70 * - On mesh config capabilities
71 * - Power Save Support En
72 * - Sync support enabled
73 * - Sync support active
74 * - Sync support required from peer
76 * - Power management control on fc
78 if (!(ifmsh
->mesh_id_len
== ie
->mesh_id_len
&&
79 memcmp(ifmsh
->mesh_id
, ie
->mesh_id
, ie
->mesh_id_len
) == 0 &&
80 (ifmsh
->mesh_pp_id
== ie
->mesh_config
->meshconf_psel
) &&
81 (ifmsh
->mesh_pm_id
== ie
->mesh_config
->meshconf_pmetric
) &&
82 (ifmsh
->mesh_cc_id
== ie
->mesh_config
->meshconf_congest
) &&
83 (ifmsh
->mesh_sp_id
== ie
->mesh_config
->meshconf_synch
) &&
84 (ifmsh
->mesh_auth_id
== ie
->mesh_config
->meshconf_auth
)))
87 sband
= ieee80211_get_sband(sdata
);
91 ieee80211_sta_get_rates(sdata
, ie
, sband
->band
,
94 if (sdata
->vif
.bss_conf
.basic_rates
!= basic_rates
)
97 cfg80211_chandef_create(&sta_chan_def
, sdata
->vif
.bss_conf
.chandef
.chan
,
99 ieee80211_chandef_ht_oper(ie
->ht_operation
, &sta_chan_def
);
101 if (ie
->vht_cap_elem
)
102 vht_cap_info
= le32_to_cpu(ie
->vht_cap_elem
->vht_cap_info
);
104 ieee80211_chandef_vht_oper(&sdata
->local
->hw
, vht_cap_info
,
105 ie
->vht_operation
, ie
->ht_operation
,
107 ieee80211_chandef_he_6ghz_oper(sdata
, ie
->he_operation
, &sta_chan_def
);
109 if (!cfg80211_chandef_compatible(&sdata
->vif
.bss_conf
.chandef
,
117 * mesh_peer_accepts_plinks - check if an mp is willing to establish peer links
119 * @ie: information elements of a management frame from the mesh peer
121 bool mesh_peer_accepts_plinks(struct ieee802_11_elems
*ie
)
123 return (ie
->mesh_config
->meshconf_cap
&
124 IEEE80211_MESHCONF_CAPAB_ACCEPT_PLINKS
) != 0;
128 * mesh_accept_plinks_update - update accepting_plink in local mesh beacons
130 * @sdata: mesh interface in which mesh beacons are going to be updated
132 * Returns: beacon changed flag if the beacon content changed.
134 u32
mesh_accept_plinks_update(struct ieee80211_sub_if_data
*sdata
)
139 /* In case mesh_plink_free_count > 0 and mesh_plinktbl_capacity == 0,
140 * the mesh interface might be able to establish plinks with peers that
141 * are already on the table but are not on PLINK_ESTAB state. However,
142 * in general the mesh interface is not accepting peer link requests
143 * from new peers, and that must be reflected in the beacon
145 free_plinks
= mesh_plink_availables(sdata
);
147 if (free_plinks
!= sdata
->u
.mesh
.accepting_plinks
) {
148 sdata
->u
.mesh
.accepting_plinks
= free_plinks
;
149 changed
= BSS_CHANGED_BEACON
;
156 * mesh_sta_cleanup - clean up any mesh sta state
158 * @sta: mesh sta to clean up.
160 void mesh_sta_cleanup(struct sta_info
*sta
)
162 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
163 u32 changed
= mesh_plink_deactivate(sta
);
166 ieee80211_mbss_info_change_notify(sdata
, changed
);
169 int mesh_rmc_init(struct ieee80211_sub_if_data
*sdata
)
173 sdata
->u
.mesh
.rmc
= kmalloc(sizeof(struct mesh_rmc
), GFP_KERNEL
);
174 if (!sdata
->u
.mesh
.rmc
)
176 sdata
->u
.mesh
.rmc
->idx_mask
= RMC_BUCKETS
- 1;
177 for (i
= 0; i
< RMC_BUCKETS
; i
++)
178 INIT_HLIST_HEAD(&sdata
->u
.mesh
.rmc
->bucket
[i
]);
182 void mesh_rmc_free(struct ieee80211_sub_if_data
*sdata
)
184 struct mesh_rmc
*rmc
= sdata
->u
.mesh
.rmc
;
186 struct hlist_node
*n
;
189 if (!sdata
->u
.mesh
.rmc
)
192 for (i
= 0; i
< RMC_BUCKETS
; i
++) {
193 hlist_for_each_entry_safe(p
, n
, &rmc
->bucket
[i
], list
) {
195 kmem_cache_free(rm_cache
, p
);
200 sdata
->u
.mesh
.rmc
= NULL
;
204 * mesh_rmc_check - Check frame in recent multicast cache and add if absent.
207 * @sa: source address
208 * @mesh_hdr: mesh_header
210 * Returns: 0 if the frame is not in the cache, nonzero otherwise.
212 * Checks using the source address and the mesh sequence number if we have
213 * received this frame lately. If the frame is not in the cache, it is added to
216 int mesh_rmc_check(struct ieee80211_sub_if_data
*sdata
,
217 const u8
*sa
, struct ieee80211s_hdr
*mesh_hdr
)
219 struct mesh_rmc
*rmc
= sdata
->u
.mesh
.rmc
;
224 struct hlist_node
*n
;
229 /* Don't care about endianness since only match matters */
230 memcpy(&seqnum
, &mesh_hdr
->seqnum
, sizeof(mesh_hdr
->seqnum
));
231 idx
= le32_to_cpu(mesh_hdr
->seqnum
) & rmc
->idx_mask
;
232 hlist_for_each_entry_safe(p
, n
, &rmc
->bucket
[idx
], list
) {
234 if (time_after(jiffies
, p
->exp_time
) ||
235 entries
== RMC_QUEUE_MAX_LEN
) {
237 kmem_cache_free(rm_cache
, p
);
239 } else if ((seqnum
== p
->seqnum
) && ether_addr_equal(sa
, p
->sa
))
243 p
= kmem_cache_alloc(rm_cache
, GFP_ATOMIC
);
248 p
->exp_time
= jiffies
+ RMC_TIMEOUT
;
249 memcpy(p
->sa
, sa
, ETH_ALEN
);
250 hlist_add_head(&p
->list
, &rmc
->bucket
[idx
]);
254 int mesh_add_meshconf_ie(struct ieee80211_sub_if_data
*sdata
,
257 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
259 u8 meshconf_len
= sizeof(struct ieee80211_meshconf_ie
);
260 bool is_connected_to_gate
= ifmsh
->num_gates
> 0 ||
261 ifmsh
->mshcfg
.dot11MeshGateAnnouncementProtocol
||
262 ifmsh
->mshcfg
.dot11MeshConnectedToMeshGate
;
263 bool is_connected_to_as
= ifmsh
->mshcfg
.dot11MeshConnectedToAuthServer
;
265 if (skb_tailroom(skb
) < 2 + meshconf_len
)
268 pos
= skb_put(skb
, 2 + meshconf_len
);
269 *pos
++ = WLAN_EID_MESH_CONFIG
;
270 *pos
++ = meshconf_len
;
272 /* save a pointer for quick updates in pre-tbtt */
273 ifmsh
->meshconf_offset
= pos
- skb
->data
;
275 /* Active path selection protocol ID */
276 *pos
++ = ifmsh
->mesh_pp_id
;
277 /* Active path selection metric ID */
278 *pos
++ = ifmsh
->mesh_pm_id
;
279 /* Congestion control mode identifier */
280 *pos
++ = ifmsh
->mesh_cc_id
;
281 /* Synchronization protocol identifier */
282 *pos
++ = ifmsh
->mesh_sp_id
;
283 /* Authentication Protocol identifier */
284 *pos
++ = ifmsh
->mesh_auth_id
;
285 /* Mesh Formation Info - number of neighbors */
286 neighbors
= atomic_read(&ifmsh
->estab_plinks
);
287 neighbors
= min_t(int, neighbors
, IEEE80211_MAX_MESH_PEERINGS
);
288 *pos
++ = (is_connected_to_as
<< 7) |
290 is_connected_to_gate
;
291 /* Mesh capability */
293 *pos
|= ifmsh
->mshcfg
.dot11MeshForwarding
?
294 IEEE80211_MESHCONF_CAPAB_FORWARDING
: 0x00;
295 *pos
|= ifmsh
->accepting_plinks
?
296 IEEE80211_MESHCONF_CAPAB_ACCEPT_PLINKS
: 0x00;
297 /* Mesh PS mode. See IEEE802.11-2012 8.4.2.100.8 */
298 *pos
|= ifmsh
->ps_peers_deep_sleep
?
299 IEEE80211_MESHCONF_CAPAB_POWER_SAVE_LEVEL
: 0x00;
303 int mesh_add_meshid_ie(struct ieee80211_sub_if_data
*sdata
, struct sk_buff
*skb
)
305 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
308 if (skb_tailroom(skb
) < 2 + ifmsh
->mesh_id_len
)
311 pos
= skb_put(skb
, 2 + ifmsh
->mesh_id_len
);
312 *pos
++ = WLAN_EID_MESH_ID
;
313 *pos
++ = ifmsh
->mesh_id_len
;
314 if (ifmsh
->mesh_id_len
)
315 memcpy(pos
, ifmsh
->mesh_id
, ifmsh
->mesh_id_len
);
320 static int mesh_add_awake_window_ie(struct ieee80211_sub_if_data
*sdata
,
323 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
326 /* see IEEE802.11-2012 13.14.6 */
327 if (ifmsh
->ps_peers_light_sleep
== 0 &&
328 ifmsh
->ps_peers_deep_sleep
== 0 &&
329 ifmsh
->nonpeer_pm
== NL80211_MESH_POWER_ACTIVE
)
332 if (skb_tailroom(skb
) < 4)
335 pos
= skb_put(skb
, 2 + 2);
336 *pos
++ = WLAN_EID_MESH_AWAKE_WINDOW
;
338 put_unaligned_le16(ifmsh
->mshcfg
.dot11MeshAwakeWindowDuration
, pos
);
343 int mesh_add_vendor_ies(struct ieee80211_sub_if_data
*sdata
,
346 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
350 if (!ifmsh
->ie
|| !ifmsh
->ie_len
)
353 /* fast-forward to vendor IEs */
354 offset
= ieee80211_ie_split_vendor(ifmsh
->ie
, ifmsh
->ie_len
, 0);
356 if (offset
< ifmsh
->ie_len
) {
357 len
= ifmsh
->ie_len
- offset
;
358 data
= ifmsh
->ie
+ offset
;
359 if (skb_tailroom(skb
) < len
)
361 skb_put_data(skb
, data
, len
);
367 int mesh_add_rsn_ie(struct ieee80211_sub_if_data
*sdata
, struct sk_buff
*skb
)
369 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
373 if (!ifmsh
->ie
|| !ifmsh
->ie_len
)
377 data
= cfg80211_find_ie(WLAN_EID_RSN
, ifmsh
->ie
, ifmsh
->ie_len
);
383 if (skb_tailroom(skb
) < len
)
385 skb_put_data(skb
, data
, len
);
390 static int mesh_add_ds_params_ie(struct ieee80211_sub_if_data
*sdata
,
393 struct ieee80211_chanctx_conf
*chanctx_conf
;
394 struct ieee80211_channel
*chan
;
397 if (skb_tailroom(skb
) < 3)
401 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
402 if (WARN_ON(!chanctx_conf
)) {
406 chan
= chanctx_conf
->def
.chan
;
409 pos
= skb_put(skb
, 2 + 1);
410 *pos
++ = WLAN_EID_DS_PARAMS
;
412 *pos
++ = ieee80211_frequency_to_channel(chan
->center_freq
);
417 int mesh_add_ht_cap_ie(struct ieee80211_sub_if_data
*sdata
,
420 struct ieee80211_supported_band
*sband
;
423 sband
= ieee80211_get_sband(sdata
);
427 /* HT not allowed in 6 GHz */
428 if (sband
->band
== NL80211_BAND_6GHZ
)
431 if (!sband
->ht_cap
.ht_supported
||
432 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_20_NOHT
||
433 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_5
||
434 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_10
)
437 if (skb_tailroom(skb
) < 2 + sizeof(struct ieee80211_ht_cap
))
440 pos
= skb_put(skb
, 2 + sizeof(struct ieee80211_ht_cap
));
441 ieee80211_ie_build_ht_cap(pos
, &sband
->ht_cap
, sband
->ht_cap
.cap
);
446 int mesh_add_ht_oper_ie(struct ieee80211_sub_if_data
*sdata
,
449 struct ieee80211_local
*local
= sdata
->local
;
450 struct ieee80211_chanctx_conf
*chanctx_conf
;
451 struct ieee80211_channel
*channel
;
452 struct ieee80211_supported_band
*sband
;
453 struct ieee80211_sta_ht_cap
*ht_cap
;
457 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
458 if (WARN_ON(!chanctx_conf
)) {
462 channel
= chanctx_conf
->def
.chan
;
465 sband
= local
->hw
.wiphy
->bands
[channel
->band
];
466 ht_cap
= &sband
->ht_cap
;
468 /* HT not allowed in 6 GHz */
469 if (sband
->band
== NL80211_BAND_6GHZ
)
472 if (!ht_cap
->ht_supported
||
473 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_20_NOHT
||
474 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_5
||
475 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_10
)
478 if (skb_tailroom(skb
) < 2 + sizeof(struct ieee80211_ht_operation
))
481 pos
= skb_put(skb
, 2 + sizeof(struct ieee80211_ht_operation
));
482 ieee80211_ie_build_ht_oper(pos
, ht_cap
, &sdata
->vif
.bss_conf
.chandef
,
483 sdata
->vif
.bss_conf
.ht_operation_mode
,
489 int mesh_add_vht_cap_ie(struct ieee80211_sub_if_data
*sdata
,
492 struct ieee80211_supported_band
*sband
;
495 sband
= ieee80211_get_sband(sdata
);
499 /* VHT not allowed in 6 GHz */
500 if (sband
->band
== NL80211_BAND_6GHZ
)
503 if (!sband
->vht_cap
.vht_supported
||
504 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_20_NOHT
||
505 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_5
||
506 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_10
)
509 if (skb_tailroom(skb
) < 2 + sizeof(struct ieee80211_vht_cap
))
512 pos
= skb_put(skb
, 2 + sizeof(struct ieee80211_vht_cap
));
513 ieee80211_ie_build_vht_cap(pos
, &sband
->vht_cap
, sband
->vht_cap
.cap
);
518 int mesh_add_vht_oper_ie(struct ieee80211_sub_if_data
*sdata
,
521 struct ieee80211_local
*local
= sdata
->local
;
522 struct ieee80211_chanctx_conf
*chanctx_conf
;
523 struct ieee80211_channel
*channel
;
524 struct ieee80211_supported_band
*sband
;
525 struct ieee80211_sta_vht_cap
*vht_cap
;
529 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
530 if (WARN_ON(!chanctx_conf
)) {
534 channel
= chanctx_conf
->def
.chan
;
537 sband
= local
->hw
.wiphy
->bands
[channel
->band
];
538 vht_cap
= &sband
->vht_cap
;
540 /* VHT not allowed in 6 GHz */
541 if (sband
->band
== NL80211_BAND_6GHZ
)
544 if (!vht_cap
->vht_supported
||
545 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_20_NOHT
||
546 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_5
||
547 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_10
)
550 if (skb_tailroom(skb
) < 2 + sizeof(struct ieee80211_vht_operation
))
553 pos
= skb_put(skb
, 2 + sizeof(struct ieee80211_vht_operation
));
554 ieee80211_ie_build_vht_oper(pos
, vht_cap
,
555 &sdata
->vif
.bss_conf
.chandef
);
560 int mesh_add_he_cap_ie(struct ieee80211_sub_if_data
*sdata
,
561 struct sk_buff
*skb
, u8 ie_len
)
563 const struct ieee80211_sta_he_cap
*he_cap
;
564 struct ieee80211_supported_band
*sband
;
567 sband
= ieee80211_get_sband(sdata
);
571 he_cap
= ieee80211_get_he_iftype_cap(sband
, NL80211_IFTYPE_MESH_POINT
);
574 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_20_NOHT
||
575 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_5
||
576 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_10
)
579 if (skb_tailroom(skb
) < ie_len
)
582 pos
= skb_put(skb
, ie_len
);
583 ieee80211_ie_build_he_cap(0, pos
, he_cap
, pos
+ ie_len
);
588 int mesh_add_he_oper_ie(struct ieee80211_sub_if_data
*sdata
,
591 const struct ieee80211_sta_he_cap
*he_cap
;
592 struct ieee80211_supported_band
*sband
;
596 sband
= ieee80211_get_sband(sdata
);
600 he_cap
= ieee80211_get_he_iftype_cap(sband
, NL80211_IFTYPE_MESH_POINT
);
602 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_20_NOHT
||
603 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_5
||
604 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_10
)
607 len
= 2 + 1 + sizeof(struct ieee80211_he_operation
);
608 if (sdata
->vif
.bss_conf
.chandef
.chan
->band
== NL80211_BAND_6GHZ
)
609 len
+= sizeof(struct ieee80211_he_6ghz_oper
);
611 if (skb_tailroom(skb
) < len
)
614 pos
= skb_put(skb
, len
);
615 ieee80211_ie_build_he_oper(pos
, &sdata
->vif
.bss_conf
.chandef
);
620 int mesh_add_he_6ghz_cap_ie(struct ieee80211_sub_if_data
*sdata
,
623 struct ieee80211_supported_band
*sband
;
624 const struct ieee80211_sband_iftype_data
*iftd
;
626 sband
= ieee80211_get_sband(sdata
);
630 iftd
= ieee80211_get_sband_iftype_data(sband
,
631 NL80211_IFTYPE_MESH_POINT
);
632 /* The device doesn't support HE in mesh mode or at all */
636 ieee80211_ie_build_he_6ghz_cap(sdata
, skb
);
640 static void ieee80211_mesh_path_timer(struct timer_list
*t
)
642 struct ieee80211_sub_if_data
*sdata
=
643 from_timer(sdata
, t
, u
.mesh
.mesh_path_timer
);
645 ieee80211_queue_work(&sdata
->local
->hw
, &sdata
->work
);
648 static void ieee80211_mesh_path_root_timer(struct timer_list
*t
)
650 struct ieee80211_sub_if_data
*sdata
=
651 from_timer(sdata
, t
, u
.mesh
.mesh_path_root_timer
);
652 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
654 set_bit(MESH_WORK_ROOT
, &ifmsh
->wrkq_flags
);
656 ieee80211_queue_work(&sdata
->local
->hw
, &sdata
->work
);
659 void ieee80211_mesh_root_setup(struct ieee80211_if_mesh
*ifmsh
)
661 if (ifmsh
->mshcfg
.dot11MeshHWMPRootMode
> IEEE80211_ROOTMODE_ROOT
)
662 set_bit(MESH_WORK_ROOT
, &ifmsh
->wrkq_flags
);
664 clear_bit(MESH_WORK_ROOT
, &ifmsh
->wrkq_flags
);
665 /* stop running timer */
666 del_timer_sync(&ifmsh
->mesh_path_root_timer
);
671 ieee80211_mesh_update_bss_params(struct ieee80211_sub_if_data
*sdata
,
674 struct ieee80211_supported_band
*sband
;
675 const struct element
*cap
;
676 const struct ieee80211_he_operation
*he_oper
= NULL
;
678 sband
= ieee80211_get_sband(sdata
);
682 if (!ieee80211_get_he_iftype_cap(sband
, NL80211_IFTYPE_MESH_POINT
) ||
683 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_20_NOHT
||
684 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_5
||
685 sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_10
)
688 sdata
->vif
.bss_conf
.he_support
= true;
690 cap
= cfg80211_find_ext_elem(WLAN_EID_EXT_HE_OPERATION
, ie
, ie_len
);
691 if (cap
&& cap
->datalen
>= 1 + sizeof(*he_oper
) &&
692 cap
->datalen
>= 1 + ieee80211_he_oper_size(cap
->data
+ 1))
693 he_oper
= (void *)(cap
->data
+ 1);
696 sdata
->vif
.bss_conf
.he_oper
.params
=
697 __le32_to_cpu(he_oper
->he_oper_params
);
701 * ieee80211_fill_mesh_addresses - fill addresses of a locally originated mesh frame
702 * @hdr: 802.11 frame header
703 * @fc: frame control field
704 * @meshda: destination address in the mesh
705 * @meshsa: source address in the mesh. Same as TA, as frame is
706 * locally originated.
708 * Return the length of the 802.11 (does not include a mesh control header)
710 int ieee80211_fill_mesh_addresses(struct ieee80211_hdr
*hdr
, __le16
*fc
,
711 const u8
*meshda
, const u8
*meshsa
)
713 if (is_multicast_ether_addr(meshda
)) {
714 *fc
|= cpu_to_le16(IEEE80211_FCTL_FROMDS
);
716 memcpy(hdr
->addr1
, meshda
, ETH_ALEN
);
717 memcpy(hdr
->addr2
, meshsa
, ETH_ALEN
);
718 memcpy(hdr
->addr3
, meshsa
, ETH_ALEN
);
721 *fc
|= cpu_to_le16(IEEE80211_FCTL_FROMDS
| IEEE80211_FCTL_TODS
);
723 eth_zero_addr(hdr
->addr1
); /* RA is resolved later */
724 memcpy(hdr
->addr2
, meshsa
, ETH_ALEN
);
725 memcpy(hdr
->addr3
, meshda
, ETH_ALEN
);
726 memcpy(hdr
->addr4
, meshsa
, ETH_ALEN
);
732 * ieee80211_new_mesh_header - create a new mesh header
733 * @sdata: mesh interface to be used
734 * @meshhdr: uninitialized mesh header
735 * @addr4or5: 1st address in the ae header, which may correspond to address 4
736 * (if addr6 is NULL) or address 5 (if addr6 is present). It may
738 * @addr6: 2nd address in the ae header, which corresponds to addr6 of the
741 * Return the header length.
743 unsigned int ieee80211_new_mesh_header(struct ieee80211_sub_if_data
*sdata
,
744 struct ieee80211s_hdr
*meshhdr
,
745 const char *addr4or5
, const char *addr6
)
747 if (WARN_ON(!addr4or5
&& addr6
))
750 memset(meshhdr
, 0, sizeof(*meshhdr
));
752 meshhdr
->ttl
= sdata
->u
.mesh
.mshcfg
.dot11MeshTTL
;
754 /* FIXME: racy -- TX on multiple queues can be concurrent */
755 put_unaligned(cpu_to_le32(sdata
->u
.mesh
.mesh_seqnum
), &meshhdr
->seqnum
);
756 sdata
->u
.mesh
.mesh_seqnum
++;
758 if (addr4or5
&& !addr6
) {
759 meshhdr
->flags
|= MESH_FLAGS_AE_A4
;
760 memcpy(meshhdr
->eaddr1
, addr4or5
, ETH_ALEN
);
762 } else if (addr4or5
&& addr6
) {
763 meshhdr
->flags
|= MESH_FLAGS_AE_A5_A6
;
764 memcpy(meshhdr
->eaddr1
, addr4or5
, ETH_ALEN
);
765 memcpy(meshhdr
->eaddr2
, addr6
, ETH_ALEN
);
772 static void ieee80211_mesh_housekeeping(struct ieee80211_sub_if_data
*sdata
)
774 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
777 if (ifmsh
->mshcfg
.plink_timeout
> 0)
778 ieee80211_sta_expire(sdata
, ifmsh
->mshcfg
.plink_timeout
* HZ
);
779 mesh_path_expire(sdata
);
781 changed
= mesh_accept_plinks_update(sdata
);
782 ieee80211_mbss_info_change_notify(sdata
, changed
);
784 mod_timer(&ifmsh
->housekeeping_timer
,
785 round_jiffies(jiffies
+
786 IEEE80211_MESH_HOUSEKEEPING_INTERVAL
));
789 static void ieee80211_mesh_rootpath(struct ieee80211_sub_if_data
*sdata
)
791 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
794 mesh_path_tx_root_frame(sdata
);
796 if (ifmsh
->mshcfg
.dot11MeshHWMPRootMode
== IEEE80211_PROACTIVE_RANN
)
797 interval
= ifmsh
->mshcfg
.dot11MeshHWMPRannInterval
;
799 interval
= ifmsh
->mshcfg
.dot11MeshHWMProotInterval
;
801 mod_timer(&ifmsh
->mesh_path_root_timer
,
802 round_jiffies(TU_TO_EXP_TIME(interval
)));
806 ieee80211_mesh_build_beacon(struct ieee80211_if_mesh
*ifmsh
)
808 struct beacon_data
*bcn
;
809 int head_len
, tail_len
;
811 struct ieee80211_mgmt
*mgmt
;
812 struct ieee80211_chanctx_conf
*chanctx_conf
;
813 struct mesh_csa_settings
*csa
;
814 enum nl80211_band band
;
817 struct ieee80211_sub_if_data
*sdata
;
818 int hdr_len
= offsetofend(struct ieee80211_mgmt
, u
.beacon
);
820 sdata
= container_of(ifmsh
, struct ieee80211_sub_if_data
, u
.mesh
);
822 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
823 band
= chanctx_conf
->def
.chan
->band
;
826 ie_len_he_cap
= ieee80211_ie_len_he_cap(sdata
,
827 NL80211_IFTYPE_MESH_POINT
);
830 /* Channel Switch Announcement */
831 2 + sizeof(struct ieee80211_channel_sw_ie
) +
832 /* Mesh Channel Switch Parameters */
833 2 + sizeof(struct ieee80211_mesh_chansw_params_ie
) +
834 /* Channel Switch Wrapper + Wide Bandwidth CSA IE */
835 2 + 2 + sizeof(struct ieee80211_wide_bw_chansw_ie
) +
836 2 + sizeof(struct ieee80211_sec_chan_offs_ie
) +
837 2 + 8 + /* supported rates */
838 2 + 3; /* DS params */
839 tail_len
= 2 + (IEEE80211_MAX_SUPP_RATES
- 8) +
840 2 + sizeof(struct ieee80211_ht_cap
) +
841 2 + sizeof(struct ieee80211_ht_operation
) +
842 2 + ifmsh
->mesh_id_len
+
843 2 + sizeof(struct ieee80211_meshconf_ie
) +
844 2 + sizeof(__le16
) + /* awake window */
845 2 + sizeof(struct ieee80211_vht_cap
) +
846 2 + sizeof(struct ieee80211_vht_operation
) +
848 2 + 1 + sizeof(struct ieee80211_he_operation
) +
849 sizeof(struct ieee80211_he_6ghz_oper
) +
850 2 + 1 + sizeof(struct ieee80211_he_6ghz_capa
) +
853 bcn
= kzalloc(sizeof(*bcn
) + head_len
+ tail_len
, GFP_KERNEL
);
854 /* need an skb for IE builders to operate on */
855 skb
= dev_alloc_skb(max(head_len
, tail_len
));
861 * pointers go into the block we allocated,
862 * memory is | beacon_data | head | tail |
864 bcn
->head
= ((u8
*) bcn
) + sizeof(*bcn
);
866 /* fill in the head */
867 mgmt
= skb_put_zero(skb
, hdr_len
);
868 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
869 IEEE80211_STYPE_BEACON
);
870 eth_broadcast_addr(mgmt
->da
);
871 memcpy(mgmt
->sa
, sdata
->vif
.addr
, ETH_ALEN
);
872 memcpy(mgmt
->bssid
, sdata
->vif
.addr
, ETH_ALEN
);
873 ieee80211_mps_set_frame_flags(sdata
, NULL
, (void *) mgmt
);
874 mgmt
->u
.beacon
.beacon_int
=
875 cpu_to_le16(sdata
->vif
.bss_conf
.beacon_int
);
876 mgmt
->u
.beacon
.capab_info
|= cpu_to_le16(
877 sdata
->u
.mesh
.security
? WLAN_CAPABILITY_PRIVACY
: 0);
879 pos
= skb_put(skb
, 2);
880 *pos
++ = WLAN_EID_SSID
;
884 csa
= rcu_dereference(ifmsh
->csa
);
886 enum nl80211_channel_type ct
;
887 struct cfg80211_chan_def
*chandef
;
888 int ie_len
= 2 + sizeof(struct ieee80211_channel_sw_ie
) +
889 2 + sizeof(struct ieee80211_mesh_chansw_params_ie
);
891 pos
= skb_put_zero(skb
, ie_len
);
892 *pos
++ = WLAN_EID_CHANNEL_SWITCH
;
895 *pos
++ = ieee80211_frequency_to_channel(
896 csa
->settings
.chandef
.chan
->center_freq
);
897 bcn
->cntdwn_current_counter
= csa
->settings
.count
;
898 bcn
->cntdwn_counter_offsets
[0] = hdr_len
+ 6;
899 *pos
++ = csa
->settings
.count
;
900 *pos
++ = WLAN_EID_CHAN_SWITCH_PARAM
;
902 if (ifmsh
->csa_role
== IEEE80211_MESH_CSA_ROLE_INIT
) {
903 *pos
++ = ifmsh
->mshcfg
.dot11MeshTTL
;
904 *pos
|= WLAN_EID_CHAN_SWITCH_PARAM_INITIATOR
;
906 *pos
++ = ifmsh
->chsw_ttl
;
908 *pos
++ |= csa
->settings
.block_tx
?
909 WLAN_EID_CHAN_SWITCH_PARAM_TX_RESTRICT
: 0x00;
910 put_unaligned_le16(WLAN_REASON_MESH_CHAN
, pos
);
912 put_unaligned_le16(ifmsh
->pre_value
, pos
);
915 switch (csa
->settings
.chandef
.width
) {
916 case NL80211_CHAN_WIDTH_40
:
917 ie_len
= 2 + sizeof(struct ieee80211_sec_chan_offs_ie
);
918 pos
= skb_put_zero(skb
, ie_len
);
920 *pos
++ = WLAN_EID_SECONDARY_CHANNEL_OFFSET
; /* EID */
921 *pos
++ = 1; /* len */
922 ct
= cfg80211_get_chandef_type(&csa
->settings
.chandef
);
923 if (ct
== NL80211_CHAN_HT40PLUS
)
924 *pos
++ = IEEE80211_HT_PARAM_CHA_SEC_ABOVE
;
926 *pos
++ = IEEE80211_HT_PARAM_CHA_SEC_BELOW
;
928 case NL80211_CHAN_WIDTH_80
:
929 case NL80211_CHAN_WIDTH_80P80
:
930 case NL80211_CHAN_WIDTH_160
:
931 /* Channel Switch Wrapper + Wide Bandwidth CSA IE */
933 sizeof(struct ieee80211_wide_bw_chansw_ie
);
934 pos
= skb_put_zero(skb
, ie_len
);
936 *pos
++ = WLAN_EID_CHANNEL_SWITCH_WRAPPER
; /* EID */
937 *pos
++ = 5; /* len */
939 chandef
= &csa
->settings
.chandef
;
940 ieee80211_ie_build_wide_bw_cs(pos
, chandef
);
948 if (ieee80211_add_srates_ie(sdata
, skb
, true, band
) ||
949 mesh_add_ds_params_ie(sdata
, skb
))
952 bcn
->head_len
= skb
->len
;
953 memcpy(bcn
->head
, skb
->data
, bcn
->head_len
);
957 bcn
->tail
= bcn
->head
+ bcn
->head_len
;
959 if (ieee80211_add_ext_srates_ie(sdata
, skb
, true, band
) ||
960 mesh_add_rsn_ie(sdata
, skb
) ||
961 mesh_add_ht_cap_ie(sdata
, skb
) ||
962 mesh_add_ht_oper_ie(sdata
, skb
) ||
963 mesh_add_meshid_ie(sdata
, skb
) ||
964 mesh_add_meshconf_ie(sdata
, skb
) ||
965 mesh_add_awake_window_ie(sdata
, skb
) ||
966 mesh_add_vht_cap_ie(sdata
, skb
) ||
967 mesh_add_vht_oper_ie(sdata
, skb
) ||
968 mesh_add_he_cap_ie(sdata
, skb
, ie_len_he_cap
) ||
969 mesh_add_he_oper_ie(sdata
, skb
) ||
970 mesh_add_he_6ghz_cap_ie(sdata
, skb
) ||
971 mesh_add_vendor_ies(sdata
, skb
))
974 bcn
->tail_len
= skb
->len
;
975 memcpy(bcn
->tail
, skb
->data
, bcn
->tail_len
);
976 ieee80211_mesh_update_bss_params(sdata
, bcn
->tail
, bcn
->tail_len
);
977 bcn
->meshconf
= (struct ieee80211_meshconf_ie
*)
978 (bcn
->tail
+ ifmsh
->meshconf_offset
);
981 rcu_assign_pointer(ifmsh
->beacon
, bcn
);
990 ieee80211_mesh_rebuild_beacon(struct ieee80211_sub_if_data
*sdata
)
992 struct beacon_data
*old_bcn
;
995 old_bcn
= rcu_dereference_protected(sdata
->u
.mesh
.beacon
,
996 lockdep_is_held(&sdata
->wdev
.mtx
));
997 ret
= ieee80211_mesh_build_beacon(&sdata
->u
.mesh
);
999 /* just reuse old beacon */
1003 kfree_rcu(old_bcn
, rcu_head
);
1007 void ieee80211_mbss_info_change_notify(struct ieee80211_sub_if_data
*sdata
,
1010 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1011 unsigned long bits
= changed
;
1017 /* if we race with running work, worst case this work becomes a noop */
1018 for_each_set_bit(bit
, &bits
, sizeof(changed
) * BITS_PER_BYTE
)
1019 set_bit(bit
, &ifmsh
->mbss_changed
);
1020 set_bit(MESH_WORK_MBSS_CHANGED
, &ifmsh
->wrkq_flags
);
1021 ieee80211_queue_work(&sdata
->local
->hw
, &sdata
->work
);
1024 int ieee80211_start_mesh(struct ieee80211_sub_if_data
*sdata
)
1026 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1027 struct ieee80211_local
*local
= sdata
->local
;
1028 u32 changed
= BSS_CHANGED_BEACON
|
1029 BSS_CHANGED_BEACON_ENABLED
|
1031 BSS_CHANGED_BASIC_RATES
|
1032 BSS_CHANGED_BEACON_INT
|
1033 BSS_CHANGED_MCAST_RATE
;
1035 local
->fif_other_bss
++;
1036 /* mesh ifaces must set allmulti to forward mcast traffic */
1037 atomic_inc(&local
->iff_allmultis
);
1038 ieee80211_configure_filter(local
);
1040 ifmsh
->mesh_cc_id
= 0; /* Disabled */
1041 /* register sync ops from extensible synchronization framework */
1042 ifmsh
->sync_ops
= ieee80211_mesh_sync_ops_get(ifmsh
->mesh_sp_id
);
1043 ifmsh
->sync_offset_clockdrift_max
= 0;
1044 set_bit(MESH_WORK_HOUSEKEEPING
, &ifmsh
->wrkq_flags
);
1045 ieee80211_mesh_root_setup(ifmsh
);
1046 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
1047 sdata
->vif
.bss_conf
.ht_operation_mode
=
1048 ifmsh
->mshcfg
.ht_opmode
;
1049 sdata
->vif
.bss_conf
.enable_beacon
= true;
1051 changed
|= ieee80211_mps_local_status_update(sdata
);
1053 if (ieee80211_mesh_build_beacon(ifmsh
)) {
1054 ieee80211_stop_mesh(sdata
);
1058 ieee80211_recalc_dtim(local
, sdata
);
1059 ieee80211_bss_info_change_notify(sdata
, changed
);
1061 netif_carrier_on(sdata
->dev
);
1065 void ieee80211_stop_mesh(struct ieee80211_sub_if_data
*sdata
)
1067 struct ieee80211_local
*local
= sdata
->local
;
1068 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1069 struct beacon_data
*bcn
;
1071 netif_carrier_off(sdata
->dev
);
1073 /* flush STAs and mpaths on this iface */
1074 sta_info_flush(sdata
);
1075 ieee80211_free_keys(sdata
, true);
1076 mesh_path_flush_by_iface(sdata
);
1078 /* stop the beacon */
1079 ifmsh
->mesh_id_len
= 0;
1080 sdata
->vif
.bss_conf
.enable_beacon
= false;
1081 sdata
->beacon_rate_set
= false;
1082 clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED
, &sdata
->state
);
1083 ieee80211_bss_info_change_notify(sdata
, BSS_CHANGED_BEACON_ENABLED
);
1086 bcn
= rcu_dereference_protected(ifmsh
->beacon
,
1087 lockdep_is_held(&sdata
->wdev
.mtx
));
1088 RCU_INIT_POINTER(ifmsh
->beacon
, NULL
);
1089 kfree_rcu(bcn
, rcu_head
);
1091 /* free all potentially still buffered group-addressed frames */
1092 local
->total_ps_buffered
-= skb_queue_len(&ifmsh
->ps
.bc_buf
);
1093 skb_queue_purge(&ifmsh
->ps
.bc_buf
);
1095 del_timer_sync(&sdata
->u
.mesh
.housekeeping_timer
);
1096 del_timer_sync(&sdata
->u
.mesh
.mesh_path_root_timer
);
1097 del_timer_sync(&sdata
->u
.mesh
.mesh_path_timer
);
1099 /* clear any mesh work (for next join) we may have accrued */
1100 ifmsh
->wrkq_flags
= 0;
1101 ifmsh
->mbss_changed
= 0;
1103 local
->fif_other_bss
--;
1104 atomic_dec(&local
->iff_allmultis
);
1105 ieee80211_configure_filter(local
);
1108 static void ieee80211_mesh_csa_mark_radar(struct ieee80211_sub_if_data
*sdata
)
1112 /* if the current channel is a DFS channel, mark the channel as
1115 err
= cfg80211_chandef_dfs_required(sdata
->local
->hw
.wiphy
,
1116 &sdata
->vif
.bss_conf
.chandef
,
1117 NL80211_IFTYPE_MESH_POINT
);
1119 cfg80211_radar_event(sdata
->local
->hw
.wiphy
,
1120 &sdata
->vif
.bss_conf
.chandef
, GFP_ATOMIC
);
1124 ieee80211_mesh_process_chnswitch(struct ieee80211_sub_if_data
*sdata
,
1125 struct ieee802_11_elems
*elems
, bool beacon
)
1127 struct cfg80211_csa_settings params
;
1128 struct ieee80211_csa_ie csa_ie
;
1129 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1130 struct ieee80211_supported_band
*sband
;
1132 u32 sta_flags
, vht_cap_info
= 0;
1134 sdata_assert_lock(sdata
);
1136 sband
= ieee80211_get_sband(sdata
);
1141 switch (sdata
->vif
.bss_conf
.chandef
.width
) {
1142 case NL80211_CHAN_WIDTH_20_NOHT
:
1143 sta_flags
|= IEEE80211_STA_DISABLE_HT
;
1145 case NL80211_CHAN_WIDTH_20
:
1146 sta_flags
|= IEEE80211_STA_DISABLE_40MHZ
;
1148 case NL80211_CHAN_WIDTH_40
:
1149 sta_flags
|= IEEE80211_STA_DISABLE_VHT
;
1155 if (elems
->vht_cap_elem
)
1157 le32_to_cpu(elems
->vht_cap_elem
->vht_cap_info
);
1159 memset(¶ms
, 0, sizeof(params
));
1160 err
= ieee80211_parse_ch_switch_ie(sdata
, elems
, sband
->band
,
1162 sta_flags
, sdata
->vif
.addr
,
1169 /* Mark the channel unavailable if the reason for the switch is
1172 if (csa_ie
.reason_code
== WLAN_REASON_MESH_CHAN_REGULATORY
)
1173 ieee80211_mesh_csa_mark_radar(sdata
);
1175 params
.chandef
= csa_ie
.chandef
;
1176 params
.count
= csa_ie
.count
;
1178 if (!cfg80211_chandef_usable(sdata
->local
->hw
.wiphy
, ¶ms
.chandef
,
1179 IEEE80211_CHAN_DISABLED
) ||
1180 !cfg80211_reg_can_beacon(sdata
->local
->hw
.wiphy
, ¶ms
.chandef
,
1181 NL80211_IFTYPE_MESH_POINT
)) {
1183 "mesh STA %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), aborting\n",
1185 params
.chandef
.chan
->center_freq
,
1186 params
.chandef
.width
,
1187 params
.chandef
.center_freq1
,
1188 params
.chandef
.center_freq2
);
1192 err
= cfg80211_chandef_dfs_required(sdata
->local
->hw
.wiphy
,
1194 NL80211_IFTYPE_MESH_POINT
);
1197 if (err
> 0 && !ifmsh
->userspace_handles_dfs
) {
1199 "mesh STA %pM switches to channel requiring DFS (%d MHz, width:%d, CF1/2: %d/%d MHz), aborting\n",
1201 params
.chandef
.chan
->center_freq
,
1202 params
.chandef
.width
,
1203 params
.chandef
.center_freq1
,
1204 params
.chandef
.center_freq2
);
1208 params
.radar_required
= err
;
1210 if (cfg80211_chandef_identical(¶ms
.chandef
,
1211 &sdata
->vif
.bss_conf
.chandef
)) {
1213 "received csa with an identical chandef, ignoring\n");
1218 "received channel switch announcement to go to channel %d MHz\n",
1219 params
.chandef
.chan
->center_freq
);
1221 params
.block_tx
= csa_ie
.mode
& WLAN_EID_CHAN_SWITCH_PARAM_TX_RESTRICT
;
1223 ifmsh
->chsw_ttl
= csa_ie
.ttl
- 1;
1224 if (ifmsh
->pre_value
>= csa_ie
.pre_value
)
1226 ifmsh
->pre_value
= csa_ie
.pre_value
;
1229 if (ifmsh
->chsw_ttl
>= ifmsh
->mshcfg
.dot11MeshTTL
)
1232 ifmsh
->csa_role
= IEEE80211_MESH_CSA_ROLE_REPEATER
;
1234 if (ieee80211_channel_switch(sdata
->local
->hw
.wiphy
, sdata
->dev
,
1242 ieee80211_mesh_rx_probe_req(struct ieee80211_sub_if_data
*sdata
,
1243 struct ieee80211_mgmt
*mgmt
, size_t len
)
1245 struct ieee80211_local
*local
= sdata
->local
;
1246 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1247 struct sk_buff
*presp
;
1248 struct beacon_data
*bcn
;
1249 struct ieee80211_mgmt
*hdr
;
1250 struct ieee802_11_elems elems
;
1254 pos
= mgmt
->u
.probe_req
.variable
;
1255 baselen
= (u8
*) pos
- (u8
*) mgmt
;
1259 ieee802_11_parse_elems(pos
, len
- baselen
, false, &elems
, mgmt
->bssid
,
1265 /* 802.11-2012 10.1.4.3.2 */
1266 if ((!ether_addr_equal(mgmt
->da
, sdata
->vif
.addr
) &&
1267 !is_broadcast_ether_addr(mgmt
->da
)) ||
1268 elems
.ssid_len
!= 0)
1271 if (elems
.mesh_id_len
!= 0 &&
1272 (elems
.mesh_id_len
!= ifmsh
->mesh_id_len
||
1273 memcmp(elems
.mesh_id
, ifmsh
->mesh_id
, ifmsh
->mesh_id_len
)))
1277 bcn
= rcu_dereference(ifmsh
->beacon
);
1282 presp
= dev_alloc_skb(local
->tx_headroom
+
1283 bcn
->head_len
+ bcn
->tail_len
);
1287 skb_reserve(presp
, local
->tx_headroom
);
1288 skb_put_data(presp
, bcn
->head
, bcn
->head_len
);
1289 skb_put_data(presp
, bcn
->tail
, bcn
->tail_len
);
1290 hdr
= (struct ieee80211_mgmt
*) presp
->data
;
1291 hdr
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
1292 IEEE80211_STYPE_PROBE_RESP
);
1293 memcpy(hdr
->da
, mgmt
->sa
, ETH_ALEN
);
1294 IEEE80211_SKB_CB(presp
)->flags
|= IEEE80211_TX_INTFL_DONT_ENCRYPT
;
1295 ieee80211_tx_skb(sdata
, presp
);
1300 static void ieee80211_mesh_rx_bcn_presp(struct ieee80211_sub_if_data
*sdata
,
1302 struct ieee80211_mgmt
*mgmt
,
1304 struct ieee80211_rx_status
*rx_status
)
1306 struct ieee80211_local
*local
= sdata
->local
;
1307 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1308 struct ieee802_11_elems elems
;
1309 struct ieee80211_channel
*channel
;
1312 enum nl80211_band band
= rx_status
->band
;
1314 /* ignore ProbeResp to foreign address */
1315 if (stype
== IEEE80211_STYPE_PROBE_RESP
&&
1316 !ether_addr_equal(mgmt
->da
, sdata
->vif
.addr
))
1319 baselen
= (u8
*) mgmt
->u
.probe_resp
.variable
- (u8
*) mgmt
;
1323 ieee802_11_parse_elems(mgmt
->u
.probe_resp
.variable
, len
- baselen
,
1324 false, &elems
, mgmt
->bssid
, NULL
);
1326 /* ignore non-mesh or secure / unsecure mismatch */
1327 if ((!elems
.mesh_id
|| !elems
.mesh_config
) ||
1328 (elems
.rsn
&& sdata
->u
.mesh
.security
== IEEE80211_MESH_SEC_NONE
) ||
1329 (!elems
.rsn
&& sdata
->u
.mesh
.security
!= IEEE80211_MESH_SEC_NONE
))
1332 if (elems
.ds_params
)
1333 freq
= ieee80211_channel_to_frequency(elems
.ds_params
[0], band
);
1335 freq
= rx_status
->freq
;
1337 channel
= ieee80211_get_channel(local
->hw
.wiphy
, freq
);
1339 if (!channel
|| channel
->flags
& IEEE80211_CHAN_DISABLED
)
1342 if (mesh_matches_local(sdata
, &elems
)) {
1343 mpl_dbg(sdata
, "rssi_threshold=%d,rx_status->signal=%d\n",
1344 sdata
->u
.mesh
.mshcfg
.rssi_threshold
, rx_status
->signal
);
1345 if (!sdata
->u
.mesh
.user_mpm
||
1346 sdata
->u
.mesh
.mshcfg
.rssi_threshold
== 0 ||
1347 sdata
->u
.mesh
.mshcfg
.rssi_threshold
< rx_status
->signal
)
1348 mesh_neighbour_update(sdata
, mgmt
->sa
, &elems
,
1351 if (ifmsh
->csa_role
!= IEEE80211_MESH_CSA_ROLE_INIT
&&
1352 !sdata
->vif
.csa_active
)
1353 ieee80211_mesh_process_chnswitch(sdata
, &elems
, true);
1356 if (ifmsh
->sync_ops
)
1357 ifmsh
->sync_ops
->rx_bcn_presp(sdata
,
1358 stype
, mgmt
, &elems
, rx_status
);
1361 int ieee80211_mesh_finish_csa(struct ieee80211_sub_if_data
*sdata
)
1363 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1364 struct mesh_csa_settings
*tmp_csa_settings
;
1368 /* Reset the TTL value and Initiator flag */
1369 ifmsh
->csa_role
= IEEE80211_MESH_CSA_ROLE_NONE
;
1370 ifmsh
->chsw_ttl
= 0;
1372 /* Remove the CSA and MCSP elements from the beacon */
1373 tmp_csa_settings
= rcu_dereference_protected(ifmsh
->csa
,
1374 lockdep_is_held(&sdata
->wdev
.mtx
));
1375 RCU_INIT_POINTER(ifmsh
->csa
, NULL
);
1376 if (tmp_csa_settings
)
1377 kfree_rcu(tmp_csa_settings
, rcu_head
);
1378 ret
= ieee80211_mesh_rebuild_beacon(sdata
);
1382 changed
|= BSS_CHANGED_BEACON
;
1384 mcsa_dbg(sdata
, "complete switching to center freq %d MHz",
1385 sdata
->vif
.bss_conf
.chandef
.chan
->center_freq
);
1389 int ieee80211_mesh_csa_beacon(struct ieee80211_sub_if_data
*sdata
,
1390 struct cfg80211_csa_settings
*csa_settings
)
1392 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1393 struct mesh_csa_settings
*tmp_csa_settings
;
1396 lockdep_assert_held(&sdata
->wdev
.mtx
);
1398 tmp_csa_settings
= kmalloc(sizeof(*tmp_csa_settings
),
1400 if (!tmp_csa_settings
)
1403 memcpy(&tmp_csa_settings
->settings
, csa_settings
,
1404 sizeof(struct cfg80211_csa_settings
));
1406 rcu_assign_pointer(ifmsh
->csa
, tmp_csa_settings
);
1408 ret
= ieee80211_mesh_rebuild_beacon(sdata
);
1410 tmp_csa_settings
= rcu_dereference(ifmsh
->csa
);
1411 RCU_INIT_POINTER(ifmsh
->csa
, NULL
);
1412 kfree_rcu(tmp_csa_settings
, rcu_head
);
1416 return BSS_CHANGED_BEACON
;
1419 static int mesh_fwd_csa_frame(struct ieee80211_sub_if_data
*sdata
,
1420 struct ieee80211_mgmt
*mgmt
, size_t len
,
1421 struct ieee802_11_elems
*elems
)
1423 struct ieee80211_mgmt
*mgmt_fwd
;
1424 struct sk_buff
*skb
;
1425 struct ieee80211_local
*local
= sdata
->local
;
1427 skb
= dev_alloc_skb(local
->tx_headroom
+ len
);
1430 skb_reserve(skb
, local
->tx_headroom
);
1431 mgmt_fwd
= skb_put(skb
, len
);
1433 elems
->mesh_chansw_params_ie
->mesh_ttl
--;
1434 elems
->mesh_chansw_params_ie
->mesh_flags
&=
1435 ~WLAN_EID_CHAN_SWITCH_PARAM_INITIATOR
;
1437 memcpy(mgmt_fwd
, mgmt
, len
);
1438 eth_broadcast_addr(mgmt_fwd
->da
);
1439 memcpy(mgmt_fwd
->sa
, sdata
->vif
.addr
, ETH_ALEN
);
1440 memcpy(mgmt_fwd
->bssid
, sdata
->vif
.addr
, ETH_ALEN
);
1442 ieee80211_tx_skb(sdata
, skb
);
1446 static void mesh_rx_csa_frame(struct ieee80211_sub_if_data
*sdata
,
1447 struct ieee80211_mgmt
*mgmt
, size_t len
)
1449 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1450 struct ieee802_11_elems elems
;
1452 bool fwd_csa
= true;
1456 if (mgmt
->u
.action
.u
.measurement
.action_code
!=
1457 WLAN_ACTION_SPCT_CHL_SWITCH
)
1460 pos
= mgmt
->u
.action
.u
.chan_switch
.variable
;
1461 baselen
= offsetof(struct ieee80211_mgmt
,
1462 u
.action
.u
.chan_switch
.variable
);
1463 ieee802_11_parse_elems(pos
, len
- baselen
, true, &elems
,
1466 if (!mesh_matches_local(sdata
, &elems
))
1469 ifmsh
->chsw_ttl
= elems
.mesh_chansw_params_ie
->mesh_ttl
;
1470 if (!--ifmsh
->chsw_ttl
)
1473 pre_value
= le16_to_cpu(elems
.mesh_chansw_params_ie
->mesh_pre_value
);
1474 if (ifmsh
->pre_value
>= pre_value
)
1477 ifmsh
->pre_value
= pre_value
;
1479 if (!sdata
->vif
.csa_active
&&
1480 !ieee80211_mesh_process_chnswitch(sdata
, &elems
, false)) {
1481 mcsa_dbg(sdata
, "Failed to process CSA action frame");
1485 /* forward or re-broadcast the CSA frame */
1487 if (mesh_fwd_csa_frame(sdata
, mgmt
, len
, &elems
) < 0)
1488 mcsa_dbg(sdata
, "Failed to forward the CSA frame");
1492 static void ieee80211_mesh_rx_mgmt_action(struct ieee80211_sub_if_data
*sdata
,
1493 struct ieee80211_mgmt
*mgmt
,
1495 struct ieee80211_rx_status
*rx_status
)
1497 switch (mgmt
->u
.action
.category
) {
1498 case WLAN_CATEGORY_SELF_PROTECTED
:
1499 switch (mgmt
->u
.action
.u
.self_prot
.action_code
) {
1500 case WLAN_SP_MESH_PEERING_OPEN
:
1501 case WLAN_SP_MESH_PEERING_CLOSE
:
1502 case WLAN_SP_MESH_PEERING_CONFIRM
:
1503 mesh_rx_plink_frame(sdata
, mgmt
, len
, rx_status
);
1507 case WLAN_CATEGORY_MESH_ACTION
:
1508 if (mesh_action_is_path_sel(mgmt
))
1509 mesh_rx_path_sel_frame(sdata
, mgmt
, len
);
1511 case WLAN_CATEGORY_SPECTRUM_MGMT
:
1512 mesh_rx_csa_frame(sdata
, mgmt
, len
);
1517 void ieee80211_mesh_rx_queued_mgmt(struct ieee80211_sub_if_data
*sdata
,
1518 struct sk_buff
*skb
)
1520 struct ieee80211_rx_status
*rx_status
;
1521 struct ieee80211_mgmt
*mgmt
;
1526 /* mesh already went down */
1527 if (!sdata
->u
.mesh
.mesh_id_len
)
1530 rx_status
= IEEE80211_SKB_RXCB(skb
);
1531 mgmt
= (struct ieee80211_mgmt
*) skb
->data
;
1532 stype
= le16_to_cpu(mgmt
->frame_control
) & IEEE80211_FCTL_STYPE
;
1535 case IEEE80211_STYPE_PROBE_RESP
:
1536 case IEEE80211_STYPE_BEACON
:
1537 ieee80211_mesh_rx_bcn_presp(sdata
, stype
, mgmt
, skb
->len
,
1540 case IEEE80211_STYPE_PROBE_REQ
:
1541 ieee80211_mesh_rx_probe_req(sdata
, mgmt
, skb
->len
);
1543 case IEEE80211_STYPE_ACTION
:
1544 ieee80211_mesh_rx_mgmt_action(sdata
, mgmt
, skb
->len
, rx_status
);
1548 sdata_unlock(sdata
);
1551 static void mesh_bss_info_changed(struct ieee80211_sub_if_data
*sdata
)
1553 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1554 u32 bit
, changed
= 0;
1556 for_each_set_bit(bit
, &ifmsh
->mbss_changed
,
1557 sizeof(changed
) * BITS_PER_BYTE
) {
1558 clear_bit(bit
, &ifmsh
->mbss_changed
);
1559 changed
|= BIT(bit
);
1562 if (sdata
->vif
.bss_conf
.enable_beacon
&&
1563 (changed
& (BSS_CHANGED_BEACON
|
1565 BSS_CHANGED_BASIC_RATES
|
1566 BSS_CHANGED_BEACON_INT
)))
1567 if (ieee80211_mesh_rebuild_beacon(sdata
))
1570 ieee80211_bss_info_change_notify(sdata
, changed
);
1573 void ieee80211_mesh_work(struct ieee80211_sub_if_data
*sdata
)
1575 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1579 /* mesh already went down */
1580 if (!sdata
->u
.mesh
.mesh_id_len
)
1583 if (ifmsh
->preq_queue_len
&&
1585 ifmsh
->last_preq
+ msecs_to_jiffies(ifmsh
->mshcfg
.dot11MeshHWMPpreqMinInterval
)))
1586 mesh_path_start_discovery(sdata
);
1588 if (test_and_clear_bit(MESH_WORK_HOUSEKEEPING
, &ifmsh
->wrkq_flags
))
1589 ieee80211_mesh_housekeeping(sdata
);
1591 if (test_and_clear_bit(MESH_WORK_ROOT
, &ifmsh
->wrkq_flags
))
1592 ieee80211_mesh_rootpath(sdata
);
1594 if (test_and_clear_bit(MESH_WORK_DRIFT_ADJUST
, &ifmsh
->wrkq_flags
))
1595 mesh_sync_adjust_tsf(sdata
);
1597 if (test_and_clear_bit(MESH_WORK_MBSS_CHANGED
, &ifmsh
->wrkq_flags
))
1598 mesh_bss_info_changed(sdata
);
1600 sdata_unlock(sdata
);
1604 void ieee80211_mesh_init_sdata(struct ieee80211_sub_if_data
*sdata
)
1606 struct ieee80211_if_mesh
*ifmsh
= &sdata
->u
.mesh
;
1607 static u8 zero_addr
[ETH_ALEN
] = {};
1609 timer_setup(&ifmsh
->housekeeping_timer
,
1610 ieee80211_mesh_housekeeping_timer
, 0);
1612 ifmsh
->accepting_plinks
= true;
1613 atomic_set(&ifmsh
->mpaths
, 0);
1614 mesh_rmc_init(sdata
);
1615 ifmsh
->last_preq
= jiffies
;
1616 ifmsh
->next_perr
= jiffies
;
1617 ifmsh
->csa_role
= IEEE80211_MESH_CSA_ROLE_NONE
;
1618 /* Allocate all mesh structures when creating the first mesh interface. */
1619 if (!mesh_allocated
)
1622 mesh_pathtbl_init(sdata
);
1624 timer_setup(&ifmsh
->mesh_path_timer
, ieee80211_mesh_path_timer
, 0);
1625 timer_setup(&ifmsh
->mesh_path_root_timer
,
1626 ieee80211_mesh_path_root_timer
, 0);
1627 INIT_LIST_HEAD(&ifmsh
->preq_queue
.list
);
1628 skb_queue_head_init(&ifmsh
->ps
.bc_buf
);
1629 spin_lock_init(&ifmsh
->mesh_preq_queue_lock
);
1630 spin_lock_init(&ifmsh
->sync_offset_lock
);
1631 RCU_INIT_POINTER(ifmsh
->beacon
, NULL
);
1633 sdata
->vif
.bss_conf
.bssid
= zero_addr
;
1636 void ieee80211_mesh_teardown_sdata(struct ieee80211_sub_if_data
*sdata
)
1638 mesh_rmc_free(sdata
);
1639 mesh_pathtbl_unregister(sdata
);