blob: 418875246a0b1b8bfd64f84d5666bf639f7f63d3 [file] [log] [blame]
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +01001/*
2 * Copyright (c) 2008 open80211s Ltd.
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 */
Johannes Berg902acc72008-02-23 15:17:19 +01009#include <linux/kernel.h>
10#include <linux/random.h>
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010011#include "ieee80211_i.h"
Johannes Berg2c8dccc2008-04-08 15:14:40 -040012#include "rate.h"
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010013#include "mesh.h"
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010014
15#ifdef CONFIG_MAC80211_VERBOSE_MPL_DEBUG
16#define mpl_dbg(fmt, args...) printk(KERN_DEBUG fmt, ##args)
17#else
18#define mpl_dbg(fmt, args...) do { (void)(0); } while (0)
19#endif
20
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010021#define PLINK_GET_FRAME_SUBTYPE(p) (p)
22#define PLINK_GET_LLID(p) (p + 1)
23#define PLINK_GET_PLID(p) (p + 3)
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
Johannes Berg472dbc42008-09-11 00:01:49 +020039#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)
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010044
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{
Johannes Berg472dbc42008-09-11 00:01:49 +020066 atomic_inc(&sdata->u.mesh.mshstats.estab_plinks);
Johannes Bergd0709a62008-02-25 16:27:46 +010067 mesh_accept_plinks_update(sdata);
Rui Paulo8f2fda92009-11-09 23:46:41 +000068 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010069}
70
71static inline
72void mesh_plink_dec_estab_count(struct ieee80211_sub_if_data *sdata)
73{
Johannes Berg472dbc42008-09-11 00:01:49 +020074 atomic_dec(&sdata->u.mesh.mshstats.estab_plinks);
Johannes Bergd0709a62008-02-25 16:27:46 +010075 mesh_accept_plinks_update(sdata);
Rui Paulo8f2fda92009-11-09 23:46:41 +000076 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010077}
78
79/**
80 * mesh_plink_fsm_restart - restart a mesh peer link finite state machine
81 *
Rui Paulo23c7a292009-11-09 23:46:42 +000082 * @sta: mesh peer link to restart
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010083 *
Johannes Berg07346f812008-05-03 01:02:02 +020084 * Locking: this function must be called holding sta->lock
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010085 */
86static inline void mesh_plink_fsm_restart(struct sta_info *sta)
87{
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -080088 sta->plink_state = PLINK_LISTEN;
Luis Carlos Cobo37659ff2008-02-29 12:13:38 -080089 sta->llid = sta->plid = sta->reason = 0;
90 sta->plink_retries = 0;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010091}
92
Johannes Berg93e5deb2008-04-01 15:21:00 +020093/*
94 * NOTE: This is just an alias for sta_info_alloc(), see notes
95 * on it in the lifecycle management section!
96 */
Johannes Berg03e44972008-02-27 09:56:40 +010097static struct sta_info *mesh_plink_alloc(struct ieee80211_sub_if_data *sdata,
Johannes Berg881d9482009-01-21 15:13:48 +010098 u8 *hw_addr, u32 rates)
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +010099{
Johannes Bergd0709a62008-02-25 16:27:46 +0100100 struct ieee80211_local *local = sdata->local;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100101 struct sta_info *sta;
102
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100103 if (local->num_sta >= MESH_MAX_PLINKS)
Johannes Berg73651ee2008-02-25 16:27:47 +0100104 return NULL;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100105
Johannes Berg03e44972008-02-27 09:56:40 +0100106 sta = sta_info_alloc(sdata, hw_addr, GFP_ATOMIC);
Johannes Berg73651ee2008-02-25 16:27:47 +0100107 if (!sta)
108 return NULL;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100109
Johannes Berg07346f812008-05-03 01:02:02 +0200110 sta->flags = WLAN_STA_AUTHORIZED;
Johannes Berg323ce792008-09-11 02:45:11 +0200111 sta->sta.supp_rates[local->hw.conf.channel->band] = rates;
Christian Lamparterb973c312008-12-27 22:19:49 +0100112 rate_control_rate_init(sta);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100113
114 return sta;
115}
116
117/**
Johannes Berg42096b62008-02-25 21:36:27 +0100118 * mesh_plink_deactivate - deactivate mesh peer link
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100119 *
120 * @sta: mesh peer link to deactivate
121 *
122 * All mesh paths with this peer as next hop will be flushed
123 *
Johannes Berg07346f812008-05-03 01:02:02 +0200124 * Locking: the caller must hold sta->lock
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100125 */
Johannes Berg902acc72008-02-23 15:17:19 +0100126static void __mesh_plink_deactivate(struct sta_info *sta)
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100127{
Johannes Bergd0709a62008-02-25 16:27:46 +0100128 struct ieee80211_sub_if_data *sdata = sta->sdata;
129
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800130 if (sta->plink_state == PLINK_ESTAB)
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100131 mesh_plink_dec_estab_count(sdata);
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800132 sta->plink_state = PLINK_BLOCKED;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100133 mesh_path_flush_by_nexthop(sta);
134}
135
Johannes Berg902acc72008-02-23 15:17:19 +0100136/**
137 * __mesh_plink_deactivate - deactivate mesh peer link
138 *
139 * @sta: mesh peer link to deactivate
140 *
141 * All mesh paths with this peer as next hop will be flushed
142 */
143void mesh_plink_deactivate(struct sta_info *sta)
144{
Johannes Berg07346f812008-05-03 01:02:02 +0200145 spin_lock_bh(&sta->lock);
Johannes Berg902acc72008-02-23 15:17:19 +0100146 __mesh_plink_deactivate(sta);
Johannes Berg07346f812008-05-03 01:02:02 +0200147 spin_unlock_bh(&sta->lock);
Johannes Berg902acc72008-02-23 15:17:19 +0100148}
149
Jasper Bryant-Greenef698d852008-08-03 12:04:37 +1200150static int mesh_plink_frame_tx(struct ieee80211_sub_if_data *sdata,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100151 enum plink_frame_type action, u8 *da, __le16 llid, __le16 plid,
152 __le16 reason) {
Jasper Bryant-Greenef698d852008-08-03 12:04:37 +1200153 struct ieee80211_local *local = sdata->local;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100154 struct sk_buff *skb = dev_alloc_skb(local->hw.extra_tx_headroom + 400);
155 struct ieee80211_mgmt *mgmt;
156 bool include_plid = false;
157 u8 *pos;
158 int ie_len;
159
160 if (!skb)
161 return -1;
162 skb_reserve(skb, local->hw.extra_tx_headroom);
163 /* 25 is the size of the common mgmt part (24) plus the size of the
164 * common action part (1)
165 */
166 mgmt = (struct ieee80211_mgmt *)
167 skb_put(skb, 25 + sizeof(mgmt->u.action.u.plink_action));
168 memset(mgmt, 0, 25 + sizeof(mgmt->u.action.u.plink_action));
Harvey Harrisone7827a72008-07-15 18:44:13 -0700169 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
170 IEEE80211_STYPE_ACTION);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100171 memcpy(mgmt->da, da, ETH_ALEN);
Jasper Bryant-Greenef698d852008-08-03 12:04:37 +1200172 memcpy(mgmt->sa, sdata->dev->dev_addr, ETH_ALEN);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100173 /* BSSID is left zeroed, wildcard value */
174 mgmt->u.action.category = PLINK_CATEGORY;
175 mgmt->u.action.u.plink_action.action_code = action;
176
177 if (action == PLINK_CLOSE)
178 mgmt->u.action.u.plink_action.aux = reason;
179 else {
180 mgmt->u.action.u.plink_action.aux = cpu_to_le16(0x0);
181 if (action == PLINK_CONFIRM) {
182 pos = skb_put(skb, 4);
183 /* two-byte status code followed by two-byte AID */
184 memset(pos, 0, 4);
185 }
Jasper Bryant-Greenef698d852008-08-03 12:04:37 +1200186 mesh_mgmt_ies_add(skb, sdata);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100187 }
188
189 /* Add Peer Link Management element */
190 switch (action) {
191 case PLINK_OPEN:
192 ie_len = 3;
193 break;
194 case PLINK_CONFIRM:
195 ie_len = 5;
196 include_plid = true;
197 break;
198 case PLINK_CLOSE:
199 default:
200 if (!plid)
201 ie_len = 5;
202 else {
203 ie_len = 7;
204 include_plid = true;
205 }
206 break;
207 }
208
209 pos = skb_put(skb, 2 + ie_len);
210 *pos++ = WLAN_EID_PEER_LINK;
211 *pos++ = ie_len;
212 *pos++ = action;
213 memcpy(pos, &llid, 2);
214 if (include_plid) {
215 pos += 2;
216 memcpy(pos, &plid, 2);
217 }
218 if (action == PLINK_CLOSE) {
219 pos += 2;
220 memcpy(pos, &reason, 2);
221 }
222
Jouni Malinen1acc97b2009-01-08 13:32:07 +0200223 ieee80211_tx_skb(sdata, skb, 1);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100224 return 0;
225}
226
Johannes Berg881d9482009-01-21 15:13:48 +0100227void mesh_neighbour_update(u8 *hw_addr, u32 rates, struct ieee80211_sub_if_data *sdata,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100228 bool peer_accepting_plinks)
229{
Jasper Bryant-Greenef698d852008-08-03 12:04:37 +1200230 struct ieee80211_local *local = sdata->local;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100231 struct sta_info *sta;
232
Johannes Bergd0709a62008-02-25 16:27:46 +0100233 rcu_read_lock();
234
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100235 sta = sta_info_get(local, hw_addr);
236 if (!sta) {
Johannes Berg03e44972008-02-27 09:56:40 +0100237 sta = mesh_plink_alloc(sdata, hw_addr, rates);
Johannes Berg73651ee2008-02-25 16:27:47 +0100238 if (!sta) {
239 rcu_read_unlock();
240 return;
241 }
242 if (sta_info_insert(sta)) {
Johannes Bergd0709a62008-02-25 16:27:46 +0100243 rcu_read_unlock();
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100244 return;
Johannes Bergd0709a62008-02-25 16:27:46 +0100245 }
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100246 }
247
248 sta->last_rx = jiffies;
Johannes Berg323ce792008-09-11 02:45:11 +0200249 sta->sta.supp_rates[local->hw.conf.channel->band] = rates;
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800250 if (peer_accepting_plinks && sta->plink_state == PLINK_LISTEN &&
Johannes Berg472dbc42008-09-11 00:01:49 +0200251 sdata->u.mesh.accepting_plinks &&
252 sdata->u.mesh.mshcfg.auto_open_plinks)
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100253 mesh_plink_open(sta);
254
Johannes Bergd0709a62008-02-25 16:27:46 +0100255 rcu_read_unlock();
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100256}
257
258static void mesh_plink_timer(unsigned long data)
259{
260 struct sta_info *sta;
261 __le16 llid, plid, reason;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100262 struct ieee80211_sub_if_data *sdata;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100263
Johannes Bergd0709a62008-02-25 16:27:46 +0100264 /*
265 * This STA is valid because sta_info_destroy() will
266 * del_timer_sync() this timer after having made sure
267 * it cannot be readded (by deleting the plink.)
268 */
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100269 sta = (struct sta_info *) data;
270
Johannes Berg5bb644a2009-05-17 11:40:42 +0200271 if (sta->sdata->local->quiescing) {
272 sta->plink_timer_was_running = true;
273 return;
274 }
275
Johannes Berg07346f812008-05-03 01:02:02 +0200276 spin_lock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100277 if (sta->ignore_plink_timer) {
278 sta->ignore_plink_timer = false;
Johannes Berg07346f812008-05-03 01:02:02 +0200279 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100280 return;
281 }
Johannes Berg0c68ae262008-10-27 15:56:10 -0700282 mpl_dbg("Mesh plink timer for %pM fired on state %d\n",
283 sta->sta.addr, sta->plink_state);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100284 reason = 0;
285 llid = sta->llid;
286 plid = sta->plid;
Johannes Bergd0709a62008-02-25 16:27:46 +0100287 sdata = sta->sdata;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100288
289 switch (sta->plink_state) {
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800290 case PLINK_OPN_RCVD:
291 case PLINK_OPN_SNT:
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100292 /* retry timer */
293 if (sta->plink_retries < dot11MeshMaxRetries(sdata)) {
294 u32 rand;
Johannes Berg0c68ae262008-10-27 15:56:10 -0700295 mpl_dbg("Mesh plink for %pM (retry, timeout): %d %d\n",
296 sta->sta.addr, sta->plink_retries,
297 sta->plink_timeout);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100298 get_random_bytes(&rand, sizeof(u32));
299 sta->plink_timeout = sta->plink_timeout +
300 rand % sta->plink_timeout;
301 ++sta->plink_retries;
Johannes Bergd0709a62008-02-25 16:27:46 +0100302 mod_plink_timer(sta, sta->plink_timeout);
Johannes Berg07346f812008-05-03 01:02:02 +0200303 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200304 mesh_plink_frame_tx(sdata, PLINK_OPEN, sta->sta.addr, llid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100305 0, 0);
306 break;
307 }
308 reason = cpu_to_le16(MESH_MAX_RETRIES);
309 /* fall through on else */
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800310 case PLINK_CNF_RCVD:
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100311 /* confirm timer */
312 if (!reason)
313 reason = cpu_to_le16(MESH_CONFIRM_TIMEOUT);
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800314 sta->plink_state = PLINK_HOLDING;
Johannes Bergd0709a62008-02-25 16:27:46 +0100315 mod_plink_timer(sta, dot11MeshHoldingTimeout(sdata));
Johannes Berg07346f812008-05-03 01:02:02 +0200316 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200317 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr, llid, plid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100318 reason);
319 break;
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800320 case PLINK_HOLDING:
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100321 /* holding timer */
Johannes Bergd0709a62008-02-25 16:27:46 +0100322 del_timer(&sta->plink_timer);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100323 mesh_plink_fsm_restart(sta);
Johannes Berg07346f812008-05-03 01:02:02 +0200324 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100325 break;
326 default:
Johannes Berg07346f812008-05-03 01:02:02 +0200327 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100328 break;
329 }
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100330}
331
Johannes Berg5bb644a2009-05-17 11:40:42 +0200332#ifdef CONFIG_PM
333void mesh_plink_quiesce(struct sta_info *sta)
334{
335 if (del_timer_sync(&sta->plink_timer))
336 sta->plink_timer_was_running = true;
337}
338
339void mesh_plink_restart(struct sta_info *sta)
340{
341 if (sta->plink_timer_was_running) {
342 add_timer(&sta->plink_timer);
343 sta->plink_timer_was_running = false;
344 }
345}
346#endif
347
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100348static inline void mesh_plink_timer_set(struct sta_info *sta, int timeout)
349{
350 sta->plink_timer.expires = jiffies + (HZ * timeout / 1000);
351 sta->plink_timer.data = (unsigned long) sta;
352 sta->plink_timer.function = mesh_plink_timer;
353 sta->plink_timeout = timeout;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100354 add_timer(&sta->plink_timer);
355}
356
357int mesh_plink_open(struct sta_info *sta)
358{
359 __le16 llid;
Johannes Bergd0709a62008-02-25 16:27:46 +0100360 struct ieee80211_sub_if_data *sdata = sta->sdata;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100361
Johannes Berg07346f812008-05-03 01:02:02 +0200362 spin_lock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100363 get_random_bytes(&llid, 2);
364 sta->llid = llid;
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800365 if (sta->plink_state != PLINK_LISTEN) {
Johannes Berg07346f812008-05-03 01:02:02 +0200366 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100367 return -EBUSY;
368 }
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800369 sta->plink_state = PLINK_OPN_SNT;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100370 mesh_plink_timer_set(sta, dot11MeshRetryTimeout(sdata));
Johannes Berg07346f812008-05-03 01:02:02 +0200371 spin_unlock_bh(&sta->lock);
Johannes Berg0c68ae262008-10-27 15:56:10 -0700372 mpl_dbg("Mesh plink: starting establishment with %pM\n",
373 sta->sta.addr);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100374
Jasper Bryant-Greenef698d852008-08-03 12:04:37 +1200375 return mesh_plink_frame_tx(sdata, PLINK_OPEN,
Johannes Berg17741cd2008-09-11 00:02:02 +0200376 sta->sta.addr, llid, 0, 0);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100377}
378
379void mesh_plink_block(struct sta_info *sta)
380{
Johannes Berg07346f812008-05-03 01:02:02 +0200381 spin_lock_bh(&sta->lock);
Johannes Berg902acc72008-02-23 15:17:19 +0100382 __mesh_plink_deactivate(sta);
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800383 sta->plink_state = PLINK_BLOCKED;
Johannes Berg07346f812008-05-03 01:02:02 +0200384 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100385}
386
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100387
Jasper Bryant-Greenef698d852008-08-03 12:04:37 +1200388void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata, struct ieee80211_mgmt *mgmt,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100389 size_t len, struct ieee80211_rx_status *rx_status)
390{
Johannes Bergd0709a62008-02-25 16:27:46 +0100391 struct ieee80211_local *local = sdata->local;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100392 struct ieee802_11_elems elems;
393 struct sta_info *sta;
394 enum plink_event event;
395 enum plink_frame_type ftype;
396 size_t baselen;
397 u8 ie_len;
398 u8 *baseaddr;
399 __le16 plid, llid, reason;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100400
Johannes Berg9c80d3d2008-09-08 15:41:59 +0200401 /* need action_code, aux */
402 if (len < IEEE80211_MIN_ACTION_SIZE + 3)
403 return;
404
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100405 if (is_multicast_ether_addr(mgmt->da)) {
406 mpl_dbg("Mesh plink: ignore frame from multicast address");
407 return;
408 }
409
410 baseaddr = mgmt->u.action.u.plink_action.variable;
411 baselen = (u8 *) mgmt->u.action.u.plink_action.variable - (u8 *) mgmt;
412 if (mgmt->u.action.u.plink_action.action_code == PLINK_CONFIRM) {
413 baseaddr += 4;
David Woo70bdb6b2009-08-12 11:03:44 -0700414 baselen += 4;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100415 }
416 ieee802_11_parse_elems(baseaddr, len - baselen, &elems);
417 if (!elems.peer_link) {
418 mpl_dbg("Mesh plink: missing necessary peer link ie\n");
419 return;
420 }
421
422 ftype = *((u8 *)PLINK_GET_FRAME_SUBTYPE(elems.peer_link));
423 ie_len = elems.peer_link_len;
424 if ((ftype == PLINK_OPEN && ie_len != 3) ||
425 (ftype == PLINK_CONFIRM && ie_len != 5) ||
426 (ftype == PLINK_CLOSE && ie_len != 5 && ie_len != 7)) {
427 mpl_dbg("Mesh plink: incorrect plink ie length\n");
428 return;
429 }
430
431 if (ftype != PLINK_CLOSE && (!elems.mesh_id || !elems.mesh_config)) {
432 mpl_dbg("Mesh plink: missing necessary ie\n");
433 return;
434 }
435 /* Note the lines below are correct, the llid in the frame is the plid
436 * from the point of view of this host.
437 */
438 memcpy(&plid, PLINK_GET_LLID(elems.peer_link), 2);
439 if (ftype == PLINK_CONFIRM || (ftype == PLINK_CLOSE && ie_len == 7))
440 memcpy(&llid, PLINK_GET_PLID(elems.peer_link), 2);
441
Johannes Bergd0709a62008-02-25 16:27:46 +0100442 rcu_read_lock();
443
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100444 sta = sta_info_get(local, mgmt->sa);
445 if (!sta && ftype != PLINK_OPEN) {
446 mpl_dbg("Mesh plink: cls or cnf from unknown peer\n");
Johannes Bergd0709a62008-02-25 16:27:46 +0100447 rcu_read_unlock();
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100448 return;
449 }
450
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800451 if (sta && sta->plink_state == PLINK_BLOCKED) {
Johannes Bergd0709a62008-02-25 16:27:46 +0100452 rcu_read_unlock();
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100453 return;
454 }
455
456 /* Now we will figure out the appropriate event... */
457 event = PLINK_UNDEFINED;
Jasper Bryant-Greenef698d852008-08-03 12:04:37 +1200458 if (ftype != PLINK_CLOSE && (!mesh_matches_local(&elems, sdata))) {
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100459 switch (ftype) {
460 case PLINK_OPEN:
461 event = OPN_RJCT;
462 break;
463 case PLINK_CONFIRM:
464 event = CNF_RJCT;
465 break;
466 case PLINK_CLOSE:
467 /* avoid warning */
468 break;
469 }
Johannes Berg07346f812008-05-03 01:02:02 +0200470 spin_lock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100471 } else if (!sta) {
472 /* ftype == PLINK_OPEN */
Johannes Berg881d9482009-01-21 15:13:48 +0100473 u32 rates;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100474 if (!mesh_plink_free_count(sdata)) {
475 mpl_dbg("Mesh plink error: no more free plinks\n");
Johannes Bergd0709a62008-02-25 16:27:46 +0100476 rcu_read_unlock();
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100477 return;
478 }
479
480 rates = ieee80211_sta_get_rates(local, &elems, rx_status->band);
Johannes Berg03e44972008-02-27 09:56:40 +0100481 sta = mesh_plink_alloc(sdata, mgmt->sa, rates);
Johannes Berg73651ee2008-02-25 16:27:47 +0100482 if (!sta) {
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100483 mpl_dbg("Mesh plink error: plink table full\n");
Johannes Bergd0709a62008-02-25 16:27:46 +0100484 rcu_read_unlock();
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100485 return;
486 }
Johannes Berg73651ee2008-02-25 16:27:47 +0100487 if (sta_info_insert(sta)) {
Johannes Berg73651ee2008-02-25 16:27:47 +0100488 rcu_read_unlock();
489 return;
490 }
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100491 event = OPN_ACPT;
Johannes Berg07346f812008-05-03 01:02:02 +0200492 spin_lock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100493 } else {
Johannes Berg07346f812008-05-03 01:02:02 +0200494 spin_lock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100495 switch (ftype) {
496 case PLINK_OPEN:
497 if (!mesh_plink_free_count(sdata) ||
Johannes Bergd0709a62008-02-25 16:27:46 +0100498 (sta->plid && sta->plid != plid))
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100499 event = OPN_IGNR;
500 else
501 event = OPN_ACPT;
502 break;
503 case PLINK_CONFIRM:
504 if (!mesh_plink_free_count(sdata) ||
Johannes Bergd0709a62008-02-25 16:27:46 +0100505 (sta->llid != llid || sta->plid != plid))
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100506 event = CNF_IGNR;
507 else
508 event = CNF_ACPT;
509 break;
510 case PLINK_CLOSE:
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800511 if (sta->plink_state == PLINK_ESTAB)
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100512 /* Do not check for llid or plid. This does not
513 * follow the standard but since multiple plinks
514 * per sta are not supported, it is necessary in
515 * order to avoid a livelock when MP A sees an
516 * establish peer link to MP B but MP B does not
517 * see it. This can be caused by a timeout in
518 * B's peer link establishment or B beign
519 * restarted.
520 */
521 event = CLS_ACPT;
522 else if (sta->plid != plid)
523 event = CLS_IGNR;
524 else if (ie_len == 7 && sta->llid != llid)
525 event = CLS_IGNR;
526 else
527 event = CLS_ACPT;
528 break;
529 default:
530 mpl_dbg("Mesh plink: unknown frame subtype\n");
Johannes Berg07346f812008-05-03 01:02:02 +0200531 spin_unlock_bh(&sta->lock);
Johannes Bergd0709a62008-02-25 16:27:46 +0100532 rcu_read_unlock();
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100533 return;
534 }
535 }
536
Johannes Berg0c68ae262008-10-27 15:56:10 -0700537 mpl_dbg("Mesh plink (peer, state, llid, plid, event): %pM %d %d %d %d\n",
538 mgmt->sa, sta->plink_state,
539 le16_to_cpu(sta->llid), le16_to_cpu(sta->plid),
540 event);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100541 reason = 0;
542 switch (sta->plink_state) {
543 /* spin_unlock as soon as state is updated at each case */
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800544 case PLINK_LISTEN:
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100545 switch (event) {
546 case CLS_ACPT:
547 mesh_plink_fsm_restart(sta);
Johannes Berg07346f812008-05-03 01:02:02 +0200548 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100549 break;
550 case OPN_ACPT:
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800551 sta->plink_state = PLINK_OPN_RCVD;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100552 sta->plid = plid;
553 get_random_bytes(&llid, 2);
554 sta->llid = llid;
555 mesh_plink_timer_set(sta, dot11MeshRetryTimeout(sdata));
Johannes Berg07346f812008-05-03 01:02:02 +0200556 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200557 mesh_plink_frame_tx(sdata, PLINK_OPEN, sta->sta.addr, llid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100558 0, 0);
Johannes Berg17741cd2008-09-11 00:02:02 +0200559 mesh_plink_frame_tx(sdata, PLINK_CONFIRM, sta->sta.addr,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100560 llid, plid, 0);
561 break;
562 default:
Johannes Berg07346f812008-05-03 01:02:02 +0200563 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100564 break;
565 }
566 break;
567
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800568 case PLINK_OPN_SNT:
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100569 switch (event) {
570 case OPN_RJCT:
571 case CNF_RJCT:
572 reason = cpu_to_le16(MESH_CAPABILITY_POLICY_VIOLATION);
573 case CLS_ACPT:
574 if (!reason)
575 reason = cpu_to_le16(MESH_CLOSE_RCVD);
576 sta->reason = reason;
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800577 sta->plink_state = PLINK_HOLDING;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100578 if (!mod_plink_timer(sta,
579 dot11MeshHoldingTimeout(sdata)))
580 sta->ignore_plink_timer = true;
581
582 llid = sta->llid;
Johannes Berg07346f812008-05-03 01:02:02 +0200583 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200584 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr, llid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100585 plid, reason);
586 break;
587 case OPN_ACPT:
588 /* retry timer is left untouched */
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800589 sta->plink_state = PLINK_OPN_RCVD;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100590 sta->plid = plid;
591 llid = sta->llid;
Johannes Berg07346f812008-05-03 01:02:02 +0200592 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200593 mesh_plink_frame_tx(sdata, PLINK_CONFIRM, sta->sta.addr, llid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100594 plid, 0);
595 break;
596 case CNF_ACPT:
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800597 sta->plink_state = PLINK_CNF_RCVD;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100598 if (!mod_plink_timer(sta,
599 dot11MeshConfirmTimeout(sdata)))
600 sta->ignore_plink_timer = true;
601
Johannes Berg07346f812008-05-03 01:02:02 +0200602 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100603 break;
604 default:
Johannes Berg07346f812008-05-03 01:02:02 +0200605 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100606 break;
607 }
608 break;
609
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800610 case PLINK_OPN_RCVD:
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100611 switch (event) {
612 case OPN_RJCT:
613 case CNF_RJCT:
614 reason = cpu_to_le16(MESH_CAPABILITY_POLICY_VIOLATION);
615 case CLS_ACPT:
616 if (!reason)
617 reason = cpu_to_le16(MESH_CLOSE_RCVD);
618 sta->reason = reason;
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800619 sta->plink_state = PLINK_HOLDING;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100620 if (!mod_plink_timer(sta,
621 dot11MeshHoldingTimeout(sdata)))
622 sta->ignore_plink_timer = true;
623
624 llid = sta->llid;
Johannes Berg07346f812008-05-03 01:02:02 +0200625 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200626 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr, llid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100627 plid, reason);
628 break;
629 case OPN_ACPT:
630 llid = sta->llid;
Johannes Berg07346f812008-05-03 01:02:02 +0200631 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200632 mesh_plink_frame_tx(sdata, PLINK_CONFIRM, sta->sta.addr, llid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100633 plid, 0);
634 break;
635 case CNF_ACPT:
Johannes Bergd0709a62008-02-25 16:27:46 +0100636 del_timer(&sta->plink_timer);
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800637 sta->plink_state = PLINK_ESTAB;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100638 mesh_plink_inc_estab_count(sdata);
Johannes Berg07346f812008-05-03 01:02:02 +0200639 spin_unlock_bh(&sta->lock);
Johannes Berg0c68ae262008-10-27 15:56:10 -0700640 mpl_dbg("Mesh plink with %pM ESTABLISHED\n",
641 sta->sta.addr);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100642 break;
643 default:
Johannes Berg07346f812008-05-03 01:02:02 +0200644 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100645 break;
646 }
647 break;
648
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800649 case PLINK_CNF_RCVD:
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100650 switch (event) {
651 case OPN_RJCT:
652 case CNF_RJCT:
653 reason = cpu_to_le16(MESH_CAPABILITY_POLICY_VIOLATION);
654 case CLS_ACPT:
655 if (!reason)
656 reason = cpu_to_le16(MESH_CLOSE_RCVD);
657 sta->reason = reason;
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800658 sta->plink_state = PLINK_HOLDING;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100659 if (!mod_plink_timer(sta,
660 dot11MeshHoldingTimeout(sdata)))
661 sta->ignore_plink_timer = true;
662
663 llid = sta->llid;
Johannes Berg07346f812008-05-03 01:02:02 +0200664 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200665 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr, llid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100666 plid, reason);
Johannes Bergff59dc72008-02-25 10:11:50 +0100667 break;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100668 case OPN_ACPT:
Johannes Bergd0709a62008-02-25 16:27:46 +0100669 del_timer(&sta->plink_timer);
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800670 sta->plink_state = PLINK_ESTAB;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100671 mesh_plink_inc_estab_count(sdata);
Johannes Berg07346f812008-05-03 01:02:02 +0200672 spin_unlock_bh(&sta->lock);
Johannes Berg0c68ae262008-10-27 15:56:10 -0700673 mpl_dbg("Mesh plink with %pM ESTABLISHED\n",
674 sta->sta.addr);
Johannes Berg17741cd2008-09-11 00:02:02 +0200675 mesh_plink_frame_tx(sdata, PLINK_CONFIRM, sta->sta.addr, llid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100676 plid, 0);
677 break;
678 default:
Johannes Berg07346f812008-05-03 01:02:02 +0200679 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100680 break;
681 }
682 break;
683
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800684 case PLINK_ESTAB:
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100685 switch (event) {
686 case CLS_ACPT:
687 reason = cpu_to_le16(MESH_CLOSE_RCVD);
688 sta->reason = reason;
Johannes Berg902acc72008-02-23 15:17:19 +0100689 __mesh_plink_deactivate(sta);
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800690 sta->plink_state = PLINK_HOLDING;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100691 llid = sta->llid;
Johannes Bergd0709a62008-02-25 16:27:46 +0100692 mod_plink_timer(sta, dot11MeshHoldingTimeout(sdata));
Johannes Berg07346f812008-05-03 01:02:02 +0200693 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200694 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr, llid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100695 plid, reason);
696 break;
697 case OPN_ACPT:
698 llid = sta->llid;
Johannes Berg07346f812008-05-03 01:02:02 +0200699 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200700 mesh_plink_frame_tx(sdata, PLINK_CONFIRM, sta->sta.addr, llid,
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100701 plid, 0);
702 break;
703 default:
Johannes Berg07346f812008-05-03 01:02:02 +0200704 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100705 break;
706 }
707 break;
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800708 case PLINK_HOLDING:
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100709 switch (event) {
710 case CLS_ACPT:
Johannes Bergd0709a62008-02-25 16:27:46 +0100711 if (del_timer(&sta->plink_timer))
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100712 sta->ignore_plink_timer = 1;
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100713 mesh_plink_fsm_restart(sta);
Johannes Berg07346f812008-05-03 01:02:02 +0200714 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100715 break;
716 case OPN_ACPT:
717 case CNF_ACPT:
718 case OPN_RJCT:
719 case CNF_RJCT:
720 llid = sta->llid;
721 reason = sta->reason;
Johannes Berg07346f812008-05-03 01:02:02 +0200722 spin_unlock_bh(&sta->lock);
Johannes Berg17741cd2008-09-11 00:02:02 +0200723 mesh_plink_frame_tx(sdata, PLINK_CLOSE, sta->sta.addr,
724 llid, plid, reason);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100725 break;
726 default:
Johannes Berg07346f812008-05-03 01:02:02 +0200727 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100728 }
729 break;
730 default:
Luis Carlos Cobob4e08ea2008-02-29 15:46:08 -0800731 /* should not get here, PLINK_BLOCKED is dealt with at the
732 * beggining of the function
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100733 */
Johannes Berg07346f812008-05-03 01:02:02 +0200734 spin_unlock_bh(&sta->lock);
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100735 break;
736 }
Johannes Bergd0709a62008-02-25 16:27:46 +0100737
738 rcu_read_unlock();
Luis Carlos Coboc3896d2c2008-02-23 15:17:13 +0100739}