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
 * Copyright 2013-2014  Intel Mobile Communications GmbH
6 7 8 9
 *
 * This file is GPLv2 as found in COPYING.
 */

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

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

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

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

44
	return wdev;
45 46
}

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

51
	return 0;
52 53
}

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

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

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

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

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

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

107 108 109
	return 0;
}

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

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

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

	sdata->noack_map = noack_map;
	return 0;
}

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

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

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

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

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

181
	mutex_lock(&local->sta_mtx);
182

183
	if (mac_addr) {
184 185 186 187
		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 已提交
188 189 190 191 192 193 194 195 196 197 198
		/*
		 * 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)) {
199
			ieee80211_key_free_unused(key);
200 201
			err = -ENOENT;
			goto out_unlock;
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 236
	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;
	}

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

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

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

	return err;
246 247 248
}

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

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

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

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

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

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

279
	ieee80211_key_free(key, true);
280

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

	return ret;
287 288
}

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

305 306
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

307 308
	rcu_read_lock();

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

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

	if (!key)
		goto out;

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

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

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

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

		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;
348
	case WLAN_CIPHER_SUITE_CCMP:
J
Johannes Berg 已提交
349 350 351 352 353 354 355
		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;
356 357 358
		params.seq = seq;
		params.seq_len = 6;
		break;
359
	case WLAN_CIPHER_SUITE_AES_CMAC:
J
Johannes Berg 已提交
360 361 362 363 364 365 366
		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;
367 368 369
		params.seq = seq;
		params.seq_len = 6;
		break;
370 371 372 373 374 375 376 377 378
	}

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

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

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

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

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

	return 0;
}

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

	ieee80211_set_default_mgmt_key(sdata, key_idx);

	return 0;
}

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

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

438 439 440 441 442 443 444 445 446 447 448 449 450
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;
451 452
		int shift = ieee80211_vif_get_shift(&sta->sdata->vif);
		u16 brate;
453 454 455

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

	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;
464
	if (sta->last_rx_rate_vht_flag & RX_VHT_FLAG_80MHZ)
465
		rinfo->flags |= RATE_INFO_FLAGS_80_MHZ_WIDTH;
466
	if (sta->last_rx_rate_vht_flag & RX_VHT_FLAG_80P80MHZ)
467
		rinfo->flags |= RATE_INFO_FLAGS_80P80_MHZ_WIDTH;
468
	if (sta->last_rx_rate_vht_flag & RX_VHT_FLAG_160MHZ)
469 470 471
		rinfo->flags |= RATE_INFO_FLAGS_160_MHZ_WIDTH;
}

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

480
	mutex_lock(&local->sta_mtx);
481

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

489
	mutex_unlock(&local->sta_mtx);
490

491
	return ret;
492 493
}

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

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

510
	mutex_lock(&local->sta_mtx);
511

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

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

	return ret;
521 522
}

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

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

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

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

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

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

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

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

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

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

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

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

	return 0;
}

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

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

598 599 600

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

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

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

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

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

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

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

665
	return changed;
666 667
}

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

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

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

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

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

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

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

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

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

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

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

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

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

764
	return 0;
765 766
}

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

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

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

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

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

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

803 804
	sdata_assert_lock(sdata);

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

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

819 820
	mutex_unlock(&local->mtx);

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

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

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

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

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

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

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

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

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

864
	return 0;
865 866
}

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

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

905 906
	skb->dev = sta->sdata->dev;
	skb->protocol = eth_type_trans(skb, sta->sdata->dev);
907
	memset(skb->cb, 0, sizeof(skb->cb));
908
	netif_rx_ni(skb);
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 962
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;
}

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

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

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

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

1001 1002 1003 1004 1005 1006
	/* 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;
	}
1007

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

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

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

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

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

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

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

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

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

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

1070 1071 1072 1073 1074 1075 1076 1077 1078
	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);
	}

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

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

				ieee80211_mps_sta_status_update(sta);
1092 1093
				changed |= ieee80211_mps_set_sta_local_pm(sta,
					      sdata->u.mesh.mshcfg.power_mode);
1094 1095
				break;
			case NL80211_PLINK_LISTEN:
1096
			case NL80211_PLINK_BLOCKED:
1097 1098 1099 1100 1101 1102 1103
			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);
1104
				sta->plink_state = params->plink_state;
M
Marco Porsch 已提交
1105 1106

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

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

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

1136 1137 1138 1139 1140 1141 1142
	/* 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;
	}

1143
	return 0;
1144 1145 1146
}

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

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

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

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

	if (is_multicast_ether_addr(mac))
		return -EINVAL;

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

1175 1176 1177 1178
	/*
	 * defaults -- if userspace wants something else we'll
	 * change it accordingly in sta_apply_parameters()
	 */
1179 1180 1181
	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);
