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

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

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

34
	err = ieee80211_if_add(local, name, &wdev, type, params);
35 36
	if (err)
		return ERR_PTR(err);
37

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

43
	return wdev;
44 45
}

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

50
	return 0;
51 52
}

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

61
	ret = ieee80211_if_change_type(sdata, type);
62 63
	if (ret)
		return ret;
64

65 66
	if (type == NL80211_IFTYPE_AP_VLAN &&
	    params && params->use_4addr == 0)
67
		RCU_INIT_POINTER(sdata->u.vlan.sta, NULL);
68 69 70 71
	else if (type == NL80211_IFTYPE_STATION &&
		 params && params->use_4addr >= 0)
		sdata->u.mgd.use_4addr = params->use_4addr;

72 73 74 75
	if (sdata->vif.type == NL80211_IFTYPE_MONITOR && flags) {
		struct ieee80211_local *local = sdata->local;

		if (ieee80211_sdata_running(sdata)) {
76 77 78
			u32 mask = MONITOR_FLAG_COOK_FRAMES |
				   MONITOR_FLAG_ACTIVE;

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

106 107 108
	return 0;
}

109 110 111
static int ieee80211_start_p2p_device(struct wiphy *wiphy,
				      struct wireless_dev *wdev)
{
112 113 114 115 116 117 118 119 120
	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;

121 122 123 124 125 126 127 128 129
	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));
}

130 131 132 133 134 135 136 137 138 139
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;
	return 0;
}

140
static int ieee80211_add_key(struct wiphy *wiphy, struct net_device *dev,
141
			     u8 key_idx, bool pairwise, const u8 *mac_addr,
142 143
			     struct key_params *params)
{
144
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
145
	struct ieee80211_local *local = sdata->local;
146
	struct sta_info *sta = NULL;
147
	const struct ieee80211_cipher_scheme *cs = NULL;
148
	struct ieee80211_key *key;
149
	int err;
150

151
	if (!ieee80211_sdata_running(sdata))
J
Johannes Berg 已提交
152 153
		return -ENETDOWN;

154
	/* reject WEP and TKIP keys if WEP failed to initialize */
155 156 157
	switch (params->cipher) {
	case WLAN_CIPHER_SUITE_WEP40:
	case WLAN_CIPHER_SUITE_TKIP:
158
	case WLAN_CIPHER_SUITE_WEP104:
159
		if (IS_ERR(local->wep_tx_tfm))
160
			return -EINVAL;
161
		break;
162 163 164 165
	case WLAN_CIPHER_SUITE_CCMP:
	case WLAN_CIPHER_SUITE_AES_CMAC:
	case WLAN_CIPHER_SUITE_GCMP:
		break;
166
	default:
167
		cs = ieee80211_cs_get(local, params->cipher, sdata->vif.type);
168
		break;
169 170
	}

171
	key = ieee80211_key_alloc(params->cipher, key_idx, params->key_len,
172 173
				  params->key, params->seq_len, params->seq,
				  cs);
174 175
	if (IS_ERR(key))
		return PTR_ERR(key);
176

177 178 179
	if (pairwise)
		key->conf.flags |= IEEE80211_KEY_FLAG_PAIRWISE;

180
	mutex_lock(&local->sta_mtx);
181

182
	if (mac_addr) {
183 184 185 186
		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 已提交
187 188 189 190 191 192 193 194 195 196 197
		/*
		 * 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
		 * so it will set the key again after assocation.
		 *
		 * 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)) {
198
			ieee80211_key_free_unused(key);
199 200
			err = -ENOENT;
			goto out_unlock;
201
		}
202 203
	}

204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235
	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:
		/* shouldn't happen */
		WARN_ON_ONCE(1);
		break;
	}

236 237 238
	if (sta)
		sta->cipher_scheme = cs;

239
	err = ieee80211_key_link(key, sdata, sta);
240

241
 out_unlock:
242
	mutex_unlock(&local->sta_mtx);
243 244

	return err;
245 246 247
}

static int ieee80211_del_key(struct wiphy *wiphy, struct net_device *dev,
248
			     u8 key_idx, bool pairwise, const u8 *mac_addr)
249
{
250 251
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_local *local = sdata->local;
252
	struct sta_info *sta;
253
	struct ieee80211_key *key = NULL;
254 255
	int ret;

256 257
	mutex_lock(&local->sta_mtx);
	mutex_lock(&local->key_mtx);
258

259
	if (mac_addr) {
260 261
		ret = -ENOENT;

262
		sta = sta_info_get_bss(sdata, mac_addr);
263
		if (!sta)
264
			goto out_unlock;
265

266
		if (pairwise)
267
			key = key_mtx_dereference(local, sta->ptk[key_idx]);
268
		else
J
Johannes Berg 已提交
269
			key = key_mtx_dereference(local, sta->gtk[key_idx]);
270
	} else
J
Johannes Berg 已提交
271
		key = key_mtx_dereference(local, sdata->keys[key_idx]);
272

273
	if (!key) {
274 275 276
		ret = -ENOENT;
		goto out_unlock;
	}
277

278
	ieee80211_key_free(key, true);
279

280 281
	ret = 0;
 out_unlock:
282 283
	mutex_unlock(&local->key_mtx);
	mutex_unlock(&local->sta_mtx);
284 285

	return ret;
286 287
}

288
static int ieee80211_get_key(struct wiphy *wiphy, struct net_device *dev,
289 290
			     u8 key_idx, bool pairwise, const u8 *mac_addr,
			     void *cookie,
291 292 293
			     void (*callback)(void *cookie,
					      struct key_params *params))
{
294
	struct ieee80211_sub_if_data *sdata;
295 296 297
	struct sta_info *sta = NULL;
	u8 seq[6] = {0};
	struct key_params params;
298
	struct ieee80211_key *key = NULL;
J
Johannes Berg 已提交
299
	u64 pn64;
300 301 302 303
	u32 iv32;
	u16 iv16;
	int err = -ENOENT;

304 305
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

306 307
	rcu_read_lock();

308
	if (mac_addr) {
309
		sta = sta_info_get_bss(sdata, mac_addr);
310 311 312
		if (!sta)
			goto out;

313
		if (pairwise && key_idx < NUM_DEFAULT_KEYS)
314
			key = rcu_dereference(sta->ptk[key_idx]);
315 316
		else if (!pairwise &&
			 key_idx < NUM_DEFAULT_KEYS + NUM_DEFAULT_MGMT_KEYS)
J
Johannes Berg 已提交
317
			key = rcu_dereference(sta->gtk[key_idx]);
318
	} else
J
Johannes Berg 已提交
319
		key = rcu_dereference(sdata->keys[key_idx]);
320 321 322 323 324 325

	if (!key)
		goto out;

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

326
	params.cipher = key->conf.cipher;
327

328 329
	switch (key->conf.cipher) {
	case WLAN_CIPHER_SUITE_TKIP:
330 331
		iv32 = key->u.tkip.tx.iv32;
		iv16 = key->u.tkip.tx.iv16;
332

333 334 335 336
		if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE)
			drv_get_tkip_seq(sdata->local,
					 key->conf.hw_key_idx,
					 &iv32, &iv16);
337 338 339 340 341 342 343 344 345 346

		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;
347
	case WLAN_CIPHER_SUITE_CCMP:
J
Johannes Berg 已提交
348 349 350 351 352 353 354
		pn64 = atomic64_read(&key->u.ccmp.tx_pn);
		seq[0] = pn64;
		seq[1] = pn64 >> 8;
		seq[2] = pn64 >> 16;
		seq[3] = pn64 >> 24;
		seq[4] = pn64 >> 32;
		seq[5] = pn64 >> 40;
355 356 357
		params.seq = seq;
		params.seq_len = 6;
		break;
358
	case WLAN_CIPHER_SUITE_AES_CMAC:
J
Johannes Berg 已提交
359 360 361 362 363 364 365
		pn64 = atomic64_read(&key->u.aes_cmac.tx_pn);
		seq[0] = pn64;
		seq[1] = pn64 >> 8;
		seq[2] = pn64 >> 16;
		seq[3] = pn64 >> 24;
		seq[4] = pn64 >> 32;
		seq[5] = pn64 >> 40;
366 367 368
		params.seq = seq;
		params.seq_len = 6;
		break;
369 370 371 372 373 374 375 376 377
	}

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

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

 out:
378
	rcu_read_unlock();
379 380 381
	return err;
}

382 383
static int ieee80211_config_default_key(struct wiphy *wiphy,
					struct net_device *dev,
384 385
					u8 key_idx, bool uni,
					bool multi)
386
{
J
Johannes Berg 已提交
387
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
388

389
	ieee80211_set_default_key(sdata, key_idx, uni, multi);
390 391 392 393

	return 0;
}

394 395 396 397
static int ieee80211_config_default_mgmt_key(struct wiphy *wiphy,
					     struct net_device *dev,
					     u8 key_idx)
{
398
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
399 400 401 402 403 404

	ieee80211_set_default_mgmt_key(sdata, key_idx);

	return 0;
}

405 406 407 408 409
void sta_set_rate_info_tx(struct sta_info *sta,
			  const struct ieee80211_tx_rate *rate,
			  struct rate_info *rinfo)
{
	rinfo->flags = 0;
410
	if (rate->flags & IEEE80211_TX_RC_MCS) {
411
		rinfo->flags |= RATE_INFO_FLAGS_MCS;
412 413 414 415 416 417 418
		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;
419 420 421
		int shift = ieee80211_vif_get_shift(&sta->sdata->vif);
		u16 brate;

422 423
		sband = sta->local->hw.wiphy->bands[
				ieee80211_get_sdata_band(sta->sdata)];
424 425
		brate = sband->bitrates[rate->idx].bitrate;
		rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift);
426
	}
427 428
	if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
		rinfo->flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH;
429 430 431 432
	if (rate->flags & IEEE80211_TX_RC_80_MHZ_WIDTH)
		rinfo->flags |= RATE_INFO_FLAGS_80_MHZ_WIDTH;
	if (rate->flags & IEEE80211_TX_RC_160_MHZ_WIDTH)
		rinfo->flags |= RATE_INFO_FLAGS_160_MHZ_WIDTH;
433 434 435 436
	if (rate->flags & IEEE80211_TX_RC_SHORT_GI)
		rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI;
}

437 438 439 440 441 442 443 444 445 446 447 448 449
void sta_set_rate_info_rx(struct sta_info *sta, struct rate_info *rinfo)
{
	rinfo->flags = 0;

	if (sta->last_rx_rate_flag & RX_FLAG_HT) {
		rinfo->flags |= RATE_INFO_FLAGS_MCS;
		rinfo->mcs = sta->last_rx_rate_idx;
	} else if (sta->last_rx_rate_flag & RX_FLAG_VHT) {
		rinfo->flags |= RATE_INFO_FLAGS_VHT_MCS;
		rinfo->nss = sta->last_rx_rate_vht_nss;
		rinfo->mcs = sta->last_rx_rate_idx;
	} else {
		struct ieee80211_supported_band *sband;
450 451
		int shift = ieee80211_vif_get_shift(&sta->sdata->vif);
		u16 brate;
452 453 454

		sband = sta->local->hw.wiphy->bands[
				ieee80211_get_sdata_band(sta->sdata)];
455 456
		brate = sband->bitrates[sta->last_rx_rate_idx].bitrate;
		rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift);
457 458 459 460 461 462
	}

	if (sta->last_rx_rate_flag & RX_FLAG_40MHZ)
		rinfo->flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH;
	if (sta->last_rx_rate_flag & RX_FLAG_SHORT_GI)
		rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI;
463
	if (sta->last_rx_rate_vht_flag & RX_VHT_FLAG_80MHZ)
464
		rinfo->flags |= RATE_INFO_FLAGS_80_MHZ_WIDTH;
465
	if (sta->last_rx_rate_vht_flag & RX_VHT_FLAG_80P80MHZ)
466
		rinfo->flags |= RATE_INFO_FLAGS_80P80_MHZ_WIDTH;
467
	if (sta->last_rx_rate_vht_flag & RX_VHT_FLAG_160MHZ)
