cfg.c 31.5 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 "cfg.h"
Johannes Berg's avatar
Johannes Berg committed
17
#include "rate.h"
18
19
#include "mesh.h"

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

38
static int ieee80211_add_iface(struct wiphy *wiphy, char *name,
39
40
			       enum nl80211_iftype type, u32 *flags,
			       struct vif_params *params)
41
42
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
43
44
45
	struct net_device *dev;
	struct ieee80211_sub_if_data *sdata;
	int err;
46

47
	if (!nl80211_type_check(type))
48
49
		return -EINVAL;

50
51
	err = ieee80211_if_add(local, name, &dev, type, params);
	if (err || type != NL80211_IFTYPE_MONITOR || !flags)
52
53
54
55
56
		return err;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	sdata->u.mntr_flags = *flags;
	return 0;
57
58
59
60
61
}

static int ieee80211_del_iface(struct wiphy *wiphy, int ifindex)
{
	struct net_device *dev;
62
	struct ieee80211_sub_if_data *sdata;
63

64
65
	/* we're under RTNL */
	dev = __dev_get_by_index(&init_net, ifindex);
66
	if (!dev)
67
		return -ENODEV;
68

69
70
71
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	ieee80211_if_remove(sdata);
72

73
	return 0;
74
75
}

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

	/* we're under RTNL */
	dev = __dev_get_by_index(&init_net, ifindex);
	if (!dev)
		return -ENODEV;

89
	if (!nl80211_type_check(type))
90
91
92
93
		return -EINVAL;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

94
	ret = ieee80211_if_change_type(sdata, type);
95
96
	if (ret)
		return ret;
97

98
99
100
	if (netif_running(sdata->dev))
		return -EBUSY;

Johannes Berg's avatar
Johannes Berg committed
101
	if (ieee80211_vif_is_mesh(&sdata->vif) && params->mesh_id_len)
102
103
104
		ieee80211_sdata_set_mesh_id(sdata,
					    params->mesh_id_len,
					    params->mesh_id);
105

106
	if (sdata->vif.type != NL80211_IFTYPE_MONITOR || !flags)
107
108
109
		return 0;

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

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

	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;
136
137
138
	case WLAN_CIPHER_SUITE_AES_CMAC:
		alg = ALG_AES_CMAC;
		break;
139
140
141
142
	default:
		return -EINVAL;
	}

143
144
145
146
	key = ieee80211_key_alloc(alg, key_idx, params->key_len, params->key);
	if (!key)
		return -ENOMEM;

147
148
	rcu_read_lock();

149
150
	if (mac_addr) {
		sta = sta_info_get(sdata->local, mac_addr);
151
152
		if (!sta) {
			ieee80211_key_free(key);
153
154
			err = -ENOENT;
			goto out_unlock;
155
		}
156
157
	}

158
159
	ieee80211_key_link(key, sdata, sta);

160
161
162
163
164
	err = 0;
 out_unlock:
	rcu_read_unlock();

	return err;
165
166
167
168
169
170
171
172
173
174
175
}

static int ieee80211_del_key(struct wiphy *wiphy, struct net_device *dev,
			     u8 key_idx, u8 *mac_addr)
{
	struct ieee80211_sub_if_data *sdata;
	struct sta_info *sta;
	int ret;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

176
177
	rcu_read_lock();

178
	if (mac_addr) {
179
180
		ret = -ENOENT;

181
182
		sta = sta_info_get(sdata->local, mac_addr);
		if (!sta)
183
			goto out_unlock;
184

185
		if (sta->key) {
186
			ieee80211_key_free(sta->key);
187
			WARN_ON(sta->key);
188
189
			ret = 0;
		}
190

191
		goto out_unlock;
192
193
	}

194
195
196
197
	if (!sdata->keys[key_idx]) {
		ret = -ENOENT;
		goto out_unlock;
	}
198

199
	ieee80211_key_free(sdata->keys[key_idx]);
200
	WARN_ON(sdata->keys[key_idx]);
201

202
203
204
205
206
	ret = 0;
 out_unlock:
	rcu_read_unlock();

	return ret;
207
208
}

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

223
224
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

225
226
	rcu_read_lock();

