cfg.c 91.0 KB
Newer Older
1 2 3
/*
 * mac80211 configuration hooks for cfg80211
 *
4
 * Copyright 2006-2010	Johannes Berg <johannes@sipsolutions.net>
5
 * Copyright 2013-2015  Intel Mobile Communications GmbH
6 7 8 9
 *
 * This file is GPLv2 as found in COPYING.
 */

10
#include <linux/ieee80211.h>
11 12
#include <linux/nl80211.h>
#include <linux/rtnetlink.h>
13
#include <linux/slab.h>
14
#include <net/net_namespace.h>
15
#include <linux/rcupdate.h>
16
#include <linux/if_ether.h>
17 18
#include <net/cfg80211.h>
#include "ieee80211_i.h"
19
#include "driver-ops.h"
J
Johannes Berg 已提交
20
#include "rate.h"
21
#include "mesh.h"
22
#include "wme.h"
23

24 25
static struct wireless_dev *ieee80211_add_iface(struct wiphy *wiphy,
						const char *name,
26
						unsigned char name_assign_type,
27 28 29
						enum nl80211_iftype type,
						u32 *flags,
						struct vif_params *params)
30 31
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
32
	struct wireless_dev *wdev;
33 34
	struct ieee80211_sub_if_data *sdata;
	int err;
35

36
	err = ieee80211_if_add(local, name, name_assign_type, &wdev, type, params);
37 38
	if (err)
		return ERR_PTR(err);
39

40
	if (type == NL80211_IFTYPE_MONITOR && flags) {
41
		sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
42 43 44
		sdata->u.mntr_flags = *flags;
	}

45
	return wdev;
46 47
}

48
static int ieee80211_del_iface(struct wiphy *wiphy, struct wireless_dev *wdev)
49
{
50
	ieee80211_if_remove(IEEE80211_WDEV_TO_SUB_IF(wdev));
51

52
	return 0;
53 54
}

55 56
static int ieee80211_change_iface(struct wiphy *wiphy,
				  struct net_device *dev,
57 58
				  enum nl80211_iftype type, u32 *flags,
				  struct vif_params *params)
59
{
60
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
61
	int ret;
62

63
	ret = ieee80211_if_change_type(sdata, type);
64 65
	if (ret)
		return ret;
66

67
	if (type == NL80211_IFTYPE_AP_VLAN &&
J
Johannes Berg 已提交
68
	    params && params->use_4addr == 0) {
69
		RCU_INIT_POINTER(sdata->u.vlan.sta, NULL);
J
Johannes Berg 已提交
70 71 72
		ieee80211_check_fast_rx_iface(sdata);
	} else if (type == NL80211_IFTYPE_STATION &&
		   params && params->use_4addr >= 0) {
73
		sdata->u.mgd.use_4addr = params->use_4addr;
J
Johannes Berg 已提交
74
	}
75

76 77 78 79
	if (sdata->vif.type == NL80211_IFTYPE_MONITOR && flags) {
		struct ieee80211_local *local = sdata->local;

		if (ieee80211_sdata_running(sdata)) {
80 81 82
			u32 mask = MONITOR_FLAG_COOK_FRAMES |
				   MONITOR_FLAG_ACTIVE;

83
			/*
84 85 86
			 * Prohibit MONITOR_FLAG_COOK_FRAMES and
			 * MONITOR_FLAG_ACTIVE to be changed while the
			 * interface is up.
87 88 89 90 91
			 * Else we would need to add a lot of cruft
			 * to update everything:
			 *	cooked_mntrs, monitor and all fif_* counters
			 *	reconfigure hardware
			 */
92
			if ((*flags & mask) != (sdata->u.mntr_flags & mask))
93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108
				return -EBUSY;

			ieee80211_adjust_monitor_flags(sdata, -1);
			sdata->u.mntr_flags = *flags;
			ieee80211_adjust_monitor_flags(sdata, 1);

			ieee80211_configure_filter(local);
		} else {
			/*
			 * Because the interface is down, ieee80211_do_stop
			 * and ieee80211_do_open take care of "everything"
			 * mentioned in the comment above.
			 */
			sdata->u.mntr_flags = *flags;
		}
	}
109

110 111 112
	return 0;
}

113 114 115
static int ieee80211_start_p2p_device(struct wiphy *wiphy,
				      struct wireless_dev *wdev)
{
116 117 118 119 120 121 122 123 124
	struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
	int ret;

	mutex_lock(&sdata->local->chanctx_mtx);
	ret = ieee80211_check_combinations(sdata, NULL, 0, 0);
	mutex_unlock(&sdata->local->chanctx_mtx);
	if (ret < 0)
		return ret;

125 126 127 128 129 130 131 132 133
	return ieee80211_do_open(wdev, true);
}

static void ieee80211_stop_p2p_device(struct wiphy *wiphy,
				      struct wireless_dev *wdev)
{
	ieee80211_sdata_stop(IEEE80211_WDEV_TO_SUB_IF(wdev));
}

134 135 136 137 138 139 140
static int ieee80211_set_noack_map(struct wiphy *wiphy,
				  struct net_device *dev,
				  u16 noack_map)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	sdata->noack_map = noack_map;
J
Johannes Berg 已提交
141 142 143

	ieee80211_check_fast_xmit_iface(sdata);

144 145 146
	return 0;
}

147
static int ieee80211_add_key(struct wiphy *wiphy, struct net_device *dev,
148
			     u8 key_idx, bool pairwise, const u8 *mac_addr,
149 150
			     struct key_params *params)
{
151
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
152
	struct ieee80211_local *local = sdata->local;
153
	struct sta_info *sta = NULL;
154
	const struct ieee80211_cipher_scheme *cs = NULL;
155
	struct ieee80211_key *key;
156
	int err;
157

158
	if (!ieee80211_sdata_running(sdata))
J
Johannes Berg 已提交
159 160
		return -ENETDOWN;

161
	/* reject WEP and TKIP keys if WEP failed to initialize */
162 163 164
	switch (params->cipher) {
	case WLAN_CIPHER_SUITE_WEP40:
	case WLAN_CIPHER_SUITE_TKIP:
165
	case WLAN_CIPHER_SUITE_WEP104:
166
		if (IS_ERR(local->wep_tx_tfm))
167
			return -EINVAL;
168
		break;
169
	case WLAN_CIPHER_SUITE_CCMP:
J
Jouni Malinen 已提交
170
	case WLAN_CIPHER_SUITE_CCMP_256:
171
	case WLAN_CIPHER_SUITE_AES_CMAC:
172
	case WLAN_CIPHER_SUITE_BIP_CMAC_256:
173 174
	case WLAN_CIPHER_SUITE_BIP_GMAC_128:
	case WLAN_CIPHER_SUITE_BIP_GMAC_256:
175
	case WLAN_CIPHER_SUITE_GCMP:
176
	case WLAN_CIPHER_SUITE_GCMP_256:
177
		break;
178
	default:
179
		cs = ieee80211_cs_get(local, params->cipher, sdata->vif.type);
180
		break;
181 182
	}

183
	key = ieee80211_key_alloc(params->cipher, key_idx, params->key_len,
184 185
				  params->key, params->seq_len, params->seq,
				  cs);
186 187
	if (IS_ERR(key))
		return PTR_ERR(key);
188

189 190 191
	if (pairwise)
		key->conf.flags |= IEEE80211_KEY_FLAG_PAIRWISE;

192
	mutex_lock(&local->sta_mtx);
193

194
	if (mac_addr) {
195 196 197 198
		if (ieee80211_vif_is_mesh(&sdata->vif))
			sta = sta_info_get(sdata, mac_addr);
		else
			sta = sta_info_get_bss(sdata, mac_addr);
J
Johannes Berg 已提交
199 200 201 202 203
		/*
		 * The ASSOC test makes sure the driver is ready to
		 * receive the key. When wpa_supplicant has roamed
		 * using FT, it attempts to set the key before
		 * association has completed, this rejects that attempt
S
Stephen Hemminger 已提交
204
		 * so it will set the key again after association.
J
Johannes Berg 已提交
205 206 207 208 209
		 *
		 * TODO: accept the key if we have a station entry and
		 *       add it to the device after the station.
		 */
		if (!sta || !test_sta_flag(sta, WLAN_STA_ASSOC)) {
210
			ieee80211_key_free_unused(key);
211 212
			err = -ENOENT;
			goto out_unlock;
213
		}
214 215
	}

216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242
	switch (sdata->vif.type) {
	case NL80211_IFTYPE_STATION:
		if (sdata->u.mgd.mfp != IEEE80211_MFP_DISABLED)
			key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT;
		break;
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
		/* Keys without a station are used for TX only */
		if (key->sta && test_sta_flag(key->sta, WLAN_STA_MFP))
			key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT;
		break;
	case NL80211_IFTYPE_ADHOC:
		/* no MFP (yet) */
		break;
	case NL80211_IFTYPE_MESH_POINT:
#ifdef CONFIG_MAC80211_MESH
		if (sdata->u.mesh.security != IEEE80211_MESH_SEC_NONE)
			key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT;
		break;
#endif
	case NL80211_IFTYPE_WDS:
	case NL80211_IFTYPE_MONITOR:
	case NL80211_IFTYPE_P2P_DEVICE:
	case NL80211_IFTYPE_UNSPECIFIED:
	case NUM_NL80211_IFTYPES:
	case NL80211_IFTYPE_P2P_CLIENT:
	case NL80211_IFTYPE_P2P_GO:
243
	case NL80211_IFTYPE_OCB:
244 245 246 247 248
		/* shouldn't happen */
		WARN_ON_ONCE(1);
		break;
	}

249 250 251
	if (sta)
		sta->cipher_scheme = cs;

252
	err = ieee80211_key_link(key, sdata, sta);
253

254
 out_unlock:
255
	mutex_unlock(&local->sta_mtx);
256 257

	return err;
258 259 260
}

static int ieee80211_del_key(struct wiphy *wiphy, struct net_device *dev,
261
			     u8 key_idx, bool pairwise, const u8 *mac_addr)
262
{
263 264
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_local *local = sdata->local;
265
	struct sta_info *sta;
266
	struct ieee80211_key *key = NULL;
267 268
	int ret;

269 270
	mutex_lock(&local->sta_mtx);
	mutex_lock(&local->key_mtx);
271

272
	if (mac_addr) {
273 274
		ret = -ENOENT;

275
		sta = sta_info_get_bss(sdata, mac_addr);
276
		if (!sta)
277
			goto out_unlock;
278

279
		if (pairwise)
280
			key = key_mtx_dereference(local, sta->ptk[key_idx]);
281
		else
J
Johannes Berg 已提交
282
			key = key_mtx_dereference(local, sta->gtk[key_idx]);
283
	} else
J
Johannes Berg 已提交
284
		key = key_mtx_dereference(local, sdata->keys[key_idx]);
285

286
	if (!key) {
287 288 289
		ret = -ENOENT;
		goto out_unlock;
	}
290

291
	ieee80211_key_free(key, true);
292

293 294
	ret = 0;
 out_unlock:
295 296
	mutex_unlock(&local->key_mtx);
	mutex_unlock(&local->sta_mtx);
297 298

	return ret;
299 300
}

301
static int ieee80211_get_key(struct wiphy *wiphy, struct net_device *dev,
302 303
			     u8 key_idx, bool pairwise, const u8 *mac_addr,
			     void *cookie,
304 305 306
			     void (*callback)(void *cookie,
					      struct key_params *params))
{
307
	struct ieee80211_sub_if_data *sdata;
308 309 310
	struct sta_info *sta = NULL;
	u8 seq[6] = {0};
	struct key_params params;
311
	struct ieee80211_key *key = NULL;
J
Johannes Berg 已提交
312
	u64 pn64;
313 314 315
	u32 iv32;
	u16 iv16;
	int err = -ENOENT;
316
	struct ieee80211_key_seq kseq = {};
317

318 319
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

320 321
	rcu_read_lock();

322
	if (mac_addr) {
323
		sta = sta_info_get_bss(sdata, mac_addr);
324 325 326
		if (!sta)
			goto out;

327
		if (pairwise && key_idx < NUM_DEFAULT_KEYS)
328
			key = rcu_dereference(sta->ptk[key_idx]);
329 330
		else if (!pairwise &&
			 key_idx < NUM_DEFAULT_KEYS + NUM_DEFAULT_MGMT_KEYS)
J
Johannes Berg 已提交
331
			key = rcu_dereference(sta->gtk[key_idx]);
332
	} else
J
Johannes Berg 已提交
333
		key = rcu_dereference(sdata->keys[key_idx]);
334 335 336 337 338 339

	if (!key)
		goto out;

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

340
	params.cipher = key->conf.cipher;
341

342 343
	switch (key->conf.cipher) {
	case WLAN_CIPHER_SUITE_TKIP:
344 345 346
		pn64 = atomic64_read(&key->conf.tx_pn);
		iv32 = TKIP_PN_TO_IV32(pn64);
		iv16 = TKIP_PN_TO_IV16(pn64);
347

348 349 350 351 352 353
		if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE &&
		    !(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV)) {
			drv_get_key_seq(sdata->local, key, &kseq);
			iv32 = kseq.tkip.iv32;
			iv16 = kseq.tkip.iv16;
		}
354 355 356 357 358 359 360 361 362 363

		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;
364
	case WLAN_CIPHER_SUITE_CCMP:
J
Jouni Malinen 已提交
365
	case WLAN_CIPHER_SUITE_CCMP_256:
366
	case WLAN_CIPHER_SUITE_AES_CMAC:
367
	case WLAN_CIPHER_SUITE_BIP_CMAC_256:
368 369
		BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) !=
			     offsetof(typeof(kseq), aes_cmac));
370 371
	case WLAN_CIPHER_SUITE_BIP_GMAC_128:
	case WLAN_CIPHER_SUITE_BIP_GMAC_256:
372 373
		BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) !=
			     offsetof(typeof(kseq), aes_gmac));
374 375
	case WLAN_CIPHER_SUITE_GCMP:
	case WLAN_CIPHER_SUITE_GCMP_256:
376 377 378
		BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) !=
			     offsetof(typeof(kseq), gcmp));

379 380 381
		if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE &&
		    !(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV)) {
			drv_get_key_seq(sdata->local, key, &kseq);
382
			memcpy(seq, kseq.ccmp.pn, 6);
383
		} else {
384
			pn64 = atomic64_read(&key->conf.tx_pn);
385 386 387 388 389 390 391
			seq[0] = pn64;
			seq[1] = pn64 >> 8;
			seq[2] = pn64 >> 16;
			seq[3] = pn64 >> 24;
			seq[4] = pn64 >> 32;
			seq[5] = pn64 >> 40;
		}
392 393 394
		params.seq = seq;
		params.seq_len = 6;
		break;
395 396 397 398 399 400 401 402 403
	default:
		if (!(key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE))
			break;
		if (WARN_ON(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV))
			break;
		drv_get_key_seq(sdata->local, key, &kseq);
		params.seq = kseq.hw.seq;
		params.seq_len = kseq.hw.seq_len;
		break;
404 405 406 407 408 409 410 411 412
	}

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

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

 out:
413
	rcu_read_unlock();
414 415 416
	return err;
}

417 418
static int ieee80211_config_default_key(struct wiphy *wiphy,
					struct net_device *dev,
419 420
					u8 key_idx, bool uni,
					bool multi)
421
{
J
Johannes Berg 已提交
422
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
423

424
	ieee80211_set_default_key(sdata, key_idx, uni, multi);
425 426 427 428

	return 0;
}

429 430 431 432
static int ieee80211_config_default_mgmt_key(struct wiphy *wiphy,
					     struct net_device *dev,
					     u8 key_idx)
{
433
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
434 435 436 437 438 439

	ieee80211_set_default_mgmt_key(sdata, key_idx);

	return 0;
}