468 469 470
		rinfo->flags |= RATE_INFO_FLAGS_160_MHZ_WIDTH;
}

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

479
	mutex_lock(&local->sta_mtx);
480

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

488
	mutex_unlock(&local->sta_mtx);
489

490
	return ret;
491 492
}

493 494 495 496 497 498 499 500
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);
}

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

509
	mutex_lock(&local->sta_mtx);
510

511
	sta = sta_info_get_bss(sdata, mac);
512 513 514 515 516
	if (sta) {
		ret = 0;
		sta_set_sinfo(sta, sinfo);
	}

517
	mutex_unlock(&local->sta_mtx);
518 519

	return ret;
520 521
}

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

529
	if (cfg80211_chandef_identical(&local->monitor_chandef, chandef))
J
Johannes Berg 已提交
530
		return 0;
531

532
	mutex_lock(&local->mtx);
J
Johannes Berg 已提交
533 534 535 536 537 538 539
	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);
540
			ret = ieee80211_vif_use_channel(sdata, chandef,
J
Johannes Berg 已提交
541 542 543
					IEEE80211_CHANCTX_EXCLUSIVE);
		}
	} else if (local->open_count == local->monitors) {
544
		local->_oper_chandef = *chandef;
J
Johannes Berg 已提交
545 546
		ieee80211_hw_config(local, 0);
	}
547

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

J
Johannes Berg 已提交
553
	return ret;
554 555
}

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

	if (!resp || !resp_len)
563
		return 1;
564

565
	old = sdata_dereference(sdata->u.ap.probe_resp, sdata);
566

567
	new = kzalloc(sizeof(struct probe_resp) + resp_len, GFP_KERNEL);
568 569 570
	if (!new)
		return -ENOMEM;

571 572
	new->len = resp_len;
	memcpy(new->data, resp, resp_len);
573

574 575 576 577 578
	if (csa)
		memcpy(new->csa_counter_offsets, csa->counter_offsets_presp,
		       csa->n_counter_offsets_presp *
		       sizeof(new->csa_counter_offsets[0]));

579
	rcu_assign_pointer(sdata->u.ap.probe_resp, new);
580 581
	if (old)
		kfree_rcu(old, rcu_head);
582 583 584 585

	return 0;
}

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

595 596
	old = sdata_dereference(sdata->u.ap.beacon, sdata);

597 598 599

	/* Need to have a beacon head if we don't have one yet */
	if (!params->head && !old)
600
		return -EINVAL;
601 602 603 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

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

632 633 634 635 636 637 638
	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]));
	}

639 640 641 642 643 644 645 646 647 648 649 650 651
	/* 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);

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

659 660 661 662
	rcu_assign_pointer(sdata->u.ap.beacon, new);

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

664
	return changed;
665 666
}

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

681
	old = sdata_dereference(sdata->u.ap.beacon, sdata);
682 683 684
	if (old)
		return -EALREADY;

685 686 687 688
	/* TODO: make hostapd tell us what it wants */
	sdata->smps_mode = IEEE80211_SMPS_OFF;
	sdata->needed_rx_chains = sdata->local->rx_chains;

689
	mutex_lock(&local->mtx);
690
	err = ieee80211_vif_use_channel(sdata, &params->chandef,
J
Johannes Berg 已提交
691
					IEEE80211_CHANCTX_SHARED);
692 693
	if (!err)
		ieee80211_vif_copy_chanctx_to_vlans(sdata, false);
694
	mutex_unlock(&local->mtx);
695 696 697
	if (err)
		return err;

698 699 700 701 702 703
	/*
	 * 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;
704 705 706 707
	sdata->encrypt_headroom = ieee80211_cs_headroom(sdata->local,
							&params->crypto,
							sdata->vif.type);

708 709 710 711 712
	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;
713 714 715 716
		vlan->encrypt_headroom =
			ieee80211_cs_headroom(sdata->local,
					      &params->crypto,
					      vlan->vif.type);
717 718
	}

719 720
	sdata->vif.bss_conf.beacon_int = params->beacon_interval;
	sdata->vif.bss_conf.dtim_period = params->dtim_period;
721
	sdata->vif.bss_conf.enable_beacon = true;
722 723 724 725 726 727 728 729

	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 已提交
730 731 732 733 734 735 736
	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;
737

738
	err = ieee80211_assign_beacon(sdata, &params->beacon, NULL);
739 740
	if (err < 0) {
		ieee80211_vif_release_channel(sdata);
741
		return err;
742
	}
743 744
	changed |= err;

745 746
	err = drv_start_ap(sdata->local, sdata);
	if (err) {
747 748
		old = sdata_dereference(sdata->u.ap.beacon, sdata);

749 750 751
		if (old)
			kfree_rcu(old, rcu_head);
		RCU_INIT_POINTER(sdata->u.ap.beacon, NULL);
752
		ieee80211_vif_release_channel(sdata);
753 754 755
		return err;
	}

756
	ieee80211_recalc_dtim(local, sdata);
757 758
	ieee80211_bss_info_change_notify(sdata, changed);

759 760 761 762
	netif_carrier_on(dev);
	list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list)
		netif_carrier_on(vlan->dev);

763
	return 0;
764 765
}

766 767
static int ieee80211_change_beacon(struct wiphy *wiphy, struct net_device *dev,
				   struct cfg80211_beacon_data *params)
768
{
769
	struct ieee80211_sub_if_data *sdata;
770
	struct beacon_data *old;
771
	int err;
772

773
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);
774
	sdata_assert_lock(sdata);
775

776 777 778 779 780 781
	/* 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;

782
	old = sdata_dereference(sdata->u.ap.beacon, sdata);
783 784 785
	if (!old)
		return -ENOENT;

786
	err = ieee80211_assign_beacon(sdata, params, NULL);
787 788 789 790
	if (err < 0)
		return err;
	ieee80211_bss_info_change_notify(sdata, err);
	return 0;
791 792
}

793
static int ieee80211_stop_ap(struct wiphy *wiphy, struct net_device *dev)
794
{
795 796 797 798 799
	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;
800
	struct cfg80211_chan_def chandef;
801

802 803
	sdata_assert_lock(sdata);

804
	old_beacon = sdata_dereference(sdata->u.ap.beacon, sdata);
805
	if (!old_beacon)
806
		return -ENOENT;
807
	old_probe_resp = sdata_dereference(sdata->u.ap.probe_resp, sdata);
808

809
	/* abort any running channel switch */
810
	mutex_lock(&local->mtx);
811
	sdata->vif.csa_active = false;
812 813 814 815 816 817
	if (sdata->csa_block_tx) {
		ieee80211_wake_vif_queues(local, sdata,
					  IEEE80211_QUEUE_STOP_REASON_CSA);
		sdata->csa_block_tx = false;
	}

818 819
	mutex_unlock(&local->mtx);

820 821 822
	kfree(sdata->u.ap.next_beacon);
	sdata->u.ap.next_beacon = NULL;

823
	/* turn off carrier for this interface and dependent VLANs */
824 825 826 827
	list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list)
		netif_carrier_off(vlan->dev);
	netif_carrier_off(dev);

828
	/* remove beacon and probe response */
829
	RCU_INIT_POINTER(sdata->u.ap.beacon, NULL);
830 831 832 833
	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);
834
	sdata->u.ap.driver_smps_mode = IEEE80211_SMPS_OFF;
835

836
	__sta_info_flush(sdata, true);
837
	ieee80211_free_keys(sdata, true);
838

839
	sdata->vif.bss_conf.enable_beacon = false;
840
	sdata->vif.bss_conf.ssid_len = 0;
841
	clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state);
842
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED);
843

844
	if (sdata->wdev.cac_started) {
845
		chandef = sdata->vif.bss_conf.chandef;
846
		cancel_delayed_work_sync(&sdata->dfs_cac_timer_work);
847 848
		cfg80211_cac_event(sdata->dev, &chandef,
				   NL80211_RADAR_CAC_ABORTED,
849 850 851
				   GFP_KERNEL);
	}

852 853
	drv_stop_ap(sdata->local, sdata);

854 855 856 857
	/* 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);

858
	mutex_lock(&local->mtx);
859
	ieee80211_vif_copy_chanctx_to_vlans(sdata, true);
J
Johannes Berg 已提交
860
	ieee80211_vif_release_channel(sdata);
861
	mutex_unlock(&local->mtx);
J
Johannes Berg 已提交
862

863
	return 0;
864 865
}

866 867 868 869 870 871 872 873 874
/* 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 已提交
875
} __packed;
876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892

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 已提交
893
	eth_broadcast_addr(msg->da);
894
	memcpy(msg->sa, sta->sta.addr, ETH_ALEN);
895 896 897 898 899 900 901 902 903
	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) */

904 905
	skb->dev = sta->sdata->dev;
	skb->protocol = eth_type_trans(skb, sta->sdata->dev);
906
	memset(skb->cb, 0, sizeof(skb->cb));
907
	netif_rx_ni(skb);
908 909
}

910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961
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)) {
		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;
}

962 963 964
static int sta_apply_parameters(struct ieee80211_local *local,
				struct sta_info *sta,
				struct station_parameters *params)
965
{
966
	int ret = 0;
967
	struct ieee80211_supported_band *sband;
968
	struct ieee80211_sub_if_data *sdata = sta->sdata;
J
Johannes Berg 已提交
969
	enum ieee80211_band band = ieee80211_get_sdata_band(sdata);
970
	u32 mask, set;
971

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

974 975
	mask = params->sta_flags_mask;
	set = params->sta_flags_set;
J
Johannes Berg 已提交
976

977 978 979 980 981 982 983 984 985
	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);
986 987 988 989 990 991 992 993 994 995 996 997
	} 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);
		}
998
	}
999

1000 1001 1002 1003 1004 1005
	/* auth flags will be set later for TDLS stations */
	if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER)) {
		ret = sta_apply_auth_flags(local, sta, mask, set);
		if (ret)
			return ret;
	}
1006

1007 1008
	if (mask & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE)) {
		if (set & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE))
J
Johannes Berg 已提交
1009 1010 1011
			set_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE);
		else
			clear_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE);
1012
	}
1013

1014 1015
	if (mask & BIT(NL80211_STA_FLAG_WME))
		sta->sta.wme = set & BIT(NL80211_STA_FLAG_WME);
1016

1017 1018
	if (mask & BIT(NL80211_STA_FLAG_MFP)) {
		if (set & BIT(NL80211_STA_FLAG_MFP))
J
Johannes Berg 已提交
1019 1020 1021
			set_sta_flag(sta, WLAN_STA_MFP);
		else
			clear_sta_flag(sta, WLAN_STA_MFP);
1022
	}
1023

1024 1025
	if (mask & BIT(NL80211_STA_FLAG_TDLS_PEER)) {
		if (set & BIT(NL80211_STA_FLAG_TDLS_PEER))
J
Johannes Berg 已提交
1026 1027 1028
			set_sta_flag(sta, WLAN_STA_TDLS_PEER);
		else
			clear_sta_flag(sta, WLAN_STA_TDLS_PEER);
1029
	}
1030

1031 1032 1033 1034
	if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) {
		sta->sta.uapsd_queues = params->uapsd_queues;
		sta->sta.max_sp = params->max_sp;
	}
1035

1036 1037 1038 1039 1040 1041 1042
	/*
	 * 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 已提交
1043
	/*
1044 1045 1046 1047 1048
	 * 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 已提交
1049 1050
	 */

1051 1052 1053 1054
	if (params->listen_interval >= 0)
		sta->listen_interval = params->listen_interval;

	if (params->supported_rates) {
1055 1056 1057 1058
		ieee80211_parse_bitrates(&sdata->vif.bss_conf.chandef,
					 sband, params->supported_rates,
					 params->supported_rates_len,
					 &sta->sta.supp_rates[band]);
1059
	}
1060

J
Johannes Berg 已提交
1061
	if (params->ht_capa)
B
Ben Greear 已提交
1062
		ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,
1063
						  params->ht_capa, sta);
1064

M
Mahesh Palivela 已提交
1065 1066
	if (params->vht_capa)
		ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband,
