2 * Copyright (c) 2008, 2009 open80211s Ltd.
3 * Author: Luis Carlos Cobo <luisca@cozybit.com>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
10 #include <linux/kernel.h>
11 #include <linux/random.h>
12 #include "ieee80211_i.h"
16 #define PLINK_GET_LLID(p) (p + 2)
17 #define PLINK_GET_PLID(p) (p + 4)
19 #define mod_plink_timer(s, t) (mod_timer(&s->plink_timer, \
20 jiffies + HZ * t / 1000))
22 /* We only need a valid sta if user configured a minimum rssi_threshold. */
23 #define rssi_threshold_check(sta, sdata) \
24 (sdata->u.mesh.mshcfg.rssi_threshold == 0 ||\
25 (sta && (s8) -ewma_read(&sta->avg_signal) > \
26 sdata->u.mesh.mshcfg.rssi_threshold))
40 static int mesh_plink_frame_tx(struct ieee80211_sub_if_data
*sdata
,
41 enum ieee80211_self_protected_actioncode action
,
42 u8
*da
, __le16 llid
, __le16 plid
, __le16 reason
);
45 * mesh_plink_fsm_restart - restart a mesh peer link finite state machine
47 * @sta: mesh peer link to restart
49 * Locking: this function must be called holding sta->lock
51 static inline void mesh_plink_fsm_restart(struct sta_info
*sta
)
53 sta
->plink_state
= NL80211_PLINK_LISTEN
;
54 sta
->llid
= sta
->plid
= sta
->reason
= 0;
55 sta
->plink_retries
= 0;
59 * mesh_set_ht_prot_mode - set correct HT protection mode
61 * Section 9.23.3.5 of IEEE 80211-2012 describes the protection rules for HT
62 * mesh STA in a MBSS. Three HT protection modes are supported for now, non-HT
63 * mixed mode, 20MHz-protection and no-protection mode. non-HT mixed mode is
64 * selected if any non-HT peers are present in our MBSS. 20MHz-protection mode
65 * is selected if all peers in our 20/40MHz MBSS support HT and atleast one
66 * HT20 peer is present. Otherwise no-protection mode is selected.
68 static u32
mesh_set_ht_prot_mode(struct ieee80211_sub_if_data
*sdata
)
70 struct ieee80211_local
*local
= sdata
->local
;
74 bool non_ht_sta
= false, ht20_sta
= false;
76 if (sdata
->vif
.bss_conf
.chandef
.width
== NL80211_CHAN_WIDTH_20_NOHT
)
80 list_for_each_entry_rcu(sta
, &local
->sta_list
, list
) {
81 if (sdata
!= sta
->sdata
||
82 sta
->plink_state
!= NL80211_PLINK_ESTAB
)
85 switch (sta
->ch_width
) {
86 case NL80211_CHAN_WIDTH_20_NOHT
:
88 "mesh_plink %pM: nonHT sta (%pM) is present\n",
89 sdata
->vif
.addr
, sta
->sta
.addr
);
92 case NL80211_CHAN_WIDTH_20
:
94 "mesh_plink %pM: HT20 sta (%pM) is present\n",
95 sdata
->vif
.addr
, sta
->sta
.addr
);
105 ht_opmode
= IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED
;
107 sdata
->vif
.bss_conf
.chandef
.width
> NL80211_CHAN_WIDTH_20
)
108 ht_opmode
= IEEE80211_HT_OP_MODE_PROTECTION_20MHZ
;
110 ht_opmode
= IEEE80211_HT_OP_MODE_PROTECTION_NONE
;
112 if (sdata
->vif
.bss_conf
.ht_operation_mode
!= ht_opmode
) {
113 sdata
->vif
.bss_conf
.ht_operation_mode
= ht_opmode
;
114 sdata
->u
.mesh
.mshcfg
.ht_opmode
= ht_opmode
;
115 changed
= BSS_CHANGED_HT
;
117 "mesh_plink %pM: protection mode changed to %d\n",
118 sdata
->vif
.addr
, ht_opmode
);
125 * __mesh_plink_deactivate - deactivate mesh peer link
127 * @sta: mesh peer link to deactivate
129 * All mesh paths with this peer as next hop will be flushed
130 * Returns beacon changed flag if the beacon content changed.
132 * Locking: the caller must hold sta->lock
134 static u32
__mesh_plink_deactivate(struct sta_info
*sta
)
136 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
139 if (sta
->plink_state
== NL80211_PLINK_ESTAB
)
140 changed
= mesh_plink_dec_estab_count(sdata
);
141 sta
->plink_state
= NL80211_PLINK_BLOCKED
;
142 mesh_path_flush_by_nexthop(sta
);
148 * mesh_plink_deactivate - deactivate mesh peer link
150 * @sta: mesh peer link to deactivate
152 * All mesh paths with this peer as next hop will be flushed
154 void mesh_plink_deactivate(struct sta_info
*sta
)
156 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
159 spin_lock_bh(&sta
->lock
);
160 changed
= __mesh_plink_deactivate(sta
);
161 sta
->reason
= cpu_to_le16(WLAN_REASON_MESH_PEER_CANCELED
);
162 mesh_plink_frame_tx(sdata
, WLAN_SP_MESH_PEERING_CLOSE
,
163 sta
->sta
.addr
, sta
->llid
, sta
->plid
,
165 spin_unlock_bh(&sta
->lock
);
167 ieee80211_bss_info_change_notify(sdata
, changed
);
170 static int mesh_plink_frame_tx(struct ieee80211_sub_if_data
*sdata
,
171 enum ieee80211_self_protected_actioncode action
,
172 u8
*da
, __le16 llid
, __le16 plid
, __le16 reason
) {
173 struct ieee80211_local
*local
= sdata
->local
;
175 struct ieee80211_tx_info
*info
;
176 struct ieee80211_mgmt
*mgmt
;
177 bool include_plid
= false;
178 u16 peering_proto
= 0;
180 int hdr_len
= offsetof(struct ieee80211_mgmt
, u
.action
.u
.self_prot
) +
181 sizeof(mgmt
->u
.action
.u
.self_prot
);
184 skb
= dev_alloc_skb(local
->tx_headroom
+
186 2 + /* capability info */
188 2 + 8 + /* supported rates */
189 2 + (IEEE80211_MAX_SUPP_RATES
- 8) +
190 2 + sdata
->u
.mesh
.mesh_id_len
+
191 2 + sizeof(struct ieee80211_meshconf_ie
) +
192 2 + sizeof(struct ieee80211_ht_cap
) +
193 2 + sizeof(struct ieee80211_ht_operation
) +
194 2 + 8 + /* peering IE */
195 sdata
->u
.mesh
.ie_len
);
198 info
= IEEE80211_SKB_CB(skb
);
199 skb_reserve(skb
, local
->tx_headroom
);
200 mgmt
= (struct ieee80211_mgmt
*) skb_put(skb
, hdr_len
);
201 memset(mgmt
, 0, hdr_len
);
202 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
203 IEEE80211_STYPE_ACTION
);
204 memcpy(mgmt
->da
, da
, ETH_ALEN
);
205 memcpy(mgmt
->sa
, sdata
->vif
.addr
, ETH_ALEN
);
206 memcpy(mgmt
->bssid
, sdata
->vif
.addr
, ETH_ALEN
);
207 mgmt
->u
.action
.category
= WLAN_CATEGORY_SELF_PROTECTED
;
208 mgmt
->u
.action
.u
.self_prot
.action_code
= action
;
210 if (action
!= WLAN_SP_MESH_PEERING_CLOSE
) {
211 enum ieee80211_band band
= ieee80211_get_sdata_band(sdata
);
213 /* capability info */
214 pos
= skb_put(skb
, 2);
216 if (action
== WLAN_SP_MESH_PEERING_CONFIRM
) {
218 pos
= skb_put(skb
, 2);
219 memcpy(pos
+ 2, &plid
, 2);
221 if (ieee80211_add_srates_ie(sdata
, skb
, true, band
) ||
222 ieee80211_add_ext_srates_ie(sdata
, skb
, true, band
) ||
223 mesh_add_rsn_ie(skb
, sdata
) ||
224 mesh_add_meshid_ie(skb
, sdata
) ||
225 mesh_add_meshconf_ie(skb
, sdata
))
227 } else { /* WLAN_SP_MESH_PEERING_CLOSE */
228 info
->flags
|= IEEE80211_TX_CTL_NO_ACK
;
229 if (mesh_add_meshid_ie(skb
, sdata
))
233 /* Add Mesh Peering Management element */
235 case WLAN_SP_MESH_PEERING_OPEN
:
237 case WLAN_SP_MESH_PEERING_CONFIRM
:
241 case WLAN_SP_MESH_PEERING_CLOSE
:
246 ie_len
+= 2; /* reason code */
253 if (WARN_ON(skb_tailroom(skb
) < 2 + ie_len
))
256 pos
= skb_put(skb
, 2 + ie_len
);
257 *pos
++ = WLAN_EID_PEER_MGMT
;
259 memcpy(pos
, &peering_proto
, 2);
261 memcpy(pos
, &llid
, 2);
264 memcpy(pos
, &plid
, 2);
267 if (action
== WLAN_SP_MESH_PEERING_CLOSE
) {
268 memcpy(pos
, &reason
, 2);
272 if (action
!= WLAN_SP_MESH_PEERING_CLOSE
) {
273 if (mesh_add_ht_cap_ie(skb
, sdata
) ||
274 mesh_add_ht_oper_ie(skb
, sdata
))
278 if (mesh_add_vendor_ies(skb
, sdata
))
281 ieee80211_tx_skb(sdata
, skb
);
288 static void mesh_sta_info_init(struct ieee80211_sub_if_data
*sdata
,
289 struct sta_info
*sta
,
290 struct ieee802_11_elems
*elems
, bool insert
)
292 struct ieee80211_local
*local
= sdata
->local
;
293 enum ieee80211_band band
= ieee80211_get_sdata_band(sdata
);
294 struct ieee80211_supported_band
*sband
;
295 u32 rates
, basic_rates
= 0, changed
= 0;
297 sband
= local
->hw
.wiphy
->bands
[band
];
298 rates
= ieee80211_sta_get_rates(local
, elems
, band
, &basic_rates
);
300 spin_lock_bh(&sta
->lock
);
301 sta
->last_rx
= jiffies
;
303 /* rates and capabilities don't change during peering */
304 if (sta
->plink_state
== NL80211_PLINK_ESTAB
)
307 if (sta
->sta
.supp_rates
[band
] != rates
)
308 changed
|= IEEE80211_RC_SUPP_RATES_CHANGED
;
309 sta
->sta
.supp_rates
[band
] = rates
;
310 if (elems
->ht_cap_elem
&&
311 sdata
->vif
.bss_conf
.chandef
.width
!= NL80211_CHAN_WIDTH_20_NOHT
)
312 ieee80211_ht_cap_ie_to_sta_ht_cap(sdata
, sband
,
316 memset(&sta
->sta
.ht_cap
, 0, sizeof(sta
->sta
.ht_cap
));
318 if (elems
->ht_operation
) {
319 struct cfg80211_chan_def chandef
;
321 if (!(elems
->ht_operation
->ht_param
&
322 IEEE80211_HT_PARAM_CHAN_WIDTH_ANY
))
323 sta
->sta
.ht_cap
.cap
&=
324 ~IEEE80211_HT_CAP_SUP_WIDTH_20_40
;
325 ieee80211_ht_oper_to_chandef(sdata
->vif
.bss_conf
.chandef
.chan
,
326 elems
->ht_operation
, &chandef
);
327 if (sta
->ch_width
!= chandef
.width
)
328 changed
|= IEEE80211_RC_BW_CHANGED
;
329 sta
->ch_width
= chandef
.width
;
333 rate_control_rate_init(sta
);
335 rate_control_rate_update(local
, sband
, sta
, changed
);
337 spin_unlock_bh(&sta
->lock
);
340 static struct sta_info
*
341 __mesh_sta_info_alloc(struct ieee80211_sub_if_data
*sdata
, u8
*hw_addr
)
343 struct sta_info
*sta
;
345 if (sdata
->local
->num_sta
>= MESH_MAX_PLINKS
)
348 sta
= sta_info_alloc(sdata
, hw_addr
, GFP_KERNEL
);
352 sta
->plink_state
= NL80211_PLINK_LISTEN
;
353 init_timer(&sta
->plink_timer
);
355 sta_info_pre_move_state(sta
, IEEE80211_STA_AUTH
);
356 sta_info_pre_move_state(sta
, IEEE80211_STA_ASSOC
);
357 sta_info_pre_move_state(sta
, IEEE80211_STA_AUTHORIZED
);
359 set_sta_flag(sta
, WLAN_STA_WME
);
364 static struct sta_info
*
365 mesh_sta_info_alloc(struct ieee80211_sub_if_data
*sdata
, u8
*addr
,
366 struct ieee802_11_elems
*elems
)
368 struct sta_info
*sta
= NULL
;
370 /* Userspace handles peer allocation when security is enabled */
371 if (sdata
->u
.mesh
.security
& IEEE80211_MESH_SEC_AUTHED
)
372 cfg80211_notify_new_peer_candidate(sdata
->dev
, addr
,
377 sta
= __mesh_sta_info_alloc(sdata
, addr
);
383 * mesh_sta_info_get - return mesh sta info entry for @addr.
385 * @sdata: local meshif
386 * @addr: peer's address
387 * @elems: IEs from beacon or mesh peering frame.
389 * Return existing or newly allocated sta_info under RCU read lock.
390 * (re)initialize with given IEs.
392 static struct sta_info
*
393 mesh_sta_info_get(struct ieee80211_sub_if_data
*sdata
,
394 u8
*addr
, struct ieee802_11_elems
*elems
) __acquires(RCU
)
396 struct sta_info
*sta
= NULL
;
399 sta
= sta_info_get(sdata
, addr
);
401 mesh_sta_info_init(sdata
, sta
, elems
, false);
404 /* can't run atomic */
405 sta
= mesh_sta_info_alloc(sdata
, addr
, elems
);
411 if (sta_info_insert_rcu(sta
))
419 * mesh_neighbour_update - update or initialize new mesh neighbor.
421 * @sdata: local meshif
422 * @addr: peer's address
423 * @elems: IEs from beacon or mesh peering frame
425 * Initiates peering if appropriate.
427 void mesh_neighbour_update(struct ieee80211_sub_if_data
*sdata
,
429 struct ieee802_11_elems
*elems
)
431 struct sta_info
*sta
;
433 sta
= mesh_sta_info_get(sdata
, hw_addr
, elems
);
437 if (mesh_peer_accepts_plinks(elems
) &&
438 sta
->plink_state
== NL80211_PLINK_LISTEN
&&
439 sdata
->u
.mesh
.accepting_plinks
&&
440 sdata
->u
.mesh
.mshcfg
.auto_open_plinks
&&
441 rssi_threshold_check(sta
, sdata
))
442 mesh_plink_open(sta
);
448 static void mesh_plink_timer(unsigned long data
)
450 struct sta_info
*sta
;
451 __le16 llid
, plid
, reason
;
452 struct ieee80211_sub_if_data
*sdata
;
453 struct mesh_config
*mshcfg
;
456 * This STA is valid because sta_info_destroy() will
457 * del_timer_sync() this timer after having made sure
458 * it cannot be readded (by deleting the plink.)
460 sta
= (struct sta_info
*) data
;
462 if (sta
->sdata
->local
->quiescing
) {
463 sta
->plink_timer_was_running
= true;
467 spin_lock_bh(&sta
->lock
);
468 if (sta
->ignore_plink_timer
) {
469 sta
->ignore_plink_timer
= false;
470 spin_unlock_bh(&sta
->lock
);
474 "Mesh plink timer for %pM fired on state %d\n",
475 sta
->sta
.addr
, sta
->plink_state
);
480 mshcfg
= &sdata
->u
.mesh
.mshcfg
;
482 switch (sta
->plink_state
) {
483 case NL80211_PLINK_OPN_RCVD
:
484 case NL80211_PLINK_OPN_SNT
:
486 if (sta
->plink_retries
< mshcfg
->dot11MeshMaxRetries
) {
489 "Mesh plink for %pM (retry, timeout): %d %d\n",
490 sta
->sta
.addr
, sta
->plink_retries
,
492 get_random_bytes(&rand
, sizeof(u32
));
493 sta
->plink_timeout
= sta
->plink_timeout
+
494 rand
% sta
->plink_timeout
;
495 ++sta
->plink_retries
;
496 mod_plink_timer(sta
, sta
->plink_timeout
);
497 spin_unlock_bh(&sta
->lock
);
498 mesh_plink_frame_tx(sdata
, WLAN_SP_MESH_PEERING_OPEN
,
499 sta
->sta
.addr
, llid
, 0, 0);
502 reason
= cpu_to_le16(WLAN_REASON_MESH_MAX_RETRIES
);
503 /* fall through on else */
504 case NL80211_PLINK_CNF_RCVD
:
507 reason
= cpu_to_le16(WLAN_REASON_MESH_CONFIRM_TIMEOUT
);
508 sta
->plink_state
= NL80211_PLINK_HOLDING
;
509 mod_plink_timer(sta
, mshcfg
->dot11MeshHoldingTimeout
);
510 spin_unlock_bh(&sta
->lock
);
511 mesh_plink_frame_tx(sdata
, WLAN_SP_MESH_PEERING_CLOSE
,
512 sta
->sta
.addr
, llid
, plid
, reason
);
514 case NL80211_PLINK_HOLDING
:
516 del_timer(&sta
->plink_timer
);
517 mesh_plink_fsm_restart(sta
);
518 spin_unlock_bh(&sta
->lock
);
521 spin_unlock_bh(&sta
->lock
);
527 void mesh_plink_quiesce(struct sta_info
*sta
)
529 if (del_timer_sync(&sta
->plink_timer
))
530 sta
->plink_timer_was_running
= true;
533 void mesh_plink_restart(struct sta_info
*sta
)
535 if (sta
->plink_timer_was_running
) {
536 add_timer(&sta
->plink_timer
);
537 sta
->plink_timer_was_running
= false;
542 static inline void mesh_plink_timer_set(struct sta_info
*sta
, int timeout
)
544 sta
->plink_timer
.expires
= jiffies
+ (HZ
* timeout
/ 1000);
545 sta
->plink_timer
.data
= (unsigned long) sta
;
546 sta
->plink_timer
.function
= mesh_plink_timer
;
547 sta
->plink_timeout
= timeout
;
548 add_timer(&sta
->plink_timer
);
551 int mesh_plink_open(struct sta_info
*sta
)
554 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
556 if (!test_sta_flag(sta
, WLAN_STA_AUTH
))
559 spin_lock_bh(&sta
->lock
);
560 get_random_bytes(&llid
, 2);
562 if (sta
->plink_state
!= NL80211_PLINK_LISTEN
&&
563 sta
->plink_state
!= NL80211_PLINK_BLOCKED
) {
564 spin_unlock_bh(&sta
->lock
);
567 sta
->plink_state
= NL80211_PLINK_OPN_SNT
;
568 mesh_plink_timer_set(sta
, sdata
->u
.mesh
.mshcfg
.dot11MeshRetryTimeout
);
569 spin_unlock_bh(&sta
->lock
);
571 "Mesh plink: starting establishment with %pM\n",
574 return mesh_plink_frame_tx(sdata
, WLAN_SP_MESH_PEERING_OPEN
,
575 sta
->sta
.addr
, llid
, 0, 0);
578 void mesh_plink_block(struct sta_info
*sta
)
580 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
583 spin_lock_bh(&sta
->lock
);
584 changed
= __mesh_plink_deactivate(sta
);
585 sta
->plink_state
= NL80211_PLINK_BLOCKED
;
586 spin_unlock_bh(&sta
->lock
);
588 ieee80211_bss_info_change_notify(sdata
, changed
);
592 void mesh_rx_plink_frame(struct ieee80211_sub_if_data
*sdata
, struct ieee80211_mgmt
*mgmt
,
593 size_t len
, struct ieee80211_rx_status
*rx_status
)
595 struct mesh_config
*mshcfg
= &sdata
->u
.mesh
.mshcfg
;
596 struct ieee802_11_elems elems
;
597 struct sta_info
*sta
;
598 enum plink_event event
;
599 enum ieee80211_self_protected_actioncode ftype
;
601 bool matches_local
= true;
605 __le16 plid
, llid
, reason
;
606 static const char *mplstates
[] = {
607 [NL80211_PLINK_LISTEN
] = "LISTEN",
608 [NL80211_PLINK_OPN_SNT
] = "OPN-SNT",
609 [NL80211_PLINK_OPN_RCVD
] = "OPN-RCVD",
610 [NL80211_PLINK_CNF_RCVD
] = "CNF_RCVD",
611 [NL80211_PLINK_ESTAB
] = "ESTAB",
612 [NL80211_PLINK_HOLDING
] = "HOLDING",
613 [NL80211_PLINK_BLOCKED
] = "BLOCKED"
616 /* need action_code, aux */
617 if (len
< IEEE80211_MIN_ACTION_SIZE
+ 3)
620 if (is_multicast_ether_addr(mgmt
->da
)) {
622 "Mesh plink: ignore frame from multicast address\n");
626 baseaddr
= mgmt
->u
.action
.u
.self_prot
.variable
;
627 baselen
= (u8
*) mgmt
->u
.action
.u
.self_prot
.variable
- (u8
*) mgmt
;
628 if (mgmt
->u
.action
.u
.self_prot
.action_code
==
629 WLAN_SP_MESH_PEERING_CONFIRM
) {
633 ieee802_11_parse_elems(baseaddr
, len
- baselen
, &elems
);
634 if (!elems
.peering
) {
636 "Mesh plink: missing necessary peer link ie\n");
640 sdata
->u
.mesh
.security
== IEEE80211_MESH_SEC_NONE
) {
642 "Mesh plink: can't establish link with secure peer\n");
646 ftype
= mgmt
->u
.action
.u
.self_prot
.action_code
;
647 ie_len
= elems
.peering_len
;
648 if ((ftype
== WLAN_SP_MESH_PEERING_OPEN
&& ie_len
!= 4) ||
649 (ftype
== WLAN_SP_MESH_PEERING_CONFIRM
&& ie_len
!= 6) ||
650 (ftype
== WLAN_SP_MESH_PEERING_CLOSE
&& ie_len
!= 6
653 "Mesh plink: incorrect plink ie length %d %d\n",
658 if (ftype
!= WLAN_SP_MESH_PEERING_CLOSE
&&
659 (!elems
.mesh_id
|| !elems
.mesh_config
)) {
660 mpl_dbg(sdata
, "Mesh plink: missing necessary ie\n");
663 /* Note the lines below are correct, the llid in the frame is the plid
664 * from the point of view of this host.
666 memcpy(&plid
, PLINK_GET_LLID(elems
.peering
), 2);
667 if (ftype
== WLAN_SP_MESH_PEERING_CONFIRM
||
668 (ftype
== WLAN_SP_MESH_PEERING_CLOSE
&& ie_len
== 8))
669 memcpy(&llid
, PLINK_GET_PLID(elems
.peering
), 2);
671 /* WARNING: Only for sta pointer, is dropped & re-acquired */
674 sta
= sta_info_get(sdata
, mgmt
->sa
);
675 if (!sta
&& ftype
!= WLAN_SP_MESH_PEERING_OPEN
) {
676 mpl_dbg(sdata
, "Mesh plink: cls or cnf from unknown peer\n");
681 if (ftype
== WLAN_SP_MESH_PEERING_OPEN
&&
682 !rssi_threshold_check(sta
, sdata
)) {
683 mpl_dbg(sdata
, "Mesh plink: %pM does not meet rssi threshold\n",
689 if (sta
&& !test_sta_flag(sta
, WLAN_STA_AUTH
)) {
690 mpl_dbg(sdata
, "Mesh plink: Action frame from non-authed peer\n");
695 if (sta
&& sta
->plink_state
== NL80211_PLINK_BLOCKED
) {
700 /* Now we will figure out the appropriate event... */
701 event
= PLINK_UNDEFINED
;
702 if (ftype
!= WLAN_SP_MESH_PEERING_CLOSE
&&
703 !mesh_matches_local(sdata
, &elems
)) {
704 matches_local
= false;
706 case WLAN_SP_MESH_PEERING_OPEN
:
709 case WLAN_SP_MESH_PEERING_CONFIRM
:
717 if (!sta
&& !matches_local
) {
719 reason
= cpu_to_le16(WLAN_REASON_MESH_CONFIG
);
721 mesh_plink_frame_tx(sdata
, WLAN_SP_MESH_PEERING_CLOSE
,
722 mgmt
->sa
, llid
, plid
, reason
);
725 /* ftype == WLAN_SP_MESH_PEERING_OPEN */
726 if (!mesh_plink_free_count(sdata
)) {
727 mpl_dbg(sdata
, "Mesh plink error: no more free plinks\n");
732 } else if (matches_local
) {
734 case WLAN_SP_MESH_PEERING_OPEN
:
735 if (!mesh_plink_free_count(sdata
) ||
736 (sta
->plid
&& sta
->plid
!= plid
))
741 case WLAN_SP_MESH_PEERING_CONFIRM
:
742 if (!mesh_plink_free_count(sdata
) ||
743 (sta
->llid
!= llid
|| sta
->plid
!= plid
))
748 case WLAN_SP_MESH_PEERING_CLOSE
:
749 if (sta
->plink_state
== NL80211_PLINK_ESTAB
)
750 /* Do not check for llid or plid. This does not
751 * follow the standard but since multiple plinks
752 * per sta are not supported, it is necessary in
753 * order to avoid a livelock when MP A sees an
754 * establish peer link to MP B but MP B does not
755 * see it. This can be caused by a timeout in
756 * B's peer link establishment or B beign
760 else if (sta
->plid
!= plid
)
762 else if (ie_len
== 7 && sta
->llid
!= llid
)
768 mpl_dbg(sdata
, "Mesh plink: unknown frame subtype\n");
774 if (event
== OPN_ACPT
) {
776 /* allocate sta entry if necessary and update info */
777 sta
= mesh_sta_info_get(sdata
, mgmt
->sa
, &elems
);
779 mpl_dbg(sdata
, "Mesh plink: failed to init peer!\n");
786 "Mesh plink (peer, state, llid, plid, event): %pM %s %d %d %d\n",
787 mgmt
->sa
, mplstates
[sta
->plink_state
],
788 le16_to_cpu(sta
->llid
), le16_to_cpu(sta
->plid
),
791 spin_lock_bh(&sta
->lock
);
792 switch (sta
->plink_state
) {
793 /* spin_unlock as soon as state is updated at each case */
794 case NL80211_PLINK_LISTEN
:
797 mesh_plink_fsm_restart(sta
);
798 spin_unlock_bh(&sta
->lock
);
801 sta
->plink_state
= NL80211_PLINK_OPN_RCVD
;
803 get_random_bytes(&llid
, 2);
805 mesh_plink_timer_set(sta
,
806 mshcfg
->dot11MeshRetryTimeout
);
807 spin_unlock_bh(&sta
->lock
);
808 mesh_plink_frame_tx(sdata
,
809 WLAN_SP_MESH_PEERING_OPEN
,
810 sta
->sta
.addr
, llid
, 0, 0);
811 mesh_plink_frame_tx(sdata
,
812 WLAN_SP_MESH_PEERING_CONFIRM
,
813 sta
->sta
.addr
, llid
, plid
, 0);
816 spin_unlock_bh(&sta
->lock
);
821 case NL80211_PLINK_OPN_SNT
:
825 reason
= cpu_to_le16(WLAN_REASON_MESH_CONFIG
);
828 reason
= cpu_to_le16(WLAN_REASON_MESH_CLOSE
);
829 sta
->reason
= reason
;
830 sta
->plink_state
= NL80211_PLINK_HOLDING
;
831 if (!mod_plink_timer(sta
,
832 mshcfg
->dot11MeshHoldingTimeout
))
833 sta
->ignore_plink_timer
= true;
836 spin_unlock_bh(&sta
->lock
);
837 mesh_plink_frame_tx(sdata
,
838 WLAN_SP_MESH_PEERING_CLOSE
,
839 sta
->sta
.addr
, llid
, plid
, reason
);
842 /* retry timer is left untouched */
843 sta
->plink_state
= NL80211_PLINK_OPN_RCVD
;
846 spin_unlock_bh(&sta
->lock
);
847 mesh_plink_frame_tx(sdata
,
848 WLAN_SP_MESH_PEERING_CONFIRM
,
849 sta
->sta
.addr
, llid
, plid
, 0);
852 sta
->plink_state
= NL80211_PLINK_CNF_RCVD
;
853 if (!mod_plink_timer(sta
,
854 mshcfg
->dot11MeshConfirmTimeout
))
855 sta
->ignore_plink_timer
= true;
857 spin_unlock_bh(&sta
->lock
);
860 spin_unlock_bh(&sta
->lock
);
865 case NL80211_PLINK_OPN_RCVD
:
869 reason
= cpu_to_le16(WLAN_REASON_MESH_CONFIG
);
872 reason
= cpu_to_le16(WLAN_REASON_MESH_CLOSE
);
873 sta
->reason
= reason
;
874 sta
->plink_state
= NL80211_PLINK_HOLDING
;
875 if (!mod_plink_timer(sta
,
876 mshcfg
->dot11MeshHoldingTimeout
))
877 sta
->ignore_plink_timer
= true;
880 spin_unlock_bh(&sta
->lock
);
881 mesh_plink_frame_tx(sdata
, WLAN_SP_MESH_PEERING_CLOSE
,
882 sta
->sta
.addr
, llid
, plid
, reason
);
886 spin_unlock_bh(&sta
->lock
);
887 mesh_plink_frame_tx(sdata
,
888 WLAN_SP_MESH_PEERING_CONFIRM
,
889 sta
->sta
.addr
, llid
, plid
, 0);
892 del_timer(&sta
->plink_timer
);
893 sta
->plink_state
= NL80211_PLINK_ESTAB
;
894 spin_unlock_bh(&sta
->lock
);
895 changed
|= mesh_plink_inc_estab_count(sdata
);
896 changed
|= mesh_set_ht_prot_mode(sdata
);
897 mpl_dbg(sdata
, "Mesh plink with %pM ESTABLISHED\n",
901 spin_unlock_bh(&sta
->lock
);
906 case NL80211_PLINK_CNF_RCVD
:
910 reason
= cpu_to_le16(WLAN_REASON_MESH_CONFIG
);
913 reason
= cpu_to_le16(WLAN_REASON_MESH_CLOSE
);
914 sta
->reason
= reason
;
915 sta
->plink_state
= NL80211_PLINK_HOLDING
;
916 if (!mod_plink_timer(sta
,
917 mshcfg
->dot11MeshHoldingTimeout
))
918 sta
->ignore_plink_timer
= true;
921 spin_unlock_bh(&sta
->lock
);
922 mesh_plink_frame_tx(sdata
,
923 WLAN_SP_MESH_PEERING_CLOSE
,
924 sta
->sta
.addr
, llid
, plid
, reason
);
927 del_timer(&sta
->plink_timer
);
928 sta
->plink_state
= NL80211_PLINK_ESTAB
;
929 spin_unlock_bh(&sta
->lock
);
930 changed
|= mesh_plink_inc_estab_count(sdata
);
931 changed
|= mesh_set_ht_prot_mode(sdata
);
932 mpl_dbg(sdata
, "Mesh plink with %pM ESTABLISHED\n",
934 mesh_plink_frame_tx(sdata
,
935 WLAN_SP_MESH_PEERING_CONFIRM
,
936 sta
->sta
.addr
, llid
, plid
, 0);
939 spin_unlock_bh(&sta
->lock
);
944 case NL80211_PLINK_ESTAB
:
947 reason
= cpu_to_le16(WLAN_REASON_MESH_CLOSE
);
948 sta
->reason
= reason
;
949 changed
|= __mesh_plink_deactivate(sta
);
950 sta
->plink_state
= NL80211_PLINK_HOLDING
;
952 mod_plink_timer(sta
, mshcfg
->dot11MeshHoldingTimeout
);
953 spin_unlock_bh(&sta
->lock
);
954 changed
|= mesh_set_ht_prot_mode(sdata
);
955 mesh_plink_frame_tx(sdata
, WLAN_SP_MESH_PEERING_CLOSE
,
956 sta
->sta
.addr
, llid
, plid
, reason
);
960 spin_unlock_bh(&sta
->lock
);
961 mesh_plink_frame_tx(sdata
,
962 WLAN_SP_MESH_PEERING_CONFIRM
,
963 sta
->sta
.addr
, llid
, plid
, 0);
966 spin_unlock_bh(&sta
->lock
);
970 case NL80211_PLINK_HOLDING
:
973 if (del_timer(&sta
->plink_timer
))
974 sta
->ignore_plink_timer
= 1;
975 mesh_plink_fsm_restart(sta
);
976 spin_unlock_bh(&sta
->lock
);
983 reason
= sta
->reason
;
984 spin_unlock_bh(&sta
->lock
);
985 mesh_plink_frame_tx(sdata
, WLAN_SP_MESH_PEERING_CLOSE
,
986 sta
->sta
.addr
, llid
, plid
, reason
);
989 spin_unlock_bh(&sta
->lock
);
993 /* should not get here, PLINK_BLOCKED is dealt with at the
994 * beginning of the function
996 spin_unlock_bh(&sta
->lock
);
1003 ieee80211_bss_info_change_notify(sdata
, changed
);