440 441 442 443 444
void sta_set_rate_info_tx(struct sta_info *sta,
			  const struct ieee80211_tx_rate *rate,
			  struct rate_info *rinfo)
{
	rinfo->flags = 0;
445
	if (rate->flags & IEEE80211_TX_RC_MCS) {
446
		rinfo->flags |= RATE_INFO_FLAGS_MCS;
447 448 449 450 451 452 453
		rinfo->mcs = rate->idx;
	} else if (rate->flags & IEEE80211_TX_RC_VHT_MCS) {
		rinfo->flags |= RATE_INFO_FLAGS_VHT_MCS;
		rinfo->mcs = ieee80211_rate_get_vht_mcs(rate);
		rinfo->nss = ieee80211_rate_get_vht_nss(rate);
	} else {
		struct ieee80211_supported_band *sband;
454 455 456
		int shift = ieee80211_vif_get_shift(&sta->sdata->vif);
		u16 brate;

457 458
		sband = sta->local->hw.wiphy->bands[
				ieee80211_get_sdata_band(sta->sdata)];
459 460
		brate = sband->bitrates[rate->idx].bitrate;
		rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift);
461
	}
462
	if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
463 464 465 466 467 468 469
		rinfo->bw = RATE_INFO_BW_40;
	else if (rate->flags & IEEE80211_TX_RC_80_MHZ_WIDTH)
		rinfo->bw = RATE_INFO_BW_80;
	else if (rate->flags & IEEE80211_TX_RC_160_MHZ_WIDTH)
		rinfo->bw = RATE_INFO_BW_160;
	else
		rinfo->bw = RATE_INFO_BW_20;
470 471 472 473
	if (rate->flags & IEEE80211_TX_RC_SHORT_GI)
		rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI;
}

474
static int ieee80211_dump_station(struct wiphy *wiphy, struct net_device *dev,
475
				  int idx, u8 *mac, struct station_info *sinfo)
476
{
477
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
478
	struct ieee80211_local *local = sdata->local;
479
	struct sta_info *sta;
480 481
	int ret = -ENOENT;

482
	mutex_lock(&local->sta_mtx);
483

484
	sta = sta_info_get_by_idx(sdata, idx);
485 486
	if (sta) {
		ret = 0;
487
		memcpy(mac, sta->sta.addr, ETH_ALEN);
488 489
		sta_set_sinfo(sta, sinfo);
	}
490

491
	mutex_unlock(&local->sta_mtx);
492

493
	return ret;
494 495
}

496 497 498 499 500 501 502 503
static int ieee80211_dump_survey(struct wiphy *wiphy, struct net_device *dev,
				 int idx, struct survey_info *survey)
{
	struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);

	return drv_get_survey(local, idx, survey);
}

504
static int ieee80211_get_station(struct wiphy *wiphy, struct net_device *dev,
505
				 const u8 *mac, struct station_info *sinfo)
506
{
507
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
508
	struct ieee80211_local *local = sdata->local;
509
	struct sta_info *sta;
510
	int ret = -ENOENT;
511

512
	mutex_lock(&local->sta_mtx);
513

514
	sta = sta_info_get_bss(sdata, mac);
515 516 517 518 519
	if (sta) {
		ret = 0;
		sta_set_sinfo(sta, sinfo);
	}

520
	mutex_unlock(&local->sta_mtx);
521 522

	return ret;
523 524
}

J
Johannes Berg 已提交
525
static int ieee80211_set_monitor_channel(struct wiphy *wiphy,
526
					 struct cfg80211_chan_def *chandef)
527 528
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
J
Johannes Berg 已提交
529 530
	struct ieee80211_sub_if_data *sdata;
	int ret = 0;
531

532
	if (cfg80211_chandef_identical(&local->monitor_chandef, chandef))
J
Johannes Berg 已提交
533
		return 0;
534

535
	mutex_lock(&local->mtx);
J
Johannes Berg 已提交
536 537 538 539 540 541 542
	mutex_lock(&local->iflist_mtx);
	if (local->use_chanctx) {
		sdata = rcu_dereference_protected(
				local->monitor_sdata,
				lockdep_is_held(&local->iflist_mtx));
		if (sdata) {
			ieee80211_vif_release_channel(sdata);
543
			ret = ieee80211_vif_use_channel(sdata, chandef,
J
Johannes Berg 已提交
544 545 546
					IEEE80211_CHANCTX_EXCLUSIVE);
		}
	} else if (local->open_count == local->monitors) {
547
		local->_oper_chandef = *chandef;
J
Johannes Berg 已提交
548 549
		ieee80211_hw_config(local, 0);
	}
550

551 552
	if (ret == 0)
		local->monitor_chandef = *chandef;
J
Johannes Berg 已提交
553
	mutex_unlock(&local->iflist_mtx);
554
	mutex_unlock(&local->mtx);
555

J
Johannes Berg 已提交
556
	return ret;
557 558
}

559
static int ieee80211_set_probe_resp(struct ieee80211_sub_if_data *sdata,
560 561
				    const u8 *resp, size_t resp_len,
				    const struct ieee80211_csa_settings *csa)
562
{
563
	struct probe_resp *new, *old;
564 565

	if (!resp || !resp_len)
566
		return 1;
567

568
	old = sdata_dereference(sdata->u.ap.probe_resp, sdata);
569

570
	new = kzalloc(sizeof(struct probe_resp) + resp_len, GFP_KERNEL);
571 572 573
	if (!new)
		return -ENOMEM;

574 575
	new->len = resp_len;
	memcpy(new->data, resp, resp_len);
576

577 578 579 580 581
	if (csa)
		memcpy(new->csa_counter_offsets, csa->counter_offsets_presp,
		       csa->n_counter_offsets_presp *
		       sizeof(new->csa_counter_offsets[0]));

582
	rcu_assign_pointer(sdata->u.ap.probe_resp, new);
583 584
	if (old)
		kfree_rcu(old, rcu_head);
585 586 587 588

	return 0;
}

589
static int ieee80211_assign_beacon(struct ieee80211_sub_if_data *sdata,
590 591
				   struct cfg80211_beacon_data *params,
				   const struct ieee80211_csa_settings *csa)
592 593 594
{
	struct beacon_data *new, *old;
	int new_head_len, new_tail_len;
595 596
	int size, err;
	u32 changed = BSS_CHANGED_BEACON;
597

598 599
	old = sdata_dereference(sdata->u.ap.beacon, sdata);

600 601 602

	/* Need to have a beacon head if we don't have one yet */
	if (!params->head && !old)
603
		return -EINVAL;
604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634

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

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

635 636 637 638 639 640 641
	if (csa) {
		new->csa_current_counter = csa->count;
		memcpy(new->csa_counter_offsets, csa->counter_offsets_beacon,
		       csa->n_counter_offsets_beacon *
		       sizeof(new->csa_counter_offsets[0]));
	}

642 643 644 645 646 647 648 649 650 651 652 653 654
	/* 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);

655
	err = ieee80211_set_probe_resp(sdata, params->probe_resp,
656
				       params->probe_resp_len, csa);
657 658 659
	if (err < 0)
		return err;
	if (err == 0)
660 661
		changed |= BSS_CHANGED_AP_PROBE_RESP;

662 663 664 665
	rcu_assign_pointer(sdata->u.ap.beacon, new);

	if (old)
		kfree_rcu(old, rcu_head);
666

667
	return changed;
668 669
}

670 671
static int ieee80211_start_ap(struct wiphy *wiphy, struct net_device *dev,
			      struct cfg80211_ap_settings *params)
672
{
673
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
674
	struct ieee80211_local *local = sdata->local;
675
	struct beacon_data *old;
676
	struct ieee80211_sub_if_data *vlan;
677 678 679
	u32 changed = BSS_CHANGED_BEACON_INT |
		      BSS_CHANGED_BEACON_ENABLED |
		      BSS_CHANGED_BEACON |
680
		      BSS_CHANGED_SSID |
681 682
		      BSS_CHANGED_P2P_PS |
		      BSS_CHANGED_TXPOWER;
683
	int err;
684

685
	old = sdata_dereference(sdata->u.ap.beacon, sdata);
686 687 688
	if (old)
		return -EALREADY;

689 690 691 692 693 694 695 696 697 698 699 700 701
	switch (params->smps_mode) {
	case NL80211_SMPS_OFF:
		sdata->smps_mode = IEEE80211_SMPS_OFF;
		break;
	case NL80211_SMPS_STATIC:
		sdata->smps_mode = IEEE80211_SMPS_STATIC;
		break;
	case NL80211_SMPS_DYNAMIC:
		sdata->smps_mode = IEEE80211_SMPS_DYNAMIC;
		break;
	default:
		return -EINVAL;
	}
702 703
	sdata->needed_rx_chains = sdata->local->rx_chains;

704
	mutex_lock(&local->mtx);
705
	err = ieee80211_vif_use_channel(sdata, &params->chandef,
J
Johannes Berg 已提交
706
					IEEE80211_CHANCTX_SHARED);
707 708
	if (!err)
		ieee80211_vif_copy_chanctx_to_vlans(sdata, false);
709
	mutex_unlock(&local->mtx);
710 711 712
	if (err)
		return err;

713 714 715 716 717 718
	/*
	 * Apply control port protocol, this allows us to
	 * not encrypt dynamic WEP control frames.
	 */
	sdata->control_port_protocol = params->crypto.control_port_ethertype;
	sdata->control_port_no_encrypt = params->crypto.control_port_no_encrypt;
719 720 721 722
	sdata->encrypt_headroom = ieee80211_cs_headroom(sdata->local,
							&params->crypto,
							sdata->vif.type);

723 724 725 726 727
	list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list) {
		vlan->control_port_protocol =
			params->crypto.control_port_ethertype;
		vlan->control_port_no_encrypt =
			params->crypto.control_port_no_encrypt;
728 729 730 731
		vlan->encrypt_headroom =
			ieee80211_cs_headroom(sdata->local,
					      &params->crypto,
					      vlan->vif.type);
732 733
	}

734 735
	sdata->vif.bss_conf.beacon_int = params->beacon_interval;
	sdata->vif.bss_conf.dtim_period = params->dtim_period;
736
	sdata->vif.bss_conf.enable_beacon = true;
737
	sdata->vif.bss_conf.allow_p2p_go_ps = sdata->vif.p2p;
738 739 740 741 742 743 744 745

	sdata->vif.bss_conf.ssid_len = params->ssid_len;
	if (params->ssid_len)
		memcpy(sdata->vif.bss_conf.ssid, params->ssid,
		       params->ssid_len);
	sdata->vif.bss_conf.hidden_ssid =
		(params->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE);

J
Janusz Dziedzic 已提交
746 747 748 749 750 751 752
	memset(&sdata->vif.bss_conf.p2p_noa_attr, 0,
	       sizeof(sdata->vif.bss_conf.p2p_noa_attr));
	sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow =
		params->p2p_ctwindow & IEEE80211_P2P_OPPPS_CTWINDOW_MASK;
	if (params->p2p_opp_ps)
		sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |=
					IEEE80211_P2P_OPPPS_ENABLE_BIT;
753

754
	err = ieee80211_assign_beacon(sdata, &params->beacon, NULL);
755 756
	if (err < 0) {
		ieee80211_vif_release_channel(sdata);
757
		return err;
758
	}
759 760
	changed |= err;

761 762
	err = drv_start_ap(sdata->local, sdata);
	if (err) {
763 764
		old = sdata_dereference(sdata->u.ap.beacon, sdata);

765 766 767
		if (old)
			kfree_rcu(old, rcu_head);
		RCU_INIT_POINTER(sdata->u.ap.beacon, NULL);
768
		ieee80211_vif_release_channel(sdata);
769 770 771
		return err;
	}

772
	ieee80211_recalc_dtim(local, sdata);
773 774
	ieee80211_bss_info_change_notify(sdata, changed);

775 776 777 778
	netif_carrier_on(dev);
	list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list)
		netif_carrier_on(vlan->dev);

779
	return 0;
780 781
}

782 783
static int ieee80211_change_beacon(struct wiphy *wiphy, struct net_device *dev,
				   struct cfg80211_beacon_data *params)
784
{
785
	struct ieee80211_sub_if_data *sdata;
786
	struct beacon_data *old;
787
	int err;
788

789
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);
790
	sdata_assert_lock(sdata);
791

792 793 794 795 796 797
	/* don't allow changing the beacon while CSA is in place - offset
	 * of channel switch counter may change
	 */
	if (sdata->vif.csa_active)
		return -EBUSY;

798
	old = sdata_dereference(sdata->u.ap.beacon, sdata);
799 800 801
	if (!old)
		return -ENOENT;

802
	err = ieee80211_assign_beacon(sdata, params, NULL);
803 804 805 806
	if (err < 0)
		return err;
	ieee80211_bss_info_change_notify(sdata, err);
	return 0;
807 808
}

809
static int ieee80211_stop_ap(struct wiphy *wiphy, struct net_device *dev)
810
{
811 812 813 814 815
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_sub_if_data *vlan;
	struct ieee80211_local *local = sdata->local;
	struct beacon_data *old_beacon;
	struct probe_resp *old_probe_resp;
816
	struct cfg80211_chan_def chandef;
817

818 819
	sdata_assert_lock(sdata);

820
	old_beacon = sdata_dereference(sdata->u.ap.beacon, sdata);
821
	if (!old_beacon)
822
		return -ENOENT;
823
	old_probe_resp = sdata_dereference(sdata->u.ap.probe_resp, sdata);
824

825
	/* abort any running channel switch */
826
	mutex_lock(&local->mtx);
827
	sdata->vif.csa_active = false;
828 829 830 831 832 833
	if (sdata->csa_block_tx) {
		ieee80211_wake_vif_queues(local, sdata,
					  IEEE80211_QUEUE_STOP_REASON_CSA);
		sdata->csa_block_tx = false;
	}

834 835
	mutex_unlock(&local->mtx);

836 837 838
	kfree(sdata->u.ap.next_beacon);
	sdata->u.ap.next_beacon = NULL;

839
	/* turn off carrier for this interface and dependent VLANs */
840 841 842 843
	list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list)
		netif_carrier_off(vlan->dev);
	netif_carrier_off(dev);

844
	/* remove beacon and probe response */
845
	RCU_INIT_POINTER(sdata->u.ap.beacon, NULL);
846 847 848 849
	RCU_INIT_POINTER(sdata->u.ap.probe_resp, NULL);
	kfree_rcu(old_beacon, rcu_head);
	if (old_probe_resp)
		kfree_rcu(old_probe_resp, rcu_head);
850
	sdata->u.ap.driver_smps_mode = IEEE80211_SMPS_OFF;
851

852
	__sta_info_flush(sdata, true);
853
	ieee80211_free_keys(sdata, true);
854

855
	sdata->vif.bss_conf.enable_beacon = false;
856
	sdata->vif.bss_conf.ssid_len = 0;
857
	clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state);
858
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED);
859

860
	if (sdata->wdev.cac_started) {
861
		chandef = sdata->vif.bss_conf.chandef;
862
		cancel_delayed_work_sync(&sdata->dfs_cac_timer_work);
863 864
		cfg80211_cac_event(sdata->dev, &chandef,
				   NL80211_RADAR_CAC_ABORTED,
865 866 867
				   GFP_KERNEL);
	}

868 869
	drv_stop_ap(sdata->local, sdata);

870 871 872 873
	/* free all potentially still buffered bcast frames */
	local->total_ps_buffered -= skb_queue_len(&sdata->u.ap.ps.bc_buf);
	skb_queue_purge(&sdata->u.ap.ps.bc_buf);

874
	mutex_lock(&local->mtx);
875
	ieee80211_vif_copy_chanctx_to_vlans(sdata, true);
J
Johannes Berg 已提交
876
	ieee80211_vif_release_channel(sdata);
877
	mutex_unlock(&local->mtx);
J
Johannes Berg 已提交
878

879
	return 0;
880 881
}

882 883 884 885 886 887 888 889 890
/* 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];
E
Eric Dumazet 已提交
891
} __packed;
892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908

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

J
Johannes Berg 已提交
909
	eth_broadcast_addr(msg->da);
910
	memcpy(msg->sa, sta->sta.addr, ETH_ALEN);
911 912 913 914 915 916 917 918 919
	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) */

920 921
	skb->dev = sta->sdata->dev;
	skb->protocol = eth_type_trans(skb, sta->sdata->dev);