1067
						    params->vht_capa, sta);
M
Mahesh Palivela 已提交
1068

1069 1070 1071 1072 1073 1074 1075 1076 1077
	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,
					      params->opmode_notif,
					      band, false);
	}

1078
	if (ieee80211_vif_is_mesh(&sdata->vif)) {
1079
#ifdef CONFIG_MAC80211_MESH
1080
		u32 changed = 0;
1081 1082

		if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) {
1083
			switch (params->plink_state) {
1084
			case NL80211_PLINK_ESTAB:
1085 1086 1087 1088
				if (sta->plink_state != NL80211_PLINK_ESTAB)
					changed = mesh_plink_inc_estab_count(
							sdata);
				sta->plink_state = params->plink_state;
M
Marco Porsch 已提交
1089 1090

				ieee80211_mps_sta_status_update(sta);
1091 1092
				changed |= ieee80211_mps_set_sta_local_pm(sta,
					      sdata->u.mesh.mshcfg.power_mode);
1093 1094
				break;
			case NL80211_PLINK_LISTEN:
1095
			case NL80211_PLINK_BLOCKED:
1096 1097 1098 1099 1100 1101 1102
			case NL80211_PLINK_OPN_SNT:
			case NL80211_PLINK_OPN_RCVD:
			case NL80211_PLINK_CNF_RCVD:
			case NL80211_PLINK_HOLDING:
				if (sta->plink_state == NL80211_PLINK_ESTAB)
					changed = mesh_plink_dec_estab_count(
							sdata);
1103
				sta->plink_state = params->plink_state;
M
Marco Porsch 已提交
1104 1105

				ieee80211_mps_sta_status_update(sta);
1106 1107
				changed |= ieee80211_mps_set_sta_local_pm(sta,
						NL80211_MESH_POWER_UNKNOWN);
1108 1109 1110 1111 1112
				break;
			default:
				/*  nothing  */
				break;
			}
1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124
		}

		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;
1125
		}
M
Marco Porsch 已提交
1126 1127

		if (params->local_pm)
1128 1129 1130
			changed |=
			      ieee80211_mps_set_sta_local_pm(sta,
							     params->local_pm);
1131
		ieee80211_mbss_info_change_notify(sdata, changed);
1132
#endif
J
Johannes Berg 已提交
1133
	}
1134

1135 1136 1137 1138 1139 1140 1141
	/* set the STA state after all sta info from usermode has been set */
	if (test_sta_flag(sta, WLAN_STA_TDLS_PEER)) {
		ret = sta_apply_auth_flags(local, sta, mask, set);
		if (ret)
			return ret;
	}

1142
	return 0;
1143 1144 1145
}

static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
1146 1147
				 const u8 *mac,
				 struct station_parameters *params)
1148
{
1149
	struct ieee80211_local *local = wiphy_priv(wiphy);
1150 1151
	struct sta_info *sta;
	struct ieee80211_sub_if_data *sdata;
J
Johannes Berg 已提交
1152
	int err;
1153
	int layer2_update;
1154 1155 1156 1157

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

1158 1159
		if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
		    sdata->vif.type != NL80211_IFTYPE_AP)
1160 1161 1162 1163
			return -EINVAL;
	} else
		sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1164
	if (ether_addr_equal(mac, sdata->vif.addr))
1165 1166 1167 1168 1169 1170
		return -EINVAL;

	if (is_multicast_ether_addr(mac))
		return -EINVAL;

	sta = sta_info_alloc(sdata, mac, GFP_KERNEL);
J
Johannes Berg 已提交
1171 1172
	if (!sta)
		return -ENOMEM;
1173

1174 1175 1176 1177
	/*
	 * defaults -- if userspace wants something else we'll
	 * change it accordingly in sta_apply_parameters()
	 */
1178 1179 1180
	if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) {
		sta_info_pre_move_state(sta, IEEE80211_STA_AUTH);
		sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC);
1181 1182
	} else {
		sta->sta.tdls = true;
1183
	}
1184

1185 1186 1187 1188 1189
	err = sta_apply_parameters(local, sta, params);
	if (err) {
		sta_info_free(local, sta);
		return err;
	}
1190

1191
	/*
1192 1193
	 * for TDLS, rate control should be initialized only when
	 * rates are known and station is marked authorized
1194 1195 1196
	 */
	if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER))
		rate_control_rate_init(sta);
1197

1198 1199 1200
	layer2_update = sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
		sdata->vif.type == NL80211_IFTYPE_AP;

1201
	err = sta_info_insert_rcu(sta);
J
Johannes Berg 已提交
1202 1203 1204 1205 1206
	if (err) {
		rcu_read_unlock();
		return err;
	}

1207
	if (layer2_update)
J
Johannes Berg 已提交
1208 1209 1210 1211
		ieee80211_send_layer2_update(sta);

	rcu_read_unlock();

1212 1213 1214 1215
	return 0;
}

static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev,
1216
				 const u8 *mac)
1217
{
1218
	struct ieee80211_sub_if_data *sdata;
1219

1220 1221
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1222 1223
	if (mac)
		return sta_info_destroy_addr_bss(sdata, mac);
1224

1225
	sta_info_flush(sdata);
1226 1227 1228 1229
	return 0;
}

static int ieee80211_change_station(struct wiphy *wiphy,
1230
				    struct net_device *dev, const u8 *mac,
1231 1232
				    struct station_parameters *params)
{
1233
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1234
	struct ieee80211_local *local = wiphy_priv(wiphy);
1235 1236
	struct sta_info *sta;
	struct ieee80211_sub_if_data *vlansdata;
1237
	enum cfg80211_station_type statype;
1238
	int err;
1239

1240
	mutex_lock(&local->sta_mtx);
J
Johannes Berg 已提交
1241

1242
	sta = sta_info_get_bss(sdata, mac);
J
Johannes Berg 已提交
1243
	if (!sta) {
1244 1245
		err = -ENOENT;
		goto out_err;
J
Johannes Berg 已提交
1246
	}
1247

1248 1249
	switch (sdata->vif.type) {
	case NL80211_IFTYPE_MESH_POINT:
1250
		if (sdata->u.mesh.user_mpm)
1251
			statype = CFG80211_STA_MESH_PEER_USER;
1252
		else
1253
			statype = CFG80211_STA_MESH_PEER_KERNEL;
1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274
		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:
		statype = CFG80211_STA_AP_CLIENT;
		break;
	default:
		err = -EOPNOTSUPP;
		goto out_err;
1275 1276
	}

1277 1278 1279 1280
	err = cfg80211_check_station_change(wiphy, params, statype);
	if (err)
		goto out_err;

1281
	if (params->vlan && params->vlan != sta->sdata->dev) {
1282 1283 1284
		bool prev_4addr = false;
		bool new_4addr = false;

1285 1286
		vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);

1287
		if (params->vlan->ieee80211_ptr->use_4addr) {
J
Johannes Berg 已提交
1288
			if (vlansdata->u.vlan.sta) {
1289 1290
				err = -EBUSY;
				goto out_err;
J
Johannes Berg 已提交
1291
			}
1292

1293
			rcu_assign_pointer(vlansdata->u.vlan.sta, sta);
1294 1295 1296 1297 1298
			new_4addr = true;
		}

		if (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
		    sta->sdata->u.vlan.sta) {
M
Monam Agarwal 已提交
1299
			RCU_INIT_POINTER(sta->sdata->u.vlan.sta, NULL);
1300
			prev_4addr = true;
1301 1302
		}

1303
		sta->sdata = vlansdata;
1304 1305 1306 1307 1308 1309 1310 1311 1312

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

1313 1314 1315
		ieee80211_send_layer2_update(sta);
	}

1316
	err = sta_apply_parameters(local, sta, params);
1317 1318
	if (err)
		goto out_err;
1319

1320 1321 1322
	/* When peer becomes authorized, init rate control as well */
	if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
	    test_sta_flag(sta, WLAN_STA_AUTHORIZED))
1323 1324
		rate_control_rate_init(sta);

1325
	mutex_unlock(&local->sta_mtx);
J
Johannes Berg 已提交
1326

1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340
	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);
	}

1341
	if (sdata->vif.type == NL80211_IFTYPE_STATION &&
E
Eliad Peller 已提交
1342
	    params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
1343
		ieee80211_recalc_ps(local, -1);
E
Eliad Peller 已提交
1344 1345
		ieee80211_recalc_ps_vif(sdata);
	}
1346

1347
	return 0;
1348 1349 1350
out_err:
	mutex_unlock(&local->sta_mtx);
	return err;
1351 1352
}

1353 1354
#ifdef CONFIG_MAC80211_MESH
static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
1355
			       const u8 *dst, const u8 *next_hop)
1356
{
1357
	struct ieee80211_sub_if_data *sdata;
1358 1359 1360
	struct mesh_path *mpath;
	struct sta_info *sta;

1361 1362
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1363
	rcu_read_lock();
1364
	sta = sta_info_get(sdata, next_hop);
1365 1366
	if (!sta) {
		rcu_read_unlock();
1367
		return -ENOENT;
1368
	}
1369

1370 1371
	mpath = mesh_path_add(sdata, dst);
	if (IS_ERR(mpath)) {
1372
		rcu_read_unlock();
1373
		return PTR_ERR(mpath);
1374
	}
1375 1376

	mesh_path_fix_nexthop(mpath, sta);
1377

1378 1379 1380 1381 1382
	rcu_read_unlock();
	return 0;
}

static int ieee80211_del_mpath(struct wiphy *wiphy, struct net_device *dev,
1383
			       const u8 *dst)
1384
{
1385 1386
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1387
	if (dst)
J
Johannes Berg 已提交
1388
		return mesh_path_del(sdata, dst);
1389

1390
	mesh_path_flush_by_iface(sdata);
1391 1392 1393
	return 0;
}

1394 1395
static int ieee80211_change_mpath(struct wiphy *wiphy, struct net_device *dev,
				  const u8 *dst, const u8 *next_hop)
1396
{
1397
	struct ieee80211_sub_if_data *sdata;
1398 1399 1400
	struct mesh_path *mpath;
	struct sta_info *sta;

1401 1402
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1403 1404
	rcu_read_lock();

1405
	sta = sta_info_get(sdata, next_hop);
1406 1407
	if (!sta) {
		rcu_read_unlock();
1408
		return -ENOENT;
1409
	}
1410

J
Johannes Berg 已提交
1411
	mpath = mesh_path_lookup(sdata, dst);
1412 1413 1414 1415 1416 1417
	if (!mpath) {
		rcu_read_unlock();
		return -ENOENT;
	}

	mesh_path_fix_nexthop(mpath, sta);
1418

1419 1420 1421 1422 1423 1424 1425
	rcu_read_unlock();
	return 0;
}

static void mpath_set_pinfo(struct mesh_path *mpath, u8 *next_hop,
			    struct mpath_info *pinfo)
{
J
Johannes Berg 已提交
1426 1427 1428 1429
	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);
1430 1431 1432
	else
		memset(next_hop, 0, ETH_ALEN);

1433 1434
	memset(pinfo, 0, sizeof(*pinfo));

1435 1436
	pinfo->generation = mesh_paths_generation;

1437
	pinfo->filled = MPATH_INFO_FRAME_QLEN |
1438
			MPATH_INFO_SN |
1439 1440 1441 1442 1443 1444 1445
			MPATH_INFO_METRIC |
			MPATH_INFO_EXPTIME |
			MPATH_INFO_DISCOVERY_TIMEOUT |
			MPATH_INFO_DISCOVERY_RETRIES |
			MPATH_INFO_FLAGS;

	pinfo->frame_qlen = mpath->frame_queue.qlen;
1446
	pinfo->sn = mpath->sn;
1447 1448 1449 1450 1451 1452 1453 1454 1455 1456
	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;
1457 1458
	if (mpath->flags & MESH_PATH_SN_VALID)
		pinfo->flags |= NL80211_MPATH_FLAG_SN_VALID;
1459 1460
	if (mpath->flags & MESH_PATH_FIXED)
		pinfo->flags |= NL80211_MPATH_FLAG_FIXED;
