cfg.c 33.2 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
static int ieee80211_add_iface(struct wiphy *wiphy, char *name,
40
41
			       enum nl80211_iftype type, u32 *flags,
			       struct vif_params *params)
42
43
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
44
45
46
	struct net_device *dev;
	struct ieee80211_sub_if_data *sdata;
	int err;
47

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

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

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

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

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

70
71
72
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	ieee80211_if_remove(sdata);
73

74
	return 0;
75
76
}

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

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

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

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

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

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

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

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

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

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

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

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

148
149
	rcu_read_lock();

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

159
160
	ieee80211_key_link(key, sdata, sta);

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

	return err;
166
167
168
}

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

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

177
178
	rcu_read_lock();

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

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

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

192
		goto out_unlock;
193
194
	}

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

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

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

	return ret;
208
209
}

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

224
225
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

226
227
	rcu_read_lock();

228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
	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;

246
247
		iv32 = key->u.tkip.tx.iv32;
		iv16 = key->u.tkip.tx.iv16;
248

249
250
251
252
		if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE)
			drv_get_tkip_seq(sdata->local,
					 key->conf.hw_key_idx,
					 &iv32, &iv16);
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

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

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

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

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

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

310
311
	rcu_read_lock();

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

315
316
	rcu_read_unlock();

317
318
319
	return 0;
}

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

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

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

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

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


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;
394
395
396
	int ret = -ENOENT;

	rcu_read_lock();
397
398

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

405
	rcu_read_unlock();
406

407
	return ret;
408
409
}

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

417
	rcu_read_lock();
418
419
420

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

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

	rcu_read_unlock();

	return ret;
430
431
}

432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
/*
 * 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.
	 */
453
454
455
456
457
	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);
458
459
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
	}

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

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

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

534
535
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

536
537
538
539
540
541
542
543
544
545
546
	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)
{
547
	struct ieee80211_sub_if_data *sdata;
548
549
	struct beacon_data *old;

550
551
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

552
553
554
555
556
557
558
559
560
561
	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)
{
562
	struct ieee80211_sub_if_data *sdata;
563
564
	struct beacon_data *old;

565
566
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

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

	if (!old)
		return -ENOENT;

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

576
577
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED);
	return 0;
578
579
}

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
/* 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);
608
	memcpy(msg->sa, sta->sta.addr, ETH_ALEN);
609
610
611
612
613
614
615
616
617
	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) */

618
619
	skb->dev = sta->sdata->dev;
	skb->protocol = eth_type_trans(skb, sta->sdata->dev);
620
621
622
623
624
625
626
627
628
629
	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;
630
	struct ieee80211_supported_band *sband;
631
	struct ieee80211_sub_if_data *sdata = sta->sdata;
632

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

Johannes Berg's avatar
Johannes Berg committed
635
636
637
638
639
640
	/*
	 * FIXME: updating the flags is racy when this function is
	 *	  called from ieee80211_change_station(), this will
	 *	  be resolved in a future patch.
	 */

641
	if (params->station_flags & STATION_FLAG_CHANGED) {
642
		spin_lock_bh(&sta->lock);
643
644
645
646
647
648
649
650
651
652
653
		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;
654
655
656
657

		sta->flags &= ~WLAN_STA_MFP;
		if (params->station_flags & STATION_FLAG_MFP)
			sta->flags |= WLAN_STA_MFP;
658
		spin_unlock_bh(&sta->lock);
659
660
	}

Johannes Berg's avatar
Johannes Berg committed
661
662
663
664
665
666
667
	/*
	 * 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.
	 */

668
	if (params->aid) {
669
670
671
		sta->sta.aid = params->aid;
		if (sta->sta.aid > IEEE80211_MAX_AID)
			sta->sta.aid = 0; /* XXX: should this be an error? */
672
673
674
675
676
677
678
	}

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

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

680
681
		for (i = 0; i < params->supported_rates_len; i++) {
			int rate = (params->supported_rates[i] & 0x7f) * 5;
682
683
			for (j = 0; j < sband->n_bitrates; j++) {
				if (sband->bitrates[j].bitrate == rate)
684
685
686
					rates |= BIT(j);
			}
		}