922
	memset(skb->cb, 0, sizeof(skb->cb));
923
	netif_rx_ni(skb);
924 925
}

926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942
static int sta_apply_auth_flags(struct ieee80211_local *local,
				struct sta_info *sta,
				u32 mask, u32 set)
{
	int ret;

	if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED) &&
	    set & BIT(NL80211_STA_FLAG_AUTHENTICATED) &&
	    !test_sta_flag(sta, WLAN_STA_AUTH)) {
		ret = sta_info_move_state(sta, IEEE80211_STA_AUTH);
		if (ret)
			return ret;
	}

	if (mask & BIT(NL80211_STA_FLAG_ASSOCIATED) &&
	    set & BIT(NL80211_STA_FLAG_ASSOCIATED) &&
	    !test_sta_flag(sta, WLAN_STA_ASSOC)) {
943 944 945 946 947
		/*
		 * When peer becomes associated, init rate control as
		 * well. Some drivers require rate control initialized
		 * before drv_sta_state() is called.
		 */
948
		if (!test_sta_flag(sta, WLAN_STA_RATE_CONTROL))
949 950
			rate_control_rate_init(sta);

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
		ret = sta_info_move_state(sta, IEEE80211_STA_ASSOC);
		if (ret)
			return ret;
	}

	if (mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
		if (set & BIT(NL80211_STA_FLAG_AUTHORIZED))
			ret = sta_info_move_state(sta, IEEE80211_STA_AUTHORIZED);
		else if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
			ret = sta_info_move_state(sta, IEEE80211_STA_ASSOC);
		else
			ret = 0;
		if (ret)
			return ret;
	}

	if (mask & BIT(NL80211_STA_FLAG_ASSOCIATED) &&
	    !(set & BIT(NL80211_STA_FLAG_ASSOCIATED)) &&
	    test_sta_flag(sta, WLAN_STA_ASSOC)) {
		ret = sta_info_move_state(sta, IEEE80211_STA_AUTH);
		if (ret)
			return ret;
	}

	if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED) &&
	    !(set & BIT(NL80211_STA_FLAG_AUTHENTICATED)) &&
	    test_sta_flag(sta, WLAN_STA_AUTH)) {
		ret = sta_info_move_state(sta, IEEE80211_STA_NONE);
		if (ret)
			return ret;
	}

	return 0;
}

986 987 988 989 990 991 992 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
static void sta_apply_mesh_params(struct ieee80211_local *local,
				  struct sta_info *sta,
				  struct station_parameters *params)
{
#ifdef CONFIG_MAC80211_MESH
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	u32 changed = 0;

	if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) {
		switch (params->plink_state) {
		case NL80211_PLINK_ESTAB:
			if (sta->mesh->plink_state != NL80211_PLINK_ESTAB)
				changed = mesh_plink_inc_estab_count(sdata);
			sta->mesh->plink_state = params->plink_state;

			ieee80211_mps_sta_status_update(sta);
			changed |= ieee80211_mps_set_sta_local_pm(sta,
				      sdata->u.mesh.mshcfg.power_mode);
			break;
		case NL80211_PLINK_LISTEN:
		case NL80211_PLINK_BLOCKED:
		case NL80211_PLINK_OPN_SNT:
		case NL80211_PLINK_OPN_RCVD:
		case NL80211_PLINK_CNF_RCVD:
		case NL80211_PLINK_HOLDING:
			if (sta->mesh->plink_state == NL80211_PLINK_ESTAB)
				changed = mesh_plink_dec_estab_count(sdata);
			sta->mesh->plink_state = params->plink_state;

			ieee80211_mps_sta_status_update(sta);
			changed |= ieee80211_mps_set_sta_local_pm(sta,
					NL80211_MESH_POWER_UNKNOWN);
			break;
		default:
			/*  nothing  */
			break;
		}
	}

	switch (params->plink_action) {
	case NL80211_PLINK_ACTION_NO_ACTION:
		/* nothing */
		break;
	case NL80211_PLINK_ACTION_OPEN:
		changed |= mesh_plink_open(sta);
		break;
	case NL80211_PLINK_ACTION_BLOCK:
		changed |= mesh_plink_block(sta);
		break;
	}

	if (params->local_pm)
		changed |= ieee80211_mps_set_sta_local_pm(sta,
							  params->local_pm);

	ieee80211_mbss_info_change_notify(sdata, changed);
#endif
}

1045 1046 1047
static int sta_apply_parameters(struct ieee80211_local *local,
				struct sta_info *sta,
				struct station_parameters *params)
1048
{
1049
	int ret = 0;
1050
	struct ieee80211_supported_band *sband;
1051
	struct ieee80211_sub_if_data *sdata = sta->sdata;
J
Johannes Berg 已提交
1052
	enum ieee80211_band band = ieee80211_get_sdata_band(sdata);
1053
	u32 mask, set;
1054

J
Johannes Berg 已提交
1055
	sband = local->hw.wiphy->bands[band];
J
Johannes Berg 已提交
1056

1057 1058
	mask = params->sta_flags_mask;
	set = params->sta_flags_set;
J
Johannes Berg 已提交
1059

1060 1061 1062 1063 1064 1065 1066 1067 1068
	if (ieee80211_vif_is_mesh(&sdata->vif)) {
		/*
		 * In mesh mode, ASSOCIATED isn't part of the nl80211
		 * API but must follow AUTHENTICATED for driver state.
		 */
		if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED))
			mask |= BIT(NL80211_STA_FLAG_ASSOCIATED);
		if (set & BIT(NL80211_STA_FLAG_AUTHENTICATED))
			set |= BIT(NL80211_STA_FLAG_ASSOCIATED);
1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080
	} else if (test_sta_flag(sta, WLAN_STA_TDLS_PEER)) {
		/*
		 * TDLS -- everything follows authorized, but
		 * only becoming authorized is possible, not
		 * going back
		 */
		if (set & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
			set |= BIT(NL80211_STA_FLAG_AUTHENTICATED) |
			       BIT(NL80211_STA_FLAG_ASSOCIATED);
			mask |= BIT(NL80211_STA_FLAG_AUTHENTICATED) |
				BIT(NL80211_STA_FLAG_ASSOCIATED);
		}
1081
	}
1082

1083 1084 1085 1086
	if (mask & BIT(NL80211_STA_FLAG_WME) &&
	    local->hw.queues >= IEEE80211_NUM_ACS)
		sta->sta.wme = set & BIT(NL80211_STA_FLAG_WME);

1087 1088 1089 1090 1091
	/* auth flags will be set later for TDLS,
	 * and for unassociated stations that move to assocaited */
	if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
	    !((mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) &&
	      (set & BIT(NL80211_STA_FLAG_ASSOCIATED)))) {
1092 1093 1094 1095
		ret = sta_apply_auth_flags(local, sta, mask, set);
		if (ret)
			return ret;
	}
1096

1097 1098
	if (mask & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE)) {
		if (set & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE))
J
Johannes Berg 已提交
1099 1100 1101
			set_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE);
		else
			clear_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE);
1102
	}
1103

1104
	if (mask & BIT(NL80211_STA_FLAG_MFP)) {
1105
		sta->sta.mfp = !!(set & BIT(NL80211_STA_FLAG_MFP));
1106
		if (set & BIT(NL80211_STA_FLAG_MFP))
J
Johannes Berg 已提交
1107 1108 1109
			set_sta_flag(sta, WLAN_STA_MFP);
		else
			clear_sta_flag(sta, WLAN_STA_MFP);
1110
	}
1111

1112 1113
	if (mask & BIT(NL80211_STA_FLAG_TDLS_PEER)) {
		if (set & BIT(NL80211_STA_FLAG_TDLS_PEER))
J
Johannes Berg 已提交
1114 1115 1116
			set_sta_flag(sta, WLAN_STA_TDLS_PEER);
		else
			clear_sta_flag(sta, WLAN_STA_TDLS_PEER);
1117
	}
1118

1119 1120 1121 1122 1123 1124 1125
	/* mark TDLS channel switch support, if the AP allows it */
	if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
	    !sdata->u.mgd.tdls_chan_switch_prohibited &&
	    params->ext_capab_len >= 4 &&
	    params->ext_capab[3] & WLAN_EXT_CAPA4_TDLS_CHAN_SWITCH)
		set_sta_flag(sta, WLAN_STA_TDLS_CHAN_SWITCH);

1126
	if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
1127
	    !sdata->u.mgd.tdls_wider_bw_prohibited &&
1128 1129 1130 1131 1132
	    ieee80211_hw_check(&local->hw, TDLS_WIDER_BW) &&
	    params->ext_capab_len >= 8 &&
	    params->ext_capab[7] & WLAN_EXT_CAPA8_TDLS_WIDE_BW_ENABLED)
		set_sta_flag(sta, WLAN_STA_TDLS_WIDER_BW);

1133 1134 1135 1136
	if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) {
		sta->sta.uapsd_queues = params->uapsd_queues;
		sta->sta.max_sp = params->max_sp;
	}
1137

1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165
	/* The sender might not have sent the last bit, consider it to be 0 */
	if (params->ext_capab_len >= 8) {
		u8 val = (params->ext_capab[7] &
			  WLAN_EXT_CAPA8_MAX_MSDU_IN_AMSDU_LSB) >> 7;

		/* we did get all the bits, take the MSB as well */
		if (params->ext_capab_len >= 9) {
			u8 val_msb = params->ext_capab[8] &
				WLAN_EXT_CAPA9_MAX_MSDU_IN_AMSDU_MSB;
			val_msb <<= 1;
			val |= val_msb;
		}

		switch (val) {
		case 1:
			sta->sta.max_amsdu_subframes = 32;
			break;
		case 2:
			sta->sta.max_amsdu_subframes = 16;
			break;
		case 3:
			sta->sta.max_amsdu_subframes = 8;
			break;
		default:
			sta->sta.max_amsdu_subframes = 0;
		}
	}

1166 1167 1168 1169 1170 1171 1172
	/*
	 * 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;

J
Johannes Berg 已提交
1173
	/*
1174 1175 1176 1177 1178
	 * Some of the following updates would be racy if called on an
	 * existing station, via ieee80211_change_station(). However,
	 * all such changes are rejected by cfg80211 except for updates
	 * changing the supported rates on an existing but not yet used
	 * TDLS peer.
J
Johannes Berg 已提交
1179 1180
	 */

1181 1182 1183 1184
	if (params->listen_interval >= 0)
		sta->listen_interval = params->listen_interval;

	if (params->supported_rates) {
1185 1186 1187 1188
		ieee80211_parse_bitrates(&sdata->vif.bss_conf.chandef,
					 sband, params->supported_rates,
					 params->supported_rates_len,
					 &sta->sta.supp_rates[band]);
1189
	}
1190

J
Johannes Berg 已提交
1191
	if (params->ht_capa)
B
Ben Greear 已提交
1192
		ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,
1193
						  params->ht_capa, sta);
1194

1195
	/* VHT can override some HT caps such as the A-MSDU max length */
M
Mahesh Palivela 已提交
1196 1197
	if (params->vht_capa)
		ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband,
1198
						    params->vht_capa, sta);
M
Mahesh Palivela 已提交
1199

1200 1201 1202 1203 1204
	if (params->opmode_notif_used) {
		/* returned value is only needed for rc update, but the
		 * rc isn't initialized here yet, so ignore it
		 */
		__ieee80211_vht_handle_opmode(sdata, sta,
1205
					      params->opmode_notif, band);
1206 1207
	}

1208 1209 1210
	if (params->support_p2p_ps >= 0)
		sta->sta.support_p2p_ps = params->support_p2p_ps;

1211 1212
	if (ieee80211_vif_is_mesh(&sdata->vif))
		sta_apply_mesh_params(local, sta, params);
1213

1214
	/* set the STA state after all sta info from usermode has been set */
1215 1216
	if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) ||
	    set & BIT(NL80211_STA_FLAG_ASSOCIATED)) {
1217 1218 1219 1220 1221
		ret = sta_apply_auth_flags(local, sta, mask, set);
		if (ret)
			return ret;
	}

1222
	return 0;
1223 1224 1225
}

static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
1226 1227
				 const u8 *mac,
				 struct station_parameters *params)
1228
{
1229
	struct ieee80211_local *local = wiphy_priv(wiphy);
1230 1231
	struct sta_info *sta;
	struct ieee80211_sub_if_data *sdata;
J
Johannes Berg 已提交
1232
	int err;
1233
	int layer2_update;
1234 1235 1236 1237

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

1238 1239
		if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
		    sdata->vif.type != NL80211_IFTYPE_AP)
1240 1241 1242 1243
			return -EINVAL;
	} else
		sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1244
	if (ether_addr_equal(mac, sdata->vif.addr))
1245 1246 1247 1248 1249 1250
		return -EINVAL;

	if (is_multicast_ether_addr(mac))
		return -EINVAL;

	sta = sta_info_alloc(sdata, mac, GFP_KERNEL);
J
Johannes Berg 已提交
1251 1252
	if (!sta)
		return -ENOMEM;
1253

1254 1255
	if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
		sta->sta.tdls = true;
1256

1257 1258 1259 1260 1261
	err = sta_apply_parameters(local, sta, params);
	if (err) {
		sta_info_free(local, sta);
		return err;
	}
1262

1263
	/*
1264 1265 1266
	 * for TDLS and for unassociated station, rate control should be
	 * initialized only when rates are known and station is marked
	 * authorized/associated
1267
	 */
1268 1269
	if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
	    test_sta_flag(sta, WLAN_STA_ASSOC))
1270
		rate_control_rate_init(sta);
1271

1272 1273 1274
	layer2_update = sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
		sdata->vif.type == NL80211_IFTYPE_AP;

1275
	err = sta_info_insert_rcu(sta);
J
Johannes Berg 已提交
1276 1277 1278 1279 1280
	if (err) {
		rcu_read_unlock();
		return err;
	}

1281
	if (layer2_update)
J
Johannes Berg 已提交
1282 1283 1284 1285
		ieee80211_send_layer2_update(sta);

	rcu_read_unlock();

1286 1287 1288 1289
	return 0;
}

static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev,
1290
				 struct station_del_parameters *params)
1291
{
1292
	struct ieee80211_sub_if_data *sdata;
1293

1294 1295
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1296 1297
	if (params->mac)
		return sta_info_destroy_addr_bss(sdata, params->mac);
1298

1299
	sta_info_flush(sdata);
1300 1301 1302 1303
	return 0;
}

static int ieee80211_change_station(struct wiphy *wiphy,
1304
				    struct net_device *dev, const u8 *mac,
1305 1306
				    struct station_parameters *params)
{
1307
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1308
	struct ieee80211_local *local = wiphy_priv(wiphy);
1309 1310
	struct sta_info *sta;
	struct ieee80211_sub_if_data *vlansdata;
1311
	enum cfg80211_station_type statype;
1312
	int err;
1313

1314
	mutex_lock(&local->sta_mtx);
J
Johannes Berg 已提交
1315

1316
	sta = sta_info_get_bss(sdata, mac);
J
Johannes Berg 已提交
1317
	if (!sta) {
1318 1319
		err = -ENOENT;
		goto out_err;
J
Johannes Berg 已提交
1320
	}
1321

1322 1323
	switch (sdata->vif.type) {
	case NL80211_IFTYPE_MESH_POINT:
1324
		if (sdata->u.mesh.user_mpm)
1325
			statype = CFG80211_STA_MESH_PEER_USER;
1326
		else
1327
			statype = CFG80211_STA_MESH_PEER_KERNEL;
1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343
		break;
	case NL80211_IFTYPE_ADHOC:
		statype = CFG80211_STA_IBSS;
		break;
	case NL80211_IFTYPE_STATION:
		if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER)) {
			statype = CFG80211_STA_AP_STA;
			break;
		}
		if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
			statype = CFG80211_STA_TDLS_PEER_ACTIVE;
		else
			statype = CFG80211_STA_TDLS_PEER_SETUP;
		break;
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
1344 1345 1346 1347
		if (test_sta_flag(sta, WLAN_STA_ASSOC))
			statype = CFG80211_STA_AP_CLIENT;
		else
			statype = CFG80211_STA_AP_CLIENT_UNASSOC;
