projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
cfg80211/nl80211: introduce p2p device types
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / mac80211 / cfg.c
CommitLineData
f0706e82
JB		 1/*
2 * mac80211 configuration hooks for cfg80211
3 *
026331c4 4 * Copyright 2006-2010 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>
5a0e3ad6 12#include <linux/slab.h>
881d966b 13#include <net/net_namespace.h>
5dfdaf58 14#include <linux/rcupdate.h>
f0706e82
JB		 15#include <net/cfg80211.h>
16#include "ieee80211_i.h"
24487981 17#include "driver-ops.h"
e0eb6859 18#include "cfg.h"
2c8dccc7 19#include "rate.h"
c5dd9c2b 20#include "mesh.h"
c5dd9c2b 21
f0706e82 22static int ieee80211_add_iface(struct wiphy *wiphy, char *name,
2ec600d6
LCC		 23 enum nl80211_iftype type, u32 *flags,
24 struct vif_params *params)
f0706e82
JB		 25{
26 struct ieee80211_local *local = wiphy_priv(wiphy);
8cc9a739
MW		 27 struct net_device *dev;
28 struct ieee80211_sub_if_data *sdata;
29 int err;
f0706e82 30
05c914fe
JB		 31 err = ieee80211_if_add(local, name, &dev, type, params);
32 if (err || type != NL80211_IFTYPE_MONITOR || !flags)
8cc9a739
MW		 33 return err;
34
35 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
36 sdata->u.mntr_flags = *flags;
37 return 0;
f0706e82
JB		 38}
39
463d0183 40static int ieee80211_del_iface(struct wiphy *wiphy, struct net_device *dev)
f0706e82 41{
463d0183 42 ieee80211_if_remove(IEEE80211_DEV_TO_SUB_IF(dev));
f0706e82 43
75636525 44 return 0;
f0706e82
JB		 45}
46
e36d56b6
JB		 47static int ieee80211_change_iface(struct wiphy *wiphy,
48 struct net_device *dev,
2ec600d6
LCC		 49 enum nl80211_iftype type, u32 *flags,
50 struct vif_params *params)
42613db7 51{
9607e6b6 52 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
f3947e2d 53 int ret;
42613db7 54
05c914fe 55 ret = ieee80211_if_change_type(sdata, type);
f3947e2d
JB		 56 if (ret)
57 return ret;
42613db7 58
902acc78 59 if (ieee80211_vif_is_mesh(&sdata->vif) && params->mesh_id_len)
472dbc45
JB		 60 ieee80211_sdata_set_mesh_id(sdata,
61 params->mesh_id_len,
62 params->mesh_id);
c5dd9c2b 63
9bc383de
JB		 64 if (type == NL80211_IFTYPE_AP_VLAN &&
65 params && params->use_4addr == 0)
66 rcu_assign_pointer(sdata->u.vlan.sta, NULL);
67 else if (type == NL80211_IFTYPE_STATION &&
68 params && params->use_4addr >= 0)
69 sdata->u.mgd.use_4addr = params->use_4addr;
70
f7917af9
FF		 71 if (sdata->vif.type == NL80211_IFTYPE_MONITOR && flags)
72 sdata->u.mntr_flags = *flags;
73
42613db7
JB		 74 return 0;
75}
76
e8cbb4cb 77static int ieee80211_add_key(struct wiphy *wiphy, struct net_device *dev,
4e943900 78 u8 key_idx, const u8 *mac_addr,
e8cbb4cb
JB		 79 struct key_params *params)
80{
26a58456 81 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
e8cbb4cb 82 struct sta_info *sta = NULL;
db4d1169 83 struct ieee80211_key *key;
3b96766f 84 int err;
e8cbb4cb 85
26a58456 86 if (!ieee80211_sdata_running(sdata))
ad0e2b5a
JB		 87 return -ENETDOWN;
88
97359d12 89 /* reject WEP and TKIP keys if WEP failed to initialize */
e8cbb4cb
JB		 90 switch (params->cipher) {
91 case WLAN_CIPHER_SUITE_WEP40:
e8cbb4cb 92 case WLAN_CIPHER_SUITE_TKIP:
97359d12
JB		 93 case WLAN_CIPHER_SUITE_WEP104:
94 if (IS_ERR(sdata->local->wep_tx_tfm))
95 return -EINVAL;
3cfcf6ac 96 break;
e8cbb4cb 97 default:
97359d12 98 break;
e8cbb4cb
JB		 99 }
100
97359d12
JB		 101 key = ieee80211_key_alloc(params->cipher, key_idx, params->key_len,
102 params->key, params->seq_len, params->seq);
1ac62ba7
BH		 103 if (IS_ERR(key))
104 return PTR_ERR(key);
db4d1169 105
ad0e2b5a 106 mutex_lock(&sdata->local->sta_mtx);
3b96766f 107
e8cbb4cb 108 if (mac_addr) {
0e5ded5a 109 sta = sta_info_get_bss(sdata, mac_addr);
db4d1169 110 if (!sta) {
32162a4d 111 ieee80211_key_free(sdata->local, key);
3b96766f
JB		 112 err = -ENOENT;
113 goto out_unlock;
db4d1169 114 }
e8cbb4cb
JB		 115 }
116
3ffc2a90
JB		 117 err = ieee80211_key_link(key, sdata, sta);
118 if (err)
119 ieee80211_key_free(sdata->local, key);
db4d1169 120
3b96766f 121 out_unlock:
ad0e2b5a 122 mutex_unlock(&sdata->local->sta_mtx);
3b96766f
JB		 123
124 return err;
e8cbb4cb
JB		 125}
126
127static int ieee80211_del_key(struct wiphy *wiphy, struct net_device *dev,
4e943900 128 u8 key_idx, const u8 *mac_addr)
e8cbb4cb
JB		 129{
130 struct ieee80211_sub_if_data *sdata;
131 struct sta_info *sta;
132 int ret;
133
134 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
135
ad0e2b5a 136 mutex_lock(&sdata->local->sta_mtx);
3b96766f 137
e8cbb4cb 138 if (mac_addr) {
3b96766f
JB		 139 ret = -ENOENT;
140
0e5ded5a 141 sta = sta_info_get_bss(sdata, mac_addr);
e8cbb4cb 142 if (!sta)
3b96766f 143 goto out_unlock;
e8cbb4cb 144
db4d1169 145 if (sta->key) {
32162a4d 146 ieee80211_key_free(sdata->local, sta->key);
db4d1169 147 WARN_ON(sta->key);
3b96766f
JB		 148 ret = 0;
149 }
e8cbb4cb 150
3b96766f 151 goto out_unlock;
e8cbb4cb
JB		 152 }
153
3b96766f
JB		 154 if (!sdata->keys[key_idx]) {
155 ret = -ENOENT;
156 goto out_unlock;
157 }
e8cbb4cb 158
32162a4d 159 ieee80211_key_free(sdata->local, sdata->keys[key_idx]);
db4d1169 160 WARN_ON(sdata->keys[key_idx]);
e8cbb4cb 161
3b96766f
JB		 162 ret = 0;
163 out_unlock:
ad0e2b5a 164 mutex_unlock(&sdata->local->sta_mtx);
3b96766f
JB		 165
166 return ret;
e8cbb4cb
JB		 167}
168
62da92fb 169static int ieee80211_get_key(struct wiphy *wiphy, struct net_device *dev,
4e943900 170 u8 key_idx, const u8 *mac_addr, void *cookie,
62da92fb
JB		 171 void (*callback)(void *cookie,
172 struct key_params *params))
173{
14db74bc 174 struct ieee80211_sub_if_data *sdata;
62da92fb
JB		 175 struct sta_info *sta = NULL;
176 u8 seq[6] = {0};
177 struct key_params params;
178 struct ieee80211_key *key;
179 u32 iv32;
180 u16 iv16;
181 int err = -ENOENT;
182
14db74bc
JB		 183 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
184
3b96766f
JB		 185 rcu_read_lock();
186
62da92fb 187 if (mac_addr) {
0e5ded5a 188 sta = sta_info_get_bss(sdata, mac_addr);
62da92fb
JB		 189 if (!sta)
190 goto out;
191
192 key = sta->key;
193 } else
194 key = sdata->keys[key_idx];
195
196 if (!key)
197 goto out;
198
199 memset(&params, 0, sizeof(params));
200
97359d12 201 params.cipher = key->conf.cipher;
62da92fb 202
97359d12
JB		 203 switch (key->conf.cipher) {
204 case WLAN_CIPHER_SUITE_TKIP:
b0f76b33
HH		 205 iv32 = key->u.tkip.tx.iv32;
206 iv16 = key->u.tkip.tx.iv16;
62da92fb 207
24487981
JB		 208 if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE)
209 drv_get_tkip_seq(sdata->local,
210 key->conf.hw_key_idx,
211 &iv32, &iv16);
62da92fb
JB		 212
213 seq[0] = iv16 & 0xff;
214 seq[1] = (iv16 >> 8) & 0xff;
215 seq[2] = iv32 & 0xff;
216 seq[3] = (iv32 >> 8) & 0xff;
217 seq[4] = (iv32 >> 16) & 0xff;
218 seq[5] = (iv32 >> 24) & 0xff;
219 params.seq = seq;
220 params.seq_len = 6;
221 break;
97359d12 222 case WLAN_CIPHER_SUITE_CCMP:
62da92fb
JB		 223 seq[0] = key->u.ccmp.tx_pn[5];
224 seq[1] = key->u.ccmp.tx_pn[4];
225 seq[2] = key->u.ccmp.tx_pn[3];
226 seq[3] = key->u.ccmp.tx_pn[2];
227 seq[4] = key->u.ccmp.tx_pn[1];
228 seq[5] = key->u.ccmp.tx_pn[0];
229 params.seq = seq;
230 params.seq_len = 6;
231 break;
97359d12 232 case WLAN_CIPHER_SUITE_AES_CMAC:
3cfcf6ac
JM		 233 seq[0] = key->u.aes_cmac.tx_pn[5];
234 seq[1] = key->u.aes_cmac.tx_pn[4];
235 seq[2] = key->u.aes_cmac.tx_pn[3];
236 seq[3] = key->u.aes_cmac.tx_pn[2];
237 seq[4] = key->u.aes_cmac.tx_pn[1];
238 seq[5] = key->u.aes_cmac.tx_pn[0];
239 params.seq = seq;
240 params.seq_len = 6;
241 break;
62da92fb
JB		 242 }
243
244 params.key = key->conf.key;
245 params.key_len = key->conf.keylen;
246
247 callback(cookie, &params);
248 err = 0;
249
250 out:
3b96766f 251 rcu_read_unlock();
62da92fb
JB		 252 return err;
253}
254
e8cbb4cb
JB		 255static int ieee80211_config_default_key(struct wiphy *wiphy,
256 struct net_device *dev,
257 u8 key_idx)
258{
ad0e2b5a 259 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3b96766f 260
e8cbb4cb
JB		 261 ieee80211_set_default_key(sdata, key_idx);
262
263 return 0;
264}
265
3cfcf6ac
JM		 266static int ieee80211_config_default_mgmt_key(struct wiphy *wiphy,
267 struct net_device *dev,
268 u8 key_idx)
269{
66c52421 270 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3cfcf6ac 271
3cfcf6ac
JM		 272 ieee80211_set_default_mgmt_key(sdata, key_idx);
273
3cfcf6ac
JM		 274 return 0;
275}
276
c5dd9c2b
LCC		 277static void sta_set_sinfo(struct sta_info *sta, struct station_info *sinfo)
278{
d0709a65 279 struct ieee80211_sub_if_data *sdata = sta->sdata;
c5dd9c2b 280
f5ea9120
JB		 281 sinfo->generation = sdata->local->sta_generation;
282
c5dd9c2b
LCC		 283 sinfo->filled = STATION_INFO_INACTIVE_TIME |
284 STATION_INFO_RX_BYTES |
420e7fab 285 STATION_INFO_TX_BYTES |
98c8a60a
JM		 286 STATION_INFO_RX_PACKETS |
287 STATION_INFO_TX_PACKETS |
420e7fab 288 STATION_INFO_TX_BITRATE;
c5dd9c2b
LCC		 289
290 sinfo->inactive_time = jiffies_to_msecs(jiffies - sta->last_rx);
291 sinfo->rx_bytes = sta->rx_bytes;
292 sinfo->tx_bytes = sta->tx_bytes;
98c8a60a
JM		 293 sinfo->rx_packets = sta->rx_packets;
294 sinfo->tx_packets = sta->tx_packets;
c5dd9c2b 295
19deffbe
JL		 296 if ((sta->local->hw.flags & IEEE80211_HW_SIGNAL_DBM) ||
297 (sta->local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)) {
420e7fab
HR		 298 sinfo->filled |= STATION_INFO_SIGNAL;
299 sinfo->signal = (s8)sta->last_signal;
300 }
301
302 sinfo->txrate.flags = 0;
303 if (sta->last_tx_rate.flags & IEEE80211_TX_RC_MCS)
304 sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
305 if (sta->last_tx_rate.flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
306 sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH;
307 if (sta->last_tx_rate.flags & IEEE80211_TX_RC_SHORT_GI)
308 sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;
309
310 if (!(sta->last_tx_rate.flags & IEEE80211_TX_RC_MCS)) {
311 struct ieee80211_supported_band *sband;
312 sband = sta->local->hw.wiphy->bands[
313 sta->local->hw.conf.channel->band];
314 sinfo->txrate.legacy =
315 sband->bitrates[sta->last_tx_rate.idx].bitrate;
316 } else
317 sinfo->txrate.mcs = sta->last_tx_rate.idx;
318
902acc78 319 if (ieee80211_vif_is_mesh(&sdata->vif)) {
c5dd9c2b 320#ifdef CONFIG_MAC80211_MESH
c5dd9c2b
LCC		 321 sinfo->filled |= STATION_INFO_LLID |
322 STATION_INFO_PLID |
323 STATION_INFO_PLINK_STATE;
324
325 sinfo->llid = le16_to_cpu(sta->llid);
326 sinfo->plid = le16_to_cpu(sta->plid);
327 sinfo->plink_state = sta->plink_state;
c5dd9c2b 328#endif
902acc78 329 }
c5dd9c2b
LCC		 330}
331
332
333static int ieee80211_dump_station(struct wiphy *wiphy, struct net_device *dev,
334 int idx, u8 *mac, struct station_info *sinfo)
335{
3b53fde8 336 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
c5dd9c2b 337 struct sta_info *sta;
d0709a65
JB		 338 int ret = -ENOENT;
339
340 rcu_read_lock();
c5dd9c2b 341
3b53fde8 342 sta = sta_info_get_by_idx(sdata, idx);
d0709a65
JB		 343 if (sta) {
344 ret = 0;
17741cdc 345 memcpy(mac, sta->sta.addr, ETH_ALEN);
d0709a65
JB		 346 sta_set_sinfo(sta, sinfo);
347 }
c5dd9c2b 348
d0709a65 349 rcu_read_unlock();
c5dd9c2b 350
d0709a65 351 return ret;
c5dd9c2b
LCC		 352}
353
1289723e
HS		 354static int ieee80211_dump_survey(struct wiphy *wiphy, struct net_device *dev,
355 int idx, struct survey_info *survey)
356{
357 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
358
1289723e
HS		 359 return drv_get_survey(local, idx, survey);
360}
361
7bbdd2d9 362static int ieee80211_get_station(struct wiphy *wiphy, struct net_device *dev,
2ec600d6 363 u8 *mac, struct station_info *sinfo)
7bbdd2d9 364{
abe60632 365 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
7bbdd2d9 366 struct sta_info *sta;
d0709a65 367 int ret = -ENOENT;
7bbdd2d9 368
d0709a65 369 rcu_read_lock();
7bbdd2d9 370
0e5ded5a 371 sta = sta_info_get_bss(sdata, mac);
d0709a65
JB		 372 if (sta) {
373 ret = 0;
374 sta_set_sinfo(sta, sinfo);
375 }
376
377 rcu_read_unlock();
378
379 return ret;
7bbdd2d9
JB		 380}
381
5dfdaf58
JB		 382/*
383 * This handles both adding a beacon and setting new beacon info
384 */
385static int ieee80211_config_beacon(struct ieee80211_sub_if_data *sdata,
386 struct beacon_parameters *params)
387{
388 struct beacon_data *new, *old;
389 int new_head_len, new_tail_len;
390 int size;
391 int err = -EINVAL;
392
393 old = sdata->u.ap.beacon;
394
395 /* head must not be zero-length */
396 if (params->head && !params->head_len)
397 return -EINVAL;
398
399 /*
400 * This is a kludge. beacon interval should really be part
401 * of the beacon information.
402 */
57c4d7b4
JB		 403 if (params->interval &&
404 (sdata->vif.bss_conf.beacon_int != params->interval)) {
405 sdata->vif.bss_conf.beacon_int = params->interval;
406 ieee80211_bss_info_change_notify(sdata,
407 BSS_CHANGED_BEACON_INT);
5dfdaf58
JB		 408 }
409
410 /* Need to have a beacon head if we don't have one yet */
411 if (!params->head && !old)
412 return err;
413
414 /* sorry, no way to start beaconing without dtim period */
415 if (!params->dtim_period && !old)
416 return err;
417
418 /* new or old head? */
419 if (params->head)
420 new_head_len = params->head_len;
421 else
422 new_head_len = old->head_len;
423
424 /* new or old tail? */
425 if (params->tail || !old)
426 /* params->tail_len will be zero for !params->tail */
427 new_tail_len = params->tail_len;
428 else
429 new_tail_len = old->tail_len;
430
431 size = sizeof(*new) + new_head_len + new_tail_len;
432
433 new = kzalloc(size, GFP_KERNEL);
434 if (!new)
435 return -ENOMEM;
436
437 /* start filling the new info now */
438
439 /* new or old dtim period? */
440 if (params->dtim_period)
441 new->dtim_period = params->dtim_period;
442 else
443 new->dtim_period = old->dtim_period;
444
445 /*
446 * pointers go into the block we allocated,
447 * memory is | beacon_data | head | tail |
448 */
449 new->head = ((u8 *) new) + sizeof(*new);
450 new->tail = new->head + new_head_len;
451 new->head_len = new_head_len;
452 new->tail_len = new_tail_len;
453
454 /* copy in head */
455 if (params->head)
456 memcpy(new->head, params->head, new_head_len);
457 else
458 memcpy(new->head, old->head, new_head_len);
459
460 /* copy in optional tail */
461 if (params->tail)
462 memcpy(new->tail, params->tail, new_tail_len);
463 else
464 if (old)
465 memcpy(new->tail, old->tail, new_tail_len);
466
19885c4f
JB		 467 sdata->vif.bss_conf.dtim_period = new->dtim_period;
468
5dfdaf58
JB		 469 rcu_assign_pointer(sdata->u.ap.beacon, new);
470
471 synchronize_rcu();
472
473 kfree(old);
474
2d0ddec5
JB		 475 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED |
476 BSS_CHANGED_BEACON);
477 return 0;
5dfdaf58
JB		 478}
479
480static int ieee80211_add_beacon(struct wiphy *wiphy, struct net_device *dev,
481 struct beacon_parameters *params)
482{
14db74bc 483 struct ieee80211_sub_if_data *sdata;
5dfdaf58
JB		 484 struct beacon_data *old;
485
14db74bc
JB		 486 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
487
5dfdaf58
JB		 488 old = sdata->u.ap.beacon;
489
490 if (old)
491 return -EALREADY;
492
493 return ieee80211_config_beacon(sdata, params);
494}
495
496static int ieee80211_set_beacon(struct wiphy *wiphy, struct net_device *dev,
497 struct beacon_parameters *params)
498{
14db74bc 499 struct ieee80211_sub_if_data *sdata;
5dfdaf58
JB		 500 struct beacon_data *old;
501
14db74bc
JB		 502 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
503
5dfdaf58
JB		 504 old = sdata->u.ap.beacon;
505
506 if (!old)
507 return -ENOENT;
508
509 return ieee80211_config_beacon(sdata, params);
510}
511
512static int ieee80211_del_beacon(struct wiphy *wiphy, struct net_device *dev)
513{
14db74bc 514 struct ieee80211_sub_if_data *sdata;
5dfdaf58
JB		 515 struct beacon_data *old;
516
14db74bc
JB		 517 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
518
5dfdaf58
JB		 519 old = sdata->u.ap.beacon;
520
521 if (!old)
522 return -ENOENT;
523
524 rcu_assign_pointer(sdata->u.ap.beacon, NULL);
525 synchronize_rcu();
526 kfree(old);
527
2d0ddec5
JB		 528 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED);
529 return 0;
5dfdaf58
JB		 530}
531
4fd6931e
JB		 532/* Layer 2 Update frame (802.2 Type 1 LLC XID Update response) */
533struct iapp_layer2_update {
534 u8 da[ETH_ALEN]; /* broadcast */
535 u8 sa[ETH_ALEN]; /* STA addr */
536 __be16 len; /* 6 */
537 u8 dsap; /* 0 */
538 u8 ssap; /* 0 */
539 u8 control;
540 u8 xid_info[3];
bc10502d 541} __packed;
4fd6931e
JB		 542
543static void ieee80211_send_layer2_update(struct sta_info *sta)
544{
545 struct iapp_layer2_update *msg;
546 struct sk_buff *skb;
547
548 /* Send Level 2 Update Frame to update forwarding tables in layer 2
549 * bridge devices */
550
551 skb = dev_alloc_skb(sizeof(*msg));
552 if (!skb)
553 return;
554 msg = (struct iapp_layer2_update *)skb_put(skb, sizeof(*msg));
555
556 /* 802.2 Type 1 Logical Link Control (LLC) Exchange Identifier (XID)
557 * Update response frame; IEEE Std 802.2-1998, 5.4.1.2.1 */
558
559 memset(msg->da, 0xff, ETH_ALEN);
17741cdc 560 memcpy(msg->sa, sta->sta.addr, ETH_ALEN);
4fd6931e
JB		 561 msg->len = htons(6);
562 msg->dsap = 0;
563 msg->ssap = 0x01; /* NULL LSAP, CR Bit: Response */
564 msg->control = 0xaf; /* XID response lsb.1111F101.
565 * F=0 (no poll command; unsolicited frame) */
566 msg->xid_info[0] = 0x81; /* XID format identifier */
567 msg->xid_info[1] = 1; /* LLC types/classes: Type 1 LLC */
568 msg->xid_info[2] = 0; /* XID sender's receive window size (RW) */
569
d0709a65
JB		 570 skb->dev = sta->sdata->dev;
571 skb->protocol = eth_type_trans(skb, sta->sdata->dev);
4fd6931e 572 memset(skb->cb, 0, sizeof(skb->cb));
06ee1c26 573 netif_rx_ni(skb);
4fd6931e
JB		 574}
575
576static void sta_apply_parameters(struct ieee80211_local *local,
577 struct sta_info *sta,
578 struct station_parameters *params)
579{
f5521b13 580 unsigned long flags;
4fd6931e
JB		 581 u32 rates;
582 int i, j;
8318d78a 583 struct ieee80211_supported_band *sband;
d0709a65 584 struct ieee80211_sub_if_data *sdata = sta->sdata;
eccb8e8f 585 u32 mask, set;
4fd6931e 586
ae5eb026
JB		 587 sband = local->hw.wiphy->bands[local->oper_channel->band];
588
f5521b13 589 spin_lock_irqsave(&sta->flaglock, flags);
eccb8e8f
JB		 590 mask = params->sta_flags_mask;
591 set = params->sta_flags_set;
73651ee6 592
eccb8e8f 593 if (mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
4fd6931e 594 sta->flags &= ~WLAN_STA_AUTHORIZED;
eccb8e8f 595 if (set & BIT(NL80211_STA_FLAG_AUTHORIZED))
4fd6931e 596 sta->flags |= WLAN_STA_AUTHORIZED;
eccb8e8f 597 }
4fd6931e 598
eccb8e8f 599 if (mask & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE)) {
4fd6931e 600 sta->flags &= ~WLAN_STA_SHORT_PREAMBLE;
eccb8e8f 601 if (set & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE))
4fd6931e 602 sta->flags |= WLAN_STA_SHORT_PREAMBLE;
eccb8e8f 603 }
4fd6931e 604
eccb8e8f 605 if (mask & BIT(NL80211_STA_FLAG_WME)) {
4fd6931e 606 sta->flags &= ~WLAN_STA_WME;
eccb8e8f 607 if (set & BIT(NL80211_STA_FLAG_WME))
4fd6931e 608 sta->flags |= WLAN_STA_WME;
eccb8e8f 609 }
5394af4d 610
eccb8e8f 611 if (mask & BIT(NL80211_STA_FLAG_MFP)) {
5394af4d 612 sta->flags &= ~WLAN_STA_MFP;
eccb8e8f 613 if (set & BIT(NL80211_STA_FLAG_MFP))
5394af4d 614 sta->flags |= WLAN_STA_MFP;
4fd6931e 615 }
f5521b13 616 spin_unlock_irqrestore(&sta->flaglock, flags);
4fd6931e 617
51b50fbe
JB		 618 /*
619 * cfg80211 validates this (1-2007) and allows setting the AID
620 * only when creating a new station entry
621 */
622 if (params->aid)
623 sta->sta.aid = params->aid;
624
73651ee6
JB		 625 /*
626 * FIXME: updating the following information is racy when this
627 * function is called from ieee80211_change_station().
628 * However, all this information should be static so
629 * maybe we should just reject attemps to change it.
630 */
631
4fd6931e
JB		 632 if (params->listen_interval >= 0)
633 sta->listen_interval = params->listen_interval;
634
635 if (params->supported_rates) {
636 rates = 0;
8318d78a 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 }
323ce79a 645 sta->sta.supp_rates[local->oper_channel->band] = rates;
4fd6931e 646 }
c5dd9c2b 647
d9fe60de 648 if (params->ht_capa)
ae5eb026
JB		 649 ieee80211_ht_cap_ie_to_sta_ht_cap(sband,
650 params->ht_capa,
d9fe60de 651 &sta->sta.ht_cap);
36aedc90 652
902acc78 653 if (ieee80211_vif_is_mesh(&sdata->vif) && params->plink_action) {
c5dd9c2b
LCC		 654 switch (params->plink_action) {
655 case PLINK_ACTION_OPEN:
656 mesh_plink_open(sta);
657 break;
658 case PLINK_ACTION_BLOCK:
659 mesh_plink_block(sta);
660 break;
661 }
902acc78 662 }
4fd6931e
JB		 663}
664
665static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
666 u8 *mac, struct station_parameters *params)
667{
14db74bc 668 struct ieee80211_local *local = wiphy_priv(wiphy);
4fd6931e
JB		 669 struct sta_info *sta;
670 struct ieee80211_sub_if_data *sdata;
73651ee6 671 int err;
b8d476c8 672 int layer2_update;
4fd6931e 673
4fd6931e
JB		 674 if (params->vlan) {
675 sdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
676
05c914fe
JB		 677 if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
678 sdata->vif.type != NL80211_IFTYPE_AP)
4fd6931e
JB		 679 return -EINVAL;
680 } else
681 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
682
47846c9b 683 if (compare_ether_addr(mac, sdata->vif.addr) == 0)
03e4497e
JB		 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
4b7679a5 697 rate_control_rate_init(sta);
4fd6931e 698
b8d476c8
JM		 699 layer2_update = sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
700 sdata->vif.type == NL80211_IFTYPE_AP;
701
34e89507 702 err = sta_info_insert_rcu(sta);
73651ee6 703 if (err) {
73651ee6
JB		 704 rcu_read_unlock();
705 return err;
706 }
707
b8d476c8 708 if (layer2_update)
73651ee6
JB		 709 ieee80211_send_layer2_update(sta);
710
711 rcu_read_unlock();
712
4fd6931e
JB		 713 return 0;
714}
715
716static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev,
717 u8 *mac)
718{
14db74bc
JB		 719 struct ieee80211_local *local = wiphy_priv(wiphy);
720 struct ieee80211_sub_if_data *sdata;
4fd6931e 721
14db74bc
JB		 722 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
723
34e89507
JB		 724 if (mac)
725 return sta_info_destroy_addr_bss(sdata, mac);
4fd6931e 726
34e89507 727 sta_info_flush(local, sdata);
4fd6931e
JB		 728 return 0;
729}
730
731static int ieee80211_change_station(struct wiphy *wiphy,
732 struct net_device *dev,
733 u8 *mac,
734 struct station_parameters *params)
735{
abe60632 736 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
14db74bc 737 struct ieee80211_local *local = wiphy_priv(wiphy);
4fd6931e
JB		 738 struct sta_info *sta;
739 struct ieee80211_sub_if_data *vlansdata;
740
98dd6a57
JB		 741 rcu_read_lock();
742
0e5ded5a 743 sta = sta_info_get_bss(sdata, mac);
98dd6a57
JB		 744 if (!sta) {
745 rcu_read_unlock();
4fd6931e 746 return -ENOENT;
98dd6a57 747 }
4fd6931e 748
d0709a65 749 if (params->vlan && params->vlan != sta->sdata->dev) {
4fd6931e
JB		 750 vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
751
05c914fe
JB		 752 if (vlansdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
753 vlansdata->vif.type != NL80211_IFTYPE_AP) {
98dd6a57 754 rcu_read_unlock();
4fd6931e 755 return -EINVAL;
98dd6a57 756 }
4fd6931e 757
9bc383de 758 if (params->vlan->ieee80211_ptr->use_4addr) {
3305443c
JB		 759 if (vlansdata->u.vlan.sta) {
760 rcu_read_unlock();
f14543ee 761 return -EBUSY;
3305443c 762 }
f14543ee
FF		 763
764 rcu_assign_pointer(vlansdata->u.vlan.sta, sta);
765 }
766
14db74bc 767 sta->sdata = vlansdata;
4fd6931e
JB		 768 ieee80211_send_layer2_update(sta);
769 }
770
771 sta_apply_parameters(local, sta, params);
772
98dd6a57
JB		 773 rcu_read_unlock();
774
4fd6931e
JB		 775 return 0;
776}
777
c5dd9c2b
LCC		 778#ifdef CONFIG_MAC80211_MESH
779static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
780 u8 *dst, u8 *next_hop)
781{
14db74bc 782 struct ieee80211_sub_if_data *sdata;
c5dd9c2b
LCC		 783 struct mesh_path *mpath;
784 struct sta_info *sta;
785 int err;
786
14db74bc
JB		 787 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
788
d0709a65 789 rcu_read_lock();
abe60632 790 sta = sta_info_get(sdata, next_hop);
d0709a65
JB		 791 if (!sta) {
792 rcu_read_unlock();
c5dd9c2b 793 return -ENOENT;
d0709a65 794 }
c5dd9c2b 795
f698d856 796 err = mesh_path_add(dst, sdata);
d0709a65
JB		 797 if (err) {
798 rcu_read_unlock();
c5dd9c2b 799 return err;
d0709a65 800 }
c5dd9c2b 801
f698d856 802 mpath = mesh_path_lookup(dst, sdata);
c5dd9c2b
LCC		 803 if (!mpath) {
804 rcu_read_unlock();
c5dd9c2b
LCC		 805 return -ENXIO;
806 }
807 mesh_path_fix_nexthop(mpath, sta);
d0709a65 808
c5dd9c2b
LCC		 809 rcu_read_unlock();
810 return 0;
811}
812
813static int ieee80211_del_mpath(struct wiphy *wiphy, struct net_device *dev,
814 u8 *dst)
815{
f698d856
JBG		 816 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
817
c5dd9c2b 818 if (dst)
f698d856 819 return mesh_path_del(dst, sdata);
c5dd9c2b 820
f698d856 821 mesh_path_flush(sdata);
c5dd9c2b
LCC		 822 return 0;
823}
824
825static int ieee80211_change_mpath(struct wiphy *wiphy,
826 struct net_device *dev,
827 u8 *dst, u8 *next_hop)
828{
14db74bc 829 struct ieee80211_sub_if_data *sdata;
c5dd9c2b
LCC		 830 struct mesh_path *mpath;
831 struct sta_info *sta;
832
14db74bc
JB		 833 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
834
d0709a65
JB		 835 rcu_read_lock();
836
abe60632 837 sta = sta_info_get(sdata, next_hop);
d0709a65
JB		 838 if (!sta) {
839 rcu_read_unlock();
c5dd9c2b 840 return -ENOENT;
d0709a65 841 }
c5dd9c2b 842
f698d856 843 mpath = mesh_path_lookup(dst, sdata);
c5dd9c2b
LCC		 844 if (!mpath) {
845 rcu_read_unlock();
c5dd9c2b
LCC		 846 return -ENOENT;
847 }
848
849 mesh_path_fix_nexthop(mpath, sta);
d0709a65 850
c5dd9c2b
LCC		 851 rcu_read_unlock();
852 return 0;
853}
854
855static void mpath_set_pinfo(struct mesh_path *mpath, u8 *next_hop,
856 struct mpath_info *pinfo)
857{
858 if (mpath->next_hop)
17741cdc 859 memcpy(next_hop, mpath->next_hop->sta.addr, ETH_ALEN);
c5dd9c2b
LCC		 860 else
861 memset(next_hop, 0, ETH_ALEN);
862
f5ea9120
JB		 863 pinfo->generation = mesh_paths_generation;
864
c5dd9c2b 865 pinfo->filled = MPATH_INFO_FRAME_QLEN |
d19b3bf6 866 MPATH_INFO_SN |
c5dd9c2b
LCC		 867 MPATH_INFO_METRIC |
868 MPATH_INFO_EXPTIME |
869 MPATH_INFO_DISCOVERY_TIMEOUT |
870 MPATH_INFO_DISCOVERY_RETRIES |
871 MPATH_INFO_FLAGS;
872
873 pinfo->frame_qlen = mpath->frame_queue.qlen;
d19b3bf6 874 pinfo->sn = mpath->sn;
c5dd9c2b
LCC		 875 pinfo->metric = mpath->metric;
876 if (time_before(jiffies, mpath->exp_time))
877 pinfo->exptime = jiffies_to_msecs(mpath->exp_time - jiffies);
878 pinfo->discovery_timeout =
879 jiffies_to_msecs(mpath->discovery_timeout);
880 pinfo->discovery_retries = mpath->discovery_retries;
881 pinfo->flags = 0;
882 if (mpath->flags & MESH_PATH_ACTIVE)
883 pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE;
884 if (mpath->flags & MESH_PATH_RESOLVING)
885 pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
d19b3bf6
RP		 886 if (mpath->flags & MESH_PATH_SN_VALID)
887 pinfo->flags |= NL80211_MPATH_FLAG_SN_VALID;
c5dd9c2b
LCC		 888 if (mpath->flags & MESH_PATH_FIXED)
889 pinfo->flags |= NL80211_MPATH_FLAG_FIXED;
890 if (mpath->flags & MESH_PATH_RESOLVING)
891 pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
892
893 pinfo->flags = mpath->flags;
894}
895
896static int ieee80211_get_mpath(struct wiphy *wiphy, struct net_device *dev,
897 u8 *dst, u8 *next_hop, struct mpath_info *pinfo)
898
899{
14db74bc 900 struct ieee80211_sub_if_data *sdata;
c5dd9c2b
LCC		 901 struct mesh_path *mpath;
902
14db74bc
JB		 903 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
904
c5dd9c2b 905 rcu_read_lock();
f698d856 906 mpath = mesh_path_lookup(dst, sdata);
c5dd9c2b
LCC		 907 if (!mpath) {
908 rcu_read_unlock();
909 return -ENOENT;
910 }
911 memcpy(dst, mpath->dst, ETH_ALEN);
912 mpath_set_pinfo(mpath, next_hop, pinfo);
913 rcu_read_unlock();
914 return 0;
915}
916
917static int ieee80211_dump_mpath(struct wiphy *wiphy, struct net_device *dev,
918 int idx, u8 *dst, u8 *next_hop,
919 struct mpath_info *pinfo)
920{
14db74bc 921 struct ieee80211_sub_if_data *sdata;
c5dd9c2b
LCC		 922 struct mesh_path *mpath;
923
14db74bc
JB		 924 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
925
c5dd9c2b 926 rcu_read_lock();
f698d856 927 mpath = mesh_path_lookup_by_idx(idx, sdata);
c5dd9c2b
LCC		 928 if (!mpath) {
929 rcu_read_unlock();
930 return -ENOENT;
931 }
932 memcpy(dst, mpath->dst, ETH_ALEN);
933 mpath_set_pinfo(mpath, next_hop, pinfo);
934 rcu_read_unlock();
935 return 0;
936}
93da9cc1 937
938static int ieee80211_get_mesh_params(struct wiphy *wiphy,
939 struct net_device *dev,
940 struct mesh_config *conf)
941{
942 struct ieee80211_sub_if_data *sdata;
943 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
944
93da9cc1 945 memcpy(conf, &(sdata->u.mesh.mshcfg), sizeof(struct mesh_config));
946 return 0;
947}
948
949static inline bool _chg_mesh_attr(enum nl80211_meshconf_params parm, u32 mask)
950{
951 return (mask >> (parm-1)) & 0x1;
952}
953
954static int ieee80211_set_mesh_params(struct wiphy *wiphy,
955 struct net_device *dev,
956 const struct mesh_config *nconf, u32 mask)
957{
958 struct mesh_config *conf;
959 struct ieee80211_sub_if_data *sdata;
63c5723b
RP		 960 struct ieee80211_if_mesh *ifmsh;
961
93da9cc1 962 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
63c5723b 963 ifmsh = &sdata->u.mesh;
93da9cc1 964
93da9cc1 965 /* Set the config options which we are interested in setting */
966 conf = &(sdata->u.mesh.mshcfg);
967 if (_chg_mesh_attr(NL80211_MESHCONF_RETRY_TIMEOUT, mask))
968 conf->dot11MeshRetryTimeout = nconf->dot11MeshRetryTimeout;
969 if (_chg_mesh_attr(NL80211_MESHCONF_CONFIRM_TIMEOUT, mask))
970 conf->dot11MeshConfirmTimeout = nconf->dot11MeshConfirmTimeout;
971 if (_chg_mesh_attr(NL80211_MESHCONF_HOLDING_TIMEOUT, mask))
972 conf->dot11MeshHoldingTimeout = nconf->dot11MeshHoldingTimeout;
973 if (_chg_mesh_attr(NL80211_MESHCONF_MAX_PEER_LINKS, mask))
974 conf->dot11MeshMaxPeerLinks = nconf->dot11MeshMaxPeerLinks;
975 if (_chg_mesh_attr(NL80211_MESHCONF_MAX_RETRIES, mask))
976 conf->dot11MeshMaxRetries = nconf->dot11MeshMaxRetries;
977 if (_chg_mesh_attr(NL80211_MESHCONF_TTL, mask))
978 conf->dot11MeshTTL = nconf->dot11MeshTTL;
979 if (_chg_mesh_attr(NL80211_MESHCONF_AUTO_OPEN_PLINKS, mask))
980 conf->auto_open_plinks = nconf->auto_open_plinks;
981 if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, mask))
982 conf->dot11MeshHWMPmaxPREQretries =
983 nconf->dot11MeshHWMPmaxPREQretries;
984 if (_chg_mesh_attr(NL80211_MESHCONF_PATH_REFRESH_TIME, mask))
985 conf->path_refresh_time = nconf->path_refresh_time;
986 if (_chg_mesh_attr(NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, mask))
987 conf->min_discovery_timeout = nconf->min_discovery_timeout;
988 if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, mask))
989 conf->dot11MeshHWMPactivePathTimeout =
990 nconf->dot11MeshHWMPactivePathTimeout;
991 if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, mask))
992 conf->dot11MeshHWMPpreqMinInterval =
993 nconf->dot11MeshHWMPpreqMinInterval;
994 if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
995 mask))
996 conf->dot11MeshHWMPnetDiameterTraversalTime =
997 nconf->dot11MeshHWMPnetDiameterTraversalTime;
63c5723b
RP		 998 if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOTMODE, mask)) {
999 conf->dot11MeshHWMPRootMode = nconf->dot11MeshHWMPRootMode;
1000 ieee80211_mesh_root_setup(ifmsh);
1001 }
93da9cc1 1002 return 0;
1003}
1004
c5dd9c2b
LCC		 1005#endif
1006
9f1ba906
JM		 1007static int ieee80211_change_bss(struct wiphy *wiphy,
1008 struct net_device *dev,
1009 struct bss_parameters *params)
1010{
9f1ba906
JM		 1011 struct ieee80211_sub_if_data *sdata;
1012 u32 changed = 0;
1013
9f1ba906
JM		 1014 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1015
9f1ba906 1016 if (params->use_cts_prot >= 0) {
bda3933a 1017 sdata->vif.bss_conf.use_cts_prot = params->use_cts_prot;
9f1ba906
JM		 1018 changed |= BSS_CHANGED_ERP_CTS_PROT;
1019 }
1020 if (params->use_short_preamble >= 0) {
bda3933a 1021 sdata->vif.bss_conf.use_short_preamble =
9f1ba906
JM		 1022 params->use_short_preamble;
1023 changed |= BSS_CHANGED_ERP_PREAMBLE;
1024 }
43d35343
FF		 1025
1026 if (!sdata->vif.bss_conf.use_short_slot &&
1027 sdata->local->hw.conf.channel->band == IEEE80211_BAND_5GHZ) {
1028 sdata->vif.bss_conf.use_short_slot = true;
1029 changed |= BSS_CHANGED_ERP_SLOT;
1030 }
1031
9f1ba906 1032 if (params->use_short_slot_time >= 0) {
bda3933a 1033 sdata->vif.bss_conf.use_short_slot =
9f1ba906
JM		 1034 params->use_short_slot_time;
1035 changed |= BSS_CHANGED_ERP_SLOT;
1036 }
1037
90c97a04
JM		 1038 if (params->basic_rates) {
1039 int i, j;
1040 u32 rates = 0;
1041 struct ieee80211_local *local = wiphy_priv(wiphy);
1042 struct ieee80211_supported_band *sband =
1043 wiphy->bands[local->oper_channel->band];
1044
1045 for (i = 0; i < params->basic_rates_len; i++) {
1046 int rate = (params->basic_rates[i] & 0x7f) * 5;
1047 for (j = 0; j < sband->n_bitrates; j++) {
1048 if (sband->bitrates[j].bitrate == rate)
1049 rates |= BIT(j);
1050 }
1051 }
1052 sdata->vif.bss_conf.basic_rates = rates;
1053 changed |= BSS_CHANGED_BASIC_RATES;
1054 }
1055
7b7b5e56
FF		 1056 if (params->ap_isolate >= 0) {
1057 if (params->ap_isolate)
1058 sdata->flags |= IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
1059 else
1060 sdata->flags &= ~IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
1061 }
1062
9f1ba906
JM		 1063 ieee80211_bss_info_change_notify(sdata, changed);
1064
1065 return 0;
1066}
1067
31888487
JM		 1068static int ieee80211_set_txq_params(struct wiphy *wiphy,
1069 struct ieee80211_txq_params *params)
1070{
1071 struct ieee80211_local *local = wiphy_priv(wiphy);
1072 struct ieee80211_tx_queue_params p;
1073
1074 if (!local->ops->conf_tx)
1075 return -EOPNOTSUPP;
1076
1077 memset(&p, 0, sizeof(p));
1078 p.aifs = params->aifs;
1079 p.cw_max = params->cwmax;
1080 p.cw_min = params->cwmin;
1081 p.txop = params->txop;
ab13315a
KV		 1082
1083 /*
1084 * Setting tx queue params disables u-apsd because it's only
1085 * called in master mode.
1086 */
1087 p.uapsd = false;
1088
24487981 1089 if (drv_conf_tx(local, params->queue, &p)) {
0fb9a9ec
JP		 1090 wiphy_debug(local->hw.wiphy,
1091 "failed to set TX queue parameters for queue %d\n",
1092 params->queue);
31888487
JM		 1093 return -EINVAL;
1094 }
1095
1096 return 0;
1097}
1098
72bdcf34 1099static int ieee80211_set_channel(struct wiphy *wiphy,
f444de05 1100 struct net_device *netdev,
72bdcf34 1101 struct ieee80211_channel *chan,
094d05dc 1102 enum nl80211_channel_type channel_type)
72bdcf34
JM		 1103{
1104 struct ieee80211_local *local = wiphy_priv(wiphy);
0aaffa9b
JB		 1105 struct ieee80211_sub_if_data *sdata = NULL;
1106
1107 if (netdev)
1108 sdata = IEEE80211_DEV_TO_SUB_IF(netdev);
72bdcf34 1109
f444de05
JB		 1110 switch (ieee80211_get_channel_mode(local, NULL)) {
1111 case CHAN_MODE_HOPPING:
1112 return -EBUSY;
1113 case CHAN_MODE_FIXED:
0aaffa9b
JB		 1114 if (local->oper_channel != chan)
1115 return -EBUSY;
1116 if (!sdata && local->_oper_channel_type == channel_type)
f444de05 1117 return 0;
0aaffa9b 1118 break;
f444de05
JB		 1119 case CHAN_MODE_UNDEFINED:
1120 break;
1121 }
72bdcf34
JM		 1122
1123 local->oper_channel = chan;
72bdcf34 1124
0aaffa9b
JB		 1125 if (!ieee80211_set_channel_type(local, sdata, channel_type))
1126 return -EBUSY;
1127
1128 ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
1129 if (sdata && sdata->vif.type != NL80211_IFTYPE_MONITOR)
1130 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_HT);
1131
1132 return 0;
72bdcf34
JM		 1133}
1134
665af4fc
BC		 1135#ifdef CONFIG_PM
1136static int ieee80211_suspend(struct wiphy *wiphy)
1137{
1138 return __ieee80211_suspend(wiphy_priv(wiphy));
1139}
1140
1141static int ieee80211_resume(struct wiphy *wiphy)
1142{
1143 return __ieee80211_resume(wiphy_priv(wiphy));
1144}
1145#else
1146#define ieee80211_suspend NULL
1147#define ieee80211_resume NULL
1148#endif
1149
2a519311
JB		 1150static int ieee80211_scan(struct wiphy *wiphy,
1151 struct net_device *dev,
1152 struct cfg80211_scan_request *req)
1153{
1154 struct ieee80211_sub_if_data *sdata;
1155
2a519311
JB		 1156 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1157
1158 if (sdata->vif.type != NL80211_IFTYPE_STATION &&
1159 sdata->vif.type != NL80211_IFTYPE_ADHOC &&
357303e2
JM		 1160 sdata->vif.type != NL80211_IFTYPE_MESH_POINT &&
1161 (sdata->vif.type != NL80211_IFTYPE_AP || sdata->u.ap.beacon))
2a519311
JB		 1162 return -EOPNOTSUPP;
1163
1164 return ieee80211_request_scan(sdata, req);
1165}
1166
636a5d36
JM		 1167static int ieee80211_auth(struct wiphy *wiphy, struct net_device *dev,
1168 struct cfg80211_auth_request *req)
1169{
77fdaa12 1170 return ieee80211_mgd_auth(IEEE80211_DEV_TO_SUB_IF(dev), req);
636a5d36
JM		 1171}
1172
1173static int ieee80211_assoc(struct wiphy *wiphy, struct net_device *dev,
1174 struct cfg80211_assoc_request *req)
1175{
f444de05
JB		 1176 struct ieee80211_local *local = wiphy_priv(wiphy);
1177 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1178
1179 switch (ieee80211_get_channel_mode(local, sdata)) {
1180 case CHAN_MODE_HOPPING:
1181 return -EBUSY;
1182 case CHAN_MODE_FIXED:
1183 if (local->oper_channel == req->bss->channel)
1184 break;
1185 return -EBUSY;
1186 case CHAN_MODE_UNDEFINED:
1187 break;
1188 }
1189
77fdaa12 1190 return ieee80211_mgd_assoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
636a5d36
JM		 1191}
1192
1193static int ieee80211_deauth(struct wiphy *wiphy, struct net_device *dev,
667503dd
JB		 1194 struct cfg80211_deauth_request *req,
1195 void *cookie)
636a5d36 1196{
667503dd
JB		 1197 return ieee80211_mgd_deauth(IEEE80211_DEV_TO_SUB_IF(dev),
1198 req, cookie);
636a5d36
JM		 1199}
1200
1201static int ieee80211_disassoc(struct wiphy *wiphy, struct net_device *dev,
667503dd
JB		 1202 struct cfg80211_disassoc_request *req,
1203 void *cookie)
636a5d36 1204{
667503dd
JB		 1205 return ieee80211_mgd_disassoc(IEEE80211_DEV_TO_SUB_IF(dev),
1206 req, cookie);
636a5d36
JM		 1207}
1208
af8cdcd8
JB		 1209static int ieee80211_join_ibss(struct wiphy *wiphy, struct net_device *dev,
1210 struct cfg80211_ibss_params *params)
1211{
f444de05 1212 struct ieee80211_local *local = wiphy_priv(wiphy);
af8cdcd8
JB		 1213 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1214
f444de05
JB		 1215 switch (ieee80211_get_channel_mode(local, sdata)) {
1216 case CHAN_MODE_HOPPING:
1217 return -EBUSY;
1218 case CHAN_MODE_FIXED:
1219 if (!params->channel_fixed)
1220 return -EBUSY;
1221 if (local->oper_channel == params->channel)
1222 break;
1223 return -EBUSY;
1224 case CHAN_MODE_UNDEFINED:
1225 break;
1226 }
1227
af8cdcd8
JB		 1228 return ieee80211_ibss_join(sdata, params);
1229}
1230
1231static int ieee80211_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
1232{
1233 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1234
1235 return ieee80211_ibss_leave(sdata);
1236}
1237
b9a5f8ca
JM		 1238static int ieee80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
1239{
1240 struct ieee80211_local *local = wiphy_priv(wiphy);
24487981 1241 int err;
b9a5f8ca 1242
310bc676
LT		 1243 if (changed & WIPHY_PARAM_COVERAGE_CLASS) {
1244 err = drv_set_coverage_class(local, wiphy->coverage_class);
1245
1246 if (err)
1247 return err;
1248 }
1249
b9a5f8ca 1250 if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
24487981 1251 err = drv_set_rts_threshold(local, wiphy->rts_threshold);
b9a5f8ca 1252
24487981
JB		 1253 if (err)
1254 return err;
b9a5f8ca
JM		 1255 }
1256
1257 if (changed & WIPHY_PARAM_RETRY_SHORT)
1258 local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
1259 if (changed & WIPHY_PARAM_RETRY_LONG)
1260 local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
1261 if (changed &
1262 (WIPHY_PARAM_RETRY_SHORT | WIPHY_PARAM_RETRY_LONG))
1263 ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_RETRY_LIMITS);
1264
1265 return 0;
1266}
1267
7643a2c3 1268static int ieee80211_set_tx_power(struct wiphy *wiphy,
fa61cf70 1269 enum nl80211_tx_power_setting type, int mbm)
7643a2c3
JB		 1270{
1271 struct ieee80211_local *local = wiphy_priv(wiphy);
1272 struct ieee80211_channel *chan = local->hw.conf.channel;
1273 u32 changes = 0;
7643a2c3
JB		 1274
1275 switch (type) {
fa61cf70 1276 case NL80211_TX_POWER_AUTOMATIC:
7643a2c3
JB		 1277 local->user_power_level = -1;
1278 break;
fa61cf70
JO		 1279 case NL80211_TX_POWER_LIMITED:
1280 if (mbm < 0 || (mbm % 100))
1281 return -EOPNOTSUPP;
1282 local->user_power_level = MBM_TO_DBM(mbm);
7643a2c3 1283 break;
fa61cf70
JO		 1284 case NL80211_TX_POWER_FIXED:
1285 if (mbm < 0 || (mbm % 100))
1286 return -EOPNOTSUPP;
7643a2c3 1287 /* TODO: move to cfg80211 when it knows the channel */
fa61cf70 1288 if (MBM_TO_DBM(mbm) > chan->max_power)
7643a2c3 1289 return -EINVAL;
fa61cf70 1290 local->user_power_level = MBM_TO_DBM(mbm);
7643a2c3 1291 break;
7643a2c3
JB		 1292 }
1293
1294 ieee80211_hw_config(local, changes);
1295
1296 return 0;
1297}
1298
1299static int ieee80211_get_tx_power(struct wiphy *wiphy, int *dbm)
1300{
1301 struct ieee80211_local *local = wiphy_priv(wiphy);
1302
1303 *dbm = local->hw.conf.power_level;
1304
7643a2c3
JB		 1305 return 0;
1306}
1307
ab737a4f
JB		 1308static int ieee80211_set_wds_peer(struct wiphy *wiphy, struct net_device *dev,
1309 u8 *addr)
1310{
1311 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1312
1313 memcpy(&sdata->u.wds.remote_addr, addr, ETH_ALEN);
1314
1315 return 0;
1316}
1317
1f87f7d3
JB		 1318static void ieee80211_rfkill_poll(struct wiphy *wiphy)
1319{
1320 struct ieee80211_local *local = wiphy_priv(wiphy);
1321
1322 drv_rfkill_poll(local);
1323}
1324
aff89a9b 1325#ifdef CONFIG_NL80211_TESTMODE
99783e2c 1326static int ieee80211_testmode_cmd(struct wiphy *wiphy, void *data, int len)
aff89a9b
JB		 1327{
1328 struct ieee80211_local *local = wiphy_priv(wiphy);
1329
1330 if (!local->ops->testmode_cmd)
1331 return -EOPNOTSUPP;
1332
1333 return local->ops->testmode_cmd(&local->hw, data, len);
1334}
1335#endif
1336
0f78231b
JB		 1337int __ieee80211_request_smps(struct ieee80211_sub_if_data *sdata,
1338 enum ieee80211_smps_mode smps_mode)
1339{
1340 const u8 *ap;
1341 enum ieee80211_smps_mode old_req;
1342 int err;
1343
1344 old_req = sdata->u.mgd.req_smps;
1345 sdata->u.mgd.req_smps = smps_mode;
1346
1347 if (old_req == smps_mode &&
1348 smps_mode != IEEE80211_SMPS_AUTOMATIC)
1349 return 0;
1350
1351 /*
1352 * If not associated, or current association is not an HT
1353 * association, there's no need to send an action frame.
1354 */
1355 if (!sdata->u.mgd.associated ||
0aaffa9b 1356 sdata->vif.bss_conf.channel_type == NL80211_CHAN_NO_HT) {
0f78231b
JB		 1357 mutex_lock(&sdata->local->iflist_mtx);
1358 ieee80211_recalc_smps(sdata->local, sdata);
1359 mutex_unlock(&sdata->local->iflist_mtx);
1360 return 0;
1361 }
1362
0c1ad2ca 1363 ap = sdata->u.mgd.associated->bssid;
0f78231b
JB		 1364
1365 if (smps_mode == IEEE80211_SMPS_AUTOMATIC) {
1366 if (sdata->u.mgd.powersave)
1367 smps_mode = IEEE80211_SMPS_DYNAMIC;
1368 else
1369 smps_mode = IEEE80211_SMPS_OFF;
1370 }
1371
1372 /* send SM PS frame to AP */
1373 err = ieee80211_send_smps_action(sdata, smps_mode,
1374 ap, ap);
1375 if (err)
1376 sdata->u.mgd.req_smps = old_req;
1377
1378 return err;
1379}
1380
bc92afd9
JB		 1381static int ieee80211_set_power_mgmt(struct wiphy *wiphy, struct net_device *dev,
1382 bool enabled, int timeout)
1383{
1384 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1385 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
bc92afd9 1386
e5de30c9
BP		 1387 if (sdata->vif.type != NL80211_IFTYPE_STATION)
1388 return -EOPNOTSUPP;
1389
bc92afd9
JB		 1390 if (!(local->hw.flags & IEEE80211_HW_SUPPORTS_PS))
1391 return -EOPNOTSUPP;
1392
1393 if (enabled == sdata->u.mgd.powersave &&
ff616381 1394 timeout == local->dynamic_ps_forced_timeout)
bc92afd9
JB		 1395 return 0;
1396
1397 sdata->u.mgd.powersave = enabled;
ff616381 1398 local->dynamic_ps_forced_timeout = timeout;
bc92afd9 1399
0f78231b
JB		 1400 /* no change, but if automatic follow powersave */
1401 mutex_lock(&sdata->u.mgd.mtx);
1402 __ieee80211_request_smps(sdata, sdata->u.mgd.req_smps);
1403 mutex_unlock(&sdata->u.mgd.mtx);
1404
bc92afd9
JB		 1405 if (local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_PS)
1406 ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
1407
1408 ieee80211_recalc_ps(local, -1);
1409
1410 return 0;
1411}
1412
a97c13c3
JO		 1413static int ieee80211_set_cqm_rssi_config(struct wiphy *wiphy,
1414 struct net_device *dev,
1415 s32 rssi_thold, u32 rssi_hyst)
1416{
1417 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1418 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1419 struct ieee80211_vif *vif = &sdata->vif;
1420 struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
1421
a97c13c3
JO		 1422 if (rssi_thold == bss_conf->cqm_rssi_thold &&
1423 rssi_hyst == bss_conf->cqm_rssi_hyst)
1424 return 0;
1425
1426 bss_conf->cqm_rssi_thold = rssi_thold;
1427 bss_conf->cqm_rssi_hyst = rssi_hyst;
1428
17e4ec14
JM		 1429 if (!(local->hw.flags & IEEE80211_HW_SUPPORTS_CQM_RSSI)) {
1430 if (sdata->vif.type != NL80211_IFTYPE_STATION)
1431 return -EOPNOTSUPP;
1432 return 0;
1433 }
1434
a97c13c3
JO		 1435 /* tell the driver upon association, unless already associated */
1436 if (sdata->u.mgd.associated)
1437 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_CQM);
1438
1439 return 0;
1440}
1441
9930380f
JB		 1442static int ieee80211_set_bitrate_mask(struct wiphy *wiphy,
1443 struct net_device *dev,
1444 const u8 *addr,
1445 const struct cfg80211_bitrate_mask *mask)
1446{
1447 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1448 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2c7e6bc9 1449 int i;
9930380f 1450
2c7e6bc9
JB		 1451 /*
1452 * This _could_ be supported by providing a hook for
1453 * drivers for this function, but at this point it
1454 * doesn't seem worth bothering.
1455 */
1456 if (local->hw.flags & IEEE80211_HW_HAS_RATE_CONTROL)
1457 return -EOPNOTSUPP;
1458
9930380f 1459
37eb0b16
JM		 1460 for (i = 0; i < IEEE80211_NUM_BANDS; i++)
1461 sdata->rc_rateidx_mask[i] = mask->control[i].legacy;
9930380f 1462
37eb0b16 1463 return 0;
9930380f
JB		 1464}
1465
b8bc4b0a
JB		 1466static int ieee80211_remain_on_channel(struct wiphy *wiphy,
1467 struct net_device *dev,
1468 struct ieee80211_channel *chan,
1469 enum nl80211_channel_type channel_type,
1470 unsigned int duration,
1471 u64 *cookie)
1472{
1473 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1474
1475 return ieee80211_wk_remain_on_channel(sdata, chan, channel_type,
1476 duration, cookie);
1477}
1478
1479static int ieee80211_cancel_remain_on_channel(struct wiphy *wiphy,
1480 struct net_device *dev,
1481 u64 cookie)
1482{
1483 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1484
1485 return ieee80211_wk_cancel_remain_on_channel(sdata, cookie);
1486}
1487
2e161f78
JB		 1488static int ieee80211_mgmt_tx(struct wiphy *wiphy, struct net_device *dev,
1489 struct ieee80211_channel *chan,
1490 enum nl80211_channel_type channel_type,
1491 bool channel_type_valid,
1492 const u8 *buf, size_t len, u64 *cookie)
026331c4 1493{
9d38d85d
JB		 1494 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1495 struct ieee80211_local *local = sdata->local;
1496 struct sk_buff *skb;
1497 struct sta_info *sta;
1498 const struct ieee80211_mgmt *mgmt = (void *)buf;
1499 u32 flags = IEEE80211_TX_INTFL_NL80211_FRAME_TX |
1500 IEEE80211_TX_CTL_REQ_TX_STATUS;
1501
1502 /* Check that we are on the requested channel for transmission */
1503 if (chan != local->tmp_channel &&
1504 chan != local->oper_channel)
1505 return -EBUSY;
1506 if (channel_type_valid &&
1507 (channel_type != local->tmp_channel_type &&
1508 channel_type != local->_oper_channel_type))
1509 return -EBUSY;
1510
1511 switch (sdata->vif.type) {
1512 case NL80211_IFTYPE_ADHOC:
1513 if (mgmt->u.action.category == WLAN_CATEGORY_PUBLIC)
1514 break;
1515 rcu_read_lock();
1516 sta = sta_info_get(sdata, mgmt->da);
1517 rcu_read_unlock();
1518 if (!sta)
1519 return -ENOLINK;
1520 break;
1521 case NL80211_IFTYPE_STATION:
9d38d85d
JB		 1522 break;
1523 default:
1524 return -EOPNOTSUPP;
1525 }
1526
1527 skb = dev_alloc_skb(local->hw.extra_tx_headroom + len);
1528 if (!skb)
1529 return -ENOMEM;
1530 skb_reserve(skb, local->hw.extra_tx_headroom);
1531
1532 memcpy(skb_put(skb, len), buf, len);
1533
1534 IEEE80211_SKB_CB(skb)->flags = flags;
1535
1536 skb->dev = sdata->dev;
1537 ieee80211_tx_skb(sdata, skb);
1538
1539 *cookie = (unsigned long) skb;
1540 return 0;
026331c4
JM		 1541}
1542
f0706e82
JB		 1543struct cfg80211_ops mac80211_config_ops = {
1544 .add_virtual_intf = ieee80211_add_iface,
1545 .del_virtual_intf = ieee80211_del_iface,
42613db7 1546 .change_virtual_intf = ieee80211_change_iface,
e8cbb4cb
JB		 1547 .add_key = ieee80211_add_key,
1548 .del_key = ieee80211_del_key,
62da92fb 1549 .get_key = ieee80211_get_key,
e8cbb4cb 1550 .set_default_key = ieee80211_config_default_key,
3cfcf6ac 1551 .set_default_mgmt_key = ieee80211_config_default_mgmt_key,
5dfdaf58
JB		 1552 .add_beacon = ieee80211_add_beacon,
1553 .set_beacon = ieee80211_set_beacon,
1554 .del_beacon = ieee80211_del_beacon,
4fd6931e
JB		 1555 .add_station = ieee80211_add_station,
1556 .del_station = ieee80211_del_station,
1557 .change_station = ieee80211_change_station,
7bbdd2d9 1558 .get_station = ieee80211_get_station,
c5dd9c2b 1559 .dump_station = ieee80211_dump_station,
1289723e 1560 .dump_survey = ieee80211_dump_survey,
c5dd9c2b
LCC		 1561#ifdef CONFIG_MAC80211_MESH
1562 .add_mpath = ieee80211_add_mpath,
1563 .del_mpath = ieee80211_del_mpath,
1564 .change_mpath = ieee80211_change_mpath,
1565 .get_mpath = ieee80211_get_mpath,
1566 .dump_mpath = ieee80211_dump_mpath,
93da9cc1 1567 .set_mesh_params = ieee80211_set_mesh_params,
1568 .get_mesh_params = ieee80211_get_mesh_params,
c5dd9c2b 1569#endif
9f1ba906 1570 .change_bss = ieee80211_change_bss,
31888487 1571 .set_txq_params = ieee80211_set_txq_params,
72bdcf34 1572 .set_channel = ieee80211_set_channel,
665af4fc
BC		 1573 .suspend = ieee80211_suspend,
1574 .resume = ieee80211_resume,
2a519311 1575 .scan = ieee80211_scan,
636a5d36
JM		 1576 .auth = ieee80211_auth,
1577 .assoc = ieee80211_assoc,
1578 .deauth = ieee80211_deauth,
1579 .disassoc = ieee80211_disassoc,
af8cdcd8
JB		 1580 .join_ibss = ieee80211_join_ibss,
1581 .leave_ibss = ieee80211_leave_ibss,
b9a5f8ca 1582 .set_wiphy_params = ieee80211_set_wiphy_params,
7643a2c3
JB		 1583 .set_tx_power = ieee80211_set_tx_power,
1584 .get_tx_power = ieee80211_get_tx_power,
ab737a4f 1585 .set_wds_peer = ieee80211_set_wds_peer,
1f87f7d3 1586 .rfkill_poll = ieee80211_rfkill_poll,
aff89a9b 1587 CFG80211_TESTMODE_CMD(ieee80211_testmode_cmd)
bc92afd9 1588 .set_power_mgmt = ieee80211_set_power_mgmt,
9930380f 1589 .set_bitrate_mask = ieee80211_set_bitrate_mask,
b8bc4b0a
JB		 1590 .remain_on_channel = ieee80211_remain_on_channel,
1591 .cancel_remain_on_channel = ieee80211_cancel_remain_on_channel,
2e161f78 1592 .mgmt_tx = ieee80211_mgmt_tx,
a97c13c3 1593 .set_cqm_rssi_config = ieee80211_set_cqm_rssi_config,
f0706e82 1594};
kernel source for telekom puls (alcatel/mediatek)