]> bbs.cooldavid.org Git - net-next-2.6.git/blame - net/mac80211/cfg.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
net/mac80211: always true conditionals
[net-next-2.6.git] / net / mac80211 / cfg.c
CommitLineData
f0706e82
JB		 1/*
2 * mac80211 configuration hooks for cfg80211
3 *
62da92fb 4 * Copyright 2006, 2007 Johannes Berg <johannes@sipsolutions.net>
f0706e82
JB		 5 *
6 * This file is GPLv2 as found in COPYING.
7 */
8
e8cbb4cb 9#include <linux/ieee80211.h>
f0706e82
JB		 10#include <linux/nl80211.h>
11#include <linux/rtnetlink.h>
881d966b 12#include <net/net_namespace.h>
5dfdaf58 13#include <linux/rcupdate.h>
f0706e82
JB		 14#include <net/cfg80211.h>
15#include "ieee80211_i.h"
e0eb6859 16#include "cfg.h"
2c8dccc7 17#include "rate.h"
c5dd9c2b 18#include "mesh.h"
c5dd9c2b 19
42613db7
JB		 20static enum ieee80211_if_types
21nl80211_type_to_mac80211_type(enum nl80211_iftype type)
22{
23 switch (type) {
24 case NL80211_IFTYPE_UNSPECIFIED:
25 return IEEE80211_IF_TYPE_STA;
26 case NL80211_IFTYPE_ADHOC:
27 return IEEE80211_IF_TYPE_IBSS;
28 case NL80211_IFTYPE_STATION:
29 return IEEE80211_IF_TYPE_STA;
30 case NL80211_IFTYPE_MONITOR:
31 return IEEE80211_IF_TYPE_MNTR;
c5dd9c2b
LCC		 32#ifdef CONFIG_MAC80211_MESH
33 case NL80211_IFTYPE_MESH_POINT:
34 return IEEE80211_IF_TYPE_MESH_POINT;
35#endif
b454048c
JB		 36 case NL80211_IFTYPE_WDS:
37 return IEEE80211_IF_TYPE_WDS;
42613db7
JB		 38 default:
39 return IEEE80211_IF_TYPE_INVALID;
40 }
41}
42
f0706e82 43static int ieee80211_add_iface(struct wiphy *wiphy, char *name,
2ec600d6
LCC		 44 enum nl80211_iftype type, u32 *flags,
45 struct vif_params *params)
f0706e82
JB		 46{
47 struct ieee80211_local *local = wiphy_priv(wiphy);
42613db7 48 enum ieee80211_if_types itype;
8cc9a739
MW		 49 struct net_device *dev;
50 struct ieee80211_sub_if_data *sdata;
51 int err;
f0706e82
JB		 52
53 if (unlikely(local->reg_state != IEEE80211_DEV_REGISTERED))
54 return -ENODEV;
55
42613db7
JB		 56 itype = nl80211_type_to_mac80211_type(type);
57 if (itype == IEEE80211_IF_TYPE_INVALID)
f0706e82 58 return -EINVAL;
f0706e82 59
ee385855 60 err = ieee80211_if_add(local->mdev, name, &dev, itype, params);
8cc9a739
MW		 61 if (err || itype != IEEE80211_IF_TYPE_MNTR || !flags)
62 return err;
63
64 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
65 sdata->u.mntr_flags = *flags;
66 return 0;
f0706e82
JB		 67}
68
69static int ieee80211_del_iface(struct wiphy *wiphy, int ifindex)
70{
71 struct ieee80211_local *local = wiphy_priv(wiphy);
72 struct net_device *dev;
73 char *name;
74
75 if (unlikely(local->reg_state != IEEE80211_DEV_REGISTERED))
76 return -ENODEV;
77
42613db7
JB		 78 /* we're under RTNL */
79 dev = __dev_get_by_index(&init_net, ifindex);
f0706e82
JB		 80 if (!dev)
81 return 0;
82
83 name = dev->name;
f0706e82
JB		 84
85 return ieee80211_if_remove(local->mdev, name, -1);
86}
87
42613db7 88static int ieee80211_change_iface(struct wiphy *wiphy, int ifindex,
2ec600d6
LCC		 89 enum nl80211_iftype type, u32 *flags,
90 struct vif_params *params)
42613db7
JB		 91{
92 struct ieee80211_local *local = wiphy_priv(wiphy);
93 struct net_device *dev;
94 enum ieee80211_if_types itype;
95 struct ieee80211_sub_if_data *sdata;
96
97 if (unlikely(local->reg_state != IEEE80211_DEV_REGISTERED))
98 return -ENODEV;
99
100 /* we're under RTNL */
101 dev = __dev_get_by_index(&init_net, ifindex);
102 if (!dev)
103 return -ENODEV;
104
105 if (netif_running(dev))
106 return -EBUSY;
107
108 itype = nl80211_type_to_mac80211_type(type);
109 if (itype == IEEE80211_IF_TYPE_INVALID)
110 return -EINVAL;
111
112 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
113
51fb61e7 114 if (sdata->vif.type == IEEE80211_IF_TYPE_VLAN)
42613db7
JB		 115 return -EOPNOTSUPP;
116
117 ieee80211_if_reinit(dev);
118 ieee80211_if_set_type(dev, itype);
119
902acc78
JB		 120 if (ieee80211_vif_is_mesh(&sdata->vif) && params->mesh_id_len)
121 ieee80211_if_sta_set_mesh_id(&sdata->u.sta,
122 params->mesh_id_len,
123 params->mesh_id);
c5dd9c2b 124
8cc9a739
MW		 125 if (sdata->vif.type != IEEE80211_IF_TYPE_MNTR || !flags)
126 return 0;
127
128 sdata->u.mntr_flags = *flags;
42613db7
JB		 129 return 0;
130}
131
e8cbb4cb
JB		 132static int ieee80211_add_key(struct wiphy *wiphy, struct net_device *dev,
133 u8 key_idx, u8 *mac_addr,
134 struct key_params *params)
135{
136 struct ieee80211_sub_if_data *sdata;
137 struct sta_info *sta = NULL;
138 enum ieee80211_key_alg alg;
db4d1169 139 struct ieee80211_key *key;
3b96766f 140 int err;
e8cbb4cb
JB		 141
142 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
143
144 switch (params->cipher) {
145 case WLAN_CIPHER_SUITE_WEP40:
146 case WLAN_CIPHER_SUITE_WEP104:
147 alg = ALG_WEP;
148 break;
149 case WLAN_CIPHER_SUITE_TKIP:
150 alg = ALG_TKIP;
151 break;
152 case WLAN_CIPHER_SUITE_CCMP:
153 alg = ALG_CCMP;
154 break;
155 default:
156 return -EINVAL;
157 }
158
db4d1169
JB		 159 key = ieee80211_key_alloc(alg, key_idx, params->key_len, params->key);
160 if (!key)
161 return -ENOMEM;
162
3b96766f
JB		 163 rcu_read_lock();
164
e8cbb4cb
JB		 165 if (mac_addr) {
166 sta = sta_info_get(sdata->local, mac_addr);
db4d1169
JB		 167 if (!sta) {
168 ieee80211_key_free(key);
3b96766f
JB		 169 err = -ENOENT;
170 goto out_unlock;
db4d1169 171 }
e8cbb4cb
JB		 172 }
173
db4d1169
JB		 174 ieee80211_key_link(key, sdata, sta);
175
3b96766f
JB		 176 err = 0;
177 out_unlock:
178 rcu_read_unlock();
179
180 return err;
e8cbb4cb
JB		 181}
182
183static int ieee80211_del_key(struct wiphy *wiphy, struct net_device *dev,
184 u8 key_idx, u8 *mac_addr)
185{
186 struct ieee80211_sub_if_data *sdata;
187 struct sta_info *sta;
188 int ret;
189
190 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
191
3b96766f
JB		 192 rcu_read_lock();
193
e8cbb4cb 194 if (mac_addr) {
3b96766f
JB		 195 ret = -ENOENT;
196
e8cbb4cb
JB		 197 sta = sta_info_get(sdata->local, mac_addr);
198 if (!sta)
3b96766f 199 goto out_unlock;
e8cbb4cb 200
db4d1169 201 if (sta->key) {
d0709a65 202 ieee80211_key_free(sta->key);
db4d1169 203 WARN_ON(sta->key);
3b96766f
JB		 204 ret = 0;
205 }
e8cbb4cb 206
3b96766f 207 goto out_unlock;
e8cbb4cb
JB		 208 }
209
3b96766f
JB		 210 if (!sdata->keys[key_idx]) {
211 ret = -ENOENT;
212 goto out_unlock;
213 }
e8cbb4cb 214
d0709a65 215 ieee80211_key_free(sdata->keys[key_idx]);
db4d1169 216 WARN_ON(sdata->keys[key_idx]);
e8cbb4cb 217
3b96766f
JB		 218 ret = 0;
219 out_unlock:
220 rcu_read_unlock();
221
222 return ret;
e8cbb4cb
JB		 223}
224
62da92fb
JB		 225static int ieee80211_get_key(struct wiphy *wiphy, struct net_device *dev,
226 u8 key_idx, u8 *mac_addr, void *cookie,
227 void (*callback)(void *cookie,
228 struct key_params *params))
229{
230 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
231 struct sta_info *sta = NULL;
232 u8 seq[6] = {0};
233 struct key_params params;
234 struct ieee80211_key *key;
235 u32 iv32;
236 u16 iv16;
237 int err = -ENOENT;
238
3b96766f
JB		 239 rcu_read_lock();
240
62da92fb
JB		 241 if (mac_addr) {
242 sta = sta_info_get(sdata->local, mac_addr);
243 if (!sta)
244 goto out;
245
246 key = sta->key;
247 } else
248 key = sdata->keys[key_idx];
249
250 if (!key)
251 goto out;
252
253 memset(&params, 0, sizeof(params));
254
255 switch (key->conf.alg) {
256 case ALG_TKIP:
257 params.cipher = WLAN_CIPHER_SUITE_TKIP;
258
259 iv32 = key->u.tkip.iv32;
260 iv16 = key->u.tkip.iv16;
261
262 if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE &&
263 sdata->local->ops->get_tkip_seq)
264 sdata->local->ops->get_tkip_seq(
265 local_to_hw(sdata->local),
266 key->conf.hw_key_idx,
267 &iv32, &iv16);
268
269 seq[0] = iv16 & 0xff;
270 seq[1] = (iv16 >> 8) & 0xff;
271 seq[2] = iv32 & 0xff;
272 seq[3] = (iv32 >> 8) & 0xff;
273 seq[4] = (iv32 >> 16) & 0xff;
274 seq[5] = (iv32 >> 24) & 0xff;
275 params.seq = seq;
276 params.seq_len = 6;
277 break;
278 case ALG_CCMP:
279 params.cipher = WLAN_CIPHER_SUITE_CCMP;
280 seq[0] = key->u.ccmp.tx_pn[5];
281 seq[1] = key->u.ccmp.tx_pn[4];
282 seq[2] = key->u.ccmp.tx_pn[3];
283 seq[3] = key->u.ccmp.tx_pn[2];
284 seq[4] = key->u.ccmp.tx_pn[1];
285 seq[5] = key->u.ccmp.tx_pn[0];
286 params.seq = seq;
287 params.seq_len = 6;
288 break;
289 case ALG_WEP:
290 if (key->conf.keylen == 5)
291 params.cipher = WLAN_CIPHER_SUITE_WEP40;
292 else
293 params.cipher = WLAN_CIPHER_SUITE_WEP104;
294 break;
295 }
296
297 params.key = key->conf.key;
298 params.key_len = key->conf.keylen;
299
300 callback(cookie, &params);
301 err = 0;
302
303 out:
3b96766f 304 rcu_read_unlock();
62da92fb
JB		 305 return err;
306}
307
e8cbb4cb
JB		 308static int ieee80211_config_default_key(struct wiphy *wiphy,
309 struct net_device *dev,
310 u8 key_idx)
311{
312 struct ieee80211_sub_if_data *sdata;
313
3b96766f
JB		 314 rcu_read_lock();
315
e8cbb4cb
JB		 316 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
317 ieee80211_set_default_key(sdata, key_idx);
318
3b96766f
JB		 319 rcu_read_unlock();
320
e8cbb4cb
JB		 321 return 0;
322}
323
c5dd9c2b
LCC		 324static void sta_set_sinfo(struct sta_info *sta, struct station_info *sinfo)
325{
d0709a65 326 struct ieee80211_sub_if_data *sdata = sta->sdata;
c5dd9c2b
LCC		 327
328 sinfo->filled = STATION_INFO_INACTIVE_TIME |
329 STATION_INFO_RX_BYTES |
330 STATION_INFO_TX_BYTES;
331
332 sinfo->inactive_time = jiffies_to_msecs(jiffies - sta->last_rx);
333 sinfo->rx_bytes = sta->rx_bytes;
334 sinfo->tx_bytes = sta->tx_bytes;
335
902acc78 336 if (ieee80211_vif_is_mesh(&sdata->vif)) {
c5dd9c2b 337#ifdef CONFIG_MAC80211_MESH
c5dd9c2b
LCC		 338 sinfo->filled |= STATION_INFO_LLID |
339 STATION_INFO_PLID |
340 STATION_INFO_PLINK_STATE;
341
342 sinfo->llid = le16_to_cpu(sta->llid);
343 sinfo->plid = le16_to_cpu(sta->plid);
344 sinfo->plink_state = sta->plink_state;
c5dd9c2b 345#endif
902acc78 346 }
c5dd9c2b
LCC		 347}
348
349
350static int ieee80211_dump_station(struct wiphy *wiphy, struct net_device *dev,
351 int idx, u8 *mac, struct station_info *sinfo)
352{
353 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
354 struct sta_info *sta;
d0709a65
JB		 355 int ret = -ENOENT;
356
357 rcu_read_lock();
c5dd9c2b
LCC		 358
359 sta = sta_info_get_by_idx(local, idx, dev);
d0709a65
JB		 360 if (sta) {
361 ret = 0;
362 memcpy(mac, sta->addr, ETH_ALEN);
363 sta_set_sinfo(sta, sinfo);
364 }
c5dd9c2b 365
d0709a65 366 rcu_read_unlock();
c5dd9c2b 367
d0709a65 368 return ret;
c5dd9c2b
LCC		 369}
370
7bbdd2d9 371static int ieee80211_get_station(struct wiphy *wiphy, struct net_device *dev,
2ec600d6 372 u8 *mac, struct station_info *sinfo)
7bbdd2d9
JB		 373{
374 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
375 struct sta_info *sta;
d0709a65 376 int ret = -ENOENT;
7bbdd2d9 377
d0709a65 378 rcu_read_lock();
7bbdd2d9
JB		 379
380 /* XXX: verify sta->dev == dev */
7bbdd2d9 381
d0709a65
JB		 382 sta = sta_info_get(local, mac);
383 if (sta) {
384 ret = 0;
385 sta_set_sinfo(sta, sinfo);
386 }
387
388 rcu_read_unlock();
389
390 return ret;
7bbdd2d9
JB		 391}
392
5dfdaf58
JB		 393/*
394 * This handles both adding a beacon and setting new beacon info
395 */
396static int ieee80211_config_beacon(struct ieee80211_sub_if_data *sdata,
397 struct beacon_parameters *params)
398{
399 struct beacon_data *new, *old;
400 int new_head_len, new_tail_len;
401 int size;
402 int err = -EINVAL;
403
404 old = sdata->u.ap.beacon;
405
406 /* head must not be zero-length */
407 if (params->head && !params->head_len)
408 return -EINVAL;
409
410 /*
411 * This is a kludge. beacon interval should really be part
412 * of the beacon information.
413 */
414 if (params->interval) {
415 sdata->local->hw.conf.beacon_int = params->interval;
416 if (ieee80211_hw_config(sdata->local))
417 return -EINVAL;
418 /*
419 * We updated some parameter so if below bails out
420 * it's not an error.
421 */
422 err = 0;
423 }
424
425 /* Need to have a beacon head if we don't have one yet */
426 if (!params->head && !old)
427 return err;
428
429 /* sorry, no way to start beaconing without dtim period */
430 if (!params->dtim_period && !old)
431 return err;
432
433 /* new or old head? */
434 if (params->head)
435 new_head_len = params->head_len;
436 else
437 new_head_len = old->head_len;
438
439 /* new or old tail? */
440 if (params->tail || !old)
441 /* params->tail_len will be zero for !params->tail */
442 new_tail_len = params->tail_len;
443 else
444 new_tail_len = old->tail_len;
445
446 size = sizeof(*new) + new_head_len + new_tail_len;
447
448 new = kzalloc(size, GFP_KERNEL);
449 if (!new)
450 return -ENOMEM;
451
452 /* start filling the new info now */
453
454 /* new or old dtim period? */
455 if (params->dtim_period)
456 new->dtim_period = params->dtim_period;
457 else
458 new->dtim_period = old->dtim_period;
459
460 /*
461 * pointers go into the block we allocated,
462 * memory is | beacon_data | head | tail |
463 */
464 new->head = ((u8 *) new) + sizeof(*new);
465 new->tail = new->head + new_head_len;
466 new->head_len = new_head_len;
467 new->tail_len = new_tail_len;
468
469 /* copy in head */
470 if (params->head)
471 memcpy(new->head, params->head, new_head_len);
472 else
473 memcpy(new->head, old->head, new_head_len);
474
475 /* copy in optional tail */
476 if (params->tail)
477 memcpy(new->tail, params->tail, new_tail_len);
478 else
479 if (old)
480 memcpy(new->tail, old->tail, new_tail_len);
481
482 rcu_assign_pointer(sdata->u.ap.beacon, new);
483
484 synchronize_rcu();
485
486 kfree(old);
487
488 return ieee80211_if_config_beacon(sdata->dev);
489}
490
491static int ieee80211_add_beacon(struct wiphy *wiphy, struct net_device *dev,
492 struct beacon_parameters *params)
493{
494 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
495 struct beacon_data *old;
496
497 if (sdata->vif.type != IEEE80211_IF_TYPE_AP)
498 return -EINVAL;
499
500 old = sdata->u.ap.beacon;
501
502 if (old)
503 return -EALREADY;
504
505 return ieee80211_config_beacon(sdata, params);
506}
507
508static int ieee80211_set_beacon(struct wiphy *wiphy, struct net_device *dev,
509 struct beacon_parameters *params)
510{
511 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
512 struct beacon_data *old;
513
514 if (sdata->vif.type != IEEE80211_IF_TYPE_AP)
515 return -EINVAL;
516
517 old = sdata->u.ap.beacon;
518
519 if (!old)
520 return -ENOENT;
521
522 return ieee80211_config_beacon(sdata, params);
523}
524
525static int ieee80211_del_beacon(struct wiphy *wiphy, struct net_device *dev)
526{
527 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
528 struct beacon_data *old;
529
530 if (sdata->vif.type != IEEE80211_IF_TYPE_AP)
531 return -EINVAL;
532
533 old = sdata->u.ap.beacon;
534
535 if (!old)
536 return -ENOENT;
537
538 rcu_assign_pointer(sdata->u.ap.beacon, NULL);
539 synchronize_rcu();
540 kfree(old);
541
542 return ieee80211_if_config_beacon(dev);
543}
544
4fd6931e
JB		 545/* Layer 2 Update frame (802.2 Type 1 LLC XID Update response) */
546struct iapp_layer2_update {
547 u8 da[ETH_ALEN]; /* broadcast */
548 u8 sa[ETH_ALEN]; /* STA addr */
549 __be16 len; /* 6 */
550 u8 dsap; /* 0 */
551 u8 ssap; /* 0 */
552 u8 control;
553 u8 xid_info[3];
554} __attribute__ ((packed));
555
556static void ieee80211_send_layer2_update(struct sta_info *sta)
557{
558 struct iapp_layer2_update *msg;
559 struct sk_buff *skb;
560
561 /* Send Level 2 Update Frame to update forwarding tables in layer 2
562 * bridge devices */
563
564 skb = dev_alloc_skb(sizeof(*msg));
565 if (!skb)
566 return;
567 msg = (struct iapp_layer2_update *)skb_put(skb, sizeof(*msg));
568
569 /* 802.2 Type 1 Logical Link Control (LLC) Exchange Identifier (XID)
570 * Update response frame; IEEE Std 802.2-1998, 5.4.1.2.1 */
571
572 memset(msg->da, 0xff, ETH_ALEN);
573 memcpy(msg->sa, sta->addr, ETH_ALEN);
574 msg->len = htons(6);
575 msg->dsap = 0;
576 msg->ssap = 0x01; /* NULL LSAP, CR Bit: Response */
577 msg->control = 0xaf; /* XID response lsb.1111F101.
578 * F=0 (no poll command; unsolicited frame) */
579 msg->xid_info[0] = 0x81; /* XID format identifier */
580 msg->xid_info[1] = 1; /* LLC types/classes: Type 1 LLC */
581 msg->xid_info[2] = 0; /* XID sender's receive window size (RW) */
582
d0709a65
JB		 583 skb->dev = sta->sdata->dev;
584 skb->protocol = eth_type_trans(skb, sta->sdata->dev);
4fd6931e
JB		 585 memset(skb->cb, 0, sizeof(skb->cb));
586 netif_rx(skb);
587}
588
589static void sta_apply_parameters(struct ieee80211_local *local,
590 struct sta_info *sta,
591 struct station_parameters *params)
592{
593 u32 rates;
594 int i, j;
8318d78a 595 struct ieee80211_supported_band *sband;
d0709a65 596 struct ieee80211_sub_if_data *sdata = sta->sdata;
4fd6931e 597
73651ee6
JB		 598 /*
599 * FIXME: updating the flags is racy when this function is
600 * called from ieee80211_change_station(), this will
601 * be resolved in a future patch.
602 */
603
4fd6931e
JB		 604 if (params->station_flags & STATION_FLAG_CHANGED) {
605 sta->flags &= ~WLAN_STA_AUTHORIZED;
606 if (params->station_flags & STATION_FLAG_AUTHORIZED)
607 sta->flags |= WLAN_STA_AUTHORIZED;
608
609 sta->flags &= ~WLAN_STA_SHORT_PREAMBLE;
610 if (params->station_flags & STATION_FLAG_SHORT_PREAMBLE)
611 sta->flags |= WLAN_STA_SHORT_PREAMBLE;
612
613 sta->flags &= ~WLAN_STA_WME;
614 if (params->station_flags & STATION_FLAG_WME)
615 sta->flags |= WLAN_STA_WME;
616 }
617
73651ee6
JB		 618 /*
619 * FIXME: updating the following information is racy when this
620 * function is called from ieee80211_change_station().
621 * However, all this information should be static so
622 * maybe we should just reject attemps to change it.
623 */
624
4fd6931e
JB		 625 if (params->aid) {
626 sta->aid = params->aid;
627 if (sta->aid > IEEE80211_MAX_AID)
628 sta->aid = 0; /* XXX: should this be an error? */
629 }
630
631 if (params->listen_interval >= 0)
632 sta->listen_interval = params->listen_interval;
633
634 if (params->supported_rates) {
635 rates = 0;
8318d78a
JB		 636 sband = local->hw.wiphy->bands[local->oper_channel->band];
637
4fd6931e
JB		 638 for (i = 0; i < params->supported_rates_len; i++) {
639 int rate = (params->supported_rates[i] & 0x7f) * 5;
8318d78a
JB		 640 for (j = 0; j < sband->n_bitrates; j++) {
641 if (sband->bitrates[j].bitrate == rate)
4fd6931e
JB		 642 rates |= BIT(j);
643 }
644 }
8318d78a 645 sta->supp_rates[local->oper_channel->band] = rates;
4fd6931e 646 }
c5dd9c2b 647
902acc78 648 if (ieee80211_vif_is_mesh(&sdata->vif) && params->plink_action) {
c5dd9c2b
LCC		 649 switch (params->plink_action) {
650 case PLINK_ACTION_OPEN:
651 mesh_plink_open(sta);
652 break;
653 case PLINK_ACTION_BLOCK:
654 mesh_plink_block(sta);
655 break;
656 }
902acc78 657 }
4fd6931e
JB		 658}
659
660static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
661 u8 *mac, struct station_parameters *params)
662{
663 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
664 struct sta_info *sta;
665 struct ieee80211_sub_if_data *sdata;
73651ee6 666 int err;
4fd6931e
JB		 667
668 /* Prevent a race with changing the rate control algorithm */
669 if (!netif_running(dev))
670 return -ENETDOWN;
671
4fd6931e
JB		 672 if (params->vlan) {
673 sdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
674
679fda1a 675 if (sdata->vif.type != IEEE80211_IF_TYPE_VLAN &&
4fd6931e
JB		 676 sdata->vif.type != IEEE80211_IF_TYPE_AP)
677 return -EINVAL;
678 } else
679 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
680
03e4497e
JB		 681 if (compare_ether_addr(mac, dev->dev_addr) == 0)
682 return -EINVAL;
683
684 if (is_multicast_ether_addr(mac))
685 return -EINVAL;
686
687 sta = sta_info_alloc(sdata, mac, GFP_KERNEL);
73651ee6
JB		 688 if (!sta)
689 return -ENOMEM;
4fd6931e
JB		 690
691 sta->flags = WLAN_STA_AUTH | WLAN_STA_ASSOC;
692
693 sta_apply_parameters(local, sta, params);
694
695 rate_control_rate_init(sta, local);
696
73651ee6
JB		 697 rcu_read_lock();
698
699 err = sta_info_insert(sta);
700 if (err) {
93e5deb1 701 /* STA has been freed */
73651ee6
JB		 702 rcu_read_unlock();
703 return err;
704 }
705
706 if (sdata->vif.type == IEEE80211_IF_TYPE_VLAN ||
707 sdata->vif.type == IEEE80211_IF_TYPE_AP)
708 ieee80211_send_layer2_update(sta);
709
710 rcu_read_unlock();
711
4fd6931e
JB		 712 return 0;
713}
714
715static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev,
716 u8 *mac)
717{
d0709a65
JB		 718 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
719 struct ieee80211_local *local = sdata->local;
4fd6931e
JB		 720 struct sta_info *sta;
721
722 if (mac) {
98dd6a57
JB		 723 rcu_read_lock();
724
4fd6931e
JB		 725 /* XXX: get sta belonging to dev */
726 sta = sta_info_get(local, mac);
98dd6a57
JB		 727 if (!sta) {
728 rcu_read_unlock();
4fd6931e 729 return -ENOENT;
98dd6a57 730 }
4fd6931e 731
d0709a65 732 sta_info_unlink(&sta);
98dd6a57
JB		 733 rcu_read_unlock();
734
4f6fab47 735 sta_info_destroy(sta);
4fd6931e 736 } else
d0709a65 737 sta_info_flush(local, sdata);
4fd6931e
JB		 738
739 return 0;
740}
741
742static int ieee80211_change_station(struct wiphy *wiphy,
743 struct net_device *dev,
744 u8 *mac,
745 struct station_parameters *params)
746{
747 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
748 struct sta_info *sta;
749 struct ieee80211_sub_if_data *vlansdata;
750
98dd6a57
JB		 751 rcu_read_lock();
752
4fd6931e
JB		 753 /* XXX: get sta belonging to dev */
754 sta = sta_info_get(local, mac);
98dd6a57
JB		 755 if (!sta) {
756 rcu_read_unlock();
4fd6931e 757 return -ENOENT;
98dd6a57 758 }
4fd6931e 759
d0709a65 760 if (params->vlan && params->vlan != sta->sdata->dev) {
4fd6931e
JB		 761 vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
762
679fda1a 763 if (vlansdata->vif.type != IEEE80211_IF_TYPE_VLAN &&
98dd6a57
JB		 764 vlansdata->vif.type != IEEE80211_IF_TYPE_AP) {
765 rcu_read_unlock();
4fd6931e 766 return -EINVAL;
98dd6a57 767 }
4fd6931e 768
d0709a65 769 sta->sdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
4fd6931e
JB		 770 ieee80211_send_layer2_update(sta);
771 }
772
773 sta_apply_parameters(local, sta, params);
774
98dd6a57
JB		 775 rcu_read_unlock();
776
4fd6931e
JB		 777 return 0;
778}
779
c5dd9c2b
LCC		 780#ifdef CONFIG_MAC80211_MESH
781static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
782 u8 *dst, u8 *next_hop)
783{
784 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
785 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
786 struct mesh_path *mpath;
787 struct sta_info *sta;
788 int err;
789
790 if (!netif_running(dev))
791 return -ENETDOWN;
792
793 if (sdata->vif.type != IEEE80211_IF_TYPE_MESH_POINT)
794 return -ENOTSUPP;
795
d0709a65 796 rcu_read_lock();
c5dd9c2b 797 sta = sta_info_get(local, next_hop);
d0709a65
JB		 798 if (!sta) {
799 rcu_read_unlock();
c5dd9c2b 800 return -ENOENT;
d0709a65 801 }
c5dd9c2b
LCC		 802
803 err = mesh_path_add(dst, dev);
d0709a65
JB		 804 if (err) {
805 rcu_read_unlock();
c5dd9c2b 806 return err;
d0709a65 807 }
c5dd9c2b 808
c5dd9c2b
LCC		 809 mpath = mesh_path_lookup(dst, dev);
810 if (!mpath) {
811 rcu_read_unlock();
c5dd9c2b
LCC		 812 return -ENXIO;
813 }
814 mesh_path_fix_nexthop(mpath, sta);
d0709a65 815
c5dd9c2b
LCC		 816 rcu_read_unlock();
817 return 0;
818}
819
820static int ieee80211_del_mpath(struct wiphy *wiphy, struct net_device *dev,
821 u8 *dst)
822{
823 if (dst)
cfa22c71 824 return mesh_path_del(dst, dev);
c5dd9c2b
LCC		 825
826 mesh_path_flush(dev);
827 return 0;
828}
829
830static int ieee80211_change_mpath(struct wiphy *wiphy,
831 struct net_device *dev,
832 u8 *dst, u8 *next_hop)
833{
834 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
835 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
836 struct mesh_path *mpath;
837 struct sta_info *sta;
838
839 if (!netif_running(dev))
840 return -ENETDOWN;
841
842 if (sdata->vif.type != IEEE80211_IF_TYPE_MESH_POINT)
843 return -ENOTSUPP;
844
d0709a65
JB		 845 rcu_read_lock();
846
c5dd9c2b 847 sta = sta_info_get(local, next_hop);
d0709a65
JB		 848 if (!sta) {
849 rcu_read_unlock();
c5dd9c2b 850 return -ENOENT;
d0709a65 851 }
c5dd9c2b 852
c5dd9c2b
LCC		 853 mpath = mesh_path_lookup(dst, dev);
854 if (!mpath) {
855 rcu_read_unlock();
c5dd9c2b
LCC		 856 return -ENOENT;
857 }
858
859 mesh_path_fix_nexthop(mpath, sta);
d0709a65 860
c5dd9c2b
LCC		 861 rcu_read_unlock();
862 return 0;
863}
864
865static void mpath_set_pinfo(struct mesh_path *mpath, u8 *next_hop,
866 struct mpath_info *pinfo)
867{
868 if (mpath->next_hop)
869 memcpy(next_hop, mpath->next_hop->addr, ETH_ALEN);
870 else
871 memset(next_hop, 0, ETH_ALEN);
872
873 pinfo->filled = MPATH_INFO_FRAME_QLEN |
874 MPATH_INFO_DSN |
875 MPATH_INFO_METRIC |
876 MPATH_INFO_EXPTIME |
877 MPATH_INFO_DISCOVERY_TIMEOUT |
878 MPATH_INFO_DISCOVERY_RETRIES |
879 MPATH_INFO_FLAGS;
880
881 pinfo->frame_qlen = mpath->frame_queue.qlen;
882 pinfo->dsn = mpath->dsn;
883 pinfo->metric = mpath->metric;
884 if (time_before(jiffies, mpath->exp_time))
885 pinfo->exptime = jiffies_to_msecs(mpath->exp_time - jiffies);
886 pinfo->discovery_timeout =
887 jiffies_to_msecs(mpath->discovery_timeout);
888 pinfo->discovery_retries = mpath->discovery_retries;
889 pinfo->flags = 0;
890 if (mpath->flags & MESH_PATH_ACTIVE)
891 pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE;
892 if (mpath->flags & MESH_PATH_RESOLVING)
893 pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
894 if (mpath->flags & MESH_PATH_DSN_VALID)
895 pinfo->flags |= NL80211_MPATH_FLAG_DSN_VALID;
896 if (mpath->flags & MESH_PATH_FIXED)
897 pinfo->flags |= NL80211_MPATH_FLAG_FIXED;
898 if (mpath->flags & MESH_PATH_RESOLVING)
899 pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
900
901 pinfo->flags = mpath->flags;
902}
903
904static int ieee80211_get_mpath(struct wiphy *wiphy, struct net_device *dev,
905 u8 *dst, u8 *next_hop, struct mpath_info *pinfo)
906
907{
908 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
909 struct mesh_path *mpath;
910
911 if (sdata->vif.type != IEEE80211_IF_TYPE_MESH_POINT)
912 return -ENOTSUPP;
913
914 rcu_read_lock();
915 mpath = mesh_path_lookup(dst, dev);
916 if (!mpath) {
917 rcu_read_unlock();
918 return -ENOENT;
919 }
920 memcpy(dst, mpath->dst, ETH_ALEN);
921 mpath_set_pinfo(mpath, next_hop, pinfo);
922 rcu_read_unlock();
923 return 0;
924}
925
926static int ieee80211_dump_mpath(struct wiphy *wiphy, struct net_device *dev,
927 int idx, u8 *dst, u8 *next_hop,
928 struct mpath_info *pinfo)
929{
930 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
931 struct mesh_path *mpath;
932
933 if (sdata->vif.type != IEEE80211_IF_TYPE_MESH_POINT)
934 return -ENOTSUPP;
935
936 rcu_read_lock();
937 mpath = mesh_path_lookup_by_idx(idx, dev);
938 if (!mpath) {
939 rcu_read_unlock();
940 return -ENOENT;
941 }
942 memcpy(dst, mpath->dst, ETH_ALEN);
943 mpath_set_pinfo(mpath, next_hop, pinfo);
944 rcu_read_unlock();
945 return 0;
946}
947#endif
948
f0706e82
JB		 949struct cfg80211_ops mac80211_config_ops = {
950 .add_virtual_intf = ieee80211_add_iface,
951 .del_virtual_intf = ieee80211_del_iface,
42613db7 952 .change_virtual_intf = ieee80211_change_iface,
e8cbb4cb
JB		 953 .add_key = ieee80211_add_key,
954 .del_key = ieee80211_del_key,
62da92fb 955 .get_key = ieee80211_get_key,
e8cbb4cb 956 .set_default_key = ieee80211_config_default_key,
5dfdaf58
JB		 957 .add_beacon = ieee80211_add_beacon,
958 .set_beacon = ieee80211_set_beacon,
959 .del_beacon = ieee80211_del_beacon,
4fd6931e
JB		 960 .add_station = ieee80211_add_station,
961 .del_station = ieee80211_del_station,
962 .change_station = ieee80211_change_station,
7bbdd2d9 963 .get_station = ieee80211_get_station,
c5dd9c2b
LCC		 964 .dump_station = ieee80211_dump_station,
965#ifdef CONFIG_MAC80211_MESH
966 .add_mpath = ieee80211_add_mpath,
967 .del_mpath = ieee80211_del_mpath,
968 .change_mpath = ieee80211_change_mpath,
969 .get_mpath = ieee80211_get_mpath,
970 .dump_mpath = ieee80211_dump_mpath,
971#endif
f0706e82 972};
Clone of davem's net-next-2.6 tree