1348 1349 1350 1351
		break;
	default:
		err = -EOPNOTSUPP;
		goto out_err;
1352 1353
	}

1354 1355 1356 1357
	err = cfg80211_check_station_change(wiphy, params, statype);
	if (err)
		goto out_err;

1358
	if (params->vlan && params->vlan != sta->sdata->dev) {
1359 1360 1361
		bool prev_4addr = false;
		bool new_4addr = false;

1362 1363
		vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);

1364
		if (params->vlan->ieee80211_ptr->use_4addr) {
J
Johannes Berg 已提交
1365
			if (vlansdata->u.vlan.sta) {
1366 1367
				err = -EBUSY;
				goto out_err;
J
Johannes Berg 已提交
1368
			}
1369

1370
			rcu_assign_pointer(vlansdata->u.vlan.sta, sta);
1371
			new_4addr = true;
J
Johannes Berg 已提交
1372
			__ieee80211_check_fast_rx_iface(vlansdata);
1373 1374 1375 1376
		}

		if (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
		    sta->sdata->u.vlan.sta) {
M
Monam Agarwal 已提交
1377
			RCU_INIT_POINTER(sta->sdata->u.vlan.sta, NULL);
1378
			prev_4addr = true;
1379 1380
		}

1381
		sta->sdata = vlansdata;
1382
		ieee80211_check_fast_xmit(sta);
1383 1384 1385 1386 1387 1388 1389 1390 1391

		if (sta->sta_state == IEEE80211_STA_AUTHORIZED &&
		    prev_4addr != new_4addr) {
			if (new_4addr)
				atomic_dec(&sta->sdata->bss->num_mcast_sta);
			else
				atomic_inc(&sta->sdata->bss->num_mcast_sta);
		}

1392 1393 1394
		ieee80211_send_layer2_update(sta);
	}

1395
	err = sta_apply_parameters(local, sta, params);
1396 1397
	if (err)
		goto out_err;
1398

1399
	mutex_unlock(&local->sta_mtx);
J
Johannes Berg 已提交
1400

1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414
	if ((sdata->vif.type == NL80211_IFTYPE_AP ||
	     sdata->vif.type == NL80211_IFTYPE_AP_VLAN) &&
	    sta->known_smps_mode != sta->sdata->bss->req_smps &&
	    test_sta_flag(sta, WLAN_STA_AUTHORIZED) &&
	    sta_info_tx_streams(sta) != 1) {
		ht_dbg(sta->sdata,
		       "%pM just authorized and MIMO capable - update SMPS\n",
		       sta->sta.addr);
		ieee80211_send_smps_action(sta->sdata,
			sta->sdata->bss->req_smps,
			sta->sta.addr,
			sta->sdata->vif.bss_conf.bssid);
	}

1415
	if (sdata->vif.type == NL80211_IFTYPE_STATION &&
E
Eliad Peller 已提交
1416
	    params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
J
Johannes Berg 已提交
1417
		ieee80211_recalc_ps(local);
E
Eliad Peller 已提交
1418 1419
		ieee80211_recalc_ps_vif(sdata);
	}
1420

1421
	return 0;
1422 1423 1424
out_err:
	mutex_unlock(&local->sta_mtx);
	return err;
1425 1426
}

1427 1428
#ifdef CONFIG_MAC80211_MESH
static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
1429
			       const u8 *dst, const u8 *next_hop)
1430
{
1431
	struct ieee80211_sub_if_data *sdata;
1432 1433 1434
	struct mesh_path *mpath;
	struct sta_info *sta;

1435 1436
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1437
	rcu_read_lock();
1438
	sta = sta_info_get(sdata, next_hop);
1439 1440
	if (!sta) {
		rcu_read_unlock();
1441
		return -ENOENT;
1442
	}
1443

1444 1445
	mpath = mesh_path_add(sdata, dst);
	if (IS_ERR(mpath)) {
1446
		rcu_read_unlock();
1447
		return PTR_ERR(mpath);
1448
	}
1449 1450

	mesh_path_fix_nexthop(mpath, sta);
1451

1452 1453 1454 1455 1456
	rcu_read_unlock();
	return 0;
}

static int ieee80211_del_mpath(struct wiphy *wiphy, struct net_device *dev,
1457
			       const u8 *dst)
1458
{
1459 1460
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1461
	if (dst)
J
Johannes Berg 已提交
1462
		return mesh_path_del(sdata, dst);
1463

1464
	mesh_path_flush_by_iface(sdata);
1465 1466 1467
	return 0;
}

1468 1469
static int ieee80211_change_mpath(struct wiphy *wiphy, struct net_device *dev,
				  const u8 *dst, const u8 *next_hop)
1470
{
1471
	struct ieee80211_sub_if_data *sdata;
1472 1473 1474
	struct mesh_path *mpath;
	struct sta_info *sta;

1475 1476
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1477 1478
	rcu_read_lock();

1479
	sta = sta_info_get(sdata, next_hop);
1480 1481
	if (!sta) {
		rcu_read_unlock();
1482
		return -ENOENT;
1483
	}
1484

J
Johannes Berg 已提交
1485
	mpath = mesh_path_lookup(sdata, dst);
1486 1487 1488 1489 1490 1491
	if (!mpath) {
		rcu_read_unlock();
		return -ENOENT;
	}

	mesh_path_fix_nexthop(mpath, sta);
1492

1493 1494 1495 1496 1497 1498 1499
	rcu_read_unlock();
	return 0;
}

static void mpath_set_pinfo(struct mesh_path *mpath, u8 *next_hop,
			    struct mpath_info *pinfo)
{
J
Johannes Berg 已提交
1500 1501 1502 1503
	struct sta_info *next_hop_sta = rcu_dereference(mpath->next_hop);

	if (next_hop_sta)
		memcpy(next_hop, next_hop_sta->sta.addr, ETH_ALEN);
1504
	else
1505
		eth_zero_addr(next_hop);
1506

1507 1508
	memset(pinfo, 0, sizeof(*pinfo));

1509
	pinfo->generation = mpath->sdata->u.mesh.mesh_paths_generation;
1510

1511
	pinfo->filled = MPATH_INFO_FRAME_QLEN |
1512
			MPATH_INFO_SN |
1513 1514 1515 1516 1517 1518 1519
			MPATH_INFO_METRIC |
			MPATH_INFO_EXPTIME |
			MPATH_INFO_DISCOVERY_TIMEOUT |
			MPATH_INFO_DISCOVERY_RETRIES |
			MPATH_INFO_FLAGS;

	pinfo->frame_qlen = mpath->frame_queue.qlen;
1520
	pinfo->sn = mpath->sn;
1521 1522 1523 1524 1525 1526 1527 1528 1529 1530
	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;
	if (mpath->flags & MESH_PATH_ACTIVE)
		pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE;
	if (mpath->flags & MESH_PATH_RESOLVING)
		pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
1531 1532
	if (mpath->flags & MESH_PATH_SN_VALID)
		pinfo->flags |= NL80211_MPATH_FLAG_SN_VALID;
1533 1534
	if (mpath->flags & MESH_PATH_FIXED)
		pinfo->flags |= NL80211_MPATH_FLAG_FIXED;
1535 1536
	if (mpath->flags & MESH_PATH_RESOLVED)
		pinfo->flags |= NL80211_MPATH_FLAG_RESOLVED;
1537 1538 1539 1540 1541 1542
}

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

{
1543
	struct ieee80211_sub_if_data *sdata;
1544 1545
	struct mesh_path *mpath;

1546 1547
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1548
	rcu_read_lock();
J
Johannes Berg 已提交
1549
	mpath = mesh_path_lookup(sdata, dst);
1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560
	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,
1561 1562
				int idx, u8 *dst, u8 *next_hop,
				struct mpath_info *pinfo)
1563
{
1564
	struct ieee80211_sub_if_data *sdata;
1565 1566
	struct mesh_path *mpath;

1567 1568
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1569
	rcu_read_lock();
J
Johannes Berg 已提交
1570
	mpath = mesh_path_lookup_by_idx(sdata, idx);
1571 1572 1573 1574 1575 1576 1577 1578 1579
	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;
}
1580

1581 1582 1583 1584 1585 1586
static void mpp_set_pinfo(struct mesh_path *mpath, u8 *mpp,
			  struct mpath_info *pinfo)
{
	memset(pinfo, 0, sizeof(*pinfo));
	memcpy(mpp, mpath->mpp, ETH_ALEN);

1587
	pinfo->generation = mpath->sdata->u.mesh.mpp_paths_generation;
1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631
}

static int ieee80211_get_mpp(struct wiphy *wiphy, struct net_device *dev,
			     u8 *dst, u8 *mpp, struct mpath_info *pinfo)

{
	struct ieee80211_sub_if_data *sdata;
	struct mesh_path *mpath;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	rcu_read_lock();
	mpath = mpp_path_lookup(sdata, dst);
	if (!mpath) {
		rcu_read_unlock();
		return -ENOENT;
	}
	memcpy(dst, mpath->dst, ETH_ALEN);
	mpp_set_pinfo(mpath, mpp, pinfo);
	rcu_read_unlock();
	return 0;
}

static int ieee80211_dump_mpp(struct wiphy *wiphy, struct net_device *dev,
			      int idx, u8 *dst, u8 *mpp,
			      struct mpath_info *pinfo)
{
	struct ieee80211_sub_if_data *sdata;
	struct mesh_path *mpath;

	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	rcu_read_lock();
	mpath = mpp_path_lookup_by_idx(sdata, idx);
	if (!mpath) {
		rcu_read_unlock();
		return -ENOENT;
	}
	memcpy(dst, mpath->dst, ETH_ALEN);
	mpp_set_pinfo(mpath, mpp, pinfo);
	rcu_read_unlock();
	return 0;
}

1632
static int ieee80211_get_mesh_config(struct wiphy *wiphy,
1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647
				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;
}

1648 1649 1650 1651 1652
static int copy_mesh_setup(struct ieee80211_if_mesh *ifmsh,
		const struct mesh_setup *setup)
{
	u8 *new_ie;
	const u8 *old_ie;
1653 1654
	struct ieee80211_sub_if_data *sdata = container_of(ifmsh,
					struct ieee80211_sub_if_data, u.mesh);
1655

1656
	/* allocate information elements */
1657
	new_ie = NULL;
1658
	old_ie = ifmsh->ie;
1659

1660 1661
	if (setup->ie_len) {
		new_ie = kmemdup(setup->ie, setup->ie_len,
1662 1663 1664 1665
				GFP_KERNEL);
		if (!new_ie)
			return -ENOMEM;
	}
1666 1667 1668
	ifmsh->ie_len = setup->ie_len;
	ifmsh->ie = new_ie;
	kfree(old_ie);
1669 1670 1671 1672

	/* now copy the rest of the setup parameters */
	ifmsh->mesh_id_len = setup->mesh_id_len;
	memcpy(ifmsh->mesh_id, setup->mesh_id, ifmsh->mesh_id_len);
1673
	ifmsh->mesh_sp_id = setup->sync_method;
1674 1675
	ifmsh->mesh_pp_id = setup->path_sel_proto;
	ifmsh->mesh_pm_id = setup->path_metric;
1676
	ifmsh->user_mpm = setup->user_mpm;
1677
	ifmsh->mesh_auth_id = setup->auth_id;
1678 1679 1680 1681 1682
	ifmsh->security = IEEE80211_MESH_SEC_NONE;
	if (setup->is_authenticated)
		ifmsh->security |= IEEE80211_MESH_SEC_AUTHED;
	if (setup->is_secure)
		ifmsh->security |= IEEE80211_MESH_SEC_SECURED;
1683

1684 1685 1686
	/* mcast rate setting in Mesh Node */
	memcpy(sdata->vif.bss_conf.mcast_rate, setup->mcast_rate,
						sizeof(setup->mcast_rate));
1687
	sdata->vif.bss_conf.basic_rates = setup->basic_rates;
1688

1689 1690 1691
	sdata->vif.bss_conf.beacon_int = setup->beacon_interval;
	sdata->vif.bss_conf.dtim_period = setup->dtim_period;

1692 1693 1694
	return 0;
}

1695
static int ieee80211_update_mesh_config(struct wiphy *wiphy,
1696 1697
					struct net_device *dev, u32 mask,
					const struct mesh_config *nconf)
1698 1699 1700
{
	struct mesh_config *conf;
	struct ieee80211_sub_if_data *sdata;
1701 1702
	struct ieee80211_if_mesh *ifmsh;

1703
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1704
	ifmsh = &sdata->u.mesh;
1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719

	/* 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;
1720
	if (_chg_mesh_attr(NL80211_MESHCONF_ELEMENT_TTL, mask))
1721
		conf->element_ttl = nconf->element_ttl;
1722 1723 1724
	if (_chg_mesh_attr(NL80211_MESHCONF_AUTO_OPEN_PLINKS, mask)) {
		if (ifmsh->user_mpm)
			return -EBUSY;
1725
		conf->auto_open_plinks = nconf->auto_open_plinks;
1726
	}
1727 1728 1729
	if (_chg_mesh_attr(NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, mask))
		conf->dot11MeshNbrOffsetMaxNeighbor =
			nconf->dot11MeshNbrOffsetMaxNeighbor;
1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742
	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;
1743 1744 1745
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, mask))
		conf->dot11MeshHWMPperrMinInterval =
			nconf->dot11MeshHWMPperrMinInterval;
1746 1747 1748 1749
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
			   mask))
		conf->dot11MeshHWMPnetDiameterTraversalTime =
			nconf->dot11MeshHWMPnetDiameterTraversalTime;
1750 1751 1752 1753
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOTMODE, mask)) {
		conf->dot11MeshHWMPRootMode = nconf->dot11MeshHWMPRootMode;
		ieee80211_mesh_root_setup(ifmsh);
	}
1754
	if (_chg_mesh_attr(NL80211_MESHCONF_GATE_ANNOUNCEMENTS, mask)) {
T
Thomas Pedersen 已提交
1755 1756 1757 1758
		/* our current gate announcement implementation rides on root
		 * announcements, so require this ifmsh to also be a root node
		 * */
		if (nconf->dot11MeshGateAnnouncementProtocol &&
1759 1760
		    !(conf->dot11MeshHWMPRootMode > IEEE80211_ROOTMODE_ROOT)) {
			conf->dot11MeshHWMPRootMode = IEEE80211_PROACTIVE_RANN;
T
Thomas Pedersen 已提交
1761 1762
			ieee80211_mesh_root_setup(ifmsh);
		}
1763 1764 1765
		conf->dot11MeshGateAnnouncementProtocol =
			nconf->dot11MeshGateAnnouncementProtocol;
	}
1766
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_RANN_INTERVAL, mask))
1767 1768
		conf->dot11MeshHWMPRannInterval =
			nconf->dot11MeshHWMPRannInterval;
1769 1770
	if (_chg_mesh_attr(NL80211_MESHCONF_FORWARDING, mask))
		conf->dot11MeshForwarding = nconf->dot11MeshForwarding;
1771 1772 1773 1774
	if (_chg_mesh_attr(NL80211_MESHCONF_RSSI_THRESHOLD, mask)) {
		/* our RSSI threshold implementation is supported only for
		 * devices that report signal in dBm.
		 */
1775
		if (!ieee80211_hw_check(&sdata->local->hw, SIGNAL_DBM))
1776 1777 1778
			return -ENOTSUPP;
		conf->rssi_threshold = nconf->rssi_threshold;
	}
1779 1780 1781 1782 1783
	if (_chg_mesh_attr(NL80211_MESHCONF_HT_OPMODE, mask)) {
		conf->ht_opmode = nconf->ht_opmode;
		sdata->vif.bss_conf.ht_operation_mode = nconf->ht_opmode;
		ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_HT);
	}
1784 1785 1786 1787 1788 1789
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, mask))
		conf->dot11MeshHWMPactivePathToRootTimeout =
			nconf->dot11MeshHWMPactivePathToRootTimeout;
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOT_INTERVAL, mask))
		conf->dot11MeshHWMProotInterval =
			nconf->dot11MeshHWMProotInterval;