1461 1462
	if (mpath->flags & MESH_PATH_RESOLVED)
		pinfo->flags |= NL80211_MPATH_FLAG_RESOLVED;
1463 1464 1465 1466 1467 1468
}

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

{
1469
	struct ieee80211_sub_if_data *sdata;
1470 1471
	struct mesh_path *mpath;

1472 1473
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1474
	rcu_read_lock();
J
Johannes Berg 已提交
1475
	mpath = mesh_path_lookup(sdata, dst);
1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486
	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,
1487 1488
				int idx, u8 *dst, u8 *next_hop,
				struct mpath_info *pinfo)
1489
{
1490
	struct ieee80211_sub_if_data *sdata;
1491 1492
	struct mesh_path *mpath;

1493 1494
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1495
	rcu_read_lock();
J
Johannes Berg 已提交
1496
	mpath = mesh_path_lookup_by_idx(sdata, idx);
1497 1498 1499 1500 1501 1502 1503 1504 1505
	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;
}
1506

1507
static int ieee80211_get_mesh_config(struct wiphy *wiphy,
1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522
				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;
}

1523 1524 1525 1526 1527
static int copy_mesh_setup(struct ieee80211_if_mesh *ifmsh,
		const struct mesh_setup *setup)
{
	u8 *new_ie;
	const u8 *old_ie;
1528 1529
	struct ieee80211_sub_if_data *sdata = container_of(ifmsh,
					struct ieee80211_sub_if_data, u.mesh);
1530

1531
	/* allocate information elements */
1532
	new_ie = NULL;
1533
	old_ie = ifmsh->ie;
1534

1535 1536
	if (setup->ie_len) {
		new_ie = kmemdup(setup->ie, setup->ie_len,
1537 1538 1539 1540
				GFP_KERNEL);
		if (!new_ie)
			return -ENOMEM;
	}
1541 1542 1543
	ifmsh->ie_len = setup->ie_len;
	ifmsh->ie = new_ie;
	kfree(old_ie);
1544 1545 1546 1547

	/* 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);
1548
	ifmsh->mesh_sp_id = setup->sync_method;
1549 1550
	ifmsh->mesh_pp_id = setup->path_sel_proto;
	ifmsh->mesh_pm_id = setup->path_metric;
1551
	ifmsh->user_mpm = setup->user_mpm;
1552
	ifmsh->mesh_auth_id = setup->auth_id;
1553 1554 1555 1556 1557
	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;
1558

1559 1560 1561
	/* mcast rate setting in Mesh Node */
	memcpy(sdata->vif.bss_conf.mcast_rate, setup->mcast_rate,
						sizeof(setup->mcast_rate));
1562
	sdata->vif.bss_conf.basic_rates = setup->basic_rates;
1563

1564 1565 1566
	sdata->vif.bss_conf.beacon_int = setup->beacon_interval;
	sdata->vif.bss_conf.dtim_period = setup->dtim_period;

1567 1568 1569
	return 0;
}

1570
static int ieee80211_update_mesh_config(struct wiphy *wiphy,
1571 1572
					struct net_device *dev, u32 mask,
					const struct mesh_config *nconf)
1573 1574 1575
{
	struct mesh_config *conf;
	struct ieee80211_sub_if_data *sdata;
1576 1577
	struct ieee80211_if_mesh *ifmsh;

1578
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1579
	ifmsh = &sdata->u.mesh;
1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594

	/* 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;
1595
	if (_chg_mesh_attr(NL80211_MESHCONF_ELEMENT_TTL, mask))
1596
		conf->element_ttl = nconf->element_ttl;
1597 1598 1599
	if (_chg_mesh_attr(NL80211_MESHCONF_AUTO_OPEN_PLINKS, mask)) {
		if (ifmsh->user_mpm)
			return -EBUSY;
1600
		conf->auto_open_plinks = nconf->auto_open_plinks;
1601
	}
1602 1603 1604
	if (_chg_mesh_attr(NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, mask))
		conf->dot11MeshNbrOffsetMaxNeighbor =
			nconf->dot11MeshNbrOffsetMaxNeighbor;
1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617
	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;
1618 1619 1620
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, mask))
		conf->dot11MeshHWMPperrMinInterval =
			nconf->dot11MeshHWMPperrMinInterval;
1621 1622 1623 1624
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
			   mask))
		conf->dot11MeshHWMPnetDiameterTraversalTime =
			nconf->dot11MeshHWMPnetDiameterTraversalTime;
1625 1626 1627 1628
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOTMODE, mask)) {
		conf->dot11MeshHWMPRootMode = nconf->dot11MeshHWMPRootMode;
		ieee80211_mesh_root_setup(ifmsh);
	}
1629
	if (_chg_mesh_attr(NL80211_MESHCONF_GATE_ANNOUNCEMENTS, mask)) {
T
Thomas Pedersen 已提交
1630 1631 1632 1633
		/* our current gate announcement implementation rides on root
		 * announcements, so require this ifmsh to also be a root node
		 * */
		if (nconf->dot11MeshGateAnnouncementProtocol &&
1634 1635
		    !(conf->dot11MeshHWMPRootMode > IEEE80211_ROOTMODE_ROOT)) {
			conf->dot11MeshHWMPRootMode = IEEE80211_PROACTIVE_RANN;
T
Thomas Pedersen 已提交
1636 1637
			ieee80211_mesh_root_setup(ifmsh);
		}
1638 1639 1640
		conf->dot11MeshGateAnnouncementProtocol =
			nconf->dot11MeshGateAnnouncementProtocol;
	}
1641
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_RANN_INTERVAL, mask))
1642 1643
		conf->dot11MeshHWMPRannInterval =
			nconf->dot11MeshHWMPRannInterval;
1644 1645
	if (_chg_mesh_attr(NL80211_MESHCONF_FORWARDING, mask))
		conf->dot11MeshForwarding = nconf->dot11MeshForwarding;
1646 1647 1648 1649 1650 1651 1652 1653
	if (_chg_mesh_attr(NL80211_MESHCONF_RSSI_THRESHOLD, mask)) {
		/* our RSSI threshold implementation is supported only for
		 * devices that report signal in dBm.
		 */
		if (!(sdata->local->hw.flags & IEEE80211_HW_SIGNAL_DBM))
			return -ENOTSUPP;
		conf->rssi_threshold = nconf->rssi_threshold;
	}
1654 1655 1656 1657 1658
	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);
	}
1659 1660 1661 1662 1663 1664
	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;
1665 1666 1667
	if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, mask))
		conf->dot11MeshHWMPconfirmationInterval =
			nconf->dot11MeshHWMPconfirmationInterval;
M
Marco Porsch 已提交
1668 1669 1670 1671
	if (_chg_mesh_attr(NL80211_MESHCONF_POWER_MODE, mask)) {
		conf->power_mode = nconf->power_mode;
		ieee80211_mps_local_status_update(sdata);
	}
T
Thomas Pedersen 已提交
1672
	if (_chg_mesh_attr(NL80211_MESHCONF_AWAKE_WINDOW, mask))
M
Marco Porsch 已提交
1673 1674
		conf->dot11MeshAwakeWindowDuration =
			nconf->dot11MeshAwakeWindowDuration;
1675 1676
	if (_chg_mesh_attr(NL80211_MESHCONF_PLINK_TIMEOUT, mask))
		conf->plink_timeout = nconf->plink_timeout;
T
Thomas Pedersen 已提交
1677
	ieee80211_mbss_info_change_notify(sdata, BSS_CHANGED_BEACON);
1678 1679 1680
	return 0;
}

1681 1682 1683 1684 1685 1686
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;
1687
	int err;
1688

1689 1690 1691 1692
	memcpy(&ifmsh->mshcfg, conf, sizeof(struct mesh_config));
	err = copy_mesh_setup(ifmsh, setup);
	if (err)
		return err;
1693

1694 1695 1696 1697
	/* can mesh use other SMPS modes? */
	sdata->smps_mode = IEEE80211_SMPS_OFF;
	sdata->needed_rx_chains = sdata->local->rx_chains;

1698
	mutex_lock(&sdata->local->mtx);
1699
	err = ieee80211_vif_use_channel(sdata, &setup->chandef,
J
Johannes Berg 已提交
1700
					IEEE80211_CHANCTX_SHARED);
1701
	mutex_unlock(&sdata->local->mtx);
1702 1703 1704
	if (err)
		return err;

T
Thomas Pedersen 已提交
1705
	return ieee80211_start_mesh(sdata);
1706 1707 1708 1709 1710 1711 1712
}

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);
1713
	mutex_lock(&sdata->local->mtx);
J
Johannes Berg 已提交
1714
	ieee80211_vif_release_channel(sdata);
1715
	mutex_unlock(&sdata->local->mtx);
1716 1717 1718

	return 0;
}
1719 1720
#endif

1721 1722 1723 1724
static int ieee80211_change_bss(struct wiphy *wiphy,
				struct net_device *dev,
				struct bss_parameters *params)
{
J
Johannes Berg 已提交
1725 1726
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	enum ieee80211_band band;
1727 1728
	u32 changed = 0;

1729
	if (!sdata_dereference(sdata->u.ap.beacon, sdata))
J
Johannes Berg 已提交
1730 1731 1732
		return -ENOENT;

	band = ieee80211_get_sdata_band(sdata);
1733 1734

	if (params->use_cts_prot >= 0) {
J
Johannes Berg 已提交
1735
		sdata->vif.bss_conf.use_cts_prot = params->use_cts_prot;
1736 1737 1738
		changed |= BSS_CHANGED_ERP_CTS_PROT;
	}
	if (params->use_short_preamble >= 0) {
J
Johannes Berg 已提交
1739
		sdata->vif.bss_conf.use_short_preamble =
1740 1741 1742
			params->use_short_preamble;
		changed |= BSS_CHANGED_ERP_PREAMBLE;
	}
1743 1744

	if (!sdata->vif.bss_conf.use_short_slot &&
J
Johannes Berg 已提交
1745
	    band == IEEE80211_BAND_5GHZ) {
1746 1747 1748 1749
		sdata->vif.bss_conf.use_short_slot = true;
		changed |= BSS_CHANGED_ERP_SLOT;
	}

1750
	if (params->use_short_slot_time >= 0) {
J
Johannes Berg 已提交
1751
		sdata->vif.bss_conf.use_short_slot =
1752 1753 1754 1755
			params->use_short_slot_time;
		changed |= BSS_CHANGED_ERP_SLOT;
	}

1756
	if (params->basic_rates) {
1757 1758 1759 1760 1761
		ieee80211_parse_bitrates(&sdata->vif.bss_conf.chandef,
					 wiphy->bands[band],
					 params->basic_rates,
					 params->basic_rates_len,
					 &sdata->vif.bss_conf.basic_rates);
1762 1763 1764
		changed |= BSS_CHANGED_BASIC_RATES;
	}

1765 1766 1767 1768 1769 1770 1771
	if (params->ap_isolate >= 0) {
		if (params->ap_isolate)
			sdata->flags |= IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
		else
			sdata->flags &= ~IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
	}

1772 1773 1774 1775 1776 1777
	if (params->ht_opmode >= 0) {
		sdata->vif.bss_conf.ht_operation_mode =
			(u16) params->ht_opmode;
		changed |= BSS_CHANGED_HT;
	}

1778
	if (params->p2p_ctwindow >= 0) {
J
Janusz Dziedzic 已提交
1779 1780 1781 1782
		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;
1783 1784 1785
		changed |= BSS_CHANGED_P2P_PS;
	}

J
Janusz Dziedzic 已提交
1786 1787 1788 1789 1790 1791 1792
	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;
1793 1794 1795
		changed |= BSS_CHANGED_P2P_PS;
	}

1796 1797 1798 1799 1800
	ieee80211_bss_info_change_notify(sdata, changed);

	return 0;
}

1801
static int ieee80211_set_txq_params(struct wiphy *wiphy,
1802
				    struct net_device *dev,
1803 1804 1805
				    struct ieee80211_txq_params *params)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
1806
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1807 1808 1809 1810 1811
	struct ieee80211_tx_queue_params p;

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