227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
	if (mac_addr) {
		sta = sta_info_get(sdata->local, mac_addr);
		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;

245
246
		iv32 = key->u.tkip.tx.iv32;
		iv16 = key->u.tkip.tx.iv16;
247
248
249
250
251
252
253
254
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

		if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE &&
		    sdata->local->ops->get_tkip_seq)
			sdata->local->ops->get_tkip_seq(
				local_to_hw(sdata->local),
				key->conf.hw_key_idx,
				&iv32, &iv16);

		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;
281
282
283
284
285
286
287
288
289
290
291
	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;
292
293
294
295
296
297
298
299
300
	}

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

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

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

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

311
312
	rcu_read_lock();

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

316
317
	rcu_read_unlock();

318
319
320
	return 0;
}

321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
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;
}

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

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

	sinfo->inactive_time = jiffies_to_msecs(jiffies - sta->last_rx);
	sinfo->rx_bytes = sta->rx_bytes;
	sinfo->tx_bytes = sta->tx_bytes;
351
352
	sinfo->rx_packets = sta->rx_packets;
	sinfo->tx_packets = sta->tx_packets;
353

354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
	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
376
	if (ieee80211_vif_is_mesh(&sdata->vif)) {
377
378
379
380
381
382
383
384
385
#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
386
	}
387
388
389
390
391
392
393
394
}


static int ieee80211_dump_station(struct wiphy *wiphy, struct net_device *dev,
				 int idx, u8 *mac, struct station_info *sinfo)
{
	struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
	struct sta_info *sta;
395
396
397
	int ret = -ENOENT;

	rcu_read_lock();
398
399

	sta = sta_info_get_by_idx(local, idx, dev);
400
401
	if (sta) {
		ret = 0;
402
		memcpy(mac, sta->sta.addr, ETH_ALEN);
403
404
		sta_set_sinfo(sta, sinfo);
	}
405

406
	rcu_read_unlock();
407

408
	return ret;
409
410
}

411
static int ieee80211_get_station(struct wiphy *wiphy, struct net_device *dev,
412
				 u8 *mac, struct station_info *sinfo)
413
414
415
{
	struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
	struct sta_info *sta;
416
	int ret = -ENOENT;
417

418
	rcu_read_lock();
419
420
421

	/* XXX: verify sta->dev == dev */

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

	rcu_read_unlock();

	return ret;
431
432
}

433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
/*
 * 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.
	 */
	if (params->interval) {
		sdata->local->hw.conf.beacon_int = params->interval;
456
457
458
459
		err = ieee80211_hw_config(sdata->local,
					IEEE80211_CONF_CHANGE_BEACON_INTERVAL);
		if (err < 0)
			return err;
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
525
526
527
528
529
		/*
		 * We updated some parameter so if below bails out
		 * it's not an error.
		 */
		err = 0;
	}

	/* 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);

530
531
	return ieee80211_if_config(sdata, IEEE80211_IFCC_BEACON |
					  IEEE80211_IFCC_BEACON_ENABLED);
532
533
534
535
536
}

static int ieee80211_add_beacon(struct wiphy *wiphy, struct net_device *dev,
				struct beacon_parameters *params)
{
537
	struct ieee80211_sub_if_data *sdata;
538
539
	struct beacon_data *old;

540
541
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

542
	if (sdata->vif.type != NL80211_IFTYPE_AP)
543
544
545
546
547
548
549
550
551
552
553
554
555
		return -EINVAL;

	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)
{
556
	struct ieee80211_sub_if_data *sdata;
557
558
	struct beacon_data *old;

559
560
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

561
	if (sdata->vif.type != NL80211_IFTYPE_AP)
562
563
564
565
566
567
568
569
570
571
572
573
		return -EINVAL;

	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)
{
574
	struct ieee80211_sub_if_data *sdata;
575
576
	struct beacon_data *old;

577
578
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

579
	if (sdata->vif.type != NL80211_IFTYPE_AP)
580
581
582
583
584
585
586
587
588
589
590
		return -EINVAL;

	old = sdata->u.ap.beacon;

	if (!old)
		return -ENOENT;

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

591
	return ieee80211_if_config(sdata, IEEE80211_IFCC_BEACON_ENABLED);
592
593
}

594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
/* 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);
622
	memcpy(msg->sa, sta->sta.addr, ETH_ALEN);
623
624
625
626
627
628
629
630
631
	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) */