1790 1791 1792
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, mask))
		conf->dot11MeshHWMPconfirmationInterval =
			nconf->dot11MeshHWMPconfirmationInterval;
M
Marco Porsch 已提交
1793 1794 1795 1796
	if (_chg_mesh_attr(NL80211_MESHCONF_POWER_MODE, mask)) {
		conf->power_mode = nconf->power_mode;
		ieee80211_mps_local_status_update(sdata);
	}
T
Thomas Pedersen 已提交
1797
	if (_chg_mesh_attr(NL80211_MESHCONF_AWAKE_WINDOW, mask))
M
Marco Porsch 已提交
1798 1799
		conf->dot11MeshAwakeWindowDuration =
			nconf->dot11MeshAwakeWindowDuration;
1800 1801
	if (_chg_mesh_attr(NL80211_MESHCONF_PLINK_TIMEOUT, mask))
		conf->plink_timeout = nconf->plink_timeout;
T
Thomas Pedersen 已提交
1802
	ieee80211_mbss_info_change_notify(sdata, BSS_CHANGED_BEACON);
1803 1804 1805
	return 0;
}

1806 1807 1808 1809 1810 1811
static int ieee80211_join_mesh(struct wiphy *wiphy, struct net_device *dev,
			       const struct mesh_config *conf,
			       const struct mesh_setup *setup)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh;
1812
	int err;
1813

1814 1815 1816 1817
	memcpy(&ifmsh->mshcfg, conf, sizeof(struct mesh_config));
	err = copy_mesh_setup(ifmsh, setup);
	if (err)
		return err;
1818

1819 1820 1821 1822
	/* can mesh use other SMPS modes? */
	sdata->smps_mode = IEEE80211_SMPS_OFF;
	sdata->needed_rx_chains = sdata->local->rx_chains;

1823
	mutex_lock(&sdata->local->mtx);
1824
	err = ieee80211_vif_use_channel(sdata, &setup->chandef,
J
Johannes Berg 已提交
1825
					IEEE80211_CHANCTX_SHARED);
1826
	mutex_unlock(&sdata->local->mtx);
1827 1828 1829
	if (err)
		return err;

T
Thomas Pedersen 已提交
1830
	return ieee80211_start_mesh(sdata);
1831 1832 1833 1834 1835 1836 1837
}

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

	ieee80211_stop_mesh(sdata);
1838
	mutex_lock(&sdata->local->mtx);
J
Johannes Berg 已提交
1839
	ieee80211_vif_release_channel(sdata);
1840
	mutex_unlock(&sdata->local->mtx);
1841 1842 1843

	return 0;
}
1844 1845
#endif

1846 1847 1848 1849
static int ieee80211_change_bss(struct wiphy *wiphy,
				struct net_device *dev,
				struct bss_parameters *params)
{
J
Johannes Berg 已提交
1850 1851
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	enum ieee80211_band band;
1852 1853
	u32 changed = 0;

1854
	if (!sdata_dereference(sdata->u.ap.beacon, sdata))
J
Johannes Berg 已提交
1855 1856 1857
		return -ENOENT;

	band = ieee80211_get_sdata_band(sdata);
1858 1859

	if (params->use_cts_prot >= 0) {
J
Johannes Berg 已提交
1860
		sdata->vif.bss_conf.use_cts_prot = params->use_cts_prot;
1861 1862 1863
		changed |= BSS_CHANGED_ERP_CTS_PROT;
	}
	if (params->use_short_preamble >= 0) {
J
Johannes Berg 已提交
1864
		sdata->vif.bss_conf.use_short_preamble =
1865 1866 1867
			params->use_short_preamble;
		changed |= BSS_CHANGED_ERP_PREAMBLE;
	}
1868 1869

	if (!sdata->vif.bss_conf.use_short_slot &&
J
Johannes Berg 已提交
1870
	    band == IEEE80211_BAND_5GHZ) {
1871 1872 1873 1874
		sdata->vif.bss_conf.use_short_slot = true;
		changed |= BSS_CHANGED_ERP_SLOT;
	}

1875
	if (params->use_short_slot_time >= 0) {
J
Johannes Berg 已提交
1876
		sdata->vif.bss_conf.use_short_slot =
1877 1878 1879 1880
			params->use_short_slot_time;
		changed |= BSS_CHANGED_ERP_SLOT;
	}

1881
	if (params->basic_rates) {
1882 1883 1884 1885 1886
		ieee80211_parse_bitrates(&sdata->vif.bss_conf.chandef,
					 wiphy->bands[band],
					 params->basic_rates,
					 params->basic_rates_len,
					 &sdata->vif.bss_conf.basic_rates);
1887 1888 1889
		changed |= BSS_CHANGED_BASIC_RATES;
	}

1890 1891 1892 1893 1894
	if (params->ap_isolate >= 0) {
		if (params->ap_isolate)
			sdata->flags |= IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
		else
			sdata->flags &= ~IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
J
Johannes Berg 已提交
1895
		ieee80211_check_fast_rx_iface(sdata);
1896 1897
	}

1898 1899 1900 1901 1902 1903
	if (params->ht_opmode >= 0) {
		sdata->vif.bss_conf.ht_operation_mode =
			(u16) params->ht_opmode;
		changed |= BSS_CHANGED_HT;
	}

1904
	if (params->p2p_ctwindow >= 0) {
J
Janusz Dziedzic 已提交
1905 1906 1907 1908
		sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow &=
					~IEEE80211_P2P_OPPPS_CTWINDOW_MASK;
		sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |=
			params->p2p_ctwindow & IEEE80211_P2P_OPPPS_CTWINDOW_MASK;
1909 1910 1911
		changed |= BSS_CHANGED_P2P_PS;
	}

J
Janusz Dziedzic 已提交
1912 1913 1914 1915 1916 1917 1918
	if (params->p2p_opp_ps > 0) {
		sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |=
					IEEE80211_P2P_OPPPS_ENABLE_BIT;
		changed |= BSS_CHANGED_P2P_PS;
	} else if (params->p2p_opp_ps == 0) {
		sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow &=
					~IEEE80211_P2P_OPPPS_ENABLE_BIT;
1919 1920 1921
		changed |= BSS_CHANGED_P2P_PS;
	}

1922 1923 1924 1925 1926
	ieee80211_bss_info_change_notify(sdata, changed);

	return 0;
}

1927
static int ieee80211_set_txq_params(struct wiphy *wiphy,
1928
				    struct net_device *dev,
1929 1930 1931
				    struct ieee80211_txq_params *params)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
1932
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1933 1934 1935 1936 1937
	struct ieee80211_tx_queue_params p;

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

1938 1939 1940
	if (local->hw.queues < IEEE80211_NUM_ACS)
		return -EOPNOTSUPP;

1941 1942 1943 1944 1945
	memset(&p, 0, sizeof(p));
	p.aifs = params->aifs;
	p.cw_max = params->cwmax;
	p.cw_min = params->cwmin;
	p.txop = params->txop;
K
Kalle Valo 已提交
1946 1947 1948 1949 1950 1951 1952

	/*
	 * Setting tx queue params disables u-apsd because it's only
	 * called in master mode.
	 */
	p.uapsd = false;

1953 1954
	sdata->tx_conf[params->ac] = p;
	if (drv_conf_tx(local, sdata, params->ac, &p)) {
J
Joe Perches 已提交
1955
		wiphy_debug(local->hw.wiphy,
1956 1957
			    "failed to set TX queue parameters for AC %d\n",
			    params->ac);
1958 1959 1960
		return -EINVAL;
	}

1961 1962
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_QOS);

1963 1964 1965
	return 0;
}

1966
#ifdef CONFIG_PM
J
Johannes Berg 已提交
1967 1968
static int ieee80211_suspend(struct wiphy *wiphy,
			     struct cfg80211_wowlan *wowlan)
1969
{
1970
	return __ieee80211_suspend(wiphy_priv(wiphy), wowlan);
1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981
}

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

1982 1983 1984
static int ieee80211_scan(struct wiphy *wiphy,
			  struct cfg80211_scan_request *req)
{
J
Johannes Berg 已提交
1985 1986 1987
	struct ieee80211_sub_if_data *sdata;

	sdata = IEEE80211_WDEV_TO_SUB_IF(req->wdev);
1988

1989 1990 1991 1992 1993
	switch (ieee80211_vif_type_p2p(&sdata->vif)) {
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_MESH_POINT:
	case NL80211_IFTYPE_P2P_CLIENT:
1994
	case NL80211_IFTYPE_P2P_DEVICE:
1995 1996 1997 1998
		break;
	case NL80211_IFTYPE_P2P_GO:
		if (sdata->local->ops->hw_scan)
			break;
1999 2000 2001 2002 2003
		/*
		 * FIXME: implement NoA while scanning in software,
		 * for now fall through to allow scanning only when
		 * beaconing hasn't been configured yet
		 */
2004
	case NL80211_IFTYPE_AP:
2005 2006 2007 2008 2009 2010 2011 2012 2013 2014
		/*
		 * If the scan has been forced (and the driver supports
		 * forcing), don't care about being beaconing already.
		 * This will create problems to the attached stations (e.g. all
		 * the  frames sent while scanning on other channel will be
		 * lost)
		 */
		if (sdata->u.ap.beacon &&
		    (!(wiphy->features & NL80211_FEATURE_AP_SCAN) ||
		     !(req->flags & NL80211_SCAN_FLAG_AP)))
2015 2016 2017 2018 2019
			return -EOPNOTSUPP;
		break;
	default:
		return -EOPNOTSUPP;
	}
2020 2021 2022 2023

	return ieee80211_request_scan(sdata, req);
}

2024 2025 2026 2027 2028
static void ieee80211_abort_scan(struct wiphy *wiphy, struct wireless_dev *wdev)
{
	ieee80211_scan_cancel(wiphy_priv(wiphy));
}

2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042
static int
ieee80211_sched_scan_start(struct wiphy *wiphy,
			   struct net_device *dev,
			   struct cfg80211_sched_scan_request *req)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	if (!sdata->local->ops->sched_scan_start)
		return -EOPNOTSUPP;

	return ieee80211_request_sched_scan_start(sdata, req);
}

static int
2043
ieee80211_sched_scan_stop(struct wiphy *wiphy, struct net_device *dev)
2044
{
2045
	struct ieee80211_local *local = wiphy_priv(wiphy);
2046

2047
	if (!local->ops->sched_scan_stop)
2048 2049
		return -EOPNOTSUPP;

2050
	return ieee80211_request_sched_scan_stop(local);
2051 2052
}

2053 2054 2055
static int ieee80211_auth(struct wiphy *wiphy, struct net_device *dev,
			  struct cfg80211_auth_request *req)
{
2056
	return ieee80211_mgd_auth(IEEE80211_DEV_TO_SUB_IF(dev), req);
2057 2058 2059 2060 2061
}

static int ieee80211_assoc(struct wiphy *wiphy, struct net_device *dev,
			   struct cfg80211_assoc_request *req)
{
2062
	return ieee80211_mgd_assoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
2063 2064 2065
}

static int ieee80211_deauth(struct wiphy *wiphy, struct net_device *dev,
2066
			    struct cfg80211_deauth_request *req)
2067
{
2068
	return ieee80211_mgd_deauth(IEEE80211_DEV_TO_SUB_IF(dev), req);
2069 2070 2071
}

static int ieee80211_disassoc(struct wiphy *wiphy, struct net_device *dev,
2072
			      struct cfg80211_disassoc_request *req)
2073
{
2074
	return ieee80211_mgd_disassoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
2075 2076
}

2077 2078 2079
static int ieee80211_join_ibss(struct wiphy *wiphy, struct net_device *dev,
			       struct cfg80211_ibss_params *params)
{
J
Johannes Berg 已提交
2080
	return ieee80211_ibss_join(IEEE80211_DEV_TO_SUB_IF(dev), params);
2081 2082 2083 2084
}

static int ieee80211_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
{
J
Johannes Berg 已提交
2085
	return ieee80211_ibss_leave(IEEE80211_DEV_TO_SUB_IF(dev));
2086 2087
}

2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098
static int ieee80211_join_ocb(struct wiphy *wiphy, struct net_device *dev,
			      struct ocb_setup *setup)
{
	return ieee80211_ocb_join(IEEE80211_DEV_TO_SUB_IF(dev), setup);
}

static int ieee80211_leave_ocb(struct wiphy *wiphy, struct net_device *dev)
{
	return ieee80211_ocb_leave(IEEE80211_DEV_TO_SUB_IF(dev));
}

2099 2100 2101 2102 2103
static int ieee80211_set_mcast_rate(struct wiphy *wiphy, struct net_device *dev,
				    int rate[IEEE80211_NUM_BANDS])
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);

2104 2105
	memcpy(sdata->vif.bss_conf.mcast_rate, rate,
	       sizeof(int) * IEEE80211_NUM_BANDS);
2106 2107 2108 2109

	return 0;
}

2110 2111 2112
static int ieee80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
2113
	int err;
2114

2115
	if (changed & WIPHY_PARAM_FRAG_THRESHOLD) {
J
Johannes Berg 已提交
2116 2117
		ieee80211_check_fast_xmit_all(local);

2118 2119
		err = drv_set_frag_threshold(local, wiphy->frag_threshold);

J
Johannes Berg 已提交
2120 2121
		if (err) {
			ieee80211_check_fast_xmit_all(local);
2122
			return err;
J
Johannes Berg 已提交
2123
		}
2124 2125
	}

2126 2127 2128 2129 2130 2131 2132
	if ((changed & WIPHY_PARAM_COVERAGE_CLASS) ||
	    (changed & WIPHY_PARAM_DYN_ACK)) {
		s16 coverage_class;

		coverage_class = changed & WIPHY_PARAM_COVERAGE_CLASS ?
					wiphy->coverage_class : -1;
		err = drv_set_coverage_class(local, coverage_class);
2133 2134 2135 2136 2137

		if (err)
			return err;
	}

2138
	if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
2139
		err = drv_set_rts_threshold(local, wiphy->rts_threshold);
2140

2141 2142
		if (err)
			return err;
2143 2144
	}

2145 2146 2147
	if (changed & WIPHY_PARAM_RETRY_SHORT) {
		if (wiphy->retry_short > IEEE80211_MAX_TX_RETRY)
			return -EINVAL;
2148
		local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
2149 2150 2151 2152
	}
	if (changed & WIPHY_PARAM_RETRY_LONG) {
		if (wiphy->retry_long > IEEE80211_MAX_TX_RETRY)
			return -EINVAL;
2153
		local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
2154
	}
2155 2156 2157 2158 2159 2160 2161
	if (changed &
	    (WIPHY_PARAM_RETRY_SHORT | WIPHY_PARAM_RETRY_LONG))
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_RETRY_LIMITS);

	return 0;
}

2162
static int ieee80211_set_tx_power(struct wiphy *wiphy,
2163
				  struct wireless_dev *wdev,
2164
				  enum nl80211_tx_power_setting type, int mbm)
2165 2166
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
2167
	struct ieee80211_sub_if_data *sdata;
2168 2169
	enum nl80211_tx_power_setting txp_type = type;
	bool update_txp_type = false;
2170

2171 2172 2173 2174 2175 2176
	if (wdev) {
		sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);

		switch (type) {
		case NL80211_TX_POWER_AUTOMATIC:
			sdata->user_power_level = IEEE80211_UNSET_POWER_LEVEL;
2177
			txp_type = NL80211_TX_POWER_LIMITED;
2178 2179 2180 2181 2182 2183 2184 2185 2186
			break;
		case NL80211_TX_POWER_LIMITED:
		case NL80211_TX_POWER_FIXED:
			if (mbm < 0 || (mbm % 100))
				return -EOPNOTSUPP;
			sdata->user_power_level = MBM_TO_DBM(mbm);
			break;
		}

2187 2188 2189 2190 2191 2192
		if (txp_type != sdata->vif.bss_conf.txpower_type) {
			update_txp_type = true;
			sdata->vif.bss_conf.txpower_type = txp_type;
		}

		ieee80211_recalc_txpower(sdata, update_txp_type);