1182 1183
	} else {
		sta->sta.tdls = true;
1184
	}
1185

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

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

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

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

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

	rcu_read_unlock();

1213 1214 1215 1216
	return 0;
}

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

1221 1222
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

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

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

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

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

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

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

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

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

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

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

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

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

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

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

1314 1315 1316
		ieee80211_send_layer2_update(sta);
	}

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

1321 1322 1323
	/* 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))
1324 1325
		rate_control_rate_init(sta);

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

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

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

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

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

1362 1363
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

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

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

	mesh_path_fix_nexthop(mpath, sta);
1378

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

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

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

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

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

1402 1403
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

1404 1405
	rcu_read_lock();

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

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

	mesh_path_fix_nexthop(mpath, sta);
1419

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

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

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

1436 1437
	pinfo->generation = mesh_paths_generation;

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

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

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

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

1473 1474
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

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

1494 1495
	sdata = IEEE80211_DEV_TO_SUB_IF(dev);

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

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

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

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

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

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

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

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

1568 1569 1570
	return 0;
}

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

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

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

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

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

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

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

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

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

	return 0;
}
1720 1721
#endif

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

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

	band = ieee80211_get_sdata_band(sdata);
1734 1735

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

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

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

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

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

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

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

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

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

	return 0;
}

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

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

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

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

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

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

1836 1837
	ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_QOS);

1838 1839 1840
	return 0;
}

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

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

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

	sdata = IEEE80211_WDEV_TO_SUB_IF(req->wdev);
1863

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

	return ieee80211_request_scan(sdata, req);
}

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

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

1920
	return ieee80211_request_sched_scan_stop(sdata);
1921 1922
}

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

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

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

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

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

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

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

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

	return 0;
}

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

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

		if (err)
			return err;
	}

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

		if (err)
			return err;
	}

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

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

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

	return 0;
}

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

2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037
	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 已提交
2038

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

2051 2052 2053 2054 2055 2056
	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);
2057 2058 2059 2060

	return 0;
}

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

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

	return 0;
}

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

	drv_rfkill_poll(local);
}

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

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

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

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

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

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

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

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

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

	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 已提交
2259 2260 2261 2262 2263 2264
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);

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

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

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

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

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

J
Johannes Berg 已提交
2283 2284 2285 2286
	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 已提交
2287
	ieee80211_recalc_ps_vif(sdata);
J
Johannes Berg 已提交
2288 2289 2290 2291

	return 0;
}

2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307
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 */
2308 2309
	if (sdata->u.mgd.associated &&
	    sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)
2310 2311 2312 2313 2314
		ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_CQM);

	return 0;
}

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

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

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

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

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

		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;
			}
2350
	}
J
Johannes Berg 已提交
2351

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

2355 2356 2357 2358
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,
2359 2360
				    struct sk_buff *txskb,
				    enum ieee80211_roc_type type)
2361 2362 2363
{
	struct ieee80211_roc_work *roc, *tmp;
	bool queued = false;
2364 2365 2366 2367
	int ret;

	lockdep_assert_held(&local->mtx);

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

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

2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386
	/*
	 * 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;

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

2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414
	/*
	 * 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;
	}

2415
	/* if there's one pending or we're scanning, queue this one */
2416 2417
	if (!list_empty(&local->roc_list) ||
	    local->scanning || local->radar_detect_enabled)
2418 2419 2420 2421 2422 2423 2424 2425 2426 2427
		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) */

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

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

 out_check_combine:
	list_for_each_entry(tmp, &local->roc_list, list) {
2439
		if (tmp->chan != channel || tmp->sdata != sdata)
2440 2441 2442 2443 2444 2445 2446
			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.
2447 2448
		 * If the type of the new ROC has higher priority, modify the
		 * type of the previous one to match that of the new one.
2449 2450 2451 2452
		 */
		if (!tmp->started) {
			list_add_tail(&roc->list, &tmp->dependents);
			tmp->duration = max(tmp->duration, roc->duration);
2453
			tmp->type = max(tmp->type, roc->type);
2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464
			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
2465
			 * when the master one begins. If it has begun,
2466 2467
			 * check that there's still a minimum time left and
			 * if so, start this one, transmitting the frame, but
2468
			 * add it to the list directly after this one with
2469 2470 2471 2472 2473 2474
			 * 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.
2475 2476
			 * TODO: the ROC type is ignored here, assuming that it
			 * is better to immediately use the current ROC.
2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498
			 */
			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 */
2499
					roc->duration = new_dur;
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 2537 2538
					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;
2539 2540
}

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

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

2557
	return ret;
2558 2559
}

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

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

		list_for_each_entry_safe(dep, tmp2, &roc->dependents, list) {
2571
			if (!mgmt_tx && dep->cookie != cookie)
2572 2573 2574 2575 2576 2577 2578
				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);