632
633
	skb->dev = sta->sdata->dev;
	skb->protocol = eth_type_trans(skb, sta->sdata->dev);
634
635
636
637
638
639
640
641
642
643
	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;
644
	struct ieee80211_supported_band *sband;
645
	struct ieee80211_sub_if_data *sdata = sta->sdata;
646

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

Johannes Berg's avatar
Johannes Berg committed
649
650
651
652
653
654
	/*
	 * FIXME: updating the flags is racy when this function is
	 *	  called from ieee80211_change_station(), this will
	 *	  be resolved in a future patch.
	 */

655
	if (params->station_flags & STATION_FLAG_CHANGED) {
656
		spin_lock_bh(&sta->lock);
657
658
659
660
661
662
663
664
665
666
667
		sta->flags &= ~WLAN_STA_AUTHORIZED;
		if (params->station_flags & STATION_FLAG_AUTHORIZED)
			sta->flags |= WLAN_STA_AUTHORIZED;

		sta->flags &= ~WLAN_STA_SHORT_PREAMBLE;
		if (params->station_flags & STATION_FLAG_SHORT_PREAMBLE)
			sta->flags |= WLAN_STA_SHORT_PREAMBLE;

		sta->flags &= ~WLAN_STA_WME;
		if (params->station_flags & STATION_FLAG_WME)
			sta->flags |= WLAN_STA_WME;
668
669
670
671

		sta->flags &= ~WLAN_STA_MFP;
		if (params->station_flags & STATION_FLAG_MFP)
			sta->flags |= WLAN_STA_MFP;
672
		spin_unlock_bh(&sta->lock);
673
674
	}

Johannes Berg's avatar
Johannes Berg committed
675
676
677
678
679
680
681
	/*
	 * 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.
	 */

682
	if (params->aid) {
683
684
685
		sta->sta.aid = params->aid;
		if (sta->sta.aid > IEEE80211_MAX_AID)
			sta->sta.aid = 0; /* XXX: should this be an error? */
686
687
688
689
690
691
692
	}

	if (params->listen_interval >= 0)
		sta->listen_interval = params->listen_interval;

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

694
695
		for (i = 0; i < params->supported_rates_len; i++) {
			int rate = (params->supported_rates[i] & 0x7f) * 5;
696
697
			for (j = 0; j < sband->n_bitrates; j++) {
				if (sband->bitrates[j].bitrate == rate)
698
699
700
					rates |= BIT(j);
			}
		}
701
		sta->sta.supp_rates[local->oper_channel->band] = rates;
702
	}
703

704
	if (params->ht_capa)
Johannes Berg's avatar
Johannes Berg committed
705
706
		ieee80211_ht_cap_ie_to_sta_ht_cap(sband,
						  params->ht_capa,
707
						  &sta->sta.ht_cap);
708

Johannes Berg's avatar
Johannes Berg committed
709
	if (ieee80211_vif_is_mesh(&sdata->vif) && params->plink_action) {
710
711
712
713
714
715
716
717
		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
718
	}
719
720
721
722
723
}

static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
				 u8 *mac, struct station_parameters *params)
{
724
	struct ieee80211_local *local = wiphy_priv(wiphy);
725
726
	struct sta_info *sta;
	struct ieee80211_sub_if_data *sdata;
Johannes Berg's avatar
Johannes Berg committed
727
	int err;
728
	int layer2_update;
729
730
731
732
733
734
735
736

	/* Prevent a race with changing the rate control algorithm */
	if (!netif_running(dev))
		return -ENETDOWN;

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

737
738
		if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
		    sdata->vif.type != NL80211_IFTYPE_AP)
739
740
741
742
			return -EINVAL;
	} else
		sdata = IEEE80211_DEV_TO_SUB_IF(dev);

743
744
745
746
747
748
749
	if (compare_ether_addr(mac, dev->dev_addr) == 0)
		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
