cfg.c 34.6 KB
Newer Older
1
2
3
/*
 * mac80211 configuration hooks for cfg80211
 *
4
 * Copyright 2006, 2007	Johannes Berg <johannes@sipsolutions.net>
5
6
7
8
 *
 * This file is GPLv2 as found in COPYING.
 */

9
#include <linux/ieee80211.h>
10
11
#include <linux/nl80211.h>
#include <linux/rtnetlink.h>
12
#include <net/net_namespace.h>
13
#include <linux/rcupdate.h>
14
15
#include <net/cfg80211.h>
#include "ieee80211_i.h"
16
#include "driver-ops.h"
17
#include "cfg.h"
Johannes Berg's avatar
Johannes Berg committed
18
#include "rate.h"
19
20
#include "mesh.h"

21
static bool nl80211_type_check(enum nl80211_iftype type)
22
23
24
25
26
{
	switch (type) {
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_MONITOR:
27
28
29
#ifdef CONFIG_MAC80211_MESH
	case NL80211_IFTYPE_MESH_POINT:
#endif
30
31
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
Johannes Berg's avatar
Johannes Berg committed
32
	case NL80211_IFTYPE_WDS:
33
		return true;
34
	default:
35
		return false;
36
37
38
	}
}

39
40
41
42
43
44
45
46
47
static bool nl80211_params_check(enum nl80211_iftype type,
				 struct vif_params *params)
{
	if (!nl80211_type_check(type))
		return false;

	return true;
}

48
static int ieee80211_add_iface(struct wiphy *wiphy, char *name,
49
50
			       enum nl80211_iftype type, u32 *flags,
			       struct vif_params *params)
51
52
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
53
54
55
	struct net_device *dev;
	struct ieee80211_sub_if_data *sdata;
	int err;
56

57
	if (!nl80211_params_check(type, params))
58
59
		return -EINVAL;

60
61
	err = ieee80211_if_add(local, name, &dev, type, params);
	if (err || type != NL80211_IFTYPE_MONITOR || !flags)
62
63
64
65
66
		return err;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	sdata->u.mntr_flags = *flags;
	return 0;
67
68
}

69
static int ieee80211_del_iface(struct wiphy *wiphy, struct net_device *dev)
70
{
71
	ieee80211_if_remove(IEEE80211_DEV_TO_SUB_IF(dev));
72

73
	return 0;
74
75
}

76
77
static int ieee80211_change_iface(struct wiphy *wiphy,
				  struct net_device *dev,
78
79
				  enum nl80211_iftype type, u32 *flags,
				  struct vif_params *params)
80
81
{
	struct ieee80211_sub_if_data *sdata;
82
	int ret;
83

84
85
86
	if (netif_running(dev))
		return -EBUSY;

87
	if (!nl80211_params_check(type, params))
88
89
90
91
		return -EINVAL;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

92
	ret = ieee80211_if_change_type(sdata, type);
93
94
	if (ret)
		return ret;
95

Johannes Berg's avatar
Johannes Berg committed
96
	if (ieee80211_vif_is_mesh(&sdata->vif) && params->mesh_id_len)
97
98
99
		ieee80211_sdata_set_mesh_id(sdata,
					    params->mesh_id_len,
					    params->mesh_id);
100

101
	if (sdata->vif.type != NL80211_IFTYPE_MONITOR || !flags)
102
103
		return 0;

104
105
106
107
108
109
110
	if (type == NL80211_IFTYPE_AP_VLAN &&
	    params && params->use_4addr == 0)
		rcu_assign_pointer(sdata->u.vlan.sta, NULL);
	else if (type == NL80211_IFTYPE_STATION &&
		 params && params->use_4addr >= 0)
		sdata->u.mgd.use_4addr = params->use_4addr;

111
	sdata->u.mntr_flags = *flags;
112
113
114
	return 0;
}

115
static int ieee80211_add_key(struct wiphy *wiphy, struct net_device *dev,
116
			     u8 key_idx, const u8 *mac_addr,
117
118
119
120
121
			     struct key_params *params)
{
	struct ieee80211_sub_if_data *sdata;
	struct sta_info *sta = NULL;
	enum ieee80211_key_alg alg;
122
	struct ieee80211_key *key;
123
	int err;
124
125
126
127
128
129
130
131
132
133
134
135
136
137

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	switch (params->cipher) {
	case WLAN_CIPHER_SUITE_WEP40:
	case WLAN_CIPHER_SUITE_WEP104:
		alg = ALG_WEP;
		break;
	case WLAN_CIPHER_SUITE_TKIP:
		alg = ALG_TKIP;
		break;
	case WLAN_CIPHER_SUITE_CCMP:
		alg = ALG_CCMP;
		break;
138
139
140
	case WLAN_CIPHER_SUITE_AES_CMAC:
		alg = ALG_AES_CMAC;
		break;
141
142
143
144
	default:
		return -EINVAL;
	}

145
146
	key = ieee80211_key_alloc(alg, key_idx, params->key_len, params->key,
				  params->seq_len, params->seq);
147
148
149
	if (!key)
		return -ENOMEM;

150
151
	rcu_read_lock();

152
	if (mac_addr) {
153
		sta = sta_info_get(sdata, mac_addr);
154
155
		if (!sta) {
			ieee80211_key_free(key);
156
157
			err = -ENOENT;
			goto out_unlock;
158
		}
159
160
	}

161
162
	ieee80211_key_link(key, sdata, sta);

163
164
165
166
167
	err = 0;
 out_unlock:
	rcu_read_unlock();