687
		sta->sta.supp_rates[local->oper_channel->band] = rates;
688
	}
689

690
	if (params->ht_capa)
Johannes Berg's avatar
Johannes Berg committed
691
692
		ieee80211_ht_cap_ie_to_sta_ht_cap(sband,
						  params->ht_capa,
693
						  &sta->sta.ht_cap);
694

Johannes Berg's avatar
Johannes Berg committed
695
	if (ieee80211_vif_is_mesh(&sdata->vif) && params->plink_action) {
696
697
698
699
700
701
702
703
		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
704
	}
705
706
707
708
709
}

static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
				 u8 *mac, struct station_parameters *params)
{
710
	struct ieee80211_local *local = wiphy_priv(wiphy);
711
712
	struct sta_info *sta;
	struct ieee80211_sub_if_data *sdata;
Johannes Berg's avatar
Johannes Berg committed
713
	int err;
714
	int layer2_update;
715
716
717
718

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

719
720
		if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
		    sdata->vif.type != NL80211_IFTYPE_AP)
721
722
723
724
			return -EINVAL;
	} else
		sdata = IEEE80211_DEV_TO_SUB_IF(dev);

725
726
727
728
729
730
731
	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
732
733
	if (!sta)
		return -ENOMEM;
734
735
736
737
738

	sta->flags = WLAN_STA_AUTH | WLAN_STA_ASSOC;

	sta_apply_parameters(local, sta, params);

739
	rate_control_rate_init(sta);
740

741
742
743
	layer2_update = sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
		sdata->vif.type == NL80211_IFTYPE_AP;

Johannes Berg's avatar
Johannes Berg committed
744
745
746
747
	rcu_read_lock();

	err = sta_info_insert(sta);
	if (err) {
748
		/* STA has been freed */
749
750
751
752
753
754
		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
755
756
757
758
		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
780
		/* XXX: get sta belonging to dev */
		sta = sta_info_get(local, mac);
Johannes Berg's avatar
Johannes Berg committed
781
782
		if (!sta) {
			rcu_read_unlock();
783
			return -ENOENT;
Johannes Berg's avatar
Johannes Berg committed
784
		}
785

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

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

	return 0;
}

static int ieee80211_change_station(struct wiphy *wiphy,
				    struct net_device *dev,
				    u8 *mac,
				    struct station_parameters *params)
{
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
808
	/* XXX: get sta belonging to dev */
	sta = sta_info_get(local, mac);
Johannes Berg's avatar
Johannes Berg committed
809
810
	if (!sta) {
		rcu_read_unlock();
811
		return -ENOENT;
Johannes Berg's avatar
Johannes Berg committed
812
	}
813

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

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

823
		sta->sdata = vlansdata;
824
825
826
827
828
		ieee80211_send_layer2_update(sta);
	}

	sta_apply_parameters(local, sta, params);

Johannes Berg's avatar
Johannes Berg committed
829
830
	rcu_read_unlock();

831
832
833
	return 0;
}

834
835
836
837
#ifdef CONFIG_MAC80211_MESH
static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
				 u8 *dst, u8 *next_hop)
{
838
839
	struct ieee80211_local *local = wiphy_priv(wiphy);
	struct ieee80211_sub_if_data *sdata;
840
841
842
843
	struct mesh_path *mpath;
	struct sta_info *sta;
	int err;

844
845
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

846
	rcu_read_lock();
847
	sta = sta_info_get(local, next_hop);
848
849
	if (!sta) {
		rcu_read_unlock();
850
		return -ENOENT;
851
	}
852

853
	err = mesh_path_add(dst, sdata);
854
855
	if (err) {
		rcu_read_unlock();
856
		return err;
857
	}
858

859
	mpath = mesh_path_lookup(dst, sdata);
860
861
862
863
864
	if (!mpath) {
		rcu_read_unlock();
		return -ENXIO;
	}
	mesh_path_fix_nexthop(mpath, sta);
865

866
867
868
869
870
871
872
	rcu_read_unlock();
	return 0;
}

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