1812 1813 1814
	if (local->hw.queues < IEEE80211_NUM_ACS)
		return -EOPNOTSUPP;

1815 1816 1817 1818 1819
	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 已提交
1820 1821 1822 1823 1824 1825 1826

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

1827 1828
	sdata->tx_conf[params->ac] = p;
	if (drv_conf_tx(local, sdata, params->ac, &p)) {
J
Joe Perches 已提交
1829
		wiphy_debug(local->hw.wiphy,
1830 1831
			    "failed to set TX queue parameters for AC %d\n",
			    params->ac);
1832 1833 1834
		return -EINVAL;
	}

1835 1836
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_QOS);

1837 1838 1839
	return 0;
}

1840
#ifdef CONFIG_PM
J
Johannes Berg 已提交
1841 1842
static int ieee80211_suspend(struct wiphy *wiphy,
			     struct cfg80211_wowlan *wowlan)
1843
{
1844
	return __ieee80211_suspend(wiphy_priv(wiphy), wowlan);
1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855
}

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

1856 1857 1858
static int ieee80211_scan(struct wiphy *wiphy,
			  struct cfg80211_scan_request *req)
{
J
Johannes Berg 已提交
1859 1860 1861
	struct ieee80211_sub_if_data *sdata;

	sdata = IEEE80211_WDEV_TO_SUB_IF(req->wdev);
1862

1863 1864 1865 1866 1867
	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:
1868
	case NL80211_IFTYPE_P2P_DEVICE:
1869 1870 1871 1872
		break;
	case NL80211_IFTYPE_P2P_GO:
		if (sdata->local->ops->hw_scan)
			break;
1873 1874 1875 1876 1877
		/*
		 * FIXME: implement NoA while scanning in software,
		 * for now fall through to allow scanning only when
		 * beaconing hasn't been configured yet
		 */
1878
	case NL80211_IFTYPE_AP:
1879 1880 1881 1882 1883 1884 1885 1886 1887 1888
		/*
		 * 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)))
1889 1890 1891 1892 1893
			return -EOPNOTSUPP;
		break;
	default:
		return -EOPNOTSUPP;
	}
1894 1895 1896 1897

	return ieee80211_request_scan(sdata, req);
}

1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911
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
1912
ieee80211_sched_scan_stop(struct wiphy *wiphy, struct net_device *dev)
1913 1914 1915 1916 1917 1918
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);

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

1919
	return ieee80211_request_sched_scan_stop(sdata);
1920 1921
}

1922 1923 1924
static int ieee80211_auth(struct wiphy *wiphy, struct net_device *dev,
			  struct cfg80211_auth_request *req)
{
1925
	return ieee80211_mgd_auth(IEEE80211_DEV_TO_SUB_IF(dev), req);
1926 1927 1928 1929 1930
}

static int ieee80211_assoc(struct wiphy *wiphy, struct net_device *dev,
			   struct cfg80211_assoc_request *req)
{
1931
	return ieee80211_mgd_assoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
1932 1933 1934
}

static int ieee80211_deauth(struct wiphy *wiphy, struct net_device *dev,
1935
			    struct cfg80211_deauth_request *req)
1936
{
1937
	return ieee80211_mgd_deauth(IEEE80211_DEV_TO_SUB_IF(dev), req);
1938 1939 1940
}

static int ieee80211_disassoc(struct wiphy *wiphy, struct net_device *dev,
1941
			      struct cfg80211_disassoc_request *req)
1942
{
1943
	return ieee80211_mgd_disassoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
1944 1945
}

1946 1947 1948
static int ieee80211_join_ibss(struct wiphy *wiphy, struct net_device *dev,
			       struct cfg80211_ibss_params *params)
{
J
Johannes Berg 已提交
1949
	return ieee80211_ibss_join(IEEE80211_DEV_TO_SUB_IF(dev), params);
1950 1951 1952 1953
}

static int ieee80211_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
{
J
Johannes Berg 已提交
1954
	return ieee80211_ibss_leave(IEEE80211_DEV_TO_SUB_IF(dev));
1955 1956
}

1957 1958 1959 1960 1961
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);

1962 1963
	memcpy(sdata->vif.bss_conf.mcast_rate, rate,
	       sizeof(int) * IEEE80211_NUM_BANDS);
1964 1965 1966 1967

	return 0;
}

1968 1969 1970
static int ieee80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
1971
	int err;
1972

1973 1974 1975 1976 1977 1978 1979
	if (changed & WIPHY_PARAM_FRAG_THRESHOLD) {
		err = drv_set_frag_threshold(local, wiphy->frag_threshold);

		if (err)
			return err;
	}

1980 1981 1982 1983 1984 1985 1986
	if (changed & WIPHY_PARAM_COVERAGE_CLASS) {
		err = drv_set_coverage_class(local, wiphy->coverage_class);

		if (err)
			return err;
	}

1987
	if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
1988
		err = drv_set_rts_threshold(local, wiphy->rts_threshold);
1989

1990 1991
		if (err)
			return err;
1992 1993
	}

1994 1995 1996
	if (changed & WIPHY_PARAM_RETRY_SHORT) {
		if (wiphy->retry_short > IEEE80211_MAX_TX_RETRY)
			return -EINVAL;
1997
		local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
1998 1999 2000 2001
	}
	if (changed & WIPHY_PARAM_RETRY_LONG) {
		if (wiphy->retry_long > IEEE80211_MAX_TX_RETRY)
			return -EINVAL;
2002
		local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
2003
	}
2004 2005 2006 2007 2008 2009 2010
	if (changed &
	    (WIPHY_PARAM_RETRY_SHORT | WIPHY_PARAM_RETRY_LONG))
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_RETRY_LIMITS);

	return 0;
}

2011
static int ieee80211_set_tx_power(struct wiphy *wiphy,
2012
				  struct wireless_dev *wdev,
2013
				  enum nl80211_tx_power_setting type, int mbm)
2014 2015
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
2016
	struct ieee80211_sub_if_data *sdata;
2017

2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036
	if (wdev) {
		sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);

		switch (type) {
		case NL80211_TX_POWER_AUTOMATIC:
			sdata->user_power_level = IEEE80211_UNSET_POWER_LEVEL;
			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;
		}

		ieee80211_recalc_txpower(sdata);

		return 0;
	}
J
Johannes Berg 已提交
2037

2038
	switch (type) {
2039
	case NL80211_TX_POWER_AUTOMATIC:
2040
		local->user_power_level = IEEE80211_UNSET_POWER_LEVEL;
2041
		break;
2042 2043 2044 2045 2046
	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);
2047 2048 2049
		break;
	}

2050 2051 2052 2053 2054 2055
	mutex_lock(&local->iflist_mtx);
	list_for_each_entry(sdata, &local->interfaces, list)
		sdata->user_power_level = local->user_power_level;
	list_for_each_entry(sdata, &local->interfaces, list)
		ieee80211_recalc_txpower(sdata);
	mutex_unlock(&local->iflist_mtx);
2056 2057 2058 2059

	return 0;
}

2060 2061 2062
static int ieee80211_get_tx_power(struct wiphy *wiphy,
				  struct wireless_dev *wdev,
				  int *dbm)
2063 2064
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
2065
	struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
2066

2067 2068 2069 2070
	if (!local->use_chanctx)
		*dbm = local->hw.conf.power_level;
	else
		*dbm = sdata->vif.bss_conf.txpower;
2071 2072 2073 2074

	return 0;
}

J
Johannes Berg 已提交
2075
static int ieee80211_set_wds_peer(struct wiphy *wiphy, struct net_device *dev,
J
Johannes Berg 已提交
2076
				  const u8 *addr)
J
Johannes Berg 已提交
2077 2078 2079 2080 2081 2082 2083 2084
{
	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 已提交
2085 2086 2087 2088 2089 2090 2091
static void ieee80211_rfkill_poll(struct wiphy *wiphy)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);

	drv_rfkill_poll(local);
}

2092
#ifdef CONFIG_NL80211_TESTMODE
2093 2094 2095
static int ieee80211_testmode_cmd(struct wiphy *wiphy,
				  struct wireless_dev *wdev,
				  void *data, int len)
2096 2097
{
	struct ieee80211_local *local = wiphy_priv(wiphy);
2098
	struct ieee80211_vif *vif = NULL;
2099 2100 2101 2102

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

2103 2104 2105 2106 2107 2108 2109 2110 2111
	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);
2112
}
W
Wey-Yi Guy 已提交
2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125

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);
}
2126 2127
#endif

2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213
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;
	int i;

	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,
	       "SMSP %d requested in AP mode, sending Action frame to %d stations\n",
	       smps_mode, atomic_read(&sdata->u.ap.num_mcast_sta));

	mutex_lock(&sdata->local->sta_mtx);
	for (i = 0; i < STA_HASH_SIZE; i++) {
		for (sta = rcu_dereference_protected(sdata->local->sta_hash[i],
				lockdep_is_held(&sdata->local->sta_mtx));
		     sta;
		     sta = rcu_dereference_protected(sta->hnext,
				lockdep_is_held(&sdata->local->sta_mtx))) {
			/*
			 * Only stations associated to our AP and
			 * associated VLANs
			 */
			if (sta->sdata->bss != &sdata->u.ap)
				continue;

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

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

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

			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);
		}
	}
	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)
2214 2215 2216 2217 2218
{
	const u8 *ap;
	enum ieee80211_smps_mode old_req;
	int err;

2219
	lockdep_assert_held(&sdata->wdev.mtx);
2220

2221 2222 2223
	if (WARN_ON_ONCE(sdata->vif.type != NL80211_IFTYPE_STATION))
		return -EINVAL;

2224 2225 2226 2227 2228 2229 2230 2231 2232
	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
2233 2234
	 * association, there's no need to do anything, just store
	 * the new value until we associate.
2235 2236
	 */
	if (!sdata->u.mgd.associated ||
2237
	    sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_20_NOHT)
2238 2239
		return 0;

2240
	ap = sdata->u.mgd.associated->bssid;
2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257

	if (smps_mode == IEEE80211_SMPS_AUTOMATIC) {
		if (sdata->u.mgd.powersave)
			smps_mode = IEEE80211_SMPS_DYNAMIC;
		else
			smps_mode = IEEE80211_SMPS_OFF;
	}

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

	return err;
}

J
Johannes Berg 已提交
2258 2259 2260 2261 2262 2263
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);

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

J
Johannes Berg 已提交
2267 2268 2269 2270
	if (!(local->hw.flags & IEEE80211_HW_SUPPORTS_PS))
		return -EOPNOTSUPP;

	if (enabled == sdata->u.mgd.powersave &&
2271
	    timeout == local->dynamic_ps_forced_timeout)
J
Johannes Berg 已提交
2272 2273 2274
		return 0;

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

2277
	/* no change, but if automatic follow powersave */
2278
	sdata_lock(sdata);
2279
	__ieee80211_request_smps_mgd(sdata, sdata->u.mgd.req_smps);
2280
	sdata_unlock(sdata);
2281

J
Johannes Berg 已提交
2282 2283 2284 2285
	if (local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_PS)
		ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);

	ieee80211_recalc_ps(local, -1);
E
Eliad Peller 已提交
2286
	ieee80211_recalc_ps_vif(sdata);
J
Johannes Berg 已提交
2287 2288 2289 2290

	return 0;
}

2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306
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;

	bss_conf->cqm_rssi_thold = rssi_thold;
	bss_conf->cqm_rssi_hyst = rssi_hyst;

	/* tell the driver upon association, unless already associated */
2307 2308
	if (sdata->u.mgd.associated &&
	    sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)
2309 2310 2311 2312 2313
		ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_CQM);

	return 0;
}

J
Johannes Berg 已提交
2314 2315 2316 2317 2318 2319 2320
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);
2321
	int i, ret;
2322

2323 2324 2325
	if (!ieee80211_sdata_running(sdata))
		return -ENETDOWN;

2326 2327 2328 2329 2330
	if (local->hw.flags & IEEE80211_HW_HAS_RATE_CONTROL) {
		ret = drv_set_bitrate_mask(local, sdata, mask);
		if (ret)
			return ret;
	}