2579
			ieee80211_roc_notify_destroy(dep, true);
2580 2581 2582
			return 0;
		}

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

2588 2589 2590
		found = roc;
		break;
	}
2591

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

2597 2598 2599 2600 2601 2602 2603
	/*
	 * 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.
	 */

2604 2605 2606 2607 2608 2609 2610 2611
	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;
			}
		}
2612

2613
		list_del(&found->list);
2614

2615 2616
		if (found->started)
			ieee80211_start_next_roc(local);
2617
		mutex_unlock(&local->mtx);
2618

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

		mutex_unlock(&local->mtx);

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

2633
	return 0;
2634 2635
}

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

2643
	return ieee80211_cancel_roc(local, cookie, false);
2644 2645
}

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

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

	/* 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)
2668
		goto out_unlock;
2669 2670

	ieee80211_queue_delayed_work(&sdata->local->hw,
2671 2672
				     &sdata->dfs_cac_timer_work,
				     msecs_to_jiffies(cac_time_ms));
2673

2674 2675 2676
 out_unlock:
	mutex_unlock(&local->mtx);
	return err;
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 2733 2734
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;
}

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

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

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

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

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

	return 0;
}

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

	sdata_assert_lock(sdata);
	lockdep_assert_held(&local->mtx);
2790
	lockdep_assert_held(&local->chanctx_mtx);
2791

2792 2793 2794 2795 2796 2797
	/*
	 * 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
	 */
2798

2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810 2811 2812
	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;
2813
	}
2814

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

2819 2820 2821 2822
	sdata->vif.csa_active = false;

	err = ieee80211_set_after_csa_beacon(sdata, &changed);
	if (err)
2823
		return err;
2824

2825
	ieee80211_bss_info_change_notify(sdata, changed);
2826 2827
	cfg80211_ch_switch_notify(sdata->dev, &sdata->csa_chandef);

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

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

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

	sdata_lock(sdata);
2854
	mutex_lock(&local->mtx);
2855
	mutex_lock(&local->chanctx_mtx);
2856

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

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

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

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

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

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

2911 2912 2913 2914 2915
		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;
2916

2917
		err = ieee80211_assign_beacon(sdata, &params->beacon_csa, &csa);
2918 2919 2920 2921
		if (err < 0) {
			kfree(sdata->u.ap.next_beacon);
			return err;
		}
2922
		*changed |= err;
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 2949 2950
		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;

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

		ieee80211_send_action_csa(sdata, params);

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

		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;

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

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

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

2995
		break;
2996
		}
2997
#endif
2998 2999 3000 3001
	default:
		return -EOPNOTSUPP;
	}

3002 3003 3004
	return 0;
}

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

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

	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;

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

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

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

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

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

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

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

3069
	if (sdata->csa_block_tx)
3070 3071
		ieee80211_stop_vif_queues(local, sdata,
					  IEEE80211_QUEUE_STOP_REASON_CSA);
3072

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

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

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

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

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

3120
	if (params->no_cck)
3121 3122
		flags |= IEEE80211_TX_CTL_NO_CCK_RATE;

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

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

3171 3172 3173 3174
	mutex_lock(&local->mtx);

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

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

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

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

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

3206 3207 3208 3209 3210 3211 3212 3213 3214
	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;
3215
		struct beacon_data *beacon = NULL;
3216

3217 3218 3219 3220 3221 3222 3223 3224 3225 3226 3227 3228 3229 3230 3231
		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();
3232
	}
3233 3234 3235 3236 3237

	IEEE80211_SKB_CB(skb)->flags = flags;

	skb->dev = sdata->dev;

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

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

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

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

3268
	return ieee80211_cancel_roc(local, cookie, true);
3269 3270
}

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

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

3284 3285 3286
		if (!local->open_count)
			break;

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

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

3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324 3325
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 已提交
3326 3327 3328 3329 3330 3331 3332 3333 3334 3335 3336 3337
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 已提交
3338 3339
	struct ieee80211_chanctx_conf *chanctx_conf;
	enum ieee80211_band band;
J
Johannes Berg 已提交
3340 3341

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

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

	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 已提交
3396
	ieee80211_xmit(sdata, skb, band);
J
Johannes Berg 已提交
3397
	local_bh_enable();
J
Johannes Berg 已提交
3398
	rcu_read_unlock();
J
Johannes Berg 已提交
3399 3400 3401 3402 3403

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

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

	rcu_read_lock();
3414 3415 3416 3417 3418 3419 3420 3421 3422 3423
	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
3424
			*chandef = local->_oper_chandef;
3425
		ret = 0;
J
Johannes Berg 已提交
3426 3427
	}
	rcu_read_unlock();
3428

3429
	return ret;
3430 3431
}

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

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

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

	return 0;
}

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

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