projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
mac80211: add a struct to hold tkip context
[GitHub/mt8127/android_kernel_alcatel_ttab.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
b0f76b33
HH		 259 iv32 = key->u.tkip.tx.iv32;
260 iv16 = key->u.tkip.tx.iv16;
62da92fb
JB		 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 604 if (params->station_flags & STATION_FLAG_CHANGED) {
07346f81 605 spin_lock_bh(&sta->lock);
4fd6931e
JB		 606 sta->flags &= ~WLAN_STA_AUTHORIZED;
607 if (params->station_flags & STATION_FLAG_AUTHORIZED)
608 sta->flags |= WLAN_STA_AUTHORIZED;
609
610 sta->flags &= ~WLAN_STA_SHORT_PREAMBLE;
611 if (params->station_flags & STATION_FLAG_SHORT_PREAMBLE)
612 sta->flags |= WLAN_STA_SHORT_PREAMBLE;
613
614 sta->flags &= ~WLAN_STA_WME;
615 if (params->station_flags & STATION_FLAG_WME)
616 sta->flags |= WLAN_STA_WME;
07346f81 617 spin_unlock_bh(&sta->lock);
4fd6931e
JB		 618 }
619
73651ee6
JB		 620 /*
621 * FIXME: updating the following information is racy when this
622 * function is called from ieee80211_change_station().
623 * However, all this information should be static so
624 * maybe we should just reject attemps to change it.
625 */
626
4fd6931e
JB		 627 if (params->aid) {
628 sta->aid = params->aid;
629 if (sta->aid > IEEE80211_MAX_AID)
630 sta->aid = 0; /* XXX: should this be an error? */
631 }
632
633 if (params->listen_interval >= 0)
634 sta->listen_interval = params->listen_interval;
635
636 if (params->supported_rates) {
637 rates = 0;
8318d78a
JB		 638 sband = local->hw.wiphy->bands[local->oper_channel->band];
639
4fd6931e
JB		 640 for (i = 0; i < params->supported_rates_len; i++) {
641 int rate = (params->supported_rates[i] & 0x7f) * 5;
8318d78a
JB		 642 for (j = 0; j < sband->n_bitrates; j++) {
643 if (sband->bitrates[j].bitrate == rate)
4fd6931e
JB		 644 rates |= BIT(j);
645 }
646 }
8318d78a 647 sta->supp_rates[local->oper_channel->band] = rates;
4fd6931e 648 }
c5dd9c2b 649
902acc78 650 if (ieee80211_vif_is_mesh(&sdata->vif) && params->plink_action) {
c5dd9c2b
LCC		 651 switch (params->plink_action) {
652 case PLINK_ACTION_OPEN:
653 mesh_plink_open(sta);
654 break;
655 case PLINK_ACTION_BLOCK:
656 mesh_plink_block(sta);
657 break;
658 }
902acc78 659 }
4fd6931e
JB		 660}
661
662static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
663 u8 *mac, struct station_parameters *params)
664{
665 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
666 struct sta_info *sta;
667 struct ieee80211_sub_if_data *sdata;
73651ee6 668 int err;
4fd6931e
JB		 669
670 /* Prevent a race with changing the rate control algorithm */
671 if (!netif_running(dev))
672 return -ENETDOWN;
673
4fd6931e
JB		 674 if (params->vlan) {
675 sdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
676
677 if (sdata->vif.type != IEEE80211_IF_TYPE_VLAN ||
678 sdata->vif.type != IEEE80211_IF_TYPE_AP)
679 return -EINVAL;
680 } else
681 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
682
03e4497e
JB		 683 if (compare_ether_addr(mac, dev->dev_addr) == 0)
684 return -EINVAL;
685
686 if (is_multicast_ether_addr(mac))
687 return -EINVAL;
688
689 sta = sta_info_alloc(sdata, mac, GFP_KERNEL);
73651ee6
JB		 690 if (!sta)
691 return -ENOMEM;
4fd6931e
JB		 692
693 sta->flags = WLAN_STA_AUTH | WLAN_STA_ASSOC;
694
695 sta_apply_parameters(local, sta, params);
696
697 rate_control_rate_init(sta, local);
698
73651ee6
JB		 699 rcu_read_lock();
700
701 err = sta_info_insert(sta);
702 if (err) {
93e5deb1 703 /* STA has been freed */
73651ee6
JB		 704 rcu_read_unlock();
705 return err;
706 }
707
708 if (sdata->vif.type == IEEE80211_IF_TYPE_VLAN ||
709 sdata->vif.type == IEEE80211_IF_TYPE_AP)
710 ieee80211_send_layer2_update(sta);
711
712 rcu_read_unlock();
713
4fd6931e
JB		 714 return 0;
715}
716
717static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev,
718 u8 *mac)
719{
d0709a65
JB		 720 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
721 struct ieee80211_local *local = sdata->local;
4fd6931e
JB		 722 struct sta_info *sta;
723
724 if (mac) {
98dd6a57
JB		 725 rcu_read_lock();
726
4fd6931e
JB		 727 /* XXX: get sta belonging to dev */
728 sta = sta_info_get(local, mac);
98dd6a57
JB		 729 if (!sta) {
730 rcu_read_unlock();
4fd6931e 731 return -ENOENT;
98dd6a57 732 }
4fd6931e 733
d0709a65 734 sta_info_unlink(&sta);
98dd6a57
JB		 735 rcu_read_unlock();
736
4f6fab47 737 sta_info_destroy(sta);
4fd6931e 738 } else
d0709a65 739 sta_info_flush(local, sdata);
4fd6931e
JB		 740
741 return 0;
742}
743
744static int ieee80211_change_station(struct wiphy *wiphy,
745 struct net_device *dev,
746 u8 *mac,
747 struct station_parameters *params)
748{
749 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
750 struct sta_info *sta;
751 struct ieee80211_sub_if_data *vlansdata;
752
98dd6a57
JB		 753 rcu_read_lock();
754
4fd6931e
JB		 755 /* XXX: get sta belonging to dev */
756 sta = sta_info_get(local, mac);
98dd6a57
JB		 757 if (!sta) {
758 rcu_read_unlock();
4fd6931e 759 return -ENOENT;
98dd6a57 760 }
4fd6931e 761
d0709a65 762 if (params->vlan && params->vlan != sta->sdata->dev) {
4fd6931e
JB		 763 vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
764
765 if (vlansdata->vif.type != IEEE80211_IF_TYPE_VLAN ||
98dd6a57
JB		 766 vlansdata->vif.type != IEEE80211_IF_TYPE_AP) {
767 rcu_read_unlock();
4fd6931e 768 return -EINVAL;
98dd6a57 769 }
4fd6931e 770
d0709a65 771 sta->sdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
4fd6931e
JB		 772 ieee80211_send_layer2_update(sta);
773 }
774
775 sta_apply_parameters(local, sta, params);
776
98dd6a57
JB		 777 rcu_read_unlock();
778
4fd6931e
JB		 779 return 0;
780}
781
c5dd9c2b
LCC		 782#ifdef CONFIG_MAC80211_MESH
783static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
784 u8 *dst, u8 *next_hop)
785{
786 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
787 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
788 struct mesh_path *mpath;
789 struct sta_info *sta;
790 int err;
791
792 if (!netif_running(dev))
793 return -ENETDOWN;
794
795 if (sdata->vif.type != IEEE80211_IF_TYPE_MESH_POINT)
796 return -ENOTSUPP;
797
d0709a65 798 rcu_read_lock();
c5dd9c2b 799 sta = sta_info_get(local, next_hop);
d0709a65
JB		 800 if (!sta) {
801 rcu_read_unlock();
c5dd9c2b 802 return -ENOENT;
d0709a65 803 }
c5dd9c2b
LCC		 804
805 err = mesh_path_add(dst, dev);
d0709a65
JB		 806 if (err) {
807 rcu_read_unlock();
c5dd9c2b 808 return err;
d0709a65 809 }
c5dd9c2b 810
c5dd9c2b
LCC		 811 mpath = mesh_path_lookup(dst, dev);
812 if (!mpath) {
813 rcu_read_unlock();
c5dd9c2b
LCC		 814 return -ENXIO;
815 }
816 mesh_path_fix_nexthop(mpath, sta);
d0709a65 817
c5dd9c2b
LCC		 818 rcu_read_unlock();
819 return 0;
820}
821
822static int ieee80211_del_mpath(struct wiphy *wiphy, struct net_device *dev,
823 u8 *dst)
824{
825 if (dst)
cfa22c71 826 return mesh_path_del(dst, dev);
c5dd9c2b
LCC		 827
828 mesh_path_flush(dev);
829 return 0;
830}
831
832static int ieee80211_change_mpath(struct wiphy *wiphy,
833 struct net_device *dev,
834 u8 *dst, u8 *next_hop)
835{
836 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
837 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
838 struct mesh_path *mpath;
839 struct sta_info *sta;
840
841 if (!netif_running(dev))
842 return -ENETDOWN;
843
844 if (sdata->vif.type != IEEE80211_IF_TYPE_MESH_POINT)
845 return -ENOTSUPP;
846
d0709a65
JB		 847 rcu_read_lock();
848
c5dd9c2b 849 sta = sta_info_get(local, next_hop);
d0709a65
JB		 850 if (!sta) {
851 rcu_read_unlock();
c5dd9c2b 852 return -ENOENT;
d0709a65 853 }
c5dd9c2b 854
c5dd9c2b
LCC		 855 mpath = mesh_path_lookup(dst, dev);
856 if (!mpath) {
857 rcu_read_unlock();
c5dd9c2b
LCC		 858 return -ENOENT;
859 }
860
861 mesh_path_fix_nexthop(mpath, sta);
d0709a65 862
c5dd9c2b
LCC		 863 rcu_read_unlock();
864 return 0;
865}
866
867static void mpath_set_pinfo(struct mesh_path *mpath, u8 *next_hop,
868 struct mpath_info *pinfo)
869{
870 if (mpath->next_hop)
871 memcpy(next_hop, mpath->next_hop->addr, ETH_ALEN);
872 else
873 memset(next_hop, 0, ETH_ALEN);
874
875 pinfo->filled = MPATH_INFO_FRAME_QLEN |
876 MPATH_INFO_DSN |
877 MPATH_INFO_METRIC |
878 MPATH_INFO_EXPTIME |
879 MPATH_INFO_DISCOVERY_TIMEOUT |
880 MPATH_INFO_DISCOVERY_RETRIES |
881 MPATH_INFO_FLAGS;
882
883 pinfo->frame_qlen = mpath->frame_queue.qlen;
884 pinfo->dsn = mpath->dsn;
885 pinfo->metric = mpath->metric;
886 if (time_before(jiffies, mpath->exp_time))
887 pinfo->exptime = jiffies_to_msecs(mpath->exp_time - jiffies);
888 pinfo->discovery_timeout =
889 jiffies_to_msecs(mpath->discovery_timeout);
890 pinfo->discovery_retries = mpath->discovery_retries;
891 pinfo->flags = 0;
892 if (mpath->flags & MESH_PATH_ACTIVE)
893 pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE;
894 if (mpath->flags & MESH_PATH_RESOLVING)
895 pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
896 if (mpath->flags & MESH_PATH_DSN_VALID)
897 pinfo->flags |= NL80211_MPATH_FLAG_DSN_VALID;
898 if (mpath->flags & MESH_PATH_FIXED)
899 pinfo->flags |= NL80211_MPATH_FLAG_FIXED;
900 if (mpath->flags & MESH_PATH_RESOLVING)
901 pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
902
903 pinfo->flags = mpath->flags;
904}
905
906static int ieee80211_get_mpath(struct wiphy *wiphy, struct net_device *dev,
907 u8 *dst, u8 *next_hop, struct mpath_info *pinfo)
908
909{
910 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
911 struct mesh_path *mpath;
912
913 if (sdata->vif.type != IEEE80211_IF_TYPE_MESH_POINT)
914 return -ENOTSUPP;
915
916 rcu_read_lock();
917 mpath = mesh_path_lookup(dst, dev);
918 if (!mpath) {
919 rcu_read_unlock();
920 return -ENOENT;
921 }
922 memcpy(dst, mpath->dst, ETH_ALEN);
923 mpath_set_pinfo(mpath, next_hop, pinfo);
924 rcu_read_unlock();
925 return 0;
926}
927
928static int ieee80211_dump_mpath(struct wiphy *wiphy, struct net_device *dev,
929 int idx, u8 *dst, u8 *next_hop,
930 struct mpath_info *pinfo)
931{
932 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
933 struct mesh_path *mpath;
934
935 if (sdata->vif.type != IEEE80211_IF_TYPE_MESH_POINT)
936 return -ENOTSUPP;
937
938 rcu_read_lock();
939 mpath = mesh_path_lookup_by_idx(idx, dev);
940 if (!mpath) {
941 rcu_read_unlock();
942 return -ENOENT;
943 }
944 memcpy(dst, mpath->dst, ETH_ALEN);
945 mpath_set_pinfo(mpath, next_hop, pinfo);
946 rcu_read_unlock();
947 return 0;
948}
949#endif
950
f0706e82
JB		 951struct cfg80211_ops mac80211_config_ops = {
952 .add_virtual_intf = ieee80211_add_iface,
953 .del_virtual_intf = ieee80211_del_iface,
42613db7 954 .change_virtual_intf = ieee80211_change_iface,
e8cbb4cb
JB		 955 .add_key = ieee80211_add_key,
956 .del_key = ieee80211_del_key,
62da92fb 957 .get_key = ieee80211_get_key,
e8cbb4cb 958 .set_default_key = ieee80211_config_default_key,
5dfdaf58
JB		 959 .add_beacon = ieee80211_add_beacon,
960 .set_beacon = ieee80211_set_beacon,
961 .del_beacon = ieee80211_del_beacon,
4fd6931e
JB		 962 .add_station = ieee80211_add_station,
963 .del_station = ieee80211_del_station,
964 .change_station = ieee80211_change_station,
7bbdd2d9 965 .get_station = ieee80211_get_station,
c5dd9c2b
LCC		 966 .dump_station = ieee80211_dump_station,
967#ifdef CONFIG_MAC80211_MESH
968 .add_mpath = ieee80211_add_mpath,
969 .del_mpath = ieee80211_del_mpath,
970 .change_mpath = ieee80211_change_mpath,
971 .get_mpath = ieee80211_get_mpath,
972 .dump_mpath = ieee80211_dump_mpath,
973#endif
f0706e82 974};
kernel source for telekom puls (alcatel/mediatek)