libertas: Use netdev_<level> or dev_<level> where possible
[deliverable/linux.git] / net / mac80211 / mesh_plink.c
CommitLineData
c3896d2c 1/*
264d9b7d 2 * Copyright (c) 2008, 2009 open80211s Ltd.
c3896d2c
LCC
3 * Author: Luis Carlos Cobo <luisca@cozybit.com>
4 *
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.
8 */
5a0e3ad6 9#include <linux/gfp.h>
902acc78
JB
10#include <linux/kernel.h>
11#include <linux/random.h>
c3896d2c 12#include "ieee80211_i.h"
2c8dccc7 13#include "rate.h"
c3896d2c 14#include "mesh.h"
c3896d2c
LCC
15
16#ifdef CONFIG_MAC80211_VERBOSE_MPL_DEBUG
17#define mpl_dbg(fmt, args...) printk(KERN_DEBUG fmt, ##args)
18#else
19#define mpl_dbg(fmt, args...) do { (void)(0); } while (0)
20#endif
21
0938393f
RP
22#define PLINK_GET_LLID(p) (p + 4)
23#define PLINK_GET_PLID(p) (p + 6)
c3896d2c
LCC
24
25#define mod_plink_timer(s, t) (mod_timer(&s->plink_timer, \
26 jiffies + HZ * t / 1000))
27
28/* Peer link cancel reasons, all subject to ANA approval */
29#define MESH_LINK_CANCELLED 2
30#define MESH_MAX_NEIGHBORS 3
31#define MESH_CAPABILITY_POLICY_VIOLATION 4
32#define MESH_CLOSE_RCVD 5
33#define MESH_MAX_RETRIES 6
34#define MESH_CONFIRM_TIMEOUT 7
35#define MESH_SECURITY_ROLE_NEGOTIATION_DIFFERS 8
36#define MESH_SECURITY_AUTHENTICATION_IMPOSSIBLE 9
37#define MESH_SECURITY_FAILED_VERIFICATION 10
38
472dbc45
JB
39#define dot11MeshMaxRetries(s) (s->u.mesh.mshcfg.dot11MeshMaxRetries)
40#define dot11MeshRetryTimeout(s) (s->u.mesh.mshcfg.dot11MeshRetryTimeout)
41#define dot11MeshConfirmTimeout(s) (s->u.mesh.mshcfg.dot11MeshConfirmTimeout)
42#define dot11MeshHoldingTimeout(s) (s->u.mesh.mshcfg.dot11MeshHoldingTimeout)
43#define dot11MeshMaxPeerLinks(s) (s->u.mesh.mshcfg.dot11MeshMaxPeerLinks)
c3896d2c
LCC
44
45enum plink_frame_type {
46 PLINK_OPEN = 0,
47 PLINK_CONFIRM,
48 PLINK_CLOSE
49};
50
51enum plink_event {
52 PLINK_UNDEFINED,
53 OPN_ACPT,
54 OPN_RJCT,
55 OPN_IGNR,
56 CNF_ACPT,
57 CNF_RJCT,
58 CNF_IGNR,
59 CLS_ACPT,
60 CLS_IGNR
61};
62
63static inline
64void mesh_plink_inc_estab_count(struct ieee80211_sub_if_data *sdata)
65{
472dbc45 66 atomic_inc(&sdata->u.mesh.mshstats.estab_plinks);
d0709a65 67 mesh_accept_plinks_update(sdata);
c3896d2c
LCC
68}
69
70static inline
71void mesh_plink_dec_estab_count(struct ieee80211_sub_if_data *sdata)
72{
472dbc45 73 atomic_dec(&sdata->u.mesh.mshstats.estab_plinks);
d0709a65 74 mesh_accept_plinks_update(sdata);
c3896d2c
LCC
75}
76
77/**
78 * mesh_plink_fsm_restart - restart a mesh peer link finite state machine
79 *
23c7a29c 80 * @sta: mesh peer link to restart
c3896d2c 81 *
07346f81 82 * Locking: this function must be called holding sta->lock
c3896d2c
LCC
83 */
84static inline void mesh_plink_fsm_restart(struct sta_info *sta)
85{
b4e08ea1 86 sta->plink_state = PLINK_LISTEN;
37659ff8
LCC
87 sta->llid = sta->plid = sta->reason = 0;
88 sta->plink_retries = 0;
c3896d2c
LCC
89}
90
93e5deb1
JB
91/*
92 * NOTE: This is just an alias for sta_info_alloc(), see notes
93 * on it in the lifecycle management section!
94 */
03e4497e 95static struct sta_info *mesh_plink_alloc(struct ieee80211_sub_if_data *sdata,
881d948c 96 u8 *hw_addr, u32 rates)
c3896d2c 97{
d0709a65 98 struct ieee80211_local *local = sdata->local;
c3896d2c
LCC
99 struct sta_info *sta;
100
c3896d2c 101 if (local->num_sta >= MESH_MAX_PLINKS)
73651ee6 102 return NULL;
c3896d2c 103
34e89507 104 sta = sta_info_alloc(sdata, hw_addr, GFP_KERNEL);
73651ee6
JB
105 if (!sta)
106 return NULL;
c3896d2c 107
96b78dff 108 sta->flags = WLAN_STA_AUTHORIZED | WLAN_STA_AUTH;
323ce79a 109 sta->sta.supp_rates[local->hw.conf.channel->band] = rates;
b973c31a 110 rate_control_rate_init(sta);
c3896d2c
LCC
111
112 return sta;
113}
114
115/**
c9370197 116 * __mesh_plink_deactivate - deactivate mesh peer link
c3896d2c
LCC
117 *
118 * @sta: mesh peer link to deactivate
119 *
120 * All mesh paths with this peer as next hop will be flushed
121 *
07346f81 122 * Locking: the caller must hold sta->lock
c3896d2c 123 */
c9370197 124static bool __mesh_plink_deactivate(struct sta_info *sta)
c3896d2c 125{
d0709a65 126 struct ieee80211_sub_if_data *sdata = sta->sdata;
c9370197 127 bool deactivated = false;
d0709a65 128
c9370197 129 if (sta->plink_state == PLINK_ESTAB) {
c3896d2c 130 mesh_plink_dec_estab_count(sdata);
c9370197
JL
131 deactivated = true;
132 }
b4e08ea1 133 sta->plink_state = PLINK_BLOCKED;
c3896d2c 134 mesh_path_flush_by_nexthop(sta);
c9370197
JL
135
136 return deactivated;
c3896d2c
LCC
137}
138
902acc78 139/**
c9370197 140 * mesh_plink_deactivate - deactivate mesh peer link
902acc78
JB
141 *
142 * @sta: mesh peer link to deactivate
143 *
144 * All mesh paths with this peer as next hop will be flushed
145 */
146void mesh_plink_deactivate(struct sta_info *sta)
147{
c9370197
JL
148 struct ieee80211_sub_if_data *sdata = sta->sdata;
149 bool deactivated;
150
07346f81 151 spin_lock_bh(&sta->lock);
c9370197 152 deactivated = __mesh_plink_deactivate(sta);
07346f81 153 spin_unlock_bh(&sta->lock);
c9370197
JL
154
155 if (deactivated)
156 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON);
902acc78
JB
157}
158
f698d856 159static int mesh_plink_frame_tx(struct ieee80211_sub_if_data *sdata,
c3896d2c
LCC
160 enum plink_frame_type action, u8 *da, __le16 llid, __le16 plid,
161 __le16 reason) {
f698d856 162 struct ieee80211_local *local = sdata->local;
c80d545d 163 struct sk_buff *skb = dev_alloc_skb(local->hw.extra_tx_headroom + 400 +
581a8b0f 164 sdata->u.mesh.ie_len);
c3896d2c
LCC
165 struct ieee80211_mgmt *mgmt;
166 bool include_plid = false;
0938393f 167 static const u8 meshpeeringproto[] = { 0x00, 0x0F, 0xAC, 0x2A };
c3896d2c
LCC
168 u8 *pos;
169 int ie_len;
170
171 if (!skb)
172 return -1;
173 skb_reserve(skb, local->hw.extra_tx_headroom);
174 /* 25 is the size of the common mgmt part (24) plus the size of the
175 * common action part (1)
176 */
177 mgmt = (struct ieee80211_mgmt *)
178 skb_put(skb, 25 + sizeof(mgmt->u.action.u.plink_action));
179 memset(mgmt, 0, 25 + sizeof(mgmt->u.action.u.plink_action));
e7827a70
HH
180 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
181 IEEE80211_STYPE_ACTION);
c3896d2c 182 memcpy(mgmt->da, da, ETH_ALEN);
47846c9b 183 memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
c3896d2c 184 /* BSSID is left zeroed, wildcard value */
97ad9139 185 mgmt->u.action.category = WLAN_CATEGORY_MESH_PLINK;
c3896d2c
LCC
186 mgmt->u.action.u.plink_action.action_code = action;
187
188 if (action == PLINK_CLOSE)
189 mgmt->u.action.u.plink_action.aux = reason;
190 else {
191 mgmt->u.action.u.plink_action.aux = cpu_to_le16(0x0);
192 if (action == PLINK_CONFIRM) {
193 pos = skb_put(skb, 4);
194 /* two-byte status code followed by two-byte AID */
77fa76bb
RP
195 memset(pos, 0, 2);
196 memcpy(pos + 2, &plid, 2);
c3896d2c 197 }
f698d856 198 mesh_mgmt_ies_add(skb, sdata);
c3896d2c
LCC
199 }
200
201 /* Add Peer Link Management element */
202 switch (action) {
203 case PLINK_OPEN:
0938393f 204 ie_len = 6;
c3896d2c
LCC
205 break;
206 case PLINK_CONFIRM:
0938393f 207 ie_len = 8;
c3896d2c
LCC
208 include_plid = true;
209 break;
210 case PLINK_CLOSE:
211 default:
212 if (!plid)
0938393f 213 ie_len = 8;
c3896d2c 214 else {
0938393f 215 ie_len = 10;
c3896d2c
LCC
216 include_plid = true;
217 }
218 break;
219 }
220
221 pos = skb_put(skb, 2 + ie_len);
222 *pos++ = WLAN_EID_PEER_LINK;
223 *pos++ = ie_len;
0938393f
RP
224 memcpy(pos, meshpeeringproto, sizeof(meshpeeringproto));
225 pos += 4;
c3896d2c
LCC
226 memcpy(pos, &llid, 2);
227 if (include_plid) {
228 pos += 2;
229 memcpy(pos, &plid, 2);
230 }
231 if (action == PLINK_CLOSE) {
232 pos += 2;
233 memcpy(pos, &reason, 2);
234 }
235
62ae67be 236 ieee80211_tx_skb(sdata, skb);
c3896d2c
LCC
237 return 0;
238}
239
1570ca59
JC
240void mesh_neighbour_update(u8 *hw_addr, u32 rates,
241 struct ieee80211_sub_if_data *sdata,
242 struct ieee802_11_elems *elems)
c3896d2c 243{
f698d856 244 struct ieee80211_local *local = sdata->local;
c3896d2c
LCC
245 struct sta_info *sta;
246
d0709a65
JB
247 rcu_read_lock();
248
abe60632 249 sta = sta_info_get(sdata, hw_addr);
c3896d2c 250 if (!sta) {
34e89507 251 rcu_read_unlock();
1570ca59
JC
252 /* Userspace handles peer allocation when security is enabled
253 * */
254 if (sdata->u.mesh.is_secure)
255 cfg80211_notify_new_peer_candidate(sdata->dev, hw_addr,
256 elems->ie_start, elems->total_len,
257 GFP_KERNEL);
258 else
259 sta = mesh_plink_alloc(sdata, hw_addr, rates);
34e89507 260 if (!sta)
73651ee6 261 return;
34e89507 262 if (sta_info_insert_rcu(sta)) {
d0709a65 263 rcu_read_unlock();
c3896d2c 264 return;
d0709a65 265 }
c3896d2c
LCC
266 }
267
268 sta->last_rx = jiffies;
323ce79a 269 sta->sta.supp_rates[local->hw.conf.channel->band] = rates;
1570ca59
JC
270 if (mesh_peer_accepts_plinks(elems) &&
271 sta->plink_state == PLINK_LISTEN &&
472dbc45
JB
272 sdata->u.mesh.accepting_plinks &&
273 sdata->u.mesh.mshcfg.auto_open_plinks)
c3896d2c
LCC
274 mesh_plink_open(sta);
275
d0709a65 276 rcu_read_unlock();
c3896d2c
LCC
277}
278
279static void mesh_plink_timer(unsigned long data)
280{
281 struct sta_info *sta;
282 __le16 llid, plid, reason;
c3896d2c 283 struct ieee80211_sub_if_data *sdata;
c3896d2c 284
d0709a65
JB
285 /*
286 * This STA is valid because sta_info_destroy() will
287 * del_timer_sync() this timer after having made sure
288 * it cannot be readded (by deleting the plink.)
289 */
c3896d2c
LCC
290 sta = (struct sta_info *) data;
291
5bb644a0
JB
292 if (sta->sdata->local->quiescing) {
293 sta->plink_timer_was_running = true;
294 return;
295 }
296
07346f81 297 spin_lock_bh(&sta->lock);
c3896d2c
LCC
298 if (sta->ignore_plink_timer) {
299 sta->ignore_plink_timer = false;
07346f81 300 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
301 return;
302 }
0c68ae26
JB
303 mpl_dbg("Mesh plink timer for %pM fired on state %d\n",
304 sta->sta.addr, sta->plink_state);
c3896d2c
LCC
305 reason = 0;
306 llid = sta->llid;
307 plid = sta->plid;
d0709a65 308 sdata = sta->sdata;
c3896d2c
LCC
309
310 switch (sta->plink_state) {
b4e08ea1
LCC
311 case PLINK_OPN_RCVD:
312 case PLINK_OPN_SNT:
c3896d2c
LCC
313 /* retry timer */
314 if (sta->plink_retries < dot11MeshMaxRetries(sdata)) {
315 u32 rand;
0c68ae26
JB
316 mpl_dbg("Mesh plink for %pM (retry, timeout): %d %d\n",
317 sta->sta.addr, sta->plink_retries,
318 sta->plink_timeout);
c3896d2c
LCC
319 get_random_bytes(&rand, sizeof(u32));
320 sta->plink_timeout = sta->plink_timeout +
321 rand % sta->plink_timeout;
322 ++sta->plink_retries;
d0709a65 323 mod_plink_timer(sta, sta->plink_timeout);
07346f81 324 spin_unlock_bh(&sta->lock);
17741cdc 325 mesh_plink_frame_tx(sdata, PLINK_OPEN, sta->sta.addr, llid,
c3896d2c
LCC
326 0, 0);
327 break;
328 }
329 reason = cpu_to_le16(MESH_MAX_RETRIES);
330 /* fall through on else */
b4e08ea1 331 case PLINK_CNF_RCVD:
c3896d2c
LCC
332 /* confirm timer */
333 if (!reason)
334 reason = cpu_to_le16(MESH_CONFIRM_TIMEOUT);
b4e08ea1 335 sta->plink_state = PLINK_HOLDING;
d0709a65 336 mod_plink_timer(sta, dot11MeshHoldingTimeout(sdata));
07346f81 337 spin_unlock_bh(&sta->lock);
17741cdc 338 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr, llid, plid,
c3896d2c
LCC
339 reason);
340 break;
b4e08ea1 341 case PLINK_HOLDING:
c3896d2c 342 /* holding timer */
d0709a65 343 del_timer(&sta->plink_timer);
c3896d2c 344 mesh_plink_fsm_restart(sta);
07346f81 345 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
346 break;
347 default:
07346f81 348 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
349 break;
350 }
c3896d2c
LCC
351}
352
5bb644a0
JB
353#ifdef CONFIG_PM
354void mesh_plink_quiesce(struct sta_info *sta)
355{
356 if (del_timer_sync(&sta->plink_timer))
357 sta->plink_timer_was_running = true;
358}
359
360void mesh_plink_restart(struct sta_info *sta)
361{
362 if (sta->plink_timer_was_running) {
363 add_timer(&sta->plink_timer);
364 sta->plink_timer_was_running = false;
365 }
366}
367#endif
368
c3896d2c
LCC
369static inline void mesh_plink_timer_set(struct sta_info *sta, int timeout)
370{
371 sta->plink_timer.expires = jiffies + (HZ * timeout / 1000);
372 sta->plink_timer.data = (unsigned long) sta;
373 sta->plink_timer.function = mesh_plink_timer;
374 sta->plink_timeout = timeout;
c3896d2c
LCC
375 add_timer(&sta->plink_timer);
376}
377
378int mesh_plink_open(struct sta_info *sta)
379{
380 __le16 llid;
d0709a65 381 struct ieee80211_sub_if_data *sdata = sta->sdata;
c3896d2c 382
53e80511
JC
383 if (!test_sta_flags(sta, WLAN_STA_AUTH))
384 return -EPERM;
385
07346f81 386 spin_lock_bh(&sta->lock);
c3896d2c
LCC
387 get_random_bytes(&llid, 2);
388 sta->llid = llid;
b4e08ea1 389 if (sta->plink_state != PLINK_LISTEN) {
07346f81 390 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
391 return -EBUSY;
392 }
b4e08ea1 393 sta->plink_state = PLINK_OPN_SNT;
c3896d2c 394 mesh_plink_timer_set(sta, dot11MeshRetryTimeout(sdata));
07346f81 395 spin_unlock_bh(&sta->lock);
0c68ae26
JB
396 mpl_dbg("Mesh plink: starting establishment with %pM\n",
397 sta->sta.addr);
c3896d2c 398
f698d856 399 return mesh_plink_frame_tx(sdata, PLINK_OPEN,
17741cdc 400 sta->sta.addr, llid, 0, 0);
c3896d2c
LCC
401}
402
403void mesh_plink_block(struct sta_info *sta)
404{
c9370197
JL
405 struct ieee80211_sub_if_data *sdata = sta->sdata;
406 bool deactivated;
407
07346f81 408 spin_lock_bh(&sta->lock);
c9370197 409 deactivated = __mesh_plink_deactivate(sta);
b4e08ea1 410 sta->plink_state = PLINK_BLOCKED;
07346f81 411 spin_unlock_bh(&sta->lock);
c9370197
JL
412
413 if (deactivated)
414 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON);
c3896d2c
LCC
415}
416
c3896d2c 417
f698d856 418void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata, struct ieee80211_mgmt *mgmt,
c3896d2c
LCC
419 size_t len, struct ieee80211_rx_status *rx_status)
420{
d0709a65 421 struct ieee80211_local *local = sdata->local;
c3896d2c
LCC
422 struct ieee802_11_elems elems;
423 struct sta_info *sta;
424 enum plink_event event;
425 enum plink_frame_type ftype;
426 size_t baselen;
d12c7452 427 bool deactivated, matches_local = true;
c3896d2c
LCC
428 u8 ie_len;
429 u8 *baseaddr;
430 __le16 plid, llid, reason;
1460dd15
RP
431#ifdef CONFIG_MAC80211_VERBOSE_MPL_DEBUG
432 static const char *mplstates[] = {
433 [PLINK_LISTEN] = "LISTEN",
434 [PLINK_OPN_SNT] = "OPN-SNT",
435 [PLINK_OPN_RCVD] = "OPN-RCVD",
436 [PLINK_CNF_RCVD] = "CNF_RCVD",
437 [PLINK_ESTAB] = "ESTAB",
438 [PLINK_HOLDING] = "HOLDING",
439 [PLINK_BLOCKED] = "BLOCKED"
440 };
441#endif
c3896d2c 442
9c80d3dc
JB
443 /* need action_code, aux */
444 if (len < IEEE80211_MIN_ACTION_SIZE + 3)
445 return;
446
c3896d2c
LCC
447 if (is_multicast_ether_addr(mgmt->da)) {
448 mpl_dbg("Mesh plink: ignore frame from multicast address");
449 return;
450 }
451
452 baseaddr = mgmt->u.action.u.plink_action.variable;
453 baselen = (u8 *) mgmt->u.action.u.plink_action.variable - (u8 *) mgmt;
454 if (mgmt->u.action.u.plink_action.action_code == PLINK_CONFIRM) {
455 baseaddr += 4;
70bdb6b2 456 baselen += 4;
c3896d2c
LCC
457 }
458 ieee802_11_parse_elems(baseaddr, len - baselen, &elems);
459 if (!elems.peer_link) {
460 mpl_dbg("Mesh plink: missing necessary peer link ie\n");
461 return;
462 }
5cff5e01
JC
463 if (elems.rsn_len && !sdata->u.mesh.is_secure) {
464 mpl_dbg("Mesh plink: can't establish link with secure peer\n");
465 return;
466 }
c3896d2c 467
0938393f 468 ftype = mgmt->u.action.u.plink_action.action_code;
c3896d2c 469 ie_len = elems.peer_link_len;
0938393f
RP
470 if ((ftype == PLINK_OPEN && ie_len != 6) ||
471 (ftype == PLINK_CONFIRM && ie_len != 8) ||
472 (ftype == PLINK_CLOSE && ie_len != 8 && ie_len != 10)) {
473 mpl_dbg("Mesh plink: incorrect plink ie length %d %d\n",
474 ftype, ie_len);
c3896d2c
LCC
475 return;
476 }
477
478 if (ftype != PLINK_CLOSE && (!elems.mesh_id || !elems.mesh_config)) {
479 mpl_dbg("Mesh plink: missing necessary ie\n");
480 return;
481 }
482 /* Note the lines below are correct, the llid in the frame is the plid
483 * from the point of view of this host.
484 */
485 memcpy(&plid, PLINK_GET_LLID(elems.peer_link), 2);
0938393f 486 if (ftype == PLINK_CONFIRM || (ftype == PLINK_CLOSE && ie_len == 10))
c3896d2c
LCC
487 memcpy(&llid, PLINK_GET_PLID(elems.peer_link), 2);
488
d0709a65
JB
489 rcu_read_lock();
490
abe60632 491 sta = sta_info_get(sdata, mgmt->sa);
c3896d2c
LCC
492 if (!sta && ftype != PLINK_OPEN) {
493 mpl_dbg("Mesh plink: cls or cnf from unknown peer\n");
d0709a65 494 rcu_read_unlock();
c3896d2c
LCC
495 return;
496 }
497
53e80511
JC
498 if (sta && !test_sta_flags(sta, WLAN_STA_AUTH)) {
499 mpl_dbg("Mesh plink: Action frame from non-authed peer\n");
500 rcu_read_unlock();
501 return;
502 }
503
b4e08ea1 504 if (sta && sta->plink_state == PLINK_BLOCKED) {
d0709a65 505 rcu_read_unlock();
c3896d2c
LCC
506 return;
507 }
508
509 /* Now we will figure out the appropriate event... */
510 event = PLINK_UNDEFINED;
f698d856 511 if (ftype != PLINK_CLOSE && (!mesh_matches_local(&elems, sdata))) {
d12c7452 512 matches_local = false;
c3896d2c
LCC
513 switch (ftype) {
514 case PLINK_OPEN:
515 event = OPN_RJCT;
516 break;
517 case PLINK_CONFIRM:
518 event = CNF_RJCT;
519 break;
520 case PLINK_CLOSE:
521 /* avoid warning */
522 break;
523 }
d12c7452
CL
524 }
525
526 if (!sta && !matches_local) {
527 rcu_read_unlock();
528 reason = cpu_to_le16(MESH_CAPABILITY_POLICY_VIOLATION);
529 llid = 0;
530 mesh_plink_frame_tx(sdata, PLINK_CLOSE, mgmt->sa, llid,
531 plid, reason);
532 return;
c3896d2c
LCC
533 } else if (!sta) {
534 /* ftype == PLINK_OPEN */
881d948c 535 u32 rates;
34e89507
JB
536
537 rcu_read_unlock();
538
c3896d2c
LCC
539 if (!mesh_plink_free_count(sdata)) {
540 mpl_dbg("Mesh plink error: no more free plinks\n");
541 return;
542 }
543
544 rates = ieee80211_sta_get_rates(local, &elems, rx_status->band);
03e4497e 545 sta = mesh_plink_alloc(sdata, mgmt->sa, rates);
73651ee6 546 if (!sta) {
c3896d2c
LCC
547 mpl_dbg("Mesh plink error: plink table full\n");
548 return;
549 }
34e89507 550 if (sta_info_insert_rcu(sta)) {
73651ee6
JB
551 rcu_read_unlock();
552 return;
553 }
c3896d2c 554 event = OPN_ACPT;
07346f81 555 spin_lock_bh(&sta->lock);
d12c7452 556 } else if (matches_local) {
07346f81 557 spin_lock_bh(&sta->lock);
c3896d2c
LCC
558 switch (ftype) {
559 case PLINK_OPEN:
560 if (!mesh_plink_free_count(sdata) ||
d0709a65 561 (sta->plid && sta->plid != plid))
c3896d2c
LCC
562 event = OPN_IGNR;
563 else
564 event = OPN_ACPT;
565 break;
566 case PLINK_CONFIRM:
567 if (!mesh_plink_free_count(sdata) ||
d0709a65 568 (sta->llid != llid || sta->plid != plid))
c3896d2c
LCC
569 event = CNF_IGNR;
570 else
571 event = CNF_ACPT;
572 break;
573 case PLINK_CLOSE:
b4e08ea1 574 if (sta->plink_state == PLINK_ESTAB)
c3896d2c
LCC
575 /* Do not check for llid or plid. This does not
576 * follow the standard but since multiple plinks
577 * per sta are not supported, it is necessary in
578 * order to avoid a livelock when MP A sees an
579 * establish peer link to MP B but MP B does not
580 * see it. This can be caused by a timeout in
581 * B's peer link establishment or B beign
582 * restarted.
583 */
584 event = CLS_ACPT;
585 else if (sta->plid != plid)
586 event = CLS_IGNR;
587 else if (ie_len == 7 && sta->llid != llid)
588 event = CLS_IGNR;
589 else
590 event = CLS_ACPT;
591 break;
592 default:
593 mpl_dbg("Mesh plink: unknown frame subtype\n");
07346f81 594 spin_unlock_bh(&sta->lock);
d0709a65 595 rcu_read_unlock();
c3896d2c
LCC
596 return;
597 }
d12c7452
CL
598 } else {
599 spin_lock_bh(&sta->lock);
c3896d2c
LCC
600 }
601
1460dd15
RP
602 mpl_dbg("Mesh plink (peer, state, llid, plid, event): %pM %s %d %d %d\n",
603 mgmt->sa, mplstates[sta->plink_state],
0c68ae26
JB
604 le16_to_cpu(sta->llid), le16_to_cpu(sta->plid),
605 event);
c3896d2c
LCC
606 reason = 0;
607 switch (sta->plink_state) {
608 /* spin_unlock as soon as state is updated at each case */
b4e08ea1 609 case PLINK_LISTEN:
c3896d2c
LCC
610 switch (event) {
611 case CLS_ACPT:
612 mesh_plink_fsm_restart(sta);
07346f81 613 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
614 break;
615 case OPN_ACPT:
b4e08ea1 616 sta->plink_state = PLINK_OPN_RCVD;
c3896d2c
LCC
617 sta->plid = plid;
618 get_random_bytes(&llid, 2);
619 sta->llid = llid;
620 mesh_plink_timer_set(sta, dot11MeshRetryTimeout(sdata));
07346f81 621 spin_unlock_bh(&sta->lock);
17741cdc 622 mesh_plink_frame_tx(sdata, PLINK_OPEN, sta->sta.addr, llid,
c3896d2c 623 0, 0);
17741cdc 624 mesh_plink_frame_tx(sdata, PLINK_CONFIRM, sta->sta.addr,
c3896d2c
LCC
625 llid, plid, 0);
626 break;
627 default:
07346f81 628 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
629 break;
630 }
631 break;
632
b4e08ea1 633 case PLINK_OPN_SNT:
c3896d2c
LCC
634 switch (event) {
635 case OPN_RJCT:
636 case CNF_RJCT:
637 reason = cpu_to_le16(MESH_CAPABILITY_POLICY_VIOLATION);
638 case CLS_ACPT:
639 if (!reason)
640 reason = cpu_to_le16(MESH_CLOSE_RCVD);
641 sta->reason = reason;
b4e08ea1 642 sta->plink_state = PLINK_HOLDING;
c3896d2c
LCC
643 if (!mod_plink_timer(sta,
644 dot11MeshHoldingTimeout(sdata)))
645 sta->ignore_plink_timer = true;
646
647 llid = sta->llid;
07346f81 648 spin_unlock_bh(&sta->lock);
17741cdc 649 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr, llid,
c3896d2c
LCC
650 plid, reason);
651 break;
652 case OPN_ACPT:
653 /* retry timer is left untouched */
b4e08ea1 654 sta->plink_state = PLINK_OPN_RCVD;
c3896d2c
LCC
655 sta->plid = plid;
656 llid = sta->llid;
07346f81 657 spin_unlock_bh(&sta->lock);
17741cdc 658 mesh_plink_frame_tx(sdata, PLINK_CONFIRM, sta->sta.addr, llid,
c3896d2c
LCC
659 plid, 0);
660 break;
661 case CNF_ACPT:
b4e08ea1 662 sta->plink_state = PLINK_CNF_RCVD;
c3896d2c
LCC
663 if (!mod_plink_timer(sta,
664 dot11MeshConfirmTimeout(sdata)))
665 sta->ignore_plink_timer = true;
666
07346f81 667 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
668 break;
669 default:
07346f81 670 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
671 break;
672 }
673 break;
674
b4e08ea1 675 case PLINK_OPN_RCVD:
c3896d2c
LCC
676 switch (event) {
677 case OPN_RJCT:
678 case CNF_RJCT:
679 reason = cpu_to_le16(MESH_CAPABILITY_POLICY_VIOLATION);
680 case CLS_ACPT:
681 if (!reason)
682 reason = cpu_to_le16(MESH_CLOSE_RCVD);
683 sta->reason = reason;
b4e08ea1 684 sta->plink_state = PLINK_HOLDING;
c3896d2c
LCC
685 if (!mod_plink_timer(sta,
686 dot11MeshHoldingTimeout(sdata)))
687 sta->ignore_plink_timer = true;
688
689 llid = sta->llid;
07346f81 690 spin_unlock_bh(&sta->lock);
17741cdc 691 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr, llid,
c3896d2c
LCC
692 plid, reason);
693 break;
694 case OPN_ACPT:
695 llid = sta->llid;
07346f81 696 spin_unlock_bh(&sta->lock);
17741cdc 697 mesh_plink_frame_tx(sdata, PLINK_CONFIRM, sta->sta.addr, llid,
c3896d2c
LCC
698 plid, 0);
699 break;
700 case CNF_ACPT:
d0709a65 701 del_timer(&sta->plink_timer);
b4e08ea1 702 sta->plink_state = PLINK_ESTAB;
07346f81 703 spin_unlock_bh(&sta->lock);
c9370197
JL
704 mesh_plink_inc_estab_count(sdata);
705 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON);
0c68ae26
JB
706 mpl_dbg("Mesh plink with %pM ESTABLISHED\n",
707 sta->sta.addr);
c3896d2c
LCC
708 break;
709 default:
07346f81 710 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
711 break;
712 }
713 break;
714
b4e08ea1 715 case PLINK_CNF_RCVD:
c3896d2c
LCC
716 switch (event) {
717 case OPN_RJCT:
718 case CNF_RJCT:
719 reason = cpu_to_le16(MESH_CAPABILITY_POLICY_VIOLATION);
720 case CLS_ACPT:
721 if (!reason)
722 reason = cpu_to_le16(MESH_CLOSE_RCVD);
723 sta->reason = reason;
b4e08ea1 724 sta->plink_state = PLINK_HOLDING;
c3896d2c
LCC
725 if (!mod_plink_timer(sta,
726 dot11MeshHoldingTimeout(sdata)))
727 sta->ignore_plink_timer = true;
728
729 llid = sta->llid;
07346f81 730 spin_unlock_bh(&sta->lock);
17741cdc 731 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr, llid,
c3896d2c 732 plid, reason);
ff59dc76 733 break;
c3896d2c 734 case OPN_ACPT:
d0709a65 735 del_timer(&sta->plink_timer);
b4e08ea1 736 sta->plink_state = PLINK_ESTAB;
07346f81 737 spin_unlock_bh(&sta->lock);
c9370197
JL
738 mesh_plink_inc_estab_count(sdata);
739 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON);
0c68ae26
JB
740 mpl_dbg("Mesh plink with %pM ESTABLISHED\n",
741 sta->sta.addr);
17741cdc 742 mesh_plink_frame_tx(sdata, PLINK_CONFIRM, sta->sta.addr, llid,
c3896d2c
LCC
743 plid, 0);
744 break;
745 default:
07346f81 746 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
747 break;
748 }
749 break;
750
b4e08ea1 751 case PLINK_ESTAB:
c3896d2c
LCC
752 switch (event) {
753 case CLS_ACPT:
754 reason = cpu_to_le16(MESH_CLOSE_RCVD);
755 sta->reason = reason;
c9370197 756 deactivated = __mesh_plink_deactivate(sta);
b4e08ea1 757 sta->plink_state = PLINK_HOLDING;
c3896d2c 758 llid = sta->llid;
d0709a65 759 mod_plink_timer(sta, dot11MeshHoldingTimeout(sdata));
07346f81 760 spin_unlock_bh(&sta->lock);
c9370197
JL
761 if (deactivated)
762 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON);
17741cdc 763 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr, llid,
c3896d2c
LCC
764 plid, reason);
765 break;
766 case OPN_ACPT:
767 llid = sta->llid;
07346f81 768 spin_unlock_bh(&sta->lock);
17741cdc 769 mesh_plink_frame_tx(sdata, PLINK_CONFIRM, sta->sta.addr, llid,
c3896d2c
LCC
770 plid, 0);
771 break;
772 default:
07346f81 773 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
774 break;
775 }
776 break;
b4e08ea1 777 case PLINK_HOLDING:
c3896d2c
LCC
778 switch (event) {
779 case CLS_ACPT:
d0709a65 780 if (del_timer(&sta->plink_timer))
c3896d2c 781 sta->ignore_plink_timer = 1;
c3896d2c 782 mesh_plink_fsm_restart(sta);
07346f81 783 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
784 break;
785 case OPN_ACPT:
786 case CNF_ACPT:
787 case OPN_RJCT:
788 case CNF_RJCT:
789 llid = sta->llid;
790 reason = sta->reason;
07346f81 791 spin_unlock_bh(&sta->lock);
17741cdc
JB
792 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr,
793 llid, plid, reason);
c3896d2c
LCC
794 break;
795 default:
07346f81 796 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
797 }
798 break;
799 default:
b4e08ea1 800 /* should not get here, PLINK_BLOCKED is dealt with at the
3ad2f3fb 801 * beginning of the function
c3896d2c 802 */
07346f81 803 spin_unlock_bh(&sta->lock);
c3896d2c
LCC
804 break;
805 }
d0709a65
JB
806
807 rcu_read_unlock();
c3896d2c 808}
This page took 0.299287 seconds and 5 git commands to generate.