J
Johannes Berg 已提交
2331

2332
	for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
2333 2334 2335
		struct ieee80211_supported_band *sband = wiphy->bands[i];
		int j;

2336
		sdata->rc_rateidx_mask[i] = mask->control[i].legacy;
2337 2338
		memcpy(sdata->rc_rateidx_mcs_mask[i], mask->control[i].ht_mcs,
		       sizeof(mask->control[i].ht_mcs));
2339 2340 2341 2342 2343 2344 2345 2346 2347 2348

		sdata->rc_has_mcs_mask[i] = false;
		if (!sband)
			continue;

		for (j = 0; j < IEEE80211_HT_MCS_MASK_LEN; j++)
			if (~sdata->rc_rateidx_mcs_mask[i][j]) {
				sdata->rc_has_mcs_mask[i] = true;
				break;
			}
2349
	}
J
Johannes Berg 已提交
2350

2351
	return 0;
J
Johannes Berg 已提交
2352 2353
}

2354 2355 2356 2357
static int ieee80211_start_roc_work(struct ieee80211_local *local,
				    struct ieee80211_sub_if_data *sdata,
				    struct ieee80211_channel *channel,
				    unsigned int duration, u64 *cookie,
2358 2359
				    struct sk_buff *txskb,
				    enum ieee80211_roc_type type)
2360 2361 2362
{
	struct ieee80211_roc_work *roc, *tmp;
	bool queued = false;
2363 2364 2365 2366
	int ret;

	lockdep_assert_held(&local->mtx);

2367 2368 2369
	if (local->use_chanctx && !local->ops->remain_on_channel)
		return -EOPNOTSUPP;

2370 2371 2372 2373
	roc = kzalloc(sizeof(*roc), GFP_KERNEL);
	if (!roc)
		return -ENOMEM;

2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385
	/*
	 * If the duration is zero, then the driver
	 * wouldn't actually do anything. Set it to
	 * 10 for now.
	 *
	 * TODO: cancel the off-channel operation
	 *       when we get the SKB's TX status and
	 *       the wait time was zero before.
	 */
	if (!duration)
		duration = 10;

2386 2387 2388 2389
	roc->chan = channel;
	roc->duration = duration;
	roc->req_duration = duration;
	roc->frame = txskb;
2390
	roc->type = type;
2391 2392 2393 2394 2395
	roc->mgmt_tx_cookie = (unsigned long)txskb;
	roc->sdata = sdata;
	INIT_DELAYED_WORK(&roc->work, ieee80211_sw_roc_work);
	INIT_LIST_HEAD(&roc->dependents);

2396 2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413
	/*
	 * cookie is either the roc cookie (for normal roc)
	 * or the SKB (for mgmt TX)
	 */
	if (!txskb) {
		/* local->mtx protects this */
		local->roc_cookie_counter++;
		roc->cookie = local->roc_cookie_counter;
		/* wow, you wrapped 64 bits ... more likely a bug */
		if (WARN_ON(roc->cookie == 0)) {
			roc->cookie = 1;
			local->roc_cookie_counter++;
		}
		*cookie = roc->cookie;
	} else {
		*cookie = (unsigned long)txskb;
	}

2414
	/* if there's one pending or we're scanning, queue this one */
2415 2416
	if (!list_empty(&local->roc_list) ||
	    local->scanning || local->radar_detect_enabled)
2417 2418 2419 2420 2421 2422 2423 2424 2425 2426
		goto out_check_combine;

	/* if not HW assist, just queue & schedule work */
	if (!local->ops->remain_on_channel) {
		ieee80211_queue_delayed_work(&local->hw, &roc->work, 0);
		goto out_queue;
	}

	/* otherwise actually kick it off here (for error handling) */

2427
	ret = drv_remain_on_channel(local, sdata, channel, duration, type);
2428
	if (ret) {
2429 2430
		kfree(roc);
		return ret;
2431 2432
	}

2433 2434 2435 2436 2437
	roc->started = true;
	goto out_queue;

 out_check_combine:
	list_for_each_entry(tmp, &local->roc_list, list) {
2438
		if (tmp->chan != channel || tmp->sdata != sdata)
2439 2440 2441 2442 2443 2444 2445
			continue;

		/*
		 * Extend this ROC if possible:
		 *
		 * If it hasn't started yet, just increase the duration
		 * and add the new one to the list of dependents.
2446 2447
		 * If the type of the new ROC has higher priority, modify the
		 * type of the previous one to match that of the new one.
2448 2449 2450 2451
		 */
		if (!tmp->started) {
			list_add_tail(&roc->list, &tmp->dependents);
			tmp->duration = max(tmp->duration, roc->duration);
2452
			tmp->type = max(tmp->type, roc->type);
2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463
			queued = true;
			break;
		}

		/* If it has already started, it's more difficult ... */
		if (local->ops->remain_on_channel) {
			unsigned long j = jiffies;

			/*
			 * In the offloaded ROC case, if it hasn't begun, add
			 * this new one to the dependent list to be handled
2464
			 * when the master one begins. If it has begun,
2465 2466
			 * check that there's still a minimum time left and
			 * if so, start this one, transmitting the frame, but
2467
			 * add it to the list directly after this one with
2468 2469 2470 2471 2472 2473
			 * a reduced time so we'll ask the driver to execute
			 * it right after finishing the previous one, in the
			 * hope that it'll also be executed right afterwards,
			 * effectively extending the old one.
			 * If there's no minimum time left, just add it to the
			 * normal list.
2474 2475
			 * TODO: the ROC type is ignored here, assuming that it
			 * is better to immediately use the current ROC.
2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536
			 */
			if (!tmp->hw_begun) {
				list_add_tail(&roc->list, &tmp->dependents);
				queued = true;
				break;
			}

			if (time_before(j + IEEE80211_ROC_MIN_LEFT,
					tmp->hw_start_time +
					msecs_to_jiffies(tmp->duration))) {
				int new_dur;

				ieee80211_handle_roc_started(roc);

				new_dur = roc->duration -
					  jiffies_to_msecs(tmp->hw_start_time +
							   msecs_to_jiffies(
								tmp->duration) -
							   j);

				if (new_dur > 0) {
					/* add right after tmp */
					list_add(&roc->list, &tmp->list);
				} else {
					list_add_tail(&roc->list,
						      &tmp->dependents);
				}
				queued = true;
			}
		} else if (del_timer_sync(&tmp->work.timer)) {
			unsigned long new_end;

			/*
			 * In the software ROC case, cancel the timer, if
			 * that fails then the finish work is already
			 * queued/pending and thus we queue the new ROC
			 * normally, if that succeeds then we can extend
			 * the timer duration and TX the frame (if any.)
			 */

			list_add_tail(&roc->list, &tmp->dependents);
			queued = true;

			new_end = jiffies + msecs_to_jiffies(roc->duration);

			/* ok, it was started & we canceled timer */
			if (time_after(new_end, tmp->work.timer.expires))
				mod_timer(&tmp->work.timer, new_end);
			else
				add_timer(&tmp->work.timer);

			ieee80211_handle_roc_started(roc);
		}
		break;
	}

 out_queue:
	if (!queued)
		list_add_tail(&roc->list, &local->roc_list);

	return 0;
2537 2538
}

2539
static int ieee80211_remain_on_channel(struct wiphy *wiphy,
2540
				       struct wireless_dev *wdev,
2541 2542 2543 2544
				       struct ieee80211_channel *chan,
				       unsigned int duration,
				       u64 *cookie)
{
2545
	struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
2546
	struct ieee80211_local *local = sdata->local;
2547
	int ret;
2548

2549
	mutex_lock(&local->mtx);
2550
	ret = ieee80211_start_roc_work(local, sdata, chan,
2551 2552
				       duration, cookie, NULL,
				       IEEE80211_ROC_TYPE_NORMAL);
2553
	mutex_unlock(&local->mtx);
2554

2555
	return ret;
2556 2557
}

2558 2559
static int ieee80211_cancel_roc(struct ieee80211_local *local,
				u64 cookie, bool mgmt_tx)
2560
{
2561
	struct ieee80211_roc_work *roc, *tmp, *found = NULL;
2562 2563
	int ret;

2564 2565
	mutex_lock(&local->mtx);
	list_for_each_entry_safe(roc, tmp, &local->roc_list, list) {
2566 2567 2568
		struct ieee80211_roc_work *dep, *tmp2;

		list_for_each_entry_safe(dep, tmp2, &roc->dependents, list) {
2569
			if (!mgmt_tx && dep->cookie != cookie)
2570 2571 2572 2573 2574 2575 2576
				continue;
			else if (mgmt_tx && dep->mgmt_tx_cookie != cookie)
				continue;
			/* found dependent item -- just remove it */
			list_del(&dep->list);
			mutex_unlock(&local->mtx);

2577
			ieee80211_roc_notify_destroy(dep, true);
2578 2579 2580
			return 0;
		}

2581
		if (!mgmt_tx && roc->cookie != cookie)
2582 2583 2584
			continue;
		else if (mgmt_tx && roc->mgmt_tx_cookie != cookie)
			continue;
2585

2586 2587 2588
		found = roc;
		break;
	}
2589

2590 2591 2592 2593
	if (!found) {
		mutex_unlock(&local->mtx);
		return -ENOENT;
	}
2594

2595 2596 2597 2598 2599 2600 2601
	/*
	 * We found the item to cancel, so do that. Note that it
	 * may have dependents, which we also cancel (and send
	 * the expired signal for.) Not doing so would be quite
	 * tricky here, but we may need to fix it later.
	 */

2602 2603 2604 2605 2606 2607 2608 2609
	if (local->ops->remain_on_channel) {
		if (found->started) {
			ret = drv_cancel_remain_on_channel(local);
			if (WARN_ON_ONCE(ret)) {
				mutex_unlock(&local->mtx);
				return ret;
			}
		}
2610

2611
		list_del(&found->list);
2612

2613 2614
		if (found->started)
			ieee80211_start_next_roc(local);
2615
		mutex_unlock(&local->mtx);
2616

2617
		ieee80211_roc_notify_destroy(found, true);
2618 2619 2620 2621
	} else {
		/* work may be pending so use it all the time */
		found->abort = true;
		ieee80211_queue_delayed_work(&local->hw, &found->work, 0);
2622 2623 2624

		mutex_unlock(&local->mtx);

2625 2626
		/* work will clean up etc */
		flush_delayed_work(&found->work);
2627 2628
		WARN_ON(!found->to_be_freed);
		kfree(found);
2629
	}
2630

2631
	return 0;
2632 2633
}

2634
static int ieee80211_cancel_remain_on_channel(struct wiphy *wiphy,
2635
					      struct wireless_dev *wdev,
2636
					      u64 cookie)
2637
{
2638
	struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
2639
	struct ieee80211_local *local = sdata->local;
2640

2641
	return ieee80211_cancel_roc(local, cookie, false);
2642 2643
}

2644 2645
static int ieee80211_start_radar_detection(struct wiphy *wiphy,
					   struct net_device *dev,
2646 2647
					   struct cfg80211_chan_def *chandef,
					   u32 cac_time_ms)
2648 2649 2650 2651 2652
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_local *local = sdata->local;
	int err;

2653 2654 2655 2656 2657
	mutex_lock(&local->mtx);
	if (!list_empty(&local->roc_list) || local->scanning) {
		err = -EBUSY;
		goto out_unlock;
	}