875
	if (dst)
876
		return mesh_path_del(dst, sdata);
877

878
	mesh_path_flush(sdata);
879
880
881
882
883
884
885
	return 0;
}

static int ieee80211_change_mpath(struct wiphy *wiphy,
				    struct net_device *dev,
				    u8 *dst, u8 *next_hop)
{
886
887
	struct ieee80211_local *local = wiphy_priv(wiphy);
	struct ieee80211_sub_if_data *sdata;
888
889
890
	struct mesh_path *mpath;
	struct sta_info *sta;

891
892
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

893
894
	rcu_read_lock();

895
	sta = sta_info_get(local, next_hop);
896
897
	if (!sta) {
		rcu_read_unlock();
898
		return -ENOENT;
899
	}
900

901
	mpath = mesh_path_lookup(dst, sdata);
902
903
904
905
906
907
	if (!mpath) {
		rcu_read_unlock();
		return -ENOENT;
	}

	mesh_path_fix_nexthop(mpath, sta);
908

909
910
911
912
913
914
915
916
	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)
917
		memcpy(next_hop, mpath->next_hop->sta.addr, ETH_ALEN);
918
919
920
921
922
923
924
925
926
927
928
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
955
	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)

{
956
	struct ieee80211_sub_if_data *sdata;
957
958
	struct mesh_path *mpath;

959
960
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

961
	rcu_read_lock();
962
	mpath = mesh_path_lookup(dst, sdata);
963
964
965
966
967
968
969
970
971
972
973
974
975
976
	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)
{
977
	struct ieee80211_sub_if_data *sdata;
978
979
	struct mesh_path *mpath;

980
981
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

982
	rcu_read_lock();
983
	mpath = mesh_path_lookup_by_idx(idx, sdata);
984
985
986
987
988
989
990
991
992
	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;
}
993
994
995
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009
1010
1011
1012
1013
1014
1015
1016
1017
1018
1019
1020
1021
1022
1023
1024
1025
1026
1027
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

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;
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

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

1054
1055
#endif

1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
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) {
1066
		sdata->vif.bss_conf.use_cts_prot = params->use_cts_prot;
1067
1068
1069
		changed |= BSS_CHANGED_ERP_CTS_PROT;
	}
	if (params->use_short_preamble >= 0) {
1070
		sdata->vif.bss_conf.use_short_preamble =
1071
1072
1073
1074
			params->use_short_preamble;
		changed |= BSS_CHANGED_ERP_PREAMBLE;
	}
	if (params->use_short_slot_time >= 0) {
1075
		sdata->vif.bss_conf.use_short_slot =
1076
1077
1078
1079
			params->use_short_slot_time;
		changed |= BSS_CHANGED_ERP_SLOT;
	}

1080
1081
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
	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;
	}

1098
1099
1100
1101
1102
	ieee80211_bss_info_change_notify(sdata, changed);

	return 0;
}

1103
1104
1105
1106
1107
1108
1109
1110
1111
1112
1113
1114
1115
1116
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;
1117
	if (drv_conf_tx(local, params->queue, &p)) {
1118
1119
1120
1121
1122
1123
1124
1125
1126
		printk(KERN_DEBUG "%s: failed to set TX queue "
		       "parameters for queue %d\n", local->mdev->name,
		       params->queue);
		return -EINVAL;
	}

	return 0;
}

1127
1128
static int ieee80211_set_channel(struct wiphy *wiphy,
				 struct ieee80211_channel *chan,
Sujith's avatar
Sujith committed
1129
				 enum nl80211_channel_type channel_type)
1130
1131
1132
1133
{
	struct ieee80211_local *local = wiphy_priv(wiphy);

	local->oper_channel = chan;
Sujith's avatar
Sujith committed
1134
	local->oper_channel_type = channel_type;
1135
1136
1137
1138

	return ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL);
}

1139
1140
1141
1142
1143
1144
1145
1146
1147
1148
1149
1150
1151
1152
1153
#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