	return err;
168
169
170
}

static int ieee80211_del_key(struct wiphy *wiphy, struct net_device *dev,
171
			     u8 key_idx, const u8 *mac_addr)
172
173
174
175
176
177
178
{
	struct ieee80211_sub_if_data *sdata;
	struct sta_info *sta;
	int ret;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

179
180
	rcu_read_lock();

181
	if (mac_addr) {
182
183
		ret = -ENOENT;

184
		sta = sta_info_get(sdata, mac_addr);
185
		if (!sta)
186
			goto out_unlock;
187

188
		if (sta->key) {
189
			ieee80211_key_free(sta->key);
190
			WARN_ON(sta->key);
191
192
			ret = 0;
		}
193

194
		goto out_unlock;
195
196
	}

197
198
199
200
	if (!sdata->keys[key_idx]) {
		ret = -ENOENT;
		goto out_unlock;
	}
201

202
	ieee80211_key_free(sdata->keys[key_idx]);
203
	WARN_ON(sdata->keys[key_idx]);
204

205
206
207
208
209
	ret = 0;
 out_unlock:
	rcu_read_unlock();

	return ret;
210
211
}

212
static int ieee80211_get_key(struct wiphy *wiphy, struct net_device *dev,
213
			     u8 key_idx, const u8 *mac_addr, void *cookie,
214
215
216
			     void (*callback)(void *cookie,
					      struct key_params *params))
{
217
	struct ieee80211_sub_if_data *sdata;
218
219
220
221
222
223
224
225
	struct sta_info *sta = NULL;
	u8 seq[6] = {0};
	struct key_params params;
	struct ieee80211_key *key;
	u32 iv32;
	u16 iv16;
	int err = -ENOENT;

226
227
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

228
229
	rcu_read_lock();

230
	if (mac_addr) {
231
		sta = sta_info_get(sdata, mac_addr);
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
		if (!sta)
			goto out;

		key = sta->key;
	} else
		key = sdata->keys[key_idx];

	if (!key)
		goto out;

	memset(&params, 0, sizeof(params));

	switch (key->conf.alg) {
	case ALG_TKIP:
		params.cipher = WLAN_CIPHER_SUITE_TKIP;

248
249
		iv32 = key->u.tkip.tx.iv32;
		iv16 = key->u.tkip.tx.iv16;
250

251
252
253
254
		if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE)
			drv_get_tkip_seq(sdata->local,
					 key->conf.hw_key_idx,
					 &iv32, &iv16);
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281

		seq[0] = iv16 & 0xff;
		seq[1] = (iv16 >> 8) & 0xff;
		seq[2] = iv32 & 0xff;
		seq[3] = (iv32 >> 8) & 0xff;
		seq[4] = (iv32 >> 16) & 0xff;
		seq[5] = (iv32 >> 24) & 0xff;
		params.seq = seq;
		params.seq_len = 6;
		break;
	case ALG_CCMP:
		params.cipher = WLAN_CIPHER_SUITE_CCMP;
		seq[0] = key->u.ccmp.tx_pn[5];
		seq[1] = key->u.ccmp.tx_pn[4];
		seq[2] = key->u.ccmp.tx_pn[3];
		seq[3] = key->u.ccmp.tx_pn[2];
		seq[4] = key->u.ccmp.tx_pn[1];
		seq[5] = key->u.ccmp.tx_pn[0];
		params.seq = seq;
		params.seq_len = 6;
		break;
	case ALG_WEP:
		if (key->conf.keylen == 5)
			params.cipher = WLAN_CIPHER_SUITE_WEP40;
		else
			params.cipher = WLAN_CIPHER_SUITE_WEP104;
		break;
282
283
284
285
286
287
288
289
290
291
292
	case ALG_AES_CMAC:
		params.cipher = WLAN_CIPHER_SUITE_AES_CMAC;
		seq[0] = key->u.aes_cmac.tx_pn[5];
		seq[1] = key->u.aes_cmac.tx_pn[4];
		seq[2] = key->u.aes_cmac.tx_pn[3];
		seq[3] = key->u.aes_cmac.tx_pn[2];
		seq[4] = key->u.aes_cmac.tx_pn[1];
		seq[5] = key->u.aes_cmac.tx_pn[0];
		params.seq = seq;
		params.seq_len = 6;
		break;
293
294
295
296
297
298
299
300
301
	}

	params.key = key->conf.key;
	params.key_len = key->conf.keylen;

	callback(cookie, &params);
	err = 0;

 out:
302
	rcu_read_unlock();
303
304
305
	return err;
}

306
307
308
309
310
311
static int ieee80211_config_default_key(struct wiphy *wiphy,
					struct net_device *dev,
					u8 key_idx)
{
	struct ieee80211_sub_if_data *sdata;

312
313
	rcu_read_lock();

314
315
316
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	ieee80211_set_default_key(sdata, key_idx);

317
318
	rcu_read_unlock();

319
320
321
	return 0;
}

322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
static int ieee80211_config_default_mgmt_key(struct wiphy *wiphy,
					     struct net_device *dev,
					     u8 key_idx)
{
	struct ieee80211_sub_if_data *sdata;

	rcu_read_lock();

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	ieee80211_set_default_mgmt_key(sdata, key_idx);

	rcu_read_unlock();

	return 0;
}