2658 2659 2660 2661 2662 2663 2664 2665

	/* 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)
2666
		goto out_unlock;
2667 2668

	ieee80211_queue_delayed_work(&sdata->local->hw,
2669 2670
				     &sdata->dfs_cac_timer_work,
				     msecs_to_jiffies(cac_time_ms));
2671

2672 2673 2674
 out_unlock:
	mutex_unlock(&local->mtx);
	return err;
2675 2676
}

2677 2678 2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 2694 2695 2696 2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710 2711 2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732
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;
}

2733
void ieee80211_csa_finish(struct ieee80211_vif *vif)
2734
{
2735
	struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
2736

2737 2738 2739 2740
	ieee80211_queue_work(&sdata->local->hw,
			     &sdata->csa_finalize_work);
}
EXPORT_SYMBOL(ieee80211_csa_finish);
2741

2742 2743
static int ieee80211_set_after_csa_beacon(struct ieee80211_sub_if_data *sdata,
					  u32 *changed)
2744
{
2745
	int err;
2746

2747 2748
	switch (sdata->vif.type) {
	case NL80211_IFTYPE_AP:
2749 2750
		err = ieee80211_assign_beacon(sdata, sdata->u.ap.next_beacon,
					      NULL);
2751 2752 2753
		kfree(sdata->u.ap.next_beacon);
		sdata->u.ap.next_beacon = NULL;

2754
		if (err < 0)
2755 2756
			return err;
		*changed |= err;
2757 2758
		break;
	case NL80211_IFTYPE_ADHOC:
2759 2760
		err = ieee80211_ibss_finish_csa(sdata);
		if (err < 0)
2761 2762
			return err;
		*changed |= err;
2763
		break;
2764 2765 2766 2767
#ifdef CONFIG_MAC80211_MESH
	case NL80211_IFTYPE_MESH_POINT:
		err = ieee80211_mesh_finish_csa(sdata);
		if (err < 0)
2768 2769
			return err;
		*changed |= err;
2770 2771
		break;
#endif
2772 2773
	default:
		WARN_ON(1);
2774 2775 2776 2777 2778 2779
		return -EINVAL;
	}

	return 0;
}

2780
static int __ieee80211_csa_finalize(struct ieee80211_sub_if_data *sdata)
2781 2782 2783 2784 2785 2786 2787
{
	struct ieee80211_local *local = sdata->local;
	u32 changed = 0;
	int err;

	sdata_assert_lock(sdata);
	lockdep_assert_held(&local->mtx);
2788
	lockdep_assert_held(&local->chanctx_mtx);
2789

2790 2791 2792 2793 2794 2795
	/*
	 * 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
	 */
2796

2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810
	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;

		err = ieee80211_vif_use_reserved_context(sdata);
		if (err)
			return err;

		return 0;
2811
	}
2812

2813 2814 2815 2816
	if (!cfg80211_chandef_identical(&sdata->vif.bss_conf.chandef,
					&sdata->csa_chandef))
		return -EINVAL;

2817 2818 2819 2820
	sdata->vif.csa_active = false;

	err = ieee80211_set_after_csa_beacon(sdata, &changed);
	if (err)
2821
		return err;
2822

2823
	ieee80211_bss_info_change_notify(sdata, changed);
2824 2825
	cfg80211_ch_switch_notify(sdata->dev, &sdata->csa_chandef);

2826 2827 2828 2829 2830
	if (sdata->csa_block_tx) {
		ieee80211_wake_vif_queues(local, sdata,
					  IEEE80211_QUEUE_STOP_REASON_CSA);
		sdata->csa_block_tx = false;
	}
2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841

	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);
	}
2842 2843 2844 2845 2846 2847 2848
}

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);
2849
	struct ieee80211_local *local = sdata->local;
2850 2851

	sdata_lock(sdata);
2852
	mutex_lock(&local->mtx);
2853
	mutex_lock(&local->chanctx_mtx);
2854

2855 2856 2857 2858 2859 2860 2861 2862
	/* 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);
2863 2864

unlock:
2865
	mutex_unlock(&local->chanctx_mtx);
2866
	mutex_unlock(&local->mtx);
2867
	sdata_unlock(sdata);
2868 2869
}

2870 2871 2872
static int ieee80211_set_csa_beacon(struct ieee80211_sub_if_data *sdata,
				    struct cfg80211_csa_settings *params,
				    u32 *changed)
2873
{
2874
	struct ieee80211_csa_settings csa = {};
2875
	int err;
2876 2877 2878

	switch (sdata->vif.type) {
	case NL80211_IFTYPE_AP:
2879 2880 2881 2882 2883
		sdata->u.ap.next_beacon =
			cfg80211_beacon_dup(&params->beacon_after);
		if (!sdata->u.ap.next_beacon)
			return -ENOMEM;

2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902
		/*
		 * 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;

2903 2904 2905 2906 2907
		if ((params->n_counter_offsets_beacon >
		     IEEE80211_MAX_CSA_COUNTERS_NUM) ||
		    (params->n_counter_offsets_presp >
		     IEEE80211_MAX_CSA_COUNTERS_NUM))
			return -EINVAL;
2908

2909 2910 2911 2912 2913
		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;
2914

2915
		err = ieee80211_assign_beacon(sdata, &params->beacon_csa, &csa);
2916 2917 2918 2919
		if (err < 0) {
			kfree(sdata->u.ap.next_beacon);
			return err;
		}
2920
		*changed |= err;
2921

2922 2923 2924 2925 2926 2927 2928 2929 2930 2931 2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943 2944 2945 2946 2947 2948
		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;

2949 2950 2951 2952 2953
		/* see comments in the NL80211_IFTYPE_AP block */
		if (params->count > 1) {
			err = ieee80211_ibss_csa_beacon(sdata, params);
			if (err < 0)
				return err;
2954
			*changed |= err;
2955 2956 2957 2958
		}

		ieee80211_send_action_csa(sdata, params);

2959
		break;
2960
#ifdef CONFIG_MAC80211_MESH
2961 2962
	case NL80211_IFTYPE_MESH_POINT: {
		struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh;
2963 2964 2965 2966 2967 2968 2969 2970 2971

		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;

2972
		if (ifmsh->csa_role == IEEE80211_MESH_CSA_ROLE_NONE) {
2973
			ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_INIT;
2974 2975 2976 2977 2978
			if (!ifmsh->pre_value)
				ifmsh->pre_value = 1;
			else
				ifmsh->pre_value++;
		}
2979

2980 2981 2982 2983 2984 2985 2986
		/* 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;
			}
2987
			*changed |= err;
2988
		}
2989 2990 2991 2992

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

2993
		break;
2994
		}
2995
#endif
2996 2997 2998 2999
	default:
		return -EOPNOTSUPP;
	}

3000 3001 3002
	return 0;
}

3003 3004 3005
static int
__ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev,
			   struct cfg80211_csa_settings *params)
3006 3007 3008
{
	struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
	struct ieee80211_local *local = sdata->local;
3009
	struct ieee80211_chanctx_conf *conf;
3010
	struct ieee80211_chanctx *chanctx;
3011
	int err, changed = 0;
3012 3013

	sdata_assert_lock(sdata);
3014
	lockdep_assert_held(&local->mtx);
3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025

	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;

3026 3027 3028 3029
	/* don't allow another channel switch if one is already active. */
	if (sdata->vif.csa_active)
		return -EBUSY;

3030 3031 3032 3033
	mutex_lock(&local->chanctx_mtx);
	conf = rcu_dereference_protected(sdata->vif.chanctx_conf,
					 lockdep_is_held(&local->chanctx_mtx));
	if (!conf) {
3034 3035
		err = -EBUSY;
		goto out;
3036 3037
	}

3038
	chanctx = container_of(conf, struct ieee80211_chanctx, conf);
3039 3040 3041
	if (!chanctx) {
		err = -EBUSY;
		goto out;
3042 3043
	}

3044 3045 3046 3047 3048
	err = ieee80211_vif_reserve_chanctx(sdata, &params->chandef,
					    chanctx->mode,
					    params->radar_required);
	if (err)
		goto out;
3049

3050 3051 3052 3053 3054 3055
	/* 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;
	}
3056 3057

	err = ieee80211_set_csa_beacon(sdata, params, &changed);
3058 3059 3060 3061
	if (err) {
		ieee80211_vif_unreserve_chanctx(sdata);
		goto out;
	}
3062

3063
	sdata->csa_chandef = params->chandef;
3064
	sdata->csa_block_tx = params->block_tx;
3065 3066
	sdata->vif.csa_active = true;

3067
	if (sdata->csa_block_tx)
3068 3069
		ieee80211_stop_vif_queues(local, sdata,
					  IEEE80211_QUEUE_STOP_REASON_CSA);
3070

3071 3072 3073 3074 3075 3076 3077
	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);
	}
3078

3079 3080 3081
out:
	mutex_unlock(&local->chanctx_mtx);
	return err;
3082 3083
}

3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097
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;
}

3098
static int ieee80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev,
3099 3100
			     struct cfg80211_mgmt_tx_params *params,
			     u64 *cookie)
3101
{
3102
	struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
3103 3104 3105
	struct ieee80211_local *local = sdata->local;
	struct sk_buff *skb;
	struct sta_info *sta;
3106
	const struct ieee80211_mgmt *mgmt = (void *)params->buf;
3107
	bool need_offchan = false;
3108
	u32 flags;
3109
	int ret;
3110
	u8 *data;
3111

3112
	if (params->dont_wait_for_ack)
3113 3114 3115 3116 3117
		flags = IEEE80211_TX_CTL_NO_ACK;
	else
		flags = IEEE80211_TX_INTFL_NL80211_FRAME_TX |
			IEEE80211_TX_CTL_REQ_TX_STATUS;

3118
	if (params->no_cck)
3119 3120
		flags |= IEEE80211_TX_CTL_NO_CCK_RATE;

3121 3122
	switch (sdata->vif.type) {
	case NL80211_IFTYPE_ADHOC:
3123 3124 3125 3126 3127 3128 3129 3130 3131 3132
		if (!sdata->vif.bss_conf.ibss_joined)
			need_offchan = true;
		/* fall through */
#ifdef CONFIG_MAC80211_MESH
	case NL80211_IFTYPE_MESH_POINT:
		if (ieee80211_vif_is_mesh(&sdata->vif) &&
		    !sdata->u.mesh.mesh_id_len)
			need_offchan = true;
		/* fall through */
#endif
3133 3134 3135
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
	case NL80211_IFTYPE_P2P_GO:
3136 3137 3138 3139
		if (sdata->vif.type != NL80211_IFTYPE_ADHOC &&
		    !ieee80211_vif_is_mesh(&sdata->vif) &&
		    !rcu_access_pointer(sdata->bss->beacon))
			need_offchan = true;
3140
		if (!ieee80211_is_action(mgmt->frame_control) ||
3141
		    mgmt->u.action.category == WLAN_CATEGORY_PUBLIC ||
3142 3143
		    mgmt->u.action.category == WLAN_CATEGORY_SELF_PROTECTED ||
		    mgmt->u.action.category == WLAN_CATEGORY_SPECTRUM_MGMT)
3144 3145 3146 3147 3148 3149 3150 3151
			break;
		rcu_read_lock();
		sta = sta_info_get(sdata, mgmt->da);
		rcu_read_unlock();
		if (!sta)
			return -ENOLINK;
		break;
	case NL80211_IFTYPE_STATION:
3152
	case NL80211_IFTYPE_P2P_CLIENT:
3153 3154
		if (!sdata->u.mgd.associated)
			need_offchan = true;
3155
		break;
3156 3157 3158
	case NL80211_IFTYPE_P2P_DEVICE:
		need_offchan = true;
		break;
3159 3160 3161 3162
	default:
		return -EOPNOTSUPP;
	}

3163 3164 3165
	/* configurations requiring offchan cannot work if no channel has been
	 * specified
	 */
3166
	if (need_offchan && !params->chan)
3167 3168
		return -EINVAL;

3169 3170 3171 3172
	mutex_lock(&local->mtx);

	/* Check if the operating channel is the requested channel */
	if (!need_offchan) {
J
Johannes Berg 已提交
3173 3174 3175 3176 3177
		struct ieee80211_chanctx_conf *chanctx_conf;

		rcu_read_lock();
		chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);

3178
		if (chanctx_conf) {
3179 3180 3181 3182
			need_offchan = params->chan &&
				       (params->chan !=
					chanctx_conf->def.chan);
		} else if (!params->chan) {
3183 3184 3185 3186
			ret = -EINVAL;
			rcu_read_unlock();
			goto out_unlock;
		} else {
3187
			need_offchan = true;
3188
		}
J
Johannes Berg 已提交
3189
		rcu_read_unlock();
3190 3191
	}