750
751
	if (!sta)
		return -ENOMEM;
752
753
754
755
756

	sta->flags = WLAN_STA_AUTH | WLAN_STA_ASSOC;

	sta_apply_parameters(local, sta, params);

757
	rate_control_rate_init(sta);
758

759
760
761
	layer2_update = sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
		sdata->vif.type == NL80211_IFTYPE_AP;

Johannes Berg's avatar
Johannes Berg committed
762
763
764
765
	rcu_read_lock();

	err = sta_info_insert(sta);
	if (err) {
766
		/* STA has been freed */
767
768
769
770
771
772
		if (err == -EEXIST && layer2_update) {
			/* Need to update layer 2 devices on reassociation */
			sta = sta_info_get(local, mac);
			if (sta)
				ieee80211_send_layer2_update(sta);
		}
Johannes Berg's avatar
Johannes Berg committed
773
774
775
776
		rcu_read_unlock();
		return err;
	}

777
	if (layer2_update)
Johannes Berg's avatar
Johannes Berg committed
778
779
780
781
		ieee80211_send_layer2_update(sta);

	rcu_read_unlock();

782
783
784
785
786
787
	return 0;
}

static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev,
				 u8 *mac)
{
788
789
	struct ieee80211_local *local = wiphy_priv(wiphy);
	struct ieee80211_sub_if_data *sdata;
790
791
	struct sta_info *sta;

792
793
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

794
	if (mac) {
Johannes Berg's avatar
Johannes Berg committed
795
796
		rcu_read_lock();

797
798
		/* XXX: get sta belonging to dev */
		sta = sta_info_get(local, mac);
Johannes Berg's avatar
Johannes Berg committed
799
800
		if (!sta) {
			rcu_read_unlock();
801
			return -ENOENT;
Johannes Berg's avatar
Johannes Berg committed
802
		}
803

804
		sta_info_unlink(&sta);
Johannes Berg's avatar
Johannes Berg committed
805
806
		rcu_read_unlock();

807
		sta_info_destroy(sta);
808
	} else
809
		sta_info_flush(local, sdata);
810
811
812
813
814
815
816
817
818

	return 0;
}

static int ieee80211_change_station(struct wiphy *wiphy,
				    struct net_device *dev,
				    u8 *mac,
				    struct station_parameters *params)
{
819
	struct ieee80211_local *local = wiphy_priv(wiphy);
820
821
822
	struct sta_info *sta;
	struct ieee80211_sub_if_data *vlansdata;

Johannes Berg's avatar
Johannes Berg committed
823
824
	rcu_read_lock();

825
826
	/* XXX: get sta belonging to dev */
	sta = sta_info_get(local, mac);
Johannes Berg's avatar
Johannes Berg committed
827
828
	if (!sta) {
		rcu_read_unlock();
829
		return -ENOENT;
Johannes Berg's avatar
Johannes Berg committed
830
	}
831

832
	if (params->vlan && params->vlan != sta->sdata->dev) {
833
834
		vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);

835
836
		if (vlansdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
		    vlansdata->vif.type != NL80211_IFTYPE_AP) {
Johannes Berg's avatar
Johannes Berg committed
837
			rcu_read_unlock();
838
			return -EINVAL;
Johannes Berg's avatar
Johannes Berg committed
839
		}
840

841
		sta->sdata = vlansdata;
842
843
844
845
846
		ieee80211_send_layer2_update(sta);
	}

	sta_apply_parameters(local, sta, params);

Johannes Berg's avatar
Johannes Berg committed
847
848
	rcu_read_unlock();

849
850
851
	return 0;
}