338
339
static void sta_set_sinfo(struct sta_info *sta, struct station_info *sinfo)
{
340
	struct ieee80211_sub_if_data *sdata = sta->sdata;
341

342
343
	sinfo->generation = sdata->local->sta_generation;

344
345
	sinfo->filled = STATION_INFO_INACTIVE_TIME |
			STATION_INFO_RX_BYTES |
346
			STATION_INFO_TX_BYTES |
347
348
			STATION_INFO_RX_PACKETS |
			STATION_INFO_TX_PACKETS |
349
			STATION_INFO_TX_BITRATE;
350
351
352
353

	sinfo->inactive_time = jiffies_to_msecs(jiffies - sta->last_rx);
	sinfo->rx_bytes = sta->rx_bytes;
	sinfo->tx_bytes = sta->tx_bytes;
354
355
	sinfo->rx_packets = sta->rx_packets;
	sinfo->tx_packets = sta->tx_packets;
356

357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
	if (sta->local->hw.flags & IEEE80211_HW_SIGNAL_DBM) {
		sinfo->filled |= STATION_INFO_SIGNAL;
		sinfo->signal = (s8)sta->last_signal;
	}

	sinfo->txrate.flags = 0;
	if (sta->last_tx_rate.flags & IEEE80211_TX_RC_MCS)
		sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS;
	if (sta->last_tx_rate.flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
		sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH;
	if (sta->last_tx_rate.flags & IEEE80211_TX_RC_SHORT_GI)
		sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI;

	if (!(sta->last_tx_rate.flags & IEEE80211_TX_RC_MCS)) {
		struct ieee80211_supported_band *sband;
		sband = sta->local->hw.wiphy->bands[
				sta->local->hw.conf.channel->band];
		sinfo->txrate.legacy =
			sband->bitrates[sta->last_tx_rate.idx].bitrate;
	} else
		sinfo->txrate.mcs = sta->last_tx_rate.idx;

Johannes Berg's avatar
Johannes Berg committed
379
	if (ieee80211_vif_is_mesh(&sdata->vif)) {
380
381
382
383
384
385
386
387
388
#ifdef CONFIG_MAC80211_MESH
		sinfo->filled |= STATION_INFO_LLID |
				 STATION_INFO_PLID |
				 STATION_INFO_PLINK_STATE;

		sinfo->llid = le16_to_cpu(sta->llid);
		sinfo->plid = le16_to_cpu(sta->plid);
		sinfo->plink_state = sta->plink_state;
#endif
Johannes Berg's avatar
Johannes Berg committed
389
	}
390
391
392
393
394
395
}


static int ieee80211_dump_station(struct wiphy *wiphy, struct net_device *dev,
				 int idx, u8 *mac, struct station_info *sinfo)
{
396
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
397
	struct sta_info *sta;
398
399
400
	int ret = -ENOENT;

	rcu_read_lock();
401

402
	sta = sta_info_get_by_idx(sdata, idx);
403
404
	if (sta) {
		ret = 0;
405
		memcpy(mac, sta->sta.addr, ETH_ALEN);
406
407
		sta_set_sinfo(sta, sinfo);
	}
408

409
	rcu_read_unlock();
410

411
	return ret;
412
413
}

414
static int ieee80211_get_station(struct wiphy *wiphy, struct net_device *dev,
415
				 u8 *mac, struct station_info *sinfo)
416
{
417
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
418
	struct sta_info *sta;
419
	int ret = -ENOENT;
420

421
	rcu_read_lock();
422

423
	sta = sta_info_get(sdata, mac);
424
425
426
427
428
429
430
431
	if (sta) {
		ret = 0;
		sta_set_sinfo(sta, sinfo);
	}

	rcu_read_unlock();

	return ret;
432
433
}

434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
/*
 * This handles both adding a beacon and setting new beacon info
 */
static int ieee80211_config_beacon(struct ieee80211_sub_if_data *sdata,
				   struct beacon_parameters *params)
{
	struct beacon_data *new, *old;
	int new_head_len, new_tail_len;
	int size;
	int err = -EINVAL;

	old = sdata->u.ap.beacon;

	/* head must not be zero-length */
	if (params->head && !params->head_len)
		return -EINVAL;

	/*
	 * This is a kludge. beacon interval should really be part
	 * of the beacon information.
	 */
455
456
457
458
459
	if (params->interval &&
	    (sdata->vif.bss_conf.beacon_int != params->interval)) {
		sdata->vif.bss_conf.beacon_int = params->interval;
		ieee80211_bss_info_change_notify(sdata,
						 BSS_CHANGED_BEACON_INT);
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
	}

	/* Need to have a beacon head if we don't have one yet */
	if (!params->head && !old)
		return err;

	/* sorry, no way to start beaconing without dtim period */
	if (!params->dtim_period && !old)
		return err;

	/* new or old head? */
	if (params->head)
		new_head_len = params->head_len;
	else
		new_head_len = old->head_len;

	/* new or old tail? */
	if (params->tail || !old)
		/* params->tail_len will be zero for !params->tail */
		new_tail_len = params->tail_len;
	else
		new_tail_len = old->tail_len;

	size = sizeof(*new) + new_head_len + new_tail_len;

	new = kzalloc(size, GFP_KERNEL);
	if (!new)
		return -ENOMEM;

	/* start filling the new info now */

	/* new or old dtim period? */
	if (params->dtim_period)
		new->dtim_period = params->dtim_period;
	else
		new->dtim_period = old->dtim_period;

	/*
	 * pointers go into the block we allocated,
	 * memory is | beacon_data | head | tail |
	 */
	new->head = ((u8 *) new) + sizeof(*new);
	new->tail = new->head + new_head_len;
	new->head_len = new_head_len;
	new->tail_len = new_tail_len;

	/* copy in head */
	if (params->head)
		memcpy(new->head, params->head, new_head_len);
	else
		memcpy(new->head, old->head, new_head_len);

	/* copy in optional tail */
	if (params->tail)
		memcpy(new->tail, params->tail, new_tail_len);
	else
		if (old)
			memcpy(new->tail, old->tail, new_tail_len);

	rcu_assign_pointer(sdata->u.ap.beacon, new);

	synchronize_rcu();

	kfree(old);

525
526
527
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED |
						BSS_CHANGED_BEACON);
	return 0;
528
529
530
531
532
}