2193 2194 2195

		return 0;
	}
J
Johannes Berg 已提交
2196

2197
	switch (type) {
2198
	case NL80211_TX_POWER_AUTOMATIC:
2199
		local->user_power_level = IEEE80211_UNSET_POWER_LEVEL;
2200
		txp_type = NL80211_TX_POWER_LIMITED;
2201
		break;
2202 2203 2204 2205 2206
	case NL80211_TX_POWER_LIMITED:
	case NL80211_TX_POWER_FIXED:
		if (mbm < 0 || (mbm % 100))
			return -EOPNOTSUPP;
		local->user_power_level = MBM_TO_DBM(mbm);
2207 2208 2209
		break;
	}

2210
	mutex_lock(&local->iflist_mtx);
2211
	list_for_each_entry(sdata, &local->interfaces, list) {
2212
		sdata->user_power_level = local->user_power_level;
2213 2214 2215 2216
		if (txp_type != sdata->vif.bss_conf.txpower_type)
			update_txp_type = true;
		sdata->vif.bss_conf.txpower_type = txp_type;
	}
2217
	list_for_each_entry(sdata, &local->interfaces, list)
2218
		ieee80211_recalc_txpower(sdata, update_txp_type);
2219
	mutex_unlock(&local->iflist_mtx);
2220 2221 2222 2223

	return 0;
}

2224 2225 2226
static int ieee80211_get_tx_power(struct wiphy *wiphy,
				  struct wireless_dev *wdev,
				  int *dbm)
2227 2228
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
2229
	struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
2230

2231 2232 2233
	if (local->ops->get_txpower)
		return drv_get_txpower(local, sdata, dbm);

2234 2235 2236 2237
	if (!local->use_chanctx)
		*dbm = local->hw.conf.power_level;
	else
		*dbm = sdata->vif.bss_conf.txpower;
2238 2239 2240 2241

	return 0;
}

J
Johannes Berg 已提交
2242
static int ieee80211_set_wds_peer(struct wiphy *wiphy, struct net_device *dev,
J
Johannes Berg 已提交
2243
				  const u8 *addr)
J
Johannes Berg 已提交
2244 2245 2246 2247 2248 2249 2250 2251
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);

	memcpy(&sdata->u.wds.remote_addr, addr, ETH_ALEN);

	return 0;
}

J
Johannes Berg 已提交
2252 2253 2254 2255 2256 2257 2258
static void ieee80211_rfkill_poll(struct wiphy *wiphy)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);

	drv_rfkill_poll(local);
}

2259
#ifdef CONFIG_NL80211_TESTMODE
2260 2261 2262
static int ieee80211_testmode_cmd(struct wiphy *wiphy,
				  struct wireless_dev *wdev,
				  void *data, int len)
2263 2264
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
2265
	struct ieee80211_vif *vif = NULL;
2266 2267 2268 2269

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

2270 2271 2272 2273 2274 2275 2276 2277 2278
	if (wdev) {
		struct ieee80211_sub_if_data *sdata;

		sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
		if (sdata->flags & IEEE80211_SDATA_IN_DRIVER)
			vif = &sdata->vif;
	}

	return local->ops->testmode_cmd(&local->hw, vif, data, len);
2279
}
W
Wey-Yi Guy 已提交
2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292

static int ieee80211_testmode_dump(struct wiphy *wiphy,
				   struct sk_buff *skb,
				   struct netlink_callback *cb,
				   void *data, int len)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);

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

	return local->ops->testmode_dump(&local->hw, skb, cb, data, len);
}
2293 2294
#endif

2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322
int __ieee80211_request_smps_ap(struct ieee80211_sub_if_data *sdata,
				enum ieee80211_smps_mode smps_mode)
{
	struct sta_info *sta;
	enum ieee80211_smps_mode old_req;

	if (WARN_ON_ONCE(sdata->vif.type != NL80211_IFTYPE_AP))
		return -EINVAL;

	if (sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_20_NOHT)
		return 0;

	old_req = sdata->u.ap.req_smps;
	sdata->u.ap.req_smps = smps_mode;

	/* AUTOMATIC doesn't mean much for AP - don't allow it */
	if (old_req == smps_mode ||
	    smps_mode == IEEE80211_SMPS_AUTOMATIC)
		return 0;

	 /* If no associated stations, there's no need to do anything */
	if (!atomic_read(&sdata->u.ap.num_mcast_sta)) {
		sdata->smps_mode = smps_mode;
		ieee80211_queue_work(&sdata->local->hw, &sdata->recalc_smps);
		return 0;
	}

	ht_dbg(sdata,
2323
	       "SMPS %d requested in AP mode, sending Action frame to %d stations\n",
2324 2325 2326
	       smps_mode, atomic_read(&sdata->u.ap.num_mcast_sta));

	mutex_lock(&sdata->local->sta_mtx);
2327 2328 2329 2330 2331 2332 2333
	list_for_each_entry(sta, &sdata->local->sta_list, list) {
		/*
		 * Only stations associated to our AP and
		 * associated VLANs
		 */
		if (sta->sdata->bss != &sdata->u.ap)
			continue;
2334

2335 2336 2337
		/* This station doesn't support MIMO - skip it */
		if (sta_info_tx_streams(sta) == 1)
			continue;
2338

2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349
		/*
		 * Don't wake up a STA just to send the action frame
		 * unless we are getting more restrictive.
		 */
		if (test_sta_flag(sta, WLAN_STA_PS_STA) &&
		    !ieee80211_smps_is_restrictive(sta->known_smps_mode,
						   smps_mode)) {
			ht_dbg(sdata, "Won't send SMPS to sleeping STA %pM\n",
			       sta->sta.addr);
			continue;
		}
2350

2351 2352 2353 2354 2355 2356
		/*
		 * If the STA is not authorized, wait until it gets
		 * authorized and the action frame will be sent then.
		 */
		if (!test_sta_flag(sta, WLAN_STA_AUTHORIZED))
			continue;
2357

2358 2359 2360
		ht_dbg(sdata, "Sending SMPS to %pM\n", sta->sta.addr);
		ieee80211_send_smps_action(sdata, smps_mode, sta->sta.addr,
					   sdata->vif.bss_conf.bssid);
2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371
	}
	mutex_unlock(&sdata->local->sta_mtx);

	sdata->smps_mode = smps_mode;
	ieee80211_queue_work(&sdata->local->hw, &sdata->recalc_smps);

	return 0;
}

int __ieee80211_request_smps_mgd(struct ieee80211_sub_if_data *sdata,
				 enum ieee80211_smps_mode smps_mode)
2372 2373 2374 2375
{
	const u8 *ap;
	enum ieee80211_smps_mode old_req;
	int err;
2376 2377
	struct sta_info *sta;
	bool tdls_peer_found = false;
2378

2379
	lockdep_assert_held(&sdata->wdev.mtx);
2380

2381 2382 2383
	if (WARN_ON_ONCE(sdata->vif.type != NL80211_IFTYPE_STATION))
		return -EINVAL;

2384 2385 2386 2387 2388 2389 2390 2391 2392
	old_req = sdata->u.mgd.req_smps;
	sdata->u.mgd.req_smps = smps_mode;

	if (old_req == smps_mode &&
	    smps_mode != IEEE80211_SMPS_AUTOMATIC)
		return 0;

	/*
	 * If not associated, or current association is not an HT
2393 2394
	 * association, there's no need to do anything, just store
	 * the new value until we associate.
2395 2396
	 */
	if (!sdata->u.mgd.associated ||
2397
	    sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_20_NOHT)
2398 2399
		return 0;

2400
	ap = sdata->u.mgd.associated->bssid;
2401

2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412
	rcu_read_lock();
	list_for_each_entry_rcu(sta, &sdata->local->sta_list, list) {
		if (!sta->sta.tdls || sta->sdata != sdata || !sta->uploaded ||
		    !test_sta_flag(sta, WLAN_STA_AUTHORIZED))
			continue;

		tdls_peer_found = true;
		break;
	}
	rcu_read_unlock();

2413
	if (smps_mode == IEEE80211_SMPS_AUTOMATIC) {
2414
		if (tdls_peer_found || !sdata->u.mgd.powersave)
2415
			smps_mode = IEEE80211_SMPS_OFF;
2416 2417
		else
			smps_mode = IEEE80211_SMPS_DYNAMIC;
2418 2419 2420 2421 2422 2423 2424
	}

	/* send SM PS frame to AP */
	err = ieee80211_send_smps_action(sdata, smps_mode,
					 ap, ap);
	if (err)
		sdata->u.mgd.req_smps = old_req;
2425 2426
	else if (smps_mode != IEEE80211_SMPS_OFF && tdls_peer_found)
		ieee80211_teardown_tdls_peers(sdata);
2427 2428 2429 2430

	return err;
}

J
Johannes Berg 已提交
2431 2432 2433 2434 2435 2436
static int ieee80211_set_power_mgmt(struct wiphy *wiphy, struct net_device *dev,
				    bool enabled, int timeout)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);

2437
	if (sdata->vif.type != NL80211_IFTYPE_STATION)
2438 2439
		return -EOPNOTSUPP;

2440
	if (!ieee80211_hw_check(&local->hw, SUPPORTS_PS))
J
Johannes Berg 已提交
2441 2442 2443
		return -EOPNOTSUPP;

	if (enabled == sdata->u.mgd.powersave &&
2444
	    timeout == local->dynamic_ps_forced_timeout)
J
Johannes Berg 已提交
2445 2446 2447
		return 0;

	sdata->u.mgd.powersave = enabled;
2448
	local->dynamic_ps_forced_timeout = timeout;
J
Johannes Berg 已提交
2449

2450
	/* no change, but if automatic follow powersave */
2451
	sdata_lock(sdata);
2452
	__ieee80211_request_smps_mgd(sdata, sdata->u.mgd.req_smps);
2453
	sdata_unlock(sdata);
2454

2455
	if (ieee80211_hw_check(&local->hw, SUPPORTS_DYNAMIC_PS))
J
Johannes Berg 已提交
2456 2457
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);

J
Johannes Berg 已提交
2458
	ieee80211_recalc_ps(local);
E
Eliad Peller 已提交
2459
	ieee80211_recalc_ps_vif(sdata);
J
Johannes Berg 已提交
2460 2461 2462 2463

	return 0;
}

2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475
static int ieee80211_set_cqm_rssi_config(struct wiphy *wiphy,
					 struct net_device *dev,
					 s32 rssi_thold, u32 rssi_hyst)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_vif *vif = &sdata->vif;
	struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;

	if (rssi_thold == bss_conf->cqm_rssi_thold &&
	    rssi_hyst == bss_conf->cqm_rssi_hyst)
		return 0;

2476 2477 2478 2479
	if (sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER &&
	    !(sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI))
		return -EOPNOTSUPP;

2480 2481
	bss_conf->cqm_rssi_thold = rssi_thold;
	bss_conf->cqm_rssi_hyst = rssi_hyst;
2482
	sdata->u.mgd.last_cqm_event_signal = 0;
2483 2484

	/* tell the driver upon association, unless already associated */
2485 2486
	if (sdata->u.mgd.associated &&
	    sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)
2487 2488 2489 2490 2491
		ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_CQM);

	return 0;
}

J
Johannes Berg 已提交
2492 2493 2494 2495 2496 2497 2498
static int ieee80211_set_bitrate_mask(struct wiphy *wiphy,
				      struct net_device *dev,
				      const u8 *addr,
				      const struct cfg80211_bitrate_mask *mask)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2499
	int i, ret;
2500

2501 2502 2503
	if (!ieee80211_sdata_running(sdata))
		return -ENETDOWN;

2504
	if (ieee80211_hw_check(&local->hw, HAS_RATE_CONTROL)) {
2505 2506 2507 2508
		ret = drv_set_bitrate_mask(local, sdata, mask);
		if (ret)
			return ret;
	}
J
Johannes Berg 已提交
2509

2510
	for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
2511 2512 2513
		struct ieee80211_supported_band *sband = wiphy->bands[i];
		int j;

2514
		sdata->rc_rateidx_mask[i] = mask->control[i].legacy;
2515 2516
		memcpy(sdata->rc_rateidx_mcs_mask[i], mask->control[i].ht_mcs,
		       sizeof(mask->control[i].ht_mcs));
2517 2518 2519
		memcpy(sdata->rc_rateidx_vht_mcs_mask[i],
		       mask->control[i].vht_mcs,
		       sizeof(mask->control[i].vht_mcs));
2520 2521

		sdata->rc_has_mcs_mask[i] = false;
2522
		sdata->rc_has_vht_mcs_mask[i] = false;
2523 2524 2525
		if (!sband)
			continue;

2526
		for (j = 0; j < IEEE80211_HT_MCS_MASK_LEN; j++) {
2527
			if (~sdata->rc_rateidx_mcs_mask[i][j]) {
2528
				sdata->rc_has_mcs_mask[i] = true;
2529 2530 2531
				break;
			}
		}
2532

2533 2534
		for (j = 0; j < NL80211_VHT_NSS_MAX; j++) {
			if (~sdata->rc_rateidx_vht_mcs_mask[i][j]) {
2535
				sdata->rc_has_vht_mcs_mask[i] = true;
2536
				break;
2537
			}
2538
		}
2539
	}
J
Johannes Berg 已提交
2540

2541
	return 0;
J
Johannes Berg 已提交
2542 2543
}

2544 2545
static int ieee80211_start_radar_detection(struct wiphy *wiphy,
					   struct net_device *dev,
2546 2547
					   struct cfg80211_chan_def *chandef,
					   u32 cac_time_ms)
2548 2549 2550 2551 2552
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_local *local = sdata->local;
	int err;

2553 2554 2555 2556 2557
	mutex_lock(&local->mtx);
	if (!list_empty(&local->roc_list) || local->scanning) {
		err = -EBUSY;
		goto out_unlock;
	}
2558 2559 2560 2561 2562 2563 2564 2565

	/* whatever, but channel contexts should not complain about that one */
	sdata->smps_mode = IEEE80211_SMPS_OFF;
	sdata->needed_rx_chains = local->rx_chains;

	err = ieee80211_vif_use_channel(sdata, chandef,
					IEEE80211_CHANCTX_SHARED);
	if (err)
2566
		goto out_unlock;
2567 2568

	ieee80211_queue_delayed_work(&sdata->local->hw,
2569 2570
				     &sdata->dfs_cac_timer_work,
				     msecs_to_jiffies(cac_time_ms));
2571

2572 2573 2574
 out_unlock:
	mutex_unlock(&local->mtx);
	return err;
2575 2576
}

2577 2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632
static struct cfg80211_beacon_data *
cfg80211_beacon_dup(struct cfg80211_beacon_data *beacon)
{
	struct cfg80211_beacon_data *new_beacon;
	u8 *pos;
	int len;

	len = beacon->head_len + beacon->tail_len + beacon->beacon_ies_len +
	      beacon->proberesp_ies_len + beacon->assocresp_ies_len +
	      beacon->probe_resp_len;

	new_beacon = kzalloc(sizeof(*new_beacon) + len, GFP_KERNEL);
	if (!new_beacon)
		return NULL;

	pos = (u8 *)(new_beacon + 1);
	if (beacon->head_len) {
		new_beacon->head_len = beacon->head_len;
		new_beacon->head = pos;
		memcpy(pos, beacon->head, beacon->head_len);
		pos += beacon->head_len;
	}
	if (beacon->tail_len) {
		new_beacon->tail_len = beacon->tail_len;
		new_beacon->tail = pos;
		memcpy(pos, beacon->tail, beacon->tail_len);
		pos += beacon->tail_len;
	}
	if (beacon->beacon_ies_len) {
		new_beacon->beacon_ies_len = beacon->beacon_ies_len;
		new_beacon->beacon_ies = pos;
		memcpy(pos, beacon->beacon_ies, beacon->beacon_ies_len);
		pos += beacon->beacon_ies_len;
	}
	if (beacon->proberesp_ies_len) {
		new_beacon->proberesp_ies_len = beacon->proberesp_ies_len;
		new_beacon->proberesp_ies = pos;
		memcpy(pos, beacon->proberesp_ies, beacon->proberesp_ies_len);
		pos += beacon->proberesp_ies_len;
	}
	if (beacon->assocresp_ies_len) {
		new_beacon->assocresp_ies_len = beacon->assocresp_ies_len;
		new_beacon->assocresp_ies = pos;
		memcpy(pos, beacon->assocresp_ies, beacon->assocresp_ies_len);
		pos += beacon->assocresp_ies_len;
	}
	if (beacon->probe_resp_len) {
		new_beacon->probe_resp_len = beacon->probe_resp_len;
		beacon->probe_resp = pos;
		memcpy(pos, beacon->probe_resp, beacon->probe_resp_len);
		pos += beacon->probe_resp_len;
	}

	return new_beacon;
}