3192
	if (need_offchan && !params->offchan) {
3193 3194 3195 3196
		ret = -EBUSY;
		goto out_unlock;
	}

3197
	skb = dev_alloc_skb(local->hw.extra_tx_headroom + params->len);
3198 3199 3200 3201
	if (!skb) {
		ret = -ENOMEM;
		goto out_unlock;
	}
3202 3203
	skb_reserve(skb, local->hw.extra_tx_headroom);

3204 3205 3206 3207 3208 3209 3210 3211 3212
	data = skb_put(skb, params->len);
	memcpy(data, params->buf, params->len);

	/* Update CSA counters */
	if (sdata->vif.csa_active &&
	    (sdata->vif.type == NL80211_IFTYPE_AP ||
	     sdata->vif.type == NL80211_IFTYPE_ADHOC) &&
	    params->n_csa_offsets) {
		int i;
3213
		struct beacon_data *beacon = NULL;
3214

3215 3216 3217 3218 3219 3220 3221 3222 3223 3224 3225 3226 3227 3228 3229
		rcu_read_lock();

		if (sdata->vif.type == NL80211_IFTYPE_AP)
			beacon = rcu_dereference(sdata->u.ap.beacon);
		else if (sdata->vif.type == NL80211_IFTYPE_ADHOC)
			beacon = rcu_dereference(sdata->u.ibss.presp);
		else if (ieee80211_vif_is_mesh(&sdata->vif))
			beacon = rcu_dereference(sdata->u.mesh.beacon);

		if (beacon)
			for (i = 0; i < params->n_csa_offsets; i++)
				data[params->csa_offsets[i]] =
					beacon->csa_current_counter;

		rcu_read_unlock();
3230
	}
3231 3232 3233 3234 3235

	IEEE80211_SKB_CB(skb)->flags = flags;

	skb->dev = sdata->dev;

3236
	if (!need_offchan) {
3237
		*cookie = (unsigned long) skb;
3238
		ieee80211_tx_skb(sdata, skb);
3239 3240
		ret = 0;
		goto out_unlock;
3241 3242
	}

3243 3244
	IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_TX_OFFCHAN |
					IEEE80211_TX_INTFL_OFFCHAN_TX_OK;
3245 3246 3247
	if (local->hw.flags & IEEE80211_HW_QUEUE_CONTROL)
		IEEE80211_SKB_CB(skb)->hw_queue =
			local->hw.offchannel_tx_hw_queue;
3248

3249
	/* This will handle all kinds of coalescing and immediate TX */
3250 3251
	ret = ieee80211_start_roc_work(local, sdata, params->chan,
				       params->wait, cookie, skb,
3252
				       IEEE80211_ROC_TYPE_MGMT_TX);
3253 3254 3255 3256 3257
	if (ret)
		kfree_skb(skb);
 out_unlock:
	mutex_unlock(&local->mtx);
	return ret;
3258 3259
}

3260
static int ieee80211_mgmt_tx_cancel_wait(struct wiphy *wiphy,
3261
					 struct wireless_dev *wdev,
3262 3263
					 u64 cookie)
{
3264
	struct ieee80211_local *local = wiphy_priv(wiphy);
3265

3266
	return ieee80211_cancel_roc(local, cookie, true);
3267 3268
}

3269
static void ieee80211_mgmt_frame_register(struct wiphy *wiphy,
3270
					  struct wireless_dev *wdev,
3271 3272 3273 3274
					  u16 frame_type, bool reg)
{
	struct ieee80211_local *local = wiphy_priv(wiphy);

3275 3276 3277 3278 3279 3280
	switch (frame_type) {
	case IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_PROBE_REQ:
		if (reg)
			local->probe_req_reg++;
		else
			local->probe_req_reg--;
3281

3282 3283 3284
		if (!local->open_count)
			break;

3285 3286 3287 3288 3289
		ieee80211_queue_work(&local->hw, &local->reconfig_filter);
		break;
	default:
		break;
	}
3290 3291
}

3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308
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);
}

3309 3310 3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323
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 已提交
3324 3325 3326 3327 3328 3329 3330 3331 3332 3333 3334 3335
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;
	struct sk_buff *skb;
	int size = sizeof(*nullfunc);
	__le16 fc;
	bool qos;
	struct ieee80211_tx_info *info;
	struct sta_info *sta;
J
Johannes Berg 已提交
3336 3337
	struct ieee80211_chanctx_conf *chanctx_conf;
	enum ieee80211_band band;
J
Johannes Berg 已提交
3338 3339

	rcu_read_lock();
J
Johannes Berg 已提交
3340 3341 3342 3343 3344
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	if (WARN_ON(!chanctx_conf)) {
		rcu_read_unlock();
		return -EINVAL;
	}
3345
	band = chanctx_conf->def.chan->band;
3346
	sta = sta_info_get_bss(sdata, peer);
3347
	if (sta) {
3348
		qos = sta->sta.wme;
3349 3350
	} else {
		rcu_read_unlock();
J
Johannes Berg 已提交
3351
		return -ENOLINK;
3352
	}
J
Johannes Berg 已提交
3353 3354 3355 3356 3357 3358 3359 3360 3361 3362 3363 3364 3365

	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 已提交
3366 3367
	if (!skb) {
		rcu_read_unlock();
J
Johannes Berg 已提交
3368
		return -ENOMEM;
J
Johannes Berg 已提交
3369
	}
J
Johannes Berg 已提交
3370 3371 3372 3373 3374 3375 3376 3377 3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391 3392 3393

	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;

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

	local_bh_disable();
J
Johannes Berg 已提交
3394
	ieee80211_xmit(sdata, skb, band);
J
Johannes Berg 已提交
3395
	local_bh_enable();
J
Johannes Berg 已提交
3396
	rcu_read_unlock();
J
Johannes Berg 已提交
3397 3398 3399 3400 3401

	*cookie = (unsigned long) skb;
	return 0;
}

3402 3403 3404
static int ieee80211_cfg_get_channel(struct wiphy *wiphy,
				     struct wireless_dev *wdev,
				     struct cfg80211_chan_def *chandef)
3405
{
J
Johannes Berg 已提交
3406
	struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
3407
	struct ieee80211_local *local = wiphy_priv(wiphy);
J
Johannes Berg 已提交
3408
	struct ieee80211_chanctx_conf *chanctx_conf;
3409
	int ret = -ENODATA;
J
Johannes Berg 已提交
3410 3411

	rcu_read_lock();
3412 3413 3414 3415 3416 3417 3418 3419 3420 3421
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	if (chanctx_conf) {
		*chandef = chanctx_conf->def;
		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
3422
			*chandef = local->_oper_chandef;
3423
		ret = 0;
J
Johannes Berg 已提交
3424 3425
	}
	rcu_read_unlock();
3426

3427
	return ret;
3428 3429
}

3430 3431 3432 3433 3434 3435 3436
#ifdef CONFIG_PM
static void ieee80211_set_wakeup(struct wiphy *wiphy, bool enabled)
{
	drv_set_wakeup(wiphy_priv(wiphy), enabled);
}
#endif

3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448 3449 3450 3451 3452 3453
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;
	}

3454
	old_qos_map = sdata_dereference(sdata->qos_map, sdata);
3455 3456 3457 3458 3459 3460 3461
	rcu_assign_pointer(sdata->qos_map, new_qos_map);
	if (old_qos_map)
		kfree_rcu(old_qos_map, rcu_head);

	return 0;
}

3462 3463 3464 3465 3466 3467 3468 3469 3470 3471 3472 3473 3474 3475 3476
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;
}

3477
const struct cfg80211_ops mac80211_config_ops = {
3478 3479
	.add_virtual_intf = ieee80211_add_iface,
	.del_virtual_intf = ieee80211_del_iface,
3480
	.change_virtual_intf = ieee80211_change_iface,
3481 3482
	.start_p2p_device = ieee80211_start_p2p_device,
	.stop_p2p_device = ieee80211_stop_p2p_device,
3483 3484
	.add_key = ieee80211_add_key,
	.del_key = ieee80211_del_key,
3485
	.get_key = ieee80211_get_key,
3486
	.set_default_key = ieee80211_config_default_key,
3487
	.set_default_mgmt_key = ieee80211_config_default_mgmt_key,
3488 3489 3490
	.start_ap = ieee80211_start_ap,
	.change_beacon = ieee80211_change_beacon,
	.stop_ap = ieee80211_stop_ap,
3491 3492 3493
	.add_station = ieee80211_add_station,
	.del_station = ieee80211_del_station,
	.change_station = ieee80211_change_station,
3494
	.get_station = ieee80211_get_station,
3495
	.dump_station = ieee80211_dump_station,
3496
	.dump_survey = ieee80211_dump_survey,
3497 3498 3499 3500 3501 3502
#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,
3503 3504
	.update_mesh_config = ieee80211_update_mesh_config,
	.get_mesh_config = ieee80211_get_mesh_config,
3505 3506
	.join_mesh = ieee80211_join_mesh,
	.leave_mesh = ieee80211_leave_mesh,
3507
#endif
3508
	.change_bss = ieee80211_change_bss,
3509
	.set_txq_params = ieee80211_set_txq_params,
3510
	.set_monitor_channel = ieee80211_set_monitor_channel,
3511 3512
	.suspend = ieee80211_suspend,
	.resume = ieee80211_resume,
3513
	.scan = ieee80211_scan,
3514 3515
	.sched_scan_start = ieee80211_sched_scan_start,
	.sched_scan_stop = ieee80211_sched_scan_stop,
3516 3517 3518 3519
	.auth = ieee80211_auth,
	.assoc = ieee80211_assoc,
	.deauth = ieee80211_deauth,
	.disassoc = ieee80211_disassoc,
3520 3521
	.join_ibss = ieee80211_join_ibss,
	.leave_ibss = ieee80211_leave_ibss,
3522
	.set_mcast_rate = ieee80211_set_mcast_rate,
3523
	.set_wiphy_params = ieee80211_set_wiphy_params,
3524 3525
	.set_tx_power = ieee80211_set_tx_power,
	.get_tx_power = ieee80211_get_tx_power,
J
Johannes Berg 已提交
3526
	.set_wds_peer = ieee80211_set_wds_peer,
J
Johannes Berg 已提交
3527
	.rfkill_poll = ieee80211_rfkill_poll,
3528
	CFG80211_TESTMODE_CMD(ieee80211_testmode_cmd)
W
Wey-Yi Guy 已提交
3529
	CFG80211_TESTMODE_DUMP(ieee80211_testmode_dump)
J
Johannes Berg 已提交
3530
	.set_power_mgmt = ieee80211_set_power_mgmt,
J
Johannes Berg 已提交
3531
	.set_bitrate_mask = ieee80211_set_bitrate_mask,
3532 3533
	.remain_on_channel = ieee80211_remain_on_channel,
	.cancel_remain_on_channel = ieee80211_cancel_remain_on_channel,
3534
	.mgmt_tx = ieee80211_mgmt_tx,
3535
	.mgmt_tx_cancel_wait = ieee80211_mgmt_tx_cancel_wait,
3536
	.set_cqm_rssi_config = ieee80211_set_cqm_rssi_config,
3537
	.mgmt_frame_register = ieee80211_mgmt_frame_register,
3538 3539
	.set_antenna = ieee80211_set_antenna,
	.get_antenna = ieee80211_get_antenna,
3540
	.set_rekey_data = ieee80211_set_rekey_data,
3541 3542
	.tdls_oper = ieee80211_tdls_oper,
	.tdls_mgmt = ieee80211_tdls_mgmt,
J
Johannes Berg 已提交
3543
	.probe_client = ieee80211_probe_client,
3544
	.set_noack_map = ieee80211_set_noack_map,
3545 3546 3547
#ifdef CONFIG_PM
	.set_wakeup = ieee80211_set_wakeup,
#endif
3548
	.get_channel = ieee80211_cfg_get_channel,
3549
	.start_radar_detection = ieee80211_start_radar_detection,
3550
	.channel_switch = ieee80211_channel_switch,
3551
	.set_qos_map = ieee80211_set_qos_map,
3552
	.set_ap_chanwidth = ieee80211_set_ap_chanwidth,
3553
};