static int ieee80211_add_beacon(struct wiphy *wiphy, struct net_device *dev,
				struct beacon_parameters *params)
{
533
	struct ieee80211_sub_if_data *sdata;
534
535
	struct beacon_data *old;

536
537
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

538
539
540
541
542
543
544
545
546
547
548
	old = sdata->u.ap.beacon;

	if (old)
		return -EALREADY;

	return ieee80211_config_beacon(sdata, params);
}

static int ieee80211_set_beacon(struct wiphy *wiphy, struct net_device *dev,
				struct beacon_parameters *params)
{
549
	struct ieee80211_sub_if_data *sdata;
550
551
	struct beacon_data *old;

552
553
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

554
555
556
557
558
559
560
561
562
563
	old = sdata->u.ap.beacon;

	if (!old)
		return -ENOENT;

	return ieee80211_config_beacon(sdata, params);
}

static int ieee80211_del_beacon(struct wiphy *wiphy, struct net_device *dev)
{
564
	struct ieee80211_sub_if_data *sdata;
565
566
	struct beacon_data *old;

567
568
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

569
570
571
572
573
574
575
576
577
	old = sdata->u.ap.beacon;

	if (!old)
		return -ENOENT;

	rcu_assign_pointer(sdata->u.ap.beacon, NULL);
	synchronize_rcu();
	kfree(old);

578
579
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED);
	return 0;
580
581
}

582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
/* Layer 2 Update frame (802.2 Type 1 LLC XID Update response) */
struct iapp_layer2_update {
	u8 da[ETH_ALEN];	/* broadcast */
	u8 sa[ETH_ALEN];	/* STA addr */
	__be16 len;		/* 6 */
	u8 dsap;		/* 0 */
	u8 ssap;		/* 0 */
	u8 control;
	u8 xid_info[3];
} __attribute__ ((packed));

static void ieee80211_send_layer2_update(struct sta_info *sta)
{
	struct iapp_layer2_update *msg;
	struct sk_buff *skb;

	/* Send Level 2 Update Frame to update forwarding tables in layer 2
	 * bridge devices */

	skb = dev_alloc_skb(sizeof(*msg));
	if (!skb)
		return;
	msg = (struct iapp_layer2_update *)skb_put(skb, sizeof(*msg));

	/* 802.2 Type 1 Logical Link Control (LLC) Exchange Identifier (XID)
	 * Update response frame; IEEE Std 802.2-1998, 5.4.1.2.1 */

	memset(msg->da, 0xff, ETH_ALEN);
610
	memcpy(msg->sa, sta->sta.addr, ETH_ALEN);
611
612
613
614
615
616
617
618
619
	msg->len = htons(6);
	msg->dsap = 0;
	msg->ssap = 0x01;	/* NULL LSAP, CR Bit: Response */
	msg->control = 0xaf;	/* XID response lsb.1111F101.
				 * F=0 (no poll command; unsolicited frame) */
	msg->xid_info[0] = 0x81;	/* XID format identifier */
	msg->xid_info[1] = 1;	/* LLC types/classes: Type 1 LLC */
	msg->xid_info[2] = 0;	/* XID sender's receive window size (RW) */

620
621
	skb->dev = sta->sdata->dev;
	skb->protocol = eth_type_trans(skb, sta->sdata->dev);
622
623
624
625
626
627
628
629
630
631
	memset(skb->cb, 0, sizeof(skb->cb));
	netif_rx(skb);
}

static void sta_apply_parameters(struct ieee80211_local *local,
				 struct sta_info *sta,
				 struct station_parameters *params)
{
	u32 rates;
	int i, j;
632
	struct ieee80211_supported_band *sband;
633
	struct ieee80211_sub_if_data *sdata = sta->sdata;
634
	u32 mask, set;
635

Johannes Berg's avatar
Johannes Berg committed
636
637
	sband = local->hw.wiphy->bands[local->oper_channel->band];

638
639
640
	spin_lock_bh(&sta->lock);
	mask = params->sta_flags_mask;
	set = params->sta_flags_set;
Johannes Berg's avatar
Johannes Berg committed
641

642
	if (mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
643
		sta->flags &= ~WLAN_STA_AUTHORIZED;
644
		if (set & BIT(NL80211_STA_FLAG_AUTHORIZED))
645
			sta->flags |= WLAN_STA_AUTHORIZED;
646
	}
647

648
	if (mask & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE)) {
649
		sta->flags &= ~WLAN_STA_SHORT_PREAMBLE;
650
		if (set & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE))
651
			sta->flags |= WLAN_STA_SHORT_PREAMBLE;