2633
void ieee80211_csa_finish(struct ieee80211_vif *vif)
2634
{
2635
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
2636

2637 2638 2639 2640
	ieee80211_queue_work(&sdata->local->hw,
			     &sdata->csa_finalize_work);
}
EXPORT_SYMBOL(ieee80211_csa_finish);
2641

2642 2643
static int ieee80211_set_after_csa_beacon(struct ieee80211_sub_if_data *sdata,
					  u32 *changed)
2644
{
2645
	int err;
2646

2647 2648
	switch (sdata->vif.type) {
	case NL80211_IFTYPE_AP:
2649 2650
		err = ieee80211_assign_beacon(sdata, sdata->u.ap.next_beacon,
					      NULL);
2651 2652 2653
		kfree(sdata->u.ap.next_beacon);
		sdata->u.ap.next_beacon = NULL;

2654
		if (err < 0)
2655 2656
			return err;
		*changed |= err;
2657 2658
		break;
	case NL80211_IFTYPE_ADHOC:
2659 2660
		err = ieee80211_ibss_finish_csa(sdata);
		if (err < 0)
2661 2662
			return err;
		*changed |= err;
2663
		break;
2664 2665 2666 2667
#ifdef CONFIG_MAC80211_MESH
	case NL80211_IFTYPE_MESH_POINT:
		err = ieee80211_mesh_finish_csa(sdata);
		if (err < 0)
2668 2669
			return err;
		*changed |= err;
2670 2671
		break;
#endif
2672 2673
	default:
		WARN_ON(1);
2674 2675 2676 2677 2678 2679
		return -EINVAL;
	}

	return 0;
}

2680
static int __ieee80211_csa_finalize(struct ieee80211_sub_if_data *sdata)
2681 2682 2683 2684 2685 2686 2687
{
	struct ieee80211_local *local = sdata->local;
	u32 changed = 0;
	int err;

	sdata_assert_lock(sdata);
	lockdep_assert_held(&local->mtx);
2688
	lockdep_assert_held(&local->chanctx_mtx);
2689

2690 2691 2692 2693 2694 2695
	/*
	 * using reservation isn't immediate as it may be deferred until later
	 * with multi-vif. once reservation is complete it will re-schedule the
	 * work with no reserved_chanctx so verify chandef to check if it
	 * completed successfully
	 */
2696

2697 2698 2699 2700 2701 2702 2703 2704 2705
	if (sdata->reserved_chanctx) {
		/*
		 * with multi-vif csa driver may call ieee80211_csa_finish()
		 * many times while waiting for other interfaces to use their
		 * reservations
		 */
		if (sdata->reserved_ready)
			return 0;

2706
		return ieee80211_vif_use_reserved_context(sdata);
2707
	}
2708

2709 2710 2711 2712
	if (!cfg80211_chandef_identical(&sdata->vif.bss_conf.chandef,
					&sdata->csa_chandef))
		return -EINVAL;

2713 2714 2715 2716
	sdata->vif.csa_active = false;

	err = ieee80211_set_after_csa_beacon(sdata, &changed);
	if (err)
2717
		return err;
2718

2719
	ieee80211_bss_info_change_notify(sdata, changed);
2720

2721 2722 2723 2724 2725
	if (sdata->csa_block_tx) {
		ieee80211_wake_vif_queues(local, sdata,
					  IEEE80211_QUEUE_STOP_REASON_CSA);
		sdata->csa_block_tx = false;
	}
2726

2727 2728 2729 2730 2731 2732
	err = drv_post_channel_switch(sdata);
	if (err)
		return err;

	cfg80211_ch_switch_notify(sdata->dev, &sdata->csa_chandef);

2733 2734 2735 2736 2737 2738 2739 2740 2741 2742
	return 0;
}

static void ieee80211_csa_finalize(struct ieee80211_sub_if_data *sdata)
{
	if (__ieee80211_csa_finalize(sdata)) {
		sdata_info(sdata, "failed to finalize CSA, disconnecting\n");
		cfg80211_stop_iface(sdata->local->hw.wiphy, &sdata->wdev,
				    GFP_KERNEL);
	}
2743 2744 2745 2746 2747 2748 2749
}

void ieee80211_csa_finalize_work(struct work_struct *work)
{
	struct ieee80211_sub_if_data *sdata =
		container_of(work, struct ieee80211_sub_if_data,
			     csa_finalize_work);
2750
	struct ieee80211_local *local = sdata->local;
2751 2752

	sdata_lock(sdata);
2753
	mutex_lock(&local->mtx);
2754
	mutex_lock(&local->chanctx_mtx);
2755

2756 2757 2758 2759 2760 2761 2762 2763
	/* AP might have been stopped while waiting for the lock. */
	if (!sdata->vif.csa_active)
		goto unlock;

	if (!ieee80211_sdata_running(sdata))
		goto unlock;

	ieee80211_csa_finalize(sdata);
2764 2765

unlock:
2766
	mutex_unlock(&local->chanctx_mtx);
2767
	mutex_unlock(&local->mtx);
2768
	sdata_unlock(sdata);
2769 2770
}

2771 2772 2773
static int ieee80211_set_csa_beacon(struct ieee80211_sub_if_data *sdata,
				    struct cfg80211_csa_settings *params,
				    u32 *changed)
2774
{
2775
	struct ieee80211_csa_settings csa = {};
2776
	int err;
2777 2778 2779

	switch (sdata->vif.type) {
	case NL80211_IFTYPE_AP:
2780 2781 2782 2783 2784
		sdata->u.ap.next_beacon =
			cfg80211_beacon_dup(&params->beacon_after);
		if (!sdata->u.ap.next_beacon)
			return -ENOMEM;

2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803
		/*
		 * With a count of 0, we don't have to wait for any
		 * TBTT before switching, so complete the CSA
		 * immediately.  In theory, with a count == 1 we
		 * should delay the switch until just before the next
		 * TBTT, but that would complicate things so we switch
		 * immediately too.  If we would delay the switch
		 * until the next TBTT, we would have to set the probe
		 * response here.
		 *
		 * TODO: A channel switch with count <= 1 without
		 * sending a CSA action frame is kind of useless,
		 * because the clients won't know we're changing
		 * channels.  The action frame must be implemented
		 * either here or in the userspace.
		 */
		if (params->count <= 1)
			break;

2804 2805 2806 2807 2808
		if ((params->n_counter_offsets_beacon >
		     IEEE80211_MAX_CSA_COUNTERS_NUM) ||
		    (params->n_counter_offsets_presp >
		     IEEE80211_MAX_CSA_COUNTERS_NUM))
			return -EINVAL;
2809

2810 2811 2812 2813 2814
		csa.counter_offsets_beacon = params->counter_offsets_beacon;
		csa.counter_offsets_presp = params->counter_offsets_presp;
		csa.n_counter_offsets_beacon = params->n_counter_offsets_beacon;
		csa.n_counter_offsets_presp = params->n_counter_offsets_presp;
		csa.count = params->count;
2815

2816
		err = ieee80211_assign_beacon(sdata, &params->beacon_csa, &csa);
2817 2818 2819 2820
		if (err < 0) {
			kfree(sdata->u.ap.next_beacon);
			return err;
		}
2821
		*changed |= err;
2822

2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849
		break;
	case NL80211_IFTYPE_ADHOC:
		if (!sdata->vif.bss_conf.ibss_joined)
			return -EINVAL;

		if (params->chandef.width != sdata->u.ibss.chandef.width)
			return -EINVAL;

		switch (params->chandef.width) {
		case NL80211_CHAN_WIDTH_40:
			if (cfg80211_get_chandef_type(&params->chandef) !=
			    cfg80211_get_chandef_type(&sdata->u.ibss.chandef))
				return -EINVAL;
		case NL80211_CHAN_WIDTH_5:
		case NL80211_CHAN_WIDTH_10:
		case NL80211_CHAN_WIDTH_20_NOHT:
		case NL80211_CHAN_WIDTH_20:
			break;
		default:
			return -EINVAL;
		}

		/* changes into another band are not supported */
		if (sdata->u.ibss.chandef.chan->band !=
		    params->chandef.chan->band)
			return -EINVAL;

2850 2851 2852 2853 2854
		/* see comments in the NL80211_IFTYPE_AP block */
		if (params->count > 1) {
			err = ieee80211_ibss_csa_beacon(sdata, params);
			if (err < 0)
				return err;
2855
			*changed |= err;
2856 2857 2858 2859
		}

		ieee80211_send_action_csa(sdata, params);

2860
		break;
2861
#ifdef CONFIG_MAC80211_MESH
2862 2863
	case NL80211_IFTYPE_MESH_POINT: {
		struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh;
2864 2865 2866 2867 2868 2869 2870 2871 2872

		if (params->chandef.width != sdata->vif.bss_conf.chandef.width)
			return -EINVAL;

		/* changes into another band are not supported */
		if (sdata->vif.bss_conf.chandef.chan->band !=
		    params->chandef.chan->band)
			return -EINVAL;

2873
		if (ifmsh->csa_role == IEEE80211_MESH_CSA_ROLE_NONE) {
2874
			ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_INIT;
2875 2876 2877 2878 2879
			if (!ifmsh->pre_value)
				ifmsh->pre_value = 1;
			else
				ifmsh->pre_value++;
		}
2880

2881 2882 2883 2884 2885 2886 2887
		/* see comments in the NL80211_IFTYPE_AP block */
		if (params->count > 1) {
			err = ieee80211_mesh_csa_beacon(sdata, params);
			if (err < 0) {
				ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_NONE;
				return err;
			}
2888
			*changed |= err;
2889
		}
2890 2891 2892 2893

		if (ifmsh->csa_role == IEEE80211_MESH_CSA_ROLE_INIT)
			ieee80211_send_action_csa(sdata, params);

2894
		break;
2895
		}
2896
#endif
2897 2898 2899 2900
	default:
		return -EOPNOTSUPP;
	}

2901 2902 2903
	return 0;
}

2904 2905 2906
static int
__ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev,
			   struct cfg80211_csa_settings *params)
2907 2908 2909
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_local *local = sdata->local;
2910
	struct ieee80211_channel_switch ch_switch;
2911
	struct ieee80211_chanctx_conf *conf;
2912
	struct ieee80211_chanctx *chanctx;
2913 2914
	u32 changed = 0;
	int err;
2915 2916

	sdata_assert_lock(sdata);
2917
	lockdep_assert_held(&local->mtx);
2918 2919 2920 2921 2922 2923 2924 2925 2926 2927 2928

	if (!list_empty(&local->roc_list) || local->scanning)
		return -EBUSY;

	if (sdata->wdev.cac_started)
		return -EBUSY;

	if (cfg80211_chandef_identical(&params->chandef,
				       &sdata->vif.bss_conf.chandef))
		return -EINVAL;

2929 2930 2931 2932
	/* don't allow another channel switch if one is already active. */
	if (sdata->vif.csa_active)
		return -EBUSY;

2933 2934 2935 2936
	mutex_lock(&local->chanctx_mtx);
	conf = rcu_dereference_protected(sdata->vif.chanctx_conf,
					 lockdep_is_held(&local->chanctx_mtx));
	if (!conf) {
2937 2938
		err = -EBUSY;
		goto out;
2939 2940
	}

2941
	chanctx = container_of(conf, struct ieee80211_chanctx, conf);
2942 2943 2944
	if (!chanctx) {
		err = -EBUSY;
		goto out;
2945 2946
	}

2947 2948 2949 2950 2951 2952
	ch_switch.timestamp = 0;
	ch_switch.device_timestamp = 0;
	ch_switch.block_tx = params->block_tx;
	ch_switch.chandef = params->chandef;
	ch_switch.count = params->count;

2953 2954 2955 2956
	err = drv_pre_channel_switch(sdata, &ch_switch);
	if (err)
		goto out;

2957 2958 2959 2960 2961
	err = ieee80211_vif_reserve_chanctx(sdata, &params->chandef,
					    chanctx->mode,
					    params->radar_required);
	if (err)
		goto out;
2962

2963 2964 2965 2966 2967 2968
	/* if reservation is invalid then this will fail */
	err = ieee80211_check_combinations(sdata, NULL, chanctx->mode, 0);
	if (err) {
		ieee80211_vif_unreserve_chanctx(sdata);
		goto out;
	}
2969 2970

	err = ieee80211_set_csa_beacon(sdata, params, &changed);
2971 2972 2973 2974
	if (err) {
		ieee80211_vif_unreserve_chanctx(sdata);
		goto out;
	}
2975

2976
	sdata->csa_chandef = params->chandef;
2977
	sdata->csa_block_tx = params->block_tx;
2978 2979
	sdata->vif.csa_active = true;

2980
	if (sdata->csa_block_tx)
2981 2982
		ieee80211_stop_vif_queues(local, sdata,
					  IEEE80211_QUEUE_STOP_REASON_CSA);
2983

2984 2985 2986
	cfg80211_ch_switch_started_notify(sdata->dev, &sdata->csa_chandef,
					  params->count);

2987 2988 2989 2990 2991 2992 2993
	if (changed) {
		ieee80211_bss_info_change_notify(sdata, changed);
		drv_channel_switch_beacon(sdata, &params->chandef);
	} else {
		/* if the beacon didn't change, we can finalize immediately */
		ieee80211_csa_finalize(sdata);
	}
2994

2995 2996 2997
out:
	mutex_unlock(&local->chanctx_mtx);
	return err;
2998 2999
}

3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013
int ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev,
			     struct cfg80211_csa_settings *params)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_local *local = sdata->local;
	int err;

	mutex_lock(&local->mtx);
	err = __ieee80211_channel_switch(wiphy, dev, params);
	mutex_unlock(&local->mtx);

	return err;
}

3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026
u64 ieee80211_mgmt_tx_cookie(struct ieee80211_local *local)
{
	lockdep_assert_held(&local->mtx);

	local->roc_cookie_counter++;

	/* wow, you wrapped 64 bits ... more likely a bug */
	if (WARN_ON(local->roc_cookie_counter == 0))
		local->roc_cookie_counter++;

	return local->roc_cookie_counter;
}

3027 3028
int ieee80211_attach_ack_skb(struct ieee80211_local *local, struct sk_buff *skb,
			     u64 *cookie, gfp_t gfp)
3029 3030 3031 3032 3033 3034 3035
{
	unsigned long spin_flags;
	struct sk_buff *ack_skb;
	int id;

	ack_skb = skb_copy(skb, gfp);
	if (!ack_skb)
3036
		return -ENOMEM;
3037 3038 3039 3040 3041 3042 3043 3044

	spin_lock_irqsave(&local->ack_status_lock, spin_flags);
	id = idr_alloc(&local->ack_status_frames, ack_skb,
		       1, 0x10000, GFP_ATOMIC);
	spin_unlock_irqrestore(&local->ack_status_lock, spin_flags);

	if (id < 0) {
		kfree_skb(ack_skb);
3045
		return -ENOMEM;
3046 3047 3048 3049 3050 3051 3052
	}

	IEEE80211_SKB_CB(skb)->ack_frame_id = id;

	*cookie = ieee80211_mgmt_tx_cookie(local);
	IEEE80211_SKB_CB(ack_skb)->ack.cookie = *cookie;

3053
	return 0;
3054 3055
}