852
853
854
855
#ifdef CONFIG_MAC80211_MESH
static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
				 u8 *dst, u8 *next_hop)
{
856
857
	struct ieee80211_local *local = wiphy_priv(wiphy);
	struct ieee80211_sub_if_data *sdata;
858
859
860
861
862
863
864
	struct mesh_path *mpath;
	struct sta_info *sta;
	int err;

	if (!netif_running(dev))
		return -ENETDOWN;

865
866
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

867
	if (sdata->vif.type != NL80211_IFTYPE_MESH_POINT)
868
869
		return -ENOTSUPP;

870
	rcu_read_lock();
871
	sta = sta_info_get(local, next_hop);
872
873
	if (!sta) {
		rcu_read_unlock();
874
		return -ENOENT;
875
	}
876

877
	err = mesh_path_add(dst, sdata);
878
879
	if (err) {
		rcu_read_unlock();
880
		return err;
881
	}
882

883
	mpath = mesh_path_lookup(dst, sdata);
884
885
886
887
888
	if (!mpath) {
		rcu_read_unlock();
		return -ENXIO;
	}
	mesh_path_fix_nexthop(mpath, sta);
889

890
891
892
893
894
895
896
	rcu_read_unlock();
	return 0;
}

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

899
	if (dst)
900
		return mesh_path_del(dst, sdata);
901

902
	mesh_path_flush(sdata);
903
904
905
906
907
908
909
	return 0;
}

static int ieee80211_change_mpath(struct wiphy *wiphy,
				    struct net_device *dev,
				    u8 *dst, u8 *next_hop)
{
910
911
	struct ieee80211_local *local = wiphy_priv(wiphy);
	struct ieee80211_sub_if_data *sdata;
912
913
914
915
916
917
	struct mesh_path *mpath;
	struct sta_info *sta;

	if (!netif_running(dev))
		return -ENETDOWN;

918
919
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

920
	if (sdata->vif.type != NL80211_IFTYPE_MESH_POINT)
921
922
		return -ENOTSUPP;

923
924
	rcu_read_lock();

925
	sta = sta_info_get(local, next_hop);
926
927
	if (!sta) {
		rcu_read_unlock();
928
		return -ENOENT;
929
	}
930

931
	mpath = mesh_path_lookup(dst, sdata);
932
933
934
935
936
937
	if (!mpath) {
		rcu_read_unlock();
		return -ENOENT;
	}

	mesh_path_fix_nexthop(mpath, sta);
938

939
940
941
942
943
944
945
946
	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)
947
		memcpy(next_hop, mpath->next_hop->sta.addr, ETH_ALEN);
948
949
950
951
952
953
954
955
956
957
958
959
960
961
962
963
964
965
966
967
968
969
970
971
972
973
974
975
976
977
978
979
980
981
982
983
984
985
	else
		memset(next_hop, 0, ETH_ALEN);

	pinfo->filled = MPATH_INFO_FRAME_QLEN |
			MPATH_INFO_DSN |
			MPATH_INFO_METRIC |
			MPATH_INFO_EXPTIME |
			MPATH_INFO_DISCOVERY_TIMEOUT |
			MPATH_INFO_DISCOVERY_RETRIES |
			MPATH_INFO_FLAGS;

	pinfo->frame_qlen = mpath->frame_queue.qlen;
	pinfo->dsn = mpath->dsn;
	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;
	if (mpath->flags & MESH_PATH_DSN_VALID)
		pinfo->flags |= NL80211_MPATH_FLAG_DSN_VALID;
	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)