652
	}
653

654
	if (mask & BIT(NL80211_STA_FLAG_WME)) {
655
		sta->flags &= ~WLAN_STA_WME;
656
		if (set & BIT(NL80211_STA_FLAG_WME))
657
			sta->flags |= WLAN_STA_WME;
658
	}
659

660
	if (mask & BIT(NL80211_STA_FLAG_MFP)) {
661
		sta->flags &= ~WLAN_STA_MFP;
662
		if (set & BIT(NL80211_STA_FLAG_MFP))
663
			sta->flags |= WLAN_STA_MFP;
664
	}
665
	spin_unlock_bh(&sta->lock);
666

667
668
669
670
671
672
673
	/*
	 * cfg80211 validates this (1-2007) and allows setting the AID
	 * only when creating a new station entry
	 */
	if (params->aid)
		sta->sta.aid = params->aid;

Johannes Berg's avatar
Johannes Berg committed
674
675
676
677
678
679
680
	/*
	 * FIXME: updating the following information is racy when this
	 *	  function is called from ieee80211_change_station().
	 *	  However, all this information should be static so
	 *	  maybe we should just reject attemps to change it.
	 */

681
682
683
684
685
	if (params->listen_interval >= 0)
		sta->listen_interval = params->listen_interval;

	if (params->supported_rates) {
		rates = 0;
686

687
688
		for (i = 0; i < params->supported_rates_len; i++) {
			int rate = (params->supported_rates[i] & 0x7f) * 5;
689
690
			for (j = 0; j < sband->n_bitrates; j++) {
				if (sband->bitrates[j].bitrate == rate)
691
692
693
					rates |= BIT(j);
			}
		}
694
		sta->sta.supp_rates[local->oper_channel->band] = rates;
695
	}
696

697
	if (params->ht_capa)
Johannes Berg's avatar
Johannes Berg committed
698
699
		ieee80211_ht_cap_ie_to_sta_ht_cap(sband,
						  params->ht_capa,
700
						  &sta->sta.ht_cap);
701

Johannes Berg's avatar
Johannes Berg committed
702
	if (ieee80211_vif_is_mesh(&sdata->vif) && params->plink_action) {
703
704
705
706
707
708
709
710
		switch (params->plink_action) {
		case PLINK_ACTION_OPEN:
			mesh_plink_open(sta);
			break;
		case PLINK_ACTION_BLOCK:
			mesh_plink_block(sta);
			break;
		}
Johannes Berg's avatar
Johannes Berg committed
711
	}
712
713
714
715
716
}

static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
				 u8 *mac, struct station_parameters *params)
{
717
	struct ieee80211_local *local = wiphy_priv(wiphy);
718
719
	struct sta_info *sta;
	struct ieee80211_sub_if_data *sdata;
Johannes Berg's avatar
Johannes Berg committed
720
	int err;
721
	int layer2_update;
722
723
724
725

	if (params->vlan) {
		sdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);

726
727
		if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
		    sdata->vif.type != NL80211_IFTYPE_AP)
728
729
730
731
			return -EINVAL;
	} else
		sdata = IEEE80211_DEV_TO_SUB_IF(dev);

732
	if (compare_ether_addr(mac, sdata->vif.addr) == 0)
733
734
735
736
737
738
		return -EINVAL;

	if (is_multicast_ether_addr(mac))
		return -EINVAL;

	sta = sta_info_alloc(sdata, mac, GFP_KERNEL);
Johannes Berg's avatar
Johannes Berg committed
739
740
	if (!sta)
		return -ENOMEM;
741
742
743
744
745

	sta->flags = WLAN_STA_AUTH | WLAN_STA_ASSOC;

	sta_apply_parameters(local, sta, params);

746
	rate_control_rate_init(sta);
747

748
749
750
	layer2_update = sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
		sdata->vif.type == NL80211_IFTYPE_AP;

Johannes Berg's avatar
Johannes Berg committed
751
752
753
754
755
756
757
758
	rcu_read_lock();

	err = sta_info_insert(sta);
	if (err) {
		rcu_read_unlock();
		return err;
	}

759
	if (layer2_update)
Johannes Berg's avatar
Johannes Berg committed
760
761
762
763
		ieee80211_send_layer2_update(sta);

	rcu_read_unlock();

764
765
766
767
768
769
	return 0;
}

static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev,
				 u8 *mac)
{
770
771
	struct ieee80211_local *local = wiphy_priv(wiphy);
	struct ieee80211_sub_if_data *sdata;
772
773
	struct sta_info *sta;

774
775
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

776
	if (mac) {
Johannes Berg's avatar
Johannes Berg committed
777
778
		rcu_read_lock();

779
		sta = sta_info_get(sdata, mac);
Johannes Berg's avatar
Johannes Berg committed
780
781
		if (!sta) {
			rcu_read_unlock();
782
			return -ENOENT;
Johannes Berg's avatar
Johannes Berg committed
783
		}
784

785
		sta_info_unlink(&sta);
Johannes Berg's avatar
Johannes Berg committed
786
787
		rcu_read_unlock();

788
		sta_info_destroy(sta);
789
	} else
790
		sta_info_flush(local, sdata);
791
792
793
794
795
796
797
798
799

	return 0;
}