3056
static void ieee80211_mgmt_frame_register(struct wiphy *wiphy,
3057
					  struct wireless_dev *wdev,
3058 3059 3060
					  u16 frame_type, bool reg)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
3061
	struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
3062

3063 3064
	switch (frame_type) {
	case IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_PROBE_REQ:
3065
		if (reg) {
3066
			local->probe_req_reg++;
3067 3068 3069 3070 3071 3072 3073 3074
			sdata->vif.probe_req_reg++;
		} else {
			if (local->probe_req_reg)
				local->probe_req_reg--;

			if (sdata->vif.probe_req_reg)
				sdata->vif.probe_req_reg--;
		}
3075

3076 3077 3078
		if (!local->open_count)
			break;

3079 3080 3081 3082 3083 3084 3085 3086
		if (sdata->vif.probe_req_reg == 1)
			drv_config_iface_filter(local, sdata, FIF_PROBE_REQ,
						FIF_PROBE_REQ);
		else if (sdata->vif.probe_req_reg == 0)
			drv_config_iface_filter(local, sdata, 0,
						FIF_PROBE_REQ);

		ieee80211_configure_filter(local);
3087 3088 3089 3090
		break;
	default:
		break;
	}
3091 3092
}

3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108 3109
static int ieee80211_set_antenna(struct wiphy *wiphy, u32 tx_ant, u32 rx_ant)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);

	if (local->started)
		return -EOPNOTSUPP;

	return drv_set_antenna(local, tx_ant, rx_ant);
}

static int ieee80211_get_antenna(struct wiphy *wiphy, u32 *tx_ant, u32 *rx_ant)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);

	return drv_get_antenna(local, tx_ant, rx_ant);
}

3110 3111 3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123 3124
static int ieee80211_set_rekey_data(struct wiphy *wiphy,
				    struct net_device *dev,
				    struct cfg80211_gtk_rekey_data *data)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);

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

	drv_set_rekey_data(local, sdata, data);

	return 0;
}

J
Johannes Berg 已提交
3125 3126 3127 3128 3129 3130
static int ieee80211_probe_client(struct wiphy *wiphy, struct net_device *dev,
				  const u8 *peer, u64 *cookie)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_qos_hdr *nullfunc;
3131
	struct sk_buff *skb;
J
Johannes Berg 已提交
3132 3133 3134 3135 3136
	int size = sizeof(*nullfunc);
	__le16 fc;
	bool qos;
	struct ieee80211_tx_info *info;
	struct sta_info *sta;
J
Johannes Berg 已提交
3137 3138
	struct ieee80211_chanctx_conf *chanctx_conf;
	enum ieee80211_band band;
3139 3140 3141 3142
	int ret;

	/* the lock is needed to assign the cookie later */
	mutex_lock(&local->mtx);
J
Johannes Berg 已提交
3143 3144

	rcu_read_lock();
J
Johannes Berg 已提交
3145 3146
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	if (WARN_ON(!chanctx_conf)) {
3147 3148
		ret = -EINVAL;
		goto unlock;
J
Johannes Berg 已提交
3149
	}
3150
	band = chanctx_conf->def.chan->band;
3151
	sta = sta_info_get_bss(sdata, peer);
3152
	if (sta) {
3153
		qos = sta->sta.wme;
3154
	} else {
3155 3156
		ret = -ENOLINK;
		goto unlock;
3157
	}
J
Johannes Berg 已提交
3158 3159 3160 3161 3162 3163 3164 3165 3166 3167 3168 3169 3170

	if (qos) {
		fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
				 IEEE80211_STYPE_QOS_NULLFUNC |
				 IEEE80211_FCTL_FROMDS);
	} else {
		size -= 2;
		fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
				 IEEE80211_STYPE_NULLFUNC |
				 IEEE80211_FCTL_FROMDS);
	}

	skb = dev_alloc_skb(local->hw.extra_tx_headroom + size);
J
Johannes Berg 已提交
3171
	if (!skb) {
3172 3173
		ret = -ENOMEM;
		goto unlock;
J
Johannes Berg 已提交
3174
	}
J
Johannes Berg 已提交
3175 3176 3177 3178 3179 3180 3181 3182 3183 3184 3185 3186 3187 3188 3189 3190 3191

	skb->dev = dev;

	skb_reserve(skb, local->hw.extra_tx_headroom);

	nullfunc = (void *) skb_put(skb, size);
	nullfunc->frame_control = fc;
	nullfunc->duration_id = 0;
	memcpy(nullfunc->addr1, sta->sta.addr, ETH_ALEN);
	memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN);
	memcpy(nullfunc->addr3, sdata->vif.addr, ETH_ALEN);
	nullfunc->seq_ctrl = 0;

	info = IEEE80211_SKB_CB(skb);

	info->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS |
		       IEEE80211_TX_INTFL_NL80211_FRAME_TX;
3192
	info->band = band;
J
Johannes Berg 已提交
3193 3194 3195 3196 3197 3198

	skb_set_queue_mapping(skb, IEEE80211_AC_VO);
	skb->priority = 7;
	if (qos)
		nullfunc->qos_ctrl = cpu_to_le16(7);

3199 3200
	ret = ieee80211_attach_ack_skb(local, skb, cookie, GFP_ATOMIC);
	if (ret) {
3201 3202 3203 3204
		kfree_skb(skb);
		goto unlock;
	}

J
Johannes Berg 已提交
3205
	local_bh_disable();
3206
	ieee80211_xmit(sdata, sta, skb);
J
Johannes Berg 已提交
3207
	local_bh_enable();
3208 3209 3210

	ret = 0;
unlock:
J
Johannes Berg 已提交
3211
	rcu_read_unlock();
3212
	mutex_unlock(&local->mtx);
J
Johannes Berg 已提交
3213

3214
	return ret;
J
Johannes Berg 已提交
3215 3216
}

3217 3218 3219
static int ieee80211_cfg_get_channel(struct wiphy *wiphy,
				     struct wireless_dev *wdev,
				     struct cfg80211_chan_def *chandef)
3220
{
J
Johannes Berg 已提交
3221
	struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
3222
	struct ieee80211_local *local = wiphy_priv(wiphy);
J
Johannes Berg 已提交
3223
	struct ieee80211_chanctx_conf *chanctx_conf;
3224
	int ret = -ENODATA;
J
Johannes Berg 已提交
3225 3226

	rcu_read_lock();
3227 3228
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	if (chanctx_conf) {
3229
		*chandef = sdata->vif.bss_conf.chandef;
3230 3231 3232 3233 3234 3235 3236
		ret = 0;
	} else if (local->open_count > 0 &&
		   local->open_count == local->monitors &&
		   sdata->vif.type == NL80211_IFTYPE_MONITOR) {
		if (local->use_chanctx)
			*chandef = local->monitor_chandef;
		else
3237
			*chandef = local->_oper_chandef;
3238
		ret = 0;
J
Johannes Berg 已提交
3239 3240
	}
	rcu_read_unlock();
3241

3242
	return ret;
3243 3244
}

3245 3246 3247 3248 3249 3250 3251
#ifdef CONFIG_PM
static void ieee80211_set_wakeup(struct wiphy *wiphy, bool enabled)
{
	drv_set_wakeup(wiphy_priv(wiphy), enabled);
}
#endif

3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264 3265 3266 3267 3268
static int ieee80211_set_qos_map(struct wiphy *wiphy,
				 struct net_device *dev,
				 struct cfg80211_qos_map *qos_map)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct mac80211_qos_map *new_qos_map, *old_qos_map;

	if (qos_map) {
		new_qos_map = kzalloc(sizeof(*new_qos_map), GFP_KERNEL);
		if (!new_qos_map)
			return -ENOMEM;
		memcpy(&new_qos_map->qos_map, qos_map, sizeof(*qos_map));
	} else {
		/* A NULL qos_map was passed to disable QoS mapping */
		new_qos_map = NULL;
	}

3269
	old_qos_map = sdata_dereference(sdata->qos_map, sdata);
3270 3271 3272 3273 3274 3275 3276
	rcu_assign_pointer(sdata->qos_map, new_qos_map);
	if (old_qos_map)
		kfree_rcu(old_qos_map, rcu_head);

	return 0;
}

3277 3278 3279 3280 3281 3282 3283 3284 3285 3286 3287 3288 3289 3290 3291
static int ieee80211_set_ap_chanwidth(struct wiphy *wiphy,
				      struct net_device *dev,
				      struct cfg80211_chan_def *chandef)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	int ret;
	u32 changed = 0;

	ret = ieee80211_vif_change_bandwidth(sdata, chandef, &changed);
	if (ret == 0)
		ieee80211_bss_info_change_notify(sdata, changed);

	return ret;
}

3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308 3309 3310 3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324 3325 3326 3327 3328 3329 3330 3331 3332 3333 3334 3335 3336 3337 3338 3339 3340 3341 3342 3343
static int ieee80211_add_tx_ts(struct wiphy *wiphy, struct net_device *dev,
			       u8 tsid, const u8 *peer, u8 up,
			       u16 admitted_time)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	int ac = ieee802_1d_to_ac[up];

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

	if (!(sdata->wmm_acm & BIT(up)))
		return -EINVAL;

	if (ifmgd->tx_tspec[ac].admitted_time)
		return -EBUSY;

	if (admitted_time) {
		ifmgd->tx_tspec[ac].admitted_time = 32 * admitted_time;
		ifmgd->tx_tspec[ac].tsid = tsid;
		ifmgd->tx_tspec[ac].up = up;
	}

	return 0;
}

static int ieee80211_del_tx_ts(struct wiphy *wiphy, struct net_device *dev,
			       u8 tsid, const u8 *peer)
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
	struct ieee80211_local *local = wiphy_priv(wiphy);
	int ac;

	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		struct ieee80211_sta_tx_tspec *tx_tspec = &ifmgd->tx_tspec[ac];

		/* skip unused entries */
		if (!tx_tspec->admitted_time)
			continue;

		if (tx_tspec->tsid != tsid)
			continue;

		/* due to this new packets will be reassigned to non-ACM ACs */
		tx_tspec->up = -1;

		/* Make sure that all packets have been sent to avoid to
		 * restore the QoS params on packets that are still on the
		 * queues.
		 */
		synchronize_net();
3344
		ieee80211_flush_queues(local, sdata, false);
3345 3346 3347 3348 3349 3350 3351 3352 3353 3354 3355 3356 3357 3358 3359 3360 3361

		/* restore the normal QoS parameters
		 * (unconditionally to avoid races)
		 */
		tx_tspec->action = TX_TSPEC_ACTION_STOP_DOWNGRADE;
		tx_tspec->downgraded = false;
		ieee80211_sta_handle_tspec_ac_params(sdata);

		/* finally clear all the data */
		memset(tx_tspec, 0, sizeof(*tx_tspec));

		return 0;
	}

	return -ENOENT;
}

3362
const struct cfg80211_ops mac80211_config_ops = {
3363 3364
	.add_virtual_intf = ieee80211_add_iface,
	.del_virtual_intf = ieee80211_del_iface,
3365
	.change_virtual_intf = ieee80211_change_iface,
3366 3367
	.start_p2p_device = ieee80211_start_p2p_device,
	.stop_p2p_device = ieee80211_stop_p2p_device,
3368 3369
	.add_key = ieee80211_add_key,
	.del_key = ieee80211_del_key,
3370
	.get_key = ieee80211_get_key,
3371
	.set_default_key = ieee80211_config_default_key,
3372
	.set_default_mgmt_key = ieee80211_config_default_mgmt_key,
3373 3374 3375
	.start_ap = ieee80211_start_ap,
	.change_beacon = ieee80211_change_beacon,
	.stop_ap = ieee80211_stop_ap,
3376 3377 3378
	.add_station = ieee80211_add_station,
	.del_station = ieee80211_del_station,
	.change_station = ieee80211_change_station,
3379
	.get_station = ieee80211_get_station,
3380
	.dump_station = ieee80211_dump_station,
3381
	.dump_survey = ieee80211_dump_survey,
3382 3383 3384 3385 3386 3387
#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,
3388 3389
	.get_mpp = ieee80211_get_mpp,
	.dump_mpp = ieee80211_dump_mpp,
3390 3391
	.update_mesh_config = ieee80211_update_mesh_config,
	.get_mesh_config = ieee80211_get_mesh_config,
3392 3393
	.join_mesh = ieee80211_join_mesh,
	.leave_mesh = ieee80211_leave_mesh,
3394
#endif
3395 3396
	.join_ocb = ieee80211_join_ocb,
	.leave_ocb = ieee80211_leave_ocb,
3397
	.change_bss = ieee80211_change_bss,
3398
	.set_txq_params = ieee80211_set_txq_params,
3399
	.set_monitor_channel = ieee80211_set_monitor_channel,
3400 3401
	.suspend = ieee80211_suspend,
	.resume = ieee80211_resume,
3402
	.scan = ieee80211_scan,
3403
	.abort_scan = ieee80211_abort_scan,
3404 3405
	.sched_scan_start = ieee80211_sched_scan_start,
	.sched_scan_stop = ieee80211_sched_scan_stop,
3406 3407 3408 3409
	.auth = ieee80211_auth,
	.assoc = ieee80211_assoc,
	.deauth = ieee80211_deauth,
	.disassoc = ieee80211_disassoc,
3410 3411
	.join_ibss = ieee80211_join_ibss,
	.leave_ibss = ieee80211_leave_ibss,
3412
	.set_mcast_rate = ieee80211_set_mcast_rate,
3413
	.set_wiphy_params = ieee80211_set_wiphy_params,
3414 3415
	.set_tx_power = ieee80211_set_tx_power,
	.get_tx_power = ieee80211_get_tx_power,
J
Johannes Berg 已提交
3416
	.set_wds_peer = ieee80211_set_wds_peer,
J
Johannes Berg 已提交
3417
	.rfkill_poll = ieee80211_rfkill_poll,
3418
	CFG80211_TESTMODE_CMD(ieee80211_testmode_cmd)
W
Wey-Yi Guy 已提交
3419
	CFG80211_TESTMODE_DUMP(ieee80211_testmode_dump)
J
Johannes Berg 已提交
3420
	.set_power_mgmt = ieee80211_set_power_mgmt,
J
Johannes Berg 已提交
3421
	.set_bitrate_mask = ieee80211_set_bitrate_mask,
3422 3423
	.remain_on_channel = ieee80211_remain_on_channel,
	.cancel_remain_on_channel = ieee80211_cancel_remain_on_channel,
3424
	.mgmt_tx = ieee80211_mgmt_tx,
3425
	.mgmt_tx_cancel_wait = ieee80211_mgmt_tx_cancel_wait,
3426
	.set_cqm_rssi_config = ieee80211_set_cqm_rssi_config,
3427
	.mgmt_frame_register = ieee80211_mgmt_frame_register,
3428 3429
	.set_antenna = ieee80211_set_antenna,
	.get_antenna = ieee80211_get_antenna,
3430
	.set_rekey_data = ieee80211_set_rekey_data,
3431 3432
	.tdls_oper = ieee80211_tdls_oper,
	.tdls_mgmt = ieee80211_tdls_mgmt,
3433 3434
	.tdls_channel_switch = ieee80211_tdls_channel_switch,
	.tdls_cancel_channel_switch = ieee80211_tdls_cancel_channel_switch,
J
Johannes Berg 已提交
3435
	.probe_client = ieee80211_probe_client,
3436
	.set_noack_map = ieee80211_set_noack_map,
3437 3438 3439
#ifdef CONFIG_PM
	.set_wakeup = ieee80211_set_wakeup,
#endif
3440
	.get_channel = ieee80211_cfg_get_channel,
3441
	.start_radar_detection = ieee80211_start_radar_detection,
3442
	.channel_switch = ieee80211_channel_switch,
3443
	.set_qos_map = ieee80211_set_qos_map,
3444
	.set_ap_chanwidth = ieee80211_set_ap_chanwidth,
3445 3446
	.add_tx_ts = ieee80211_add_tx_ts,
	.del_tx_ts = ieee80211_del_tx_ts,
3447
};