1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
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 &&
1164
1165
	    sdata->vif.type != NL80211_IFTYPE_MESH_POINT &&
	    (sdata->vif.type != NL80211_IFTYPE_AP || sdata->u.ap.beacon))
1166
1167
1168
1169
1170
		return -EOPNOTSUPP;

	return ieee80211_request_scan(sdata, req);
}

1171
1172
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188
1189
1190
1191
1192
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
1203
1204
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
1225
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
1255
static int ieee80211_auth(struct wiphy *wiphy, struct net_device *dev,
			  struct cfg80211_auth_request *req)
{
	struct ieee80211_sub_if_data *sdata;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	switch (req->auth_type) {
	case NL80211_AUTHTYPE_OPEN_SYSTEM:
		sdata->u.mgd.auth_algs = IEEE80211_AUTH_ALG_OPEN;
		break;
	case NL80211_AUTHTYPE_SHARED_KEY:
		sdata->u.mgd.auth_algs = IEEE80211_AUTH_ALG_SHARED_KEY;
		break;
	case NL80211_AUTHTYPE_FT:
		sdata->u.mgd.auth_algs = IEEE80211_AUTH_ALG_FT;
		break;
	case NL80211_AUTHTYPE_NETWORK_EAP:
		sdata->u.mgd.auth_algs = IEEE80211_AUTH_ALG_LEAP;
		break;
	default:
		return -EOPNOTSUPP;
	}

	memcpy(sdata->u.mgd.bssid, req->peer_addr, ETH_ALEN);
	sdata->u.mgd.flags &= ~IEEE80211_STA_AUTO_BSSID_SEL;
	sdata->u.mgd.flags |= IEEE80211_STA_BSSID_SET;

	/* TODO: req->chan */
	sdata->u.mgd.flags |= IEEE80211_STA_AUTO_CHANNEL_SEL;

	if (req->ssid) {
		sdata->u.mgd.flags |= IEEE80211_STA_SSID_SET;
		memcpy(sdata->u.mgd.ssid, req->ssid, req->ssid_len);
		sdata->u.mgd.ssid_len = req->ssid_len;
		sdata->u.mgd.flags &= ~IEEE80211_STA_AUTO_SSID_SEL;
	}

	kfree(sdata->u.mgd.sme_auth_ie);
	sdata->u.mgd.sme_auth_ie = NULL;
	sdata->u.mgd.sme_auth_ie_len = 0;
	if (req->ie) {
		sdata->u.mgd.sme_auth_ie = kmalloc(req->ie_len, GFP_KERNEL);
		if (sdata->u.mgd.sme_auth_ie == NULL)
			return -ENOMEM;
		memcpy(sdata->u.mgd.sme_auth_ie, req->ie, req->ie_len);
		sdata->u.mgd.sme_auth_ie_len = req->ie_len;
	}

	sdata->u.mgd.flags |= IEEE80211_STA_EXT_SME;
	sdata->u.mgd.state = IEEE80211_STA_MLME_DIRECT_PROBE;
	ieee80211_sta_req_auth(sdata);
	return 0;
}

static int ieee80211_assoc(struct wiphy *wiphy, struct net_device *dev,
			   struct cfg80211_assoc_request *req)
{
	struct ieee80211_sub_if_data *sdata;
	int ret;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	if (memcmp(sdata->u.mgd.bssid, req->peer_addr, ETH_ALEN) != 0 ||
	    !(sdata->u.mgd.flags & IEEE80211_STA_AUTHENTICATED))
		return -ENOLINK; /* not authenticated */

	sdata->u.mgd.flags &= ~IEEE80211_STA_AUTO_BSSID_SEL;
	sdata->u.mgd.flags |= IEEE80211_STA_BSSID_SET;

	/* TODO: req->chan */
	sdata->u.mgd.flags |= IEEE80211_STA_AUTO_CHANNEL_SEL;

	if (req->ssid) {
		sdata->u.mgd.flags |= IEEE80211_STA_SSID_SET;
		memcpy(sdata->u.mgd.ssid, req->ssid, req->ssid_len);
		sdata->u.mgd.ssid_len = req->ssid_len;
		sdata->u.mgd.flags &= ~IEEE80211_STA_AUTO_SSID_SEL;
	} else
		sdata->u.mgd.flags |= IEEE80211_STA_AUTO_SSID_SEL;