static int ieee80211_change_station(struct wiphy *wiphy,
				    struct net_device *dev,
				    u8 *mac,
				    struct station_parameters *params)
{
800
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
801
	struct ieee80211_local *local = wiphy_priv(wiphy);
802
803
804
	struct sta_info *sta;
	struct ieee80211_sub_if_data *vlansdata;

Johannes Berg's avatar
Johannes Berg committed
805
806
	rcu_read_lock();

807
	sta = sta_info_get(sdata, mac);
Johannes Berg's avatar
Johannes Berg committed
808
809
	if (!sta) {
		rcu_read_unlock();
810
		return -ENOENT;
Johannes Berg's avatar
Johannes Berg committed
811
	}
812

813
	if (params->vlan && params->vlan != sta->sdata->dev) {
814
815
		vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);

816
817
		if (vlansdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
		    vlansdata->vif.type != NL80211_IFTYPE_AP) {
Johannes Berg's avatar
Johannes Berg committed
818
			rcu_read_unlock();
819
			return -EINVAL;
Johannes Berg's avatar
Johannes Berg committed
820
		}
821

822
		if (params->vlan->ieee80211_ptr->use_4addr) {
Johannes Berg's avatar
Johannes Berg committed
823
824
			if (vlansdata->u.vlan.sta) {
				rcu_read_unlock();
825
				return -EBUSY;
Johannes Berg's avatar
Johannes Berg committed
826
			}
827
828
829
830

			rcu_assign_pointer(vlansdata->u.vlan.sta, sta);
		}

831
		sta->sdata = vlansdata;
832
833
834
835
836
		ieee80211_send_layer2_update(sta);
	}

	sta_apply_parameters(local, sta, params);

Johannes Berg's avatar
Johannes Berg committed
837
838
	rcu_read_unlock();

839
840
841
	return 0;
}

842
843
844
845
#ifdef CONFIG_MAC80211_MESH
static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
				 u8 *dst, u8 *next_hop)
{
846
	struct ieee80211_sub_if_data *sdata;
847
848
849
850
	struct mesh_path *mpath;
	struct sta_info *sta;
	int err;

851
852
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

853
	rcu_read_lock();
854
	sta = sta_info_get(sdata, next_hop);
855
856
	if (!sta) {
		rcu_read_unlock();
857
		return -ENOENT;
858
	}
859

860
	err = mesh_path_add(dst, sdata);
861
862
	if (err) {
		rcu_read_unlock();
863
		return err;
864
	}
865

866
	mpath = mesh_path_lookup(dst, sdata);
867
868
869
870
871
	if (!mpath) {
		rcu_read_unlock();
		return -ENXIO;
	}
	mesh_path_fix_nexthop(mpath, sta);
872

873
874
875
876
877
878
879
	rcu_read_unlock();
	return 0;
}

static int ieee80211_del_mpath(struct wiphy *wiphy, struct net_device *dev,
				 u8 *dst)
{
880
881
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);

882
	if (dst)
883
		return mesh_path_del(dst, sdata);
884

885
	mesh_path_flush(sdata);
886
887
888
889
890
891
892
	return 0;
}

static int ieee80211_change_mpath(struct wiphy *wiphy,
				    struct net_device *dev,
				    u8 *dst, u8 *next_hop)
{
893
	struct ieee80211_sub_if_data *sdata;
894
895
896
	struct mesh_path *mpath;
	struct sta_info *sta;

897
898
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

899
900
	rcu_read_lock();

901
	sta = sta_info_get(sdata, next_hop);
902
903
	if (!sta) {
		rcu_read_unlock();
904
		return -ENOENT;
905
	}
906

907
	mpath = mesh_path_lookup(dst, sdata);
908
909
910
911
912
913
	if (!mpath) {
		rcu_read_unlock();
		return -ENOENT;
	}

	mesh_path_fix_nexthop(mpath, sta);
914

915
916
917
918
919
920
921
922
	rcu_read_unlock();
	return 0;
}

static void mpath_set_pinfo(struct mesh_path *mpath, u8 *next_hop,
			    struct mpath_info *pinfo)
{
	if (mpath->next_hop)
923
		memcpy(next_hop, mpath->next_hop->sta.addr, ETH_ALEN);
924
925
926
	else
		memset(next_hop, 0, ETH_ALEN);

927
928
	pinfo->generation = mesh_paths_generation;

929
	pinfo->filled = MPATH_INFO_FRAME_QLEN |
930
			MPATH_INFO_SN |
931
932
933
934
935
936
937
			MPATH_INFO_METRIC |
			MPATH_INFO_EXPTIME |
			MPATH_INFO_DISCOVERY_TIMEOUT |
			MPATH_INFO_DISCOVERY_RETRIES |
			MPATH_INFO_FLAGS;

	pinfo->frame_qlen = mpath->frame_queue.qlen;
938
	pinfo->sn = mpath->sn;
939
940
941
942
943
944
945
946
947
948
949
	pinfo->metric = mpath->metric;
	if (time_before(jiffies, mpath->exp_time))
		pinfo->exptime = jiffies_to_msecs(mpath->exp_time - jiffies);
	pinfo->discovery_timeout =
			jiffies_to_msecs(mpath->discovery_timeout);
	pinfo->discovery_retries = mpath->discovery_retries;
	pinfo->flags = 0;
	if (mpath->flags & MESH_PATH_ACTIVE)
		pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE;
	if (mpath->flags & MESH_PATH_RESOLVING)
		pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
950
951
	if (mpath->flags & MESH_PATH_SN_VALID)
		pinfo->flags |= NL80211_MPATH_FLAG_SN_VALID;
952
953
954
955
956
957
958
959
960
961
962
963
	if (mpath->flags & MESH_PATH_FIXED)
		pinfo->flags |= NL80211_MPATH_FLAG_FIXED;
	if (mpath->flags & MESH_PATH_RESOLVING)
		pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;