{
986
	struct ieee80211_sub_if_data *sdata;
987
988
	struct mesh_path *mpath;

989
990
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

991
	if (sdata->vif.type != NL80211_IFTYPE_MESH_POINT)
992
993
994
		return -ENOTSUPP;

	rcu_read_lock();
995
	mpath = mesh_path_lookup(dst, sdata);
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009
	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)
{
1010
	struct ieee80211_sub_if_data *sdata;
1011
1012
	struct mesh_path *mpath;

1013
1014
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1015
	if (sdata->vif.type != NL80211_IFTYPE_MESH_POINT)
1016
1017
1018
		return -ENOTSUPP;

	rcu_read_lock();
1019
	mpath = mesh_path_lookup_by_idx(idx, sdata);
1020
1021
1022
1023
1024
1025
1026
1027
1028
	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;
}
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
1062
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094

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);

	if (sdata->vif.type != NL80211_IFTYPE_MESH_POINT)
		return -ENOTSUPP;
	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;
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	if (sdata->vif.type != NL80211_IFTYPE_MESH_POINT)
		return -ENOTSUPP;

	/* 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;
	return 0;
}

1095
1096
#endif

1097
1098
1099
1100
1101
1102
1103
1104
1105
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);

1106
	if (sdata->vif.type != NL80211_IFTYPE_AP)
1107
1108
1109
		return -EINVAL;

	if (params->use_cts_prot >= 0) {
1110
		sdata->vif.bss_conf.use_cts_prot = params->use_cts_prot;
1111
1112
1113
		changed |= BSS_CHANGED_ERP_CTS_PROT;
	}
	if (params->use_short_preamble >= 0) {
1114
		sdata->vif.bss_conf.use_short_preamble =
1115
1116
1117
1118
			params->use_short_preamble;
		changed |= BSS_CHANGED_ERP_PREAMBLE;
	}
	if (params->use_short_slot_time >= 0) {
1119
		sdata->vif.bss_conf.use_short_slot =
1120
1121
1122
1123
			params->use_short_slot_time;
		changed |= BSS_CHANGED_ERP_SLOT;
	}

1124
1125
1126
1127
1128
1129
1130
1131
1132
1133
1134
1135
1136
1137
1138
1139
1140
1141
	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;
	}

1142
1143
1144
1145
1146
	ieee80211_bss_info_change_notify(sdata, changed);

	return 0;
}

1147
1148
1149
1150
1151
1152
1153
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
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;
	if (local->ops->conf_tx(local_to_hw(local), params->queue, &p)) {
		printk(KERN_DEBUG "%s: failed to set TX queue "
		       "parameters for queue %d\n", local->mdev->name,
		       params->queue);
		return -EINVAL;
	}

	return 0;
}

1171
1172
static int ieee80211_set_channel(struct wiphy *wiphy,
				 struct ieee80211_channel *chan,
Sujith's avatar
Sujith committed
1173
				 enum nl80211_channel_type channel_type)
1174
1175
1176
1177
{
	struct ieee80211_local *local = wiphy_priv(wiphy);

	local->oper_channel = chan;
Sujith's avatar
Sujith committed
1178
	local->oper_channel_type = channel_type;
1179
1180
1181
1182

	return ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
}

1183
1184
static int set_mgmt_extra_ie_sta(struct ieee80211_sub_if_data *sdata,
				 u8 subtype, u8 *ies, size_t ies_len)
1185
{
1186
	struct ieee80211_local *local = sdata->local;
1187
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
1188

1189
1190
	switch (subtype) {
	case IEEE80211_STYPE_PROBE_REQ >> 4:
1191
1192
		if (local->ops->hw_scan)
			break;
1193
1194
1195
		kfree(ifmgd->ie_probereq);
		ifmgd->ie_probereq = ies;
		ifmgd->ie_probereq_len = ies_len;
1196
1197
		return 0;
	case IEEE80211_STYPE_PROBE_RESP >> 4:
1198
1199
1200
		kfree(ifmgd->ie_proberesp);
		ifmgd->ie_proberesp = ies;
		ifmgd->ie_proberesp_len = ies_len;
1201
1202
		return 0;
	case IEEE80211_STYPE_AUTH >> 4:
1203
1204
1205
		kfree(ifmgd->ie_auth);
		ifmgd->ie_auth = ies;
		ifmgd->ie_auth_len = ies_len;
1206
1207
		return 0;
	case IEEE80211_STYPE_ASSOC_REQ >> 4:
1208
1209
1210
		kfree(ifmgd->ie_assocreq);
		ifmgd->ie_assocreq = ies;
		ifmgd->ie_assocreq_len = ies_len;
1211
1212
		return 0;
	case IEEE80211_STYPE_REASSOC_REQ >> 4:
1213
1214
1215
		kfree(ifmgd->ie_reassocreq);
		ifmgd->ie_reassocreq = ies;
		ifmgd->ie_reassocreq_len = ies_len;
1216
1217
		return 0;
	case IEEE80211_STYPE_DEAUTH >> 4:
1218
1219
1220
		kfree(ifmgd->ie_deauth);
		ifmgd->ie_deauth = ies;
		ifmgd->ie_deauth_len = ies_len;
1221
1222
		return 0;
	case IEEE80211_STYPE_DISASSOC >> 4:
1223
1224
1225
		kfree(ifmgd->ie_disassoc);
		ifmgd->ie_disassoc = ies;
		ifmgd->ie_disassoc_len = ies_len;
1226
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236
1237
1238
1239
1240
1241
1242
1243
1244
1245
1246
1247
1248
1249
1250
1251
1252
1253
1254
		return 0;
	}

	return -EOPNOTSUPP;
}

static int ieee80211_set_mgmt_extra_ie(struct wiphy *wiphy,
				       struct net_device *dev,
				       struct mgmt_extra_ie_params *params)
{
	struct ieee80211_sub_if_data *sdata;
	u8 *ies;
	size_t ies_len;
	int ret = -EOPNOTSUPP;

	if (params->ies) {
		ies = kmemdup(params->ies, params->ies_len, GFP_KERNEL);
		if (ies == NULL)
			return -ENOMEM;
		ies_len = params->ies_len;
	} else {
		ies = NULL;
		ies_len = 0;
	}

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	switch (sdata->vif.type) {
	case NL80211_IFTYPE_STATION:
1255
		ret = set_mgmt_extra_ie_sta(sdata, params->subtype,
1256
1257
1258
1259
1260
1261
1262
1263
1264
1265
1266
1267
					    ies, ies_len);
		break;
	default:
		ret = -EOPNOTSUPP;
		break;
	}

	if (ret)
		kfree(ies);
	return ret;
}

1268
1269
1270
1271
1272
1273
1274
1275
1276
1277
1278
1279
1280
1281
1282
#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

1283
1284
1285
1286
1287
1288
1289
1290
1291
1292
1293
1294
1295
1296
1297
1298
1299
1300
1301
static int ieee80211_scan(struct wiphy *wiphy,
			  struct net_device *dev,
			  struct cfg80211_scan_request *req)
{
	struct ieee80211_sub_if_data *sdata;

	if (!netif_running(dev))
		return -ENETDOWN;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	if (sdata->vif.type != NL80211_IFTYPE_STATION &&
	    sdata->vif.type != NL80211_IFTYPE_ADHOC &&
	    sdata->vif.type != NL80211_IFTYPE_MESH_POINT)
		return -EOPNOTSUPP;

	return ieee80211_request_scan(sdata, req);
}

1302
1303
1304
struct cfg80211_ops mac80211_config_ops = {
	.add_virtual_intf = ieee80211_add_iface,
	.del_virtual_intf = ieee80211_del_iface,
1305
	.change_virtual_intf = ieee80211_change_iface,
1306
1307
	.add_key = ieee80211_add_key,
	.del_key = ieee80211_del_key,
1308
	.get_key = ieee80211_get_key,
1309
	.set_default_key = ieee80211_config_default_key,
1310
	.set_default_mgmt_key = ieee80211_config_default_mgmt_key,
1311
1312
1313
	.add_beacon = ieee80211_add_beacon,
	.set_beacon = ieee80211_set_beacon,
	.del_beacon = ieee80211_del_beacon,
1314
1315
1316
	.add_station = ieee80211_add_station,
	.del_station = ieee80211_del_station,
	.change_station = ieee80211_change_station,
1317
	.get_station = ieee80211_get_station,
1318
1319
1320
1321
1322
1323
1324
	.dump_station = ieee80211_dump_station,
#ifdef CONFIG_MAC80211_MESH
	.add_mpath = ieee80211_add_mpath,
	.del_mpath = ieee80211_del_mpath,
	.change_mpath = ieee80211_change_mpath,
	.get_mpath = ieee80211_get_mpath,
	.dump_mpath = ieee80211_dump_mpath,
1325
1326
	.set_mesh_params = ieee80211_set_mesh_params,
	.get_mesh_params = ieee80211_get_mesh_params,
1327
#endif
1328
	.change_bss = ieee80211_change_bss,
1329
	.set_txq_params = ieee80211_set_txq_params,
1330
	.set_channel = ieee80211_set_channel,
1331
	.set_mgmt_extra_ie = ieee80211_set_mgmt_extra_ie,
1332
1333
	.suspend = ieee80211_suspend,
	.resume = ieee80211_resume,
1334
	.scan = ieee80211_scan,
1335
};