	ret = ieee80211_sta_set_extra_ie(sdata, req->ie, req->ie_len);
	if (ret)
		return ret;

1256
1257
1258
1259
1260
1261
1262
1263
	if (req->use_mfp) {
		sdata->u.mgd.mfp = IEEE80211_MFP_REQUIRED;
		sdata->u.mgd.flags |= IEEE80211_STA_MFP_ENABLED;
	} else {
		sdata->u.mgd.mfp = IEEE80211_MFP_DISABLED;
		sdata->u.mgd.flags &= ~IEEE80211_STA_MFP_ENABLED;
	}

1264
1265
1266
1267
1268
1269
1270
1271
1272
	sdata->u.mgd.flags |= IEEE80211_STA_EXT_SME;
	sdata->u.mgd.state = IEEE80211_STA_MLME_ASSOCIATE;
	ieee80211_sta_req_auth(sdata);
	return 0;
}

static int ieee80211_deauth(struct wiphy *wiphy, struct net_device *dev,
			    struct cfg80211_deauth_request *req)
{
1273
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1274

1275
	/* TODO: req->ie, req->peer_addr */
1276
1277
1278
1279
1280
1281
	return ieee80211_sta_deauthenticate(sdata, req->reason_code);
}

static int ieee80211_disassoc(struct wiphy *wiphy, struct net_device *dev,
			      struct cfg80211_disassoc_request *req)
{
1282
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1283

1284
	/* TODO: req->ie, req->peer_addr */
1285
1286
1287
	return ieee80211_sta_disassociate(sdata, req->reason_code);
}

1288
1289
1290
1291
1292
1293
1294
1295
1296
1297
1298
1299
1300
1301
1302
static int ieee80211_join_ibss(struct wiphy *wiphy, struct net_device *dev,
			       struct cfg80211_ibss_params *params)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	return ieee80211_ibss_join(sdata, params);
}

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

	return ieee80211_ibss_leave(sdata);
}

1303
1304
1305
static int ieee80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
1306
	int err;
1307
1308

	if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
1309
		err = drv_set_rts_threshold(local, wiphy->rts_threshold);
1310

1311
1312
		if (err)
			return err;
1313
1314
1315
1316
1317
1318
1319
1320
1321
1322
1323
1324
1325
	}

	if (changed & WIPHY_PARAM_RETRY_SHORT)
		local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
	if (changed & WIPHY_PARAM_RETRY_LONG)
		local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
	if (changed &
	    (WIPHY_PARAM_RETRY_SHORT | WIPHY_PARAM_RETRY_LONG))
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_RETRY_LIMITS);

	return 0;
}

1326
1327
1328
struct cfg80211_ops mac80211_config_ops = {
	.add_virtual_intf = ieee80211_add_iface,
	.del_virtual_intf = ieee80211_del_iface,
1329
	.change_virtual_intf = ieee80211_change_iface,
1330
1331
	.add_key = ieee80211_add_key,
	.del_key = ieee80211_del_key,
1332
	.get_key = ieee80211_get_key,
1333
	.set_default_key = ieee80211_config_default_key,
1334
	.set_default_mgmt_key = ieee80211_config_default_mgmt_key,
1335
1336
1337
	.add_beacon = ieee80211_add_beacon,
	.set_beacon = ieee80211_set_beacon,
	.del_beacon = ieee80211_del_beacon,
1338
1339
1340
	.add_station = ieee80211_add_station,
	.del_station = ieee80211_del_station,
	.change_station = ieee80211_change_station,
1341
	.get_station = ieee80211_get_station,
1342
1343
1344
1345
1346
1347
1348
	.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,
1349
1350
	.set_mesh_params = ieee80211_set_mesh_params,
	.get_mesh_params = ieee80211_get_mesh_params,
1351
#endif
1352
	.change_bss = ieee80211_change_bss,