	pinfo->flags = mpath->flags;
}

static int ieee80211_get_mpath(struct wiphy *wiphy, struct net_device *dev,
			       u8 *dst, u8 *next_hop, struct mpath_info *pinfo)

{
964
	struct ieee80211_sub_if_data *sdata;
965
966
	struct mesh_path *mpath;

967
968
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

969
	rcu_read_lock();
970
	mpath = mesh_path_lookup(dst, sdata);
971
972
973
974
975
976
977
978
979
980
981
982
983
984
	if (!mpath) {
		rcu_read_unlock();
		return -ENOENT;
	}
	memcpy(dst, mpath->dst, ETH_ALEN);
	mpath_set_pinfo(mpath, next_hop, pinfo);
	rcu_read_unlock();
	return 0;
}

static int ieee80211_dump_mpath(struct wiphy *wiphy, struct net_device *dev,
				 int idx, u8 *dst, u8 *next_hop,
				 struct mpath_info *pinfo)
{
985
	struct ieee80211_sub_if_data *sdata;
986
987
	struct mesh_path *mpath;

988
989
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

990
	rcu_read_lock();
991
	mpath = mesh_path_lookup_by_idx(idx, sdata);
992
993
994
995
996
997
998
999
1000
	if (!mpath) {
		rcu_read_unlock();
		return -ENOENT;
	}
	memcpy(dst, mpath->dst, ETH_ALEN);
	mpath_set_pinfo(mpath, next_hop, pinfo);
	rcu_read_unlock();
	return 0;
}
1001
1002
1003
1004
1005
1006
1007
1008
1009
1010
1011
1012
1013
1014
1015
1016
1017
1018
1019
1020
1021
1022
1023

static int ieee80211_get_mesh_params(struct wiphy *wiphy,
				struct net_device *dev,
				struct mesh_config *conf)
{
	struct ieee80211_sub_if_data *sdata;
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	memcpy(conf, &(sdata->u.mesh.mshcfg), sizeof(struct mesh_config));
	return 0;
}

static inline bool _chg_mesh_attr(enum nl80211_meshconf_params parm, u32 mask)
{
	return (mask >> (parm-1)) & 0x1;
}

static int ieee80211_set_mesh_params(struct wiphy *wiphy,
				struct net_device *dev,
				const struct mesh_config *nconf, u32 mask)
{
	struct mesh_config *conf;
	struct ieee80211_sub_if_data *sdata;
1024
1025
	struct ieee80211_if_mesh *ifmsh;

1026
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1027
	ifmsh = &sdata->u.mesh;
1028
1029
1030
1031
1032
1033
1034
1035
1036
1037
1038
1039
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061

	/* Set the config options which we are interested in setting */
	conf = &(sdata->u.mesh.mshcfg);
	if (_chg_mesh_attr(NL80211_MESHCONF_RETRY_TIMEOUT, mask))
		conf->dot11MeshRetryTimeout = nconf->dot11MeshRetryTimeout;
	if (_chg_mesh_attr(NL80211_MESHCONF_CONFIRM_TIMEOUT, mask))
		conf->dot11MeshConfirmTimeout = nconf->dot11MeshConfirmTimeout;
	if (_chg_mesh_attr(NL80211_MESHCONF_HOLDING_TIMEOUT, mask))
		conf->dot11MeshHoldingTimeout = nconf->dot11MeshHoldingTimeout;
	if (_chg_mesh_attr(NL80211_MESHCONF_MAX_PEER_LINKS, mask))
		conf->dot11MeshMaxPeerLinks = nconf->dot11MeshMaxPeerLinks;
	if (_chg_mesh_attr(NL80211_MESHCONF_MAX_RETRIES, mask))
		conf->dot11MeshMaxRetries = nconf->dot11MeshMaxRetries;
	if (_chg_mesh_attr(NL80211_MESHCONF_TTL, mask))
		conf->dot11MeshTTL = nconf->dot11MeshTTL;
	if (_chg_mesh_attr(NL80211_MESHCONF_AUTO_OPEN_PLINKS, mask))
		conf->auto_open_plinks = nconf->auto_open_plinks;
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, mask))
		conf->dot11MeshHWMPmaxPREQretries =
			nconf->dot11MeshHWMPmaxPREQretries;
	if (_chg_mesh_attr(NL80211_MESHCONF_PATH_REFRESH_TIME, mask))
		conf->path_refresh_time = nconf->path_refresh_time;
	if (_chg_mesh_attr(NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, mask))
		conf->min_discovery_timeout = nconf->min_discovery_timeout;
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, mask))
		conf->dot11MeshHWMPactivePathTimeout =
			nconf->dot11MeshHWMPactivePathTimeout;
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, mask))
		conf->dot11MeshHWMPpreqMinInterval =
			nconf->dot11MeshHWMPpreqMinInterval;
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
			   mask))
		conf->dot11MeshHWMPnetDiameterTraversalTime =
			nconf->dot11MeshHWMPnetDiameterTraversalTime;
1062
1063
1064
1065
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOTMODE, mask)) {
		conf->dot11MeshHWMPRootMode = nconf->dot11MeshHWMPRootMode;
		ieee80211_mesh_root_setup(ifmsh);
	}
1066
1067
1068
	return 0;
}

1069
1070
#endif

1071
1072
1073
1074
1075
1076
1077
1078
1079
1080
static int ieee80211_change_bss(struct wiphy *wiphy,
				struct net_device *dev,
				struct bss_parameters *params)
{
	struct ieee80211_sub_if_data *sdata;
	u32 changed = 0;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	if (params->use_cts_prot >= 0) {
1081
		sdata->vif.bss_conf.use_cts_prot = params->use_cts_prot;
1082
1083
1084
		changed |= BSS_CHANGED_ERP_CTS_PROT;
	}
	if (params->use_short_preamble >= 0) {
1085
		sdata->vif.bss_conf.use_short_preamble =
1086
1087
1088
1089
			params->use_short_preamble;
		changed |= BSS_CHANGED_ERP_PREAMBLE;
	}
	if (params->use_short_slot_time >= 0) {
1090
		sdata->vif.bss_conf.use_short_slot =
1091
1092
1093
1094
			params->use_short_slot_time;
		changed |= BSS_CHANGED_ERP_SLOT;
	}

1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105
1106
1107
1108
1109
1110
1111
1112
	if (params->basic_rates) {
		int i, j;
		u32 rates = 0;
		struct ieee80211_local *local = wiphy_priv(wiphy);
		struct ieee80211_supported_band *sband =
			wiphy->bands[local->oper_channel->band];

		for (i = 0; i < params->basic_rates_len; i++) {
			int rate = (params->basic_rates[i] & 0x7f) * 5;
			for (j = 0; j < sband->n_bitrates; j++) {
				if (sband->bitrates[j].bitrate == rate)
					rates |= BIT(j);
			}
		}
		sdata->vif.bss_conf.basic_rates = rates;
		changed |= BSS_CHANGED_BASIC_RATES;
	}

1113
1114
1115
1116
1117
	ieee80211_bss_info_change_notify(sdata, changed);

	return 0;
}

1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
static int ieee80211_set_txq_params(struct wiphy *wiphy,
				    struct ieee80211_txq_params *params)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
	struct ieee80211_tx_queue_params p;

	if (!local->ops->conf_tx)
		return -EOPNOTSUPP;

	memset(&p, 0, sizeof(p));
	p.aifs = params->aifs;
	p.cw_max = params->cwmax;
	p.cw_min = params->cwmin;
	p.txop = params->txop;
1132
	if (drv_conf_tx(local, params->queue, &p)) {
1133
		printk(KERN_DEBUG "%s: failed to set TX queue "
1134
1135
		       "parameters for queue %d\n",
		       wiphy_name(local->hw.wiphy), params->queue);
1136
1137
1138
1139
1140
1141
		return -EINVAL;
	}

	return 0;
}

1142
1143
static int ieee80211_set_channel(struct wiphy *wiphy,
				 struct ieee80211_channel *chan,
Sujith's avatar
Sujith committed
1144
				 enum nl80211_channel_type channel_type)
1145
1146
1147
1148
{
	struct ieee80211_local *local = wiphy_priv(wiphy);

	local->oper_channel = chan;
Sujith's avatar
Sujith committed
1149
	local->oper_channel_type = channel_type;
1150
1151
1152
1153

	return ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
}

1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
#ifdef CONFIG_PM
static int ieee80211_suspend(struct wiphy *wiphy)
{
	return __ieee80211_suspend(wiphy_priv(wiphy));
}

static int ieee80211_resume(struct wiphy *wiphy)
{
	return __ieee80211_resume(wiphy_priv(wiphy));
}
#else
#define ieee80211_suspend NULL
#define ieee80211_resume NULL
#endif

1169
1170
1171
1172
1173
1174
1175
1176
1177
1178
static int ieee80211_scan(struct wiphy *wiphy,
			  struct net_device *dev,
			  struct cfg80211_scan_request *req)
{
	struct ieee80211_sub_if_data *sdata;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	if (sdata->vif.type != NL80211_IFTYPE_STATION &&
	    sdata->vif.type != NL80211_IFTYPE_ADHOC &&
1179
1180
	    sdata->vif.type != NL80211_IFTYPE_MESH_POINT &&
	    (sdata->vif.type != NL80211_IFTYPE_AP || sdata->u.ap.beacon))
1181
1182
1183
1184
1185
		return -EOPNOTSUPP;

	return ieee80211_request_scan(sdata, req);
}

1186
1187
1188
static int ieee80211_auth(struct wiphy *wiphy, struct net_device *dev,
			  struct cfg80211_auth_request *req)
{
1189
	return ieee80211_mgd_auth(IEEE80211_DEV_TO_SUB_IF(dev), req);
1190
1191
1192
1193
1194
}

static int ieee80211_assoc(struct wiphy *wiphy, struct net_device *dev,
			   struct cfg80211_assoc_request *req)
{
1195
	return ieee80211_mgd_assoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
1196
1197
1198
}

static int ieee80211_deauth(struct wiphy *wiphy, struct net_device *dev,
Johannes Berg's avatar
Johannes Berg committed
1199
1200
			    struct cfg80211_deauth_request *req,
			    void *cookie)
1201
{
Johannes Berg's avatar
Johannes Berg committed
1202
1203
	return ieee80211_mgd_deauth(IEEE80211_DEV_TO_SUB_IF(dev),
				    req, cookie);
1204
1205
1206