nl80211.c 420.7 KB
Newer Older
1 2 3
/*
 * This is the new netlink-based wireless configuration interface.
 *
4
 * Copyright 2006-2010	Johannes Berg <johannes@sipsolutions.net>
5
 * Copyright 2013-2014  Intel Mobile Communications GmbH
6
 * Copyright 2015-2017	Intel Deutschland GmbH
7
 * Copyright (C) 2018 Intel Corporation
8 9 10 11 12
 */

#include <linux/if.h>
#include <linux/module.h>
#include <linux/err.h>
13
#include <linux/slab.h>
14 15 16 17 18 19
#include <linux/list.h>
#include <linux/if_ether.h>
#include <linux/ieee80211.h>
#include <linux/nl80211.h>
#include <linux/rtnetlink.h>
#include <linux/netlink.h>
20
#include <linux/nospec.h>
21
#include <linux/etherdevice.h>
22
#include <net/net_namespace.h>
23 24
#include <net/genetlink.h>
#include <net/cfg80211.h>
25
#include <net/sock.h>
26
#include <net/inet_connection_sock.h>
27 28
#include "core.h"
#include "nl80211.h"
29
#include "reg.h"
30
#include "rdev-ops.h"
31

32 33 34 35 36
static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
				   struct genl_info *info,
				   struct cfg80211_crypto_settings *settings,
				   int cipher_limit);

37
/* the netlink family */
38
static struct genl_family nl80211_fam;
39

40 41 42 43 44 45
/* multicast groups */
enum nl80211_multicast_groups {
	NL80211_MCGRP_CONFIG,
	NL80211_MCGRP_SCAN,
	NL80211_MCGRP_REGULATORY,
	NL80211_MCGRP_MLME,
46
	NL80211_MCGRP_VENDOR,
47
	NL80211_MCGRP_NAN,
48 49 50 51
	NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
};

static const struct genl_multicast_group nl80211_mcgrps[] = {
52 53 54 55 56
	[NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
	[NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
	[NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
	[NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
	[NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
57
	[NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
58
#ifdef CONFIG_NL80211_TESTMODE
59
	[NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
60 61 62
#endif
};

63 64 65
/* returns ERR_PTR values */
static struct wireless_dev *
__cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
66
{
67 68 69 70 71 72 73
	struct cfg80211_registered_device *rdev;
	struct wireless_dev *result = NULL;
	bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
	bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
	u64 wdev_id;
	int wiphy_idx = -1;
	int ifidx = -1;
74

75
	ASSERT_RTNL();
76

77 78
	if (!have_ifidx && !have_wdev_id)
		return ERR_PTR(-EINVAL);
79

80 81 82 83 84
	if (have_ifidx)
		ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
	if (have_wdev_id) {
		wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
		wiphy_idx = wdev_id >> 32;
85 86
	}

87 88 89 90 91 92 93 94 95
	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
		struct wireless_dev *wdev;

		if (wiphy_net(&rdev->wiphy) != netns)
			continue;

		if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
			continue;

96
		list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114
			if (have_ifidx && wdev->netdev &&
			    wdev->netdev->ifindex == ifidx) {
				result = wdev;
				break;
			}
			if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
				result = wdev;
				break;
			}
		}

		if (result)
			break;
	}

	if (result)
		return result;
	return ERR_PTR(-ENODEV);
115 116
}

117
static struct cfg80211_registered_device *
118
__cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
119
{
120 121
	struct cfg80211_registered_device *rdev = NULL, *tmp;
	struct net_device *netdev;
122

123
	ASSERT_RTNL();
124

125
	if (!attrs[NL80211_ATTR_WIPHY] &&
126 127
	    !attrs[NL80211_ATTR_IFINDEX] &&
	    !attrs[NL80211_ATTR_WDEV])
128 129
		return ERR_PTR(-EINVAL);

130
	if (attrs[NL80211_ATTR_WIPHY])
131
		rdev = cfg80211_rdev_by_wiphy_idx(
132
				nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
133

134 135 136 137 138 139 140 141
	if (attrs[NL80211_ATTR_WDEV]) {
		u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
		struct wireless_dev *wdev;
		bool found = false;

		tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
		if (tmp) {
			/* make sure wdev exists */
142
			list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
143 144 145 146 147 148 149 150 151 152 153 154 155 156 157
				if (wdev->identifier != (u32)wdev_id)
					continue;
				found = true;
				break;
			}

			if (!found)
				tmp = NULL;

			if (rdev && tmp != rdev)
				return ERR_PTR(-EINVAL);
			rdev = tmp;
		}
	}

158 159
	if (attrs[NL80211_ATTR_IFINDEX]) {
		int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
160

161
		netdev = __dev_get_by_index(netns, ifindex);
162 163
		if (netdev) {
			if (netdev->ieee80211_ptr)
164 165
				tmp = wiphy_to_rdev(
					netdev->ieee80211_ptr->wiphy);
166 167 168 169 170 171 172 173 174 175 176 177
			else
				tmp = NULL;

			/* not wireless device -- return error */
			if (!tmp)
				return ERR_PTR(-EINVAL);

			/* mismatch -- return error */
			if (rdev && tmp != rdev)
				return ERR_PTR(-EINVAL);

			rdev = tmp;
178 179 180
		}
	}

J
Johannes Berg 已提交
181 182
	if (!rdev)
		return ERR_PTR(-ENODEV);
183

J
Johannes Berg 已提交
184 185 186 187
	if (netns != wiphy_net(&rdev->wiphy))
		return ERR_PTR(-ENODEV);

	return rdev;
188 189 190 191 192 193 194 195 196 197
}

/*
 * This function returns a pointer to the driver
 * that the genl_info item that is passed refers to.
 *
 * The result of this can be a PTR_ERR and hence must
 * be checked with IS_ERR() for errors.
 */
static struct cfg80211_registered_device *
J
Johannes Berg 已提交
198
cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
199
{
200
	return __cfg80211_rdev_from_attrs(netns, info->attrs);
201 202
}

203
/* policy for the attributes */
204
static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
205 206
	[NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
	[NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
207
				      .len = 20-1 },
208
	[NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
209

210
	[NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
S
Sujith 已提交
211
	[NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
212 213 214 215
	[NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
	[NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
	[NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },

216 217 218 219
	[NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
	[NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
	[NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
	[NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
220
	[NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
221
	[NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
222 223 224 225

	[NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
	[NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
	[NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
226

E
Eliad Peller 已提交
227 228
	[NL80211_ATTR_MAC] = { .len = ETH_ALEN },
	[NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
229

230
	[NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
231 232 233 234 235
	[NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
				    .len = WLAN_MAX_KEY_LEN },
	[NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
	[NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
	[NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
236
	[NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
237
	[NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
238 239 240 241 242 243 244

	[NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
	[NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
	[NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
				       .len = IEEE80211_MAX_DATA_LEN },
	[NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
				       .len = IEEE80211_MAX_DATA_LEN },
245 246 247 248 249
	[NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
	[NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
	[NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
	[NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
					       .len = NL80211_MAX_SUPP_RATES },
250
	[NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
251
	[NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
J
Johannes Berg 已提交
252
	[NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
253
	[NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
254
				   .len = IEEE80211_MAX_MESH_ID_LEN },
255
	[NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
256

257 258 259
	[NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
	[NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },

260 261 262
	[NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
	[NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
	[NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
263 264
	[NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
					   .len = NL80211_MAX_SUPP_RATES },
265
	[NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
266

267
	[NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
268
	[NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
269

270
	[NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
271 272 273 274

	[NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
	[NL80211_ATTR_IE] = { .type = NLA_BINARY,
			      .len = IEEE80211_MAX_DATA_LEN },
275 276
	[NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
	[NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
277 278 279 280 281

	[NL80211_ATTR_SSID] = { .type = NLA_BINARY,
				.len = IEEE80211_MAX_SSID_LEN },
	[NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
	[NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
J
Johannes Berg 已提交
282
	[NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
283
	[NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
284
	[NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
285 286 287
	[NL80211_ATTR_STA_FLAGS2] = {
		.len = sizeof(struct nl80211_sta_flag_update),
	},
288
	[NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
289 290
	[NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
	[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
291
	[NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG },
S
Samuel Ortiz 已提交
292 293 294
	[NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
	[NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
	[NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
295
	[NL80211_ATTR_PID] = { .type = NLA_U32 },
296
	[NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
297
	[NL80211_ATTR_PMKID] = { .len = WLAN_PMKID_LEN },
298 299
	[NL80211_ATTR_DURATION] = { .type = NLA_U32 },
	[NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
300
	[NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
301 302 303
	[NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
				 .len = IEEE80211_MAX_DATA_LEN },
	[NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
K
Kalle Valo 已提交
304
	[NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
305
	[NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
306
	[NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
307
	[NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
308 309
	[NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
	[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
310
	[NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
311 312
	[NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
	[NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
313
	[NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
314
	[NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
315
	[NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
J
Johannes Berg 已提交
316
	[NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
317
	[NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
318
	[NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
319
	[NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
320
	[NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
321
	[NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
322 323 324 325
	[NL80211_ATTR_IE_PROBE_RESP] = { .type = NLA_BINARY,
					 .len = IEEE80211_MAX_DATA_LEN },
	[NL80211_ATTR_IE_ASSOC_RESP] = { .type = NLA_BINARY,
					 .len = IEEE80211_MAX_DATA_LEN },
326
	[NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
327
	[NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
328
	[NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
329 330 331 332 333
	[NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
	[NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
	[NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
	[NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
	[NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
334
	[NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
335
	[NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
336 337
	[NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
				      .len = IEEE80211_MAX_DATA_LEN },
338
	[NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
339 340 341 342
	[NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
	[NL80211_ATTR_HT_CAPABILITY_MASK] = {
		.len = NL80211_HT_CAPABILITY_LEN
	},
343
	[NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
344
	[NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
345
	[NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
346
	[NL80211_ATTR_WDEV] = { .type = NLA_U64 },
347
	[NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
348
	[NL80211_ATTR_AUTH_DATA] = { .type = NLA_BINARY, },
M
Mahesh Palivela 已提交
349
	[NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
350
	[NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
351 352
	[NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
	[NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
353
	[NL80211_ATTR_LOCAL_MESH_POWER_MODE] = {. type = NLA_U32 },
354 355
	[NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
	[NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
356 357
	[NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
	[NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
358
	[NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
359 360 361 362
	[NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
	[NL80211_ATTR_VHT_CAPABILITY_MASK] = {
		.len = NL80211_VHT_CAPABILITY_LEN,
	},
363 364 365
	[NL80211_ATTR_MDID] = { .type = NLA_U16 },
	[NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
				  .len = IEEE80211_MAX_DATA_LEN },
366
	[NL80211_ATTR_PEER_AID] = { .type = NLA_U16 },
367 368 369
	[NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
	[NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
	[NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
370 371
	[NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
	[NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
372 373
	[NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
	[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
374
	[NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
375
	[NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
J
Johannes Berg 已提交
376 377 378
	[NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
	[NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
	[NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
379 380
	[NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
				   .len = IEEE80211_QOS_MAP_LEN_MAX },
381 382
	[NL80211_ATTR_MAC_HINT] = { .len = ETH_ALEN },
	[NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
383
	[NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
384
	[NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
385
	[NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
386
	[NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
387 388 389
	[NL80211_ATTR_TSID] = { .type = NLA_U8 },
	[NL80211_ATTR_USER_PRIO] = { .type = NLA_U8 },
	[NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
390
	[NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
391
	[NL80211_ATTR_MAC_MASK] = { .len = ETH_ALEN },
392
	[NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
393
	[NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
394
	[NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
395
	[NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
396
	[NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
397
	[NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
398
	[NL80211_ATTR_STA_SUPPORT_P2P_PS] = { .type = NLA_U8 },
399 400 401 402
	[NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
		.len = VHT_MUMIMO_GROUPS_DATA_LEN
	},
	[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = { .len = ETH_ALEN },
403
	[NL80211_ATTR_NAN_MASTER_PREF] = { .type = NLA_U8 },
L
Luca Coelho 已提交
404
	[NL80211_ATTR_BANDS] = { .type = NLA_U32 },
405
	[NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
406 407 408
	[NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
				    .len = FILS_MAX_KEK_LEN },
	[NL80211_ATTR_FILS_NONCES] = { .len = 2 * FILS_NONCE_LEN },
409
	[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
410
	[NL80211_ATTR_BSSID] = { .len = ETH_ALEN },
411 412 413 414
	[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
	[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
		.len = sizeof(struct nl80211_bss_select_rssi_adjust)
	},
415
	[NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
416 417 418 419 420 421 422 423 424
	[NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
					     .len = FILS_ERP_MAX_USERNAME_LEN },
	[NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
					  .len = FILS_ERP_MAX_REALM_LEN },
	[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
	[NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
					.len = FILS_ERP_MAX_RRK_LEN },
	[NL80211_ATTR_FILS_CACHE_ID] = { .len = 2 },
	[NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
425
	[NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
426
	[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG },
427 428 429 430

	[NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 },
	[NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 },
	[NL80211_ATTR_TXQ_QUANTUM] = { .type = NLA_U32 },
431 432
};

433
/* policy for the key attributes */
A
Alexey Dobriyan 已提交
434
static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
J
Johannes Berg 已提交
435
	[NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
436 437
	[NL80211_KEY_IDX] = { .type = NLA_U8 },
	[NL80211_KEY_CIPHER] = { .type = NLA_U32 },
438
	[NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
439 440
	[NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
	[NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
441
	[NL80211_KEY_TYPE] = { .type = NLA_U32 },
442 443 444 445 446 447 448 449
	[NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
};

/* policy for the key default flags */
static const struct nla_policy
nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
	[NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
	[NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
450 451
};

452
#ifdef CONFIG_PM
J
Johannes Berg 已提交
453 454 455 456 457 458 459
/* policy for WoWLAN attributes */
static const struct nla_policy
nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
	[NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
	[NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
	[NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
	[NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
460 461 462 463
	[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
	[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
	[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
	[NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
464
	[NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
465
	[NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484
};

static const struct nla_policy
nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
	[NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
	[NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
	[NL80211_WOWLAN_TCP_DST_MAC] = { .len = ETH_ALEN },
	[NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
	[NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
	[NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .len = 1 },
	[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
		.len = sizeof(struct nl80211_wowlan_tcp_data_seq)
	},
	[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
		.len = sizeof(struct nl80211_wowlan_tcp_data_token)
	},
	[NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
	[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .len = 1 },
	[NL80211_WOWLAN_TCP_WAKE_MASK] = { .len = 1 },
J
Johannes Berg 已提交
485
};
486
#endif /* CONFIG_PM */
J
Johannes Berg 已提交
487

488 489 490 491 492 493 494 495
/* policy for coalesce rule attributes */
static const struct nla_policy
nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
	[NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
	[NL80211_ATTR_COALESCE_RULE_CONDITION] = { .type = NLA_U32 },
	[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
};

496 497 498 499 500 501 502 503
/* policy for GTK rekey offload attributes */
static const struct nla_policy
nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
	[NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
	[NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
	[NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
};

504 505
static const struct nla_policy
nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
506
	[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
507
						 .len = IEEE80211_MAX_SSID_LEN },
508
	[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = { .len = ETH_ALEN },
509
	[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
510 511
};

512 513 514 515 516 517
static const struct nla_policy
nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
	[NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
	[NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
};

518 519 520 521 522 523 524 525 526
static const struct nla_policy
nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
	[NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
	[NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
	[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
		.len = sizeof(struct nl80211_bss_select_rssi_adjust)
	},
};

527 528 529 530
/* policy for NAN function attributes */
static const struct nla_policy
nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
	[NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
531
	[NL80211_NAN_FUNC_SERVICE_ID] = {
532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559
				    .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
	[NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
	[NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
	[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
	[NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
	[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
	[NL80211_NAN_FUNC_FOLLOW_UP_DEST] = { .len = ETH_ALEN },
	[NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
	[NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
	[NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
			.len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
	[NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
	[NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
	[NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
	[NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
	[NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
};

/* policy for Service Response Filter attributes */
static const struct nla_policy
nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
	[NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
	[NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
				 .len =  NL80211_NAN_FUNC_SRF_MAX_LEN },
	[NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
	[NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
};

560 561 562 563 564 565 566 567
/* policy for packet pattern attributes */
static const struct nla_policy
nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
	[NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
	[NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
	[NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
};

568 569 570 571
static int nl80211_prepare_wdev_dump(struct sk_buff *skb,
				     struct netlink_callback *cb,
				     struct cfg80211_registered_device **rdev,
				     struct wireless_dev **wdev)
572
{
573
	int err;
574

575 576
	if (!cb->args[0]) {
		err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
577
				  genl_family_attrbuf(&nl80211_fam),
578
				  nl80211_fam.maxattr, nl80211_policy, NULL);
579
		if (err)
580
			return err;
581

582 583 584
		*wdev = __cfg80211_wdev_from_attrs(
					sock_net(skb->sk),
					genl_family_attrbuf(&nl80211_fam));
585 586
		if (IS_ERR(*wdev))
			return PTR_ERR(*wdev);
587
		*rdev = wiphy_to_rdev((*wdev)->wiphy);
588 589
		/* 0 is the first index - add 1 to parse only once */
		cb->args[0] = (*rdev)->wiphy_idx + 1;
590 591
		cb->args[1] = (*wdev)->identifier;
	} else {
592 593
		/* subtract the 1 again here */
		struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
594
		struct wireless_dev *tmp;
595

596 597
		if (!wiphy)
			return -ENODEV;
598
		*rdev = wiphy_to_rdev(wiphy);
599
		*wdev = NULL;
600

601
		list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
602 603 604 605 606
			if (tmp->identifier == cb->args[1]) {
				*wdev = tmp;
				break;
			}
		}
607

608 609
		if (!*wdev)
			return -ENODEV;
610 611 612 613 614
	}

	return 0;
}

615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644
/* IE validation */
static bool is_valid_ie_attr(const struct nlattr *attr)
{
	const u8 *pos;
	int len;

	if (!attr)
		return true;

	pos = nla_data(attr);
	len = nla_len(attr);

	while (len) {
		u8 elemlen;

		if (len < 2)
			return false;
		len -= 2;

		elemlen = pos[1];
		if (elemlen > len)
			return false;

		len -= elemlen;
		pos += 2 + elemlen;
	}

	return true;
}

645
/* message building helper */
646
static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
647 648 649
				   int flags, u8 cmd)
{
	/* since there is no private header just add the generic one */
650
	return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
651 652
}

653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689
static int nl80211_msg_put_wmm_rules(struct sk_buff *msg,
				     const struct ieee80211_reg_rule *rule)
{
	int j;
	struct nlattr *nl_wmm_rules =
		nla_nest_start(msg, NL80211_FREQUENCY_ATTR_WMM);

	if (!nl_wmm_rules)
		goto nla_put_failure;

	for (j = 0; j < IEEE80211_NUM_ACS; j++) {
		struct nlattr *nl_wmm_rule = nla_nest_start(msg, j);

		if (!nl_wmm_rule)
			goto nla_put_failure;

		if (nla_put_u16(msg, NL80211_WMMR_CW_MIN,
				rule->wmm_rule->client[j].cw_min) ||
		    nla_put_u16(msg, NL80211_WMMR_CW_MAX,
				rule->wmm_rule->client[j].cw_max) ||
		    nla_put_u8(msg, NL80211_WMMR_AIFSN,
			       rule->wmm_rule->client[j].aifsn) ||
		    nla_put_u8(msg, NL80211_WMMR_TXOP,
			       rule->wmm_rule->client[j].cot))
			goto nla_put_failure;

		nla_nest_end(msg, nl_wmm_rule);
	}
	nla_nest_end(msg, nl_wmm_rules);

	return 0;

nla_put_failure:
	return -ENOBUFS;
}

static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy,
690 691
				   struct ieee80211_channel *chan,
				   bool large)
692
{
693 694 695 696 697 698 699
	/* Some channels must be completely excluded from the
	 * list to protect old user-space tools from breaking
	 */
	if (!large && chan->flags &
	    (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
		return 0;

700 701 702
	if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
			chan->center_freq))
		goto nla_put_failure;
703

704 705 706
	if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
	    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
		goto nla_put_failure;
707 708 709 710 711 712
	if (chan->flags & IEEE80211_CHAN_NO_IR) {
		if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
			goto nla_put_failure;
		if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
			goto nla_put_failure;
	}
713 714 715 716 717 718 719 720 721 722 723 724 725 726
	if (chan->flags & IEEE80211_CHAN_RADAR) {
		if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
			goto nla_put_failure;
		if (large) {
			u32 time;

			time = elapsed_jiffies_msecs(chan->dfs_state_entered);

			if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
					chan->dfs_state))
				goto nla_put_failure;
			if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
					time))
				goto nla_put_failure;
727 728 729 730
			if (nla_put_u32(msg,
					NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
					chan->dfs_cac_ms))
				goto nla_put_failure;
731 732
		}
	}
733

734 735 736 737 738 739 740 741 742 743 744 745 746
	if (large) {
		if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
			goto nla_put_failure;
		if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
			goto nla_put_failure;
		if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
			goto nla_put_failure;
		if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
			goto nla_put_failure;
747 748 749
		if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
			goto nla_put_failure;
750 751
		if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
752
			goto nla_put_failure;
753 754 755 756 757 758
		if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
			goto nla_put_failure;
		if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
			goto nla_put_failure;
759 760
	}

761 762 763
	if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
			DBM_TO_MBM(chan->max_power)))
		goto nla_put_failure;
764

765 766 767 768 769 770 771 772 773 774
	if (large) {
		const struct ieee80211_reg_rule *rule =
			freq_reg_info(wiphy, chan->center_freq);

		if (!IS_ERR(rule) && rule->wmm_rule) {
			if (nl80211_msg_put_wmm_rules(msg, rule))
				goto nla_put_failure;
		}
	}

775 776 777 778 779 780
	return 0;

 nla_put_failure:
	return -ENOBUFS;
}

781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813
static bool nl80211_put_txq_stats(struct sk_buff *msg,
				  struct cfg80211_txq_stats *txqstats,
				  int attrtype)
{
	struct nlattr *txqattr;

#define PUT_TXQVAL_U32(attr, memb) do {					  \
	if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) &&	  \
	    nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \
		return false;						  \
	} while (0)

	txqattr = nla_nest_start(msg, attrtype);
	if (!txqattr)
		return false;

	PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes);
	PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets);
	PUT_TXQVAL_U32(FLOWS, flows);
	PUT_TXQVAL_U32(DROPS, drops);
	PUT_TXQVAL_U32(ECN_MARKS, ecn_marks);
	PUT_TXQVAL_U32(OVERLIMIT, overlimit);
	PUT_TXQVAL_U32(OVERMEMORY, overmemory);
	PUT_TXQVAL_U32(COLLISIONS, collisions);
	PUT_TXQVAL_U32(TX_BYTES, tx_bytes);
	PUT_TXQVAL_U32(TX_PACKETS, tx_packets);
	PUT_TXQVAL_U32(MAX_FLOWS, max_flows);
	nla_nest_end(msg, txqattr);

#undef PUT_TXQVAL_U32
	return true;
}

814 815
/* netlink command implementations */

816 817 818
struct key_parse {
	struct key_params p;
	int idx;
819
	int type;
820
	bool def, defmgmt;
821
	bool def_uni, def_multi;
822 823
};

824 825
static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key,
				 struct key_parse *k)
826 827 828
{
	struct nlattr *tb[NL80211_KEY_MAX + 1];
	int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
829
				   nl80211_key_policy, info->extack);
830 831 832 833 834 835
	if (err)
		return err;

	k->def = !!tb[NL80211_KEY_DEFAULT];
	k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];

836 837 838 839 840 841 842
	if (k->def) {
		k->def_uni = true;
		k->def_multi = true;
	}
	if (k->defmgmt)
		k->def_multi = true;

843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858
	if (tb[NL80211_KEY_IDX])
		k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);

	if (tb[NL80211_KEY_DATA]) {
		k->p.key = nla_data(tb[NL80211_KEY_DATA]);
		k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
	}

	if (tb[NL80211_KEY_SEQ]) {
		k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
		k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
	}

	if (tb[NL80211_KEY_CIPHER])
		k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);

859 860 861
	if (tb[NL80211_KEY_TYPE]) {
		k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
		if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
862 863
			return genl_err_attr(info, -EINVAL,
					     tb[NL80211_KEY_TYPE]);
864 865
	}

866 867
	if (tb[NL80211_KEY_DEFAULT_TYPES]) {
		struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
868

869 870
		err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
				       tb[NL80211_KEY_DEFAULT_TYPES],
871 872
				       nl80211_key_default_policy,
				       info->extack);
873 874 875 876 877 878 879
		if (err)
			return err;

		k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
		k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
	}

880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903
	return 0;
}

static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
{
	if (info->attrs[NL80211_ATTR_KEY_DATA]) {
		k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
		k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
	}

	if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
		k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
		k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
	}

	if (info->attrs[NL80211_ATTR_KEY_IDX])
		k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);

	if (info->attrs[NL80211_ATTR_KEY_CIPHER])
		k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);

	k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
	k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];

904 905 906 907 908 909 910
	if (k->def) {
		k->def_uni = true;
		k->def_multi = true;
	}
	if (k->defmgmt)
		k->def_multi = true;

911 912
	if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
		k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
913 914
		if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES) {
			GENL_SET_ERR_MSG(info, "key type out of range");
915
			return -EINVAL;
916
		}
917 918
	}

919 920
	if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
		struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
921 922 923
		int err = nla_parse_nested(kdt,
					   NUM_NL80211_KEY_DEFAULT_TYPES - 1,
					   info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
924 925
					   nl80211_key_default_policy,
					   info->extack);
926 927 928 929 930 931 932
		if (err)
			return err;

		k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
		k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
	}

933 934 935 936 937 938 939 940 941
	return 0;
}

static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
{
	int err;

	memset(k, 0, sizeof(*k));
	k->idx = -1;
942
	k->type = -1;
943 944

	if (info->attrs[NL80211_ATTR_KEY])
945
		err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k);
946 947 948 949 950 951
	else
		err = nl80211_parse_key_old(info, k);

	if (err)
		return err;

952 953
	if (k->def && k->defmgmt) {
		GENL_SET_ERR_MSG(info, "key with def && defmgmt is invalid");
954
		return -EINVAL;
955
	}
956

957
	if (k->defmgmt) {
958 959
		if (k->def_uni || !k->def_multi) {
			GENL_SET_ERR_MSG(info, "defmgmt key must be mcast");
960
			return -EINVAL;
961
		}
962 963
	}

964 965
	if (k->idx != -1) {
		if (k->defmgmt) {
966 967 968
			if (k->idx < 4 || k->idx > 5) {
				GENL_SET_ERR_MSG(info,
						 "defmgmt key idx not 4 or 5");
969
				return -EINVAL;
970
			}
971
		} else if (k->def) {
972 973
			if (k->idx < 0 || k->idx > 3) {
				GENL_SET_ERR_MSG(info, "def key idx not 0-3");
974
				return -EINVAL;
975
			}
976
		} else {
977 978
			if (k->idx < 0 || k->idx > 5) {
				GENL_SET_ERR_MSG(info, "key idx not 0-5");
979
				return -EINVAL;
980
			}
981 982 983 984 985 986
		}
	}

	return 0;
}

J
Johannes Berg 已提交
987 988
static struct cfg80211_cached_keys *
nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
989
		       struct genl_info *info, bool *no_ht)
J
Johannes Berg 已提交
990
{
991
	struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS];
J
Johannes Berg 已提交
992 993 994 995
	struct key_parse parse;
	struct nlattr *key;
	struct cfg80211_cached_keys *result;
	int rem, err, def = 0;
996 997 998 999 1000 1001 1002 1003 1004
	bool have_key = false;

	nla_for_each_nested(key, keys, rem) {
		have_key = true;
		break;
	}

	if (!have_key)
		return NULL;
J
Johannes Berg 已提交
1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015

	result = kzalloc(sizeof(*result), GFP_KERNEL);
	if (!result)
		return ERR_PTR(-ENOMEM);

	result->def = -1;

	nla_for_each_nested(key, keys, rem) {
		memset(&parse, 0, sizeof(parse));
		parse.idx = -1;

1016
		err = nl80211_parse_key_new(info, key, &parse);
J
Johannes Berg 已提交
1017 1018 1019 1020 1021
		if (err)
			goto error;
		err = -EINVAL;
		if (!parse.p.key)
			goto error;
1022 1023
		if (parse.idx < 0 || parse.idx > 3) {
			GENL_SET_ERR_MSG(info, "key index out of range [0-3]");
J
Johannes Berg 已提交
1024
			goto error;
1025
		}
J
Johannes Berg 已提交
1026
		if (parse.def) {
1027 1028 1029
			if (def) {
				GENL_SET_ERR_MSG(info,
						 "only one key can be default");
J
Johannes Berg 已提交
1030
				goto error;
1031
			}
J
Johannes Berg 已提交
1032 1033
			def = 1;
			result->def = parse.idx;
1034 1035
			if (!parse.def_uni || !parse.def_multi)
				goto error;
J
Johannes Berg 已提交
1036 1037 1038
		} else if (parse.defmgmt)
			goto error;
		err = cfg80211_validate_key_settings(rdev, &parse.p,
1039
						     parse.idx, false, NULL);
J
Johannes Berg 已提交
1040 1041
		if (err)
			goto error;
1042 1043
		if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
		    parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
1044
			GENL_SET_ERR_MSG(info, "connect key must be WEP");
1045 1046 1047
			err = -EINVAL;
			goto error;
		}
J
Johannes Berg 已提交
1048 1049 1050 1051
		result->params[parse.idx].cipher = parse.p.cipher;
		result->params[parse.idx].key_len = parse.p.key_len;
		result->params[parse.idx].key = result->data[parse.idx];
		memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
1052

1053 1054 1055
		/* must be WEP key if we got here */
		if (no_ht)
			*no_ht = true;
J
Johannes Berg 已提交
1056 1057
	}

1058 1059
	if (result->def < 0) {
		err = -EINVAL;
1060
		GENL_SET_ERR_MSG(info, "need a default/TX key");
1061 1062 1063
		goto error;
	}

J
Johannes Berg 已提交
1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076
	return result;
 error:
	kfree(result);
	return ERR_PTR(err);
}

static int nl80211_key_allowed(struct wireless_dev *wdev)
{
	ASSERT_WDEV_LOCK(wdev);

	switch (wdev->iftype) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
1077
	case NL80211_IFTYPE_P2P_GO:
1078
	case NL80211_IFTYPE_MESH_POINT:
J
Johannes Berg 已提交
1079 1080 1081
		break;
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_STATION:
1082
	case NL80211_IFTYPE_P2P_CLIENT:
1083
		if (!wdev->current_bss)
J
Johannes Berg 已提交
1084 1085
			return -ENOLINK;
		break;
1086
	case NL80211_IFTYPE_UNSPECIFIED:
1087
	case NL80211_IFTYPE_OCB:
1088
	case NL80211_IFTYPE_MONITOR:
1089
	case NL80211_IFTYPE_NAN:
1090 1091 1092
	case NL80211_IFTYPE_P2P_DEVICE:
	case NL80211_IFTYPE_WDS:
	case NUM_NL80211_IFTYPES:
J
Johannes Berg 已提交
1093 1094 1095 1096 1097 1098
		return -EINVAL;
	}

	return 0;
}

1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111
static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
							struct nlattr *tb)
{
	struct ieee80211_channel *chan;

	if (tb == NULL)
		return NULL;
	chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
	if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
		return NULL;
	return chan;
}

1112 1113 1114 1115 1116 1117 1118 1119 1120 1121
static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
{
	struct nlattr *nl_modes = nla_nest_start(msg, attr);
	int i;

	if (!nl_modes)
		goto nla_put_failure;

	i = 0;
	while (ifmodes) {
1122 1123
		if ((ifmodes & 1) && nla_put_flag(msg, i))
			goto nla_put_failure;
1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135
		ifmodes >>= 1;
		i++;
	}

	nla_nest_end(msg, nl_modes);
	return 0;

nla_put_failure:
	return -ENOBUFS;
}

static int nl80211_put_iface_combinations(struct wiphy *wiphy,
1136 1137
					  struct sk_buff *msg,
					  bool large)
1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166
{
	struct nlattr *nl_combis;
	int i, j;

	nl_combis = nla_nest_start(msg,
				NL80211_ATTR_INTERFACE_COMBINATIONS);
	if (!nl_combis)
		goto nla_put_failure;

	for (i = 0; i < wiphy->n_iface_combinations; i++) {
		const struct ieee80211_iface_combination *c;
		struct nlattr *nl_combi, *nl_limits;

		c = &wiphy->iface_combinations[i];

		nl_combi = nla_nest_start(msg, i + 1);
		if (!nl_combi)
			goto nla_put_failure;

		nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
		if (!nl_limits)
			goto nla_put_failure;

		for (j = 0; j < c->n_limits; j++) {
			struct nlattr *nl_limit;

			nl_limit = nla_nest_start(msg, j + 1);
			if (!nl_limit)
				goto nla_put_failure;
1167 1168 1169
			if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
					c->limits[j].max))
				goto nla_put_failure;
1170 1171 1172 1173 1174 1175 1176 1177
			if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
						c->limits[j].types))
				goto nla_put_failure;
			nla_nest_end(msg, nl_limit);
		}

		nla_nest_end(msg, nl_limits);

1178 1179 1180 1181 1182 1183 1184 1185
		if (c->beacon_int_infra_match &&
		    nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
			goto nla_put_failure;
		if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
				c->num_different_channels) ||
		    nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
				c->max_interfaces))
			goto nla_put_failure;
1186
		if (large &&
1187 1188 1189 1190
		    (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
				c->radar_detect_widths) ||
		     nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
				c->radar_detect_regions)))
1191
			goto nla_put_failure;
1192 1193 1194 1195
		if (c->beacon_int_min_gcd &&
		    nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
				c->beacon_int_min_gcd))
			goto nla_put_failure;
1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206

		nla_nest_end(msg, nl_combi);
	}

	nla_nest_end(msg, nl_combis);

	return 0;
nla_put_failure:
	return -ENOBUFS;
}

1207
#ifdef CONFIG_PM
1208 1209 1210
static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
					struct sk_buff *msg)
{
1211
	const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247
	struct nlattr *nl_tcp;

	if (!tcp)
		return 0;

	nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
	if (!nl_tcp)
		return -ENOBUFS;

	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
			tcp->data_payload_max))
		return -ENOBUFS;

	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
			tcp->data_payload_max))
		return -ENOBUFS;

	if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
		return -ENOBUFS;

	if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
				sizeof(*tcp->tok), tcp->tok))
		return -ENOBUFS;

	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
			tcp->data_interval_max))
		return -ENOBUFS;

	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
			tcp->wake_payload_max))
		return -ENOBUFS;

	nla_nest_end(msg, nl_tcp);
	return 0;
}

1248
static int nl80211_send_wowlan(struct sk_buff *msg,
1249
			       struct cfg80211_registered_device *rdev,
1250
			       bool large)
1251
{
1252
	struct nlattr *nl_wowlan;
1253

1254
	if (!rdev->wiphy.wowlan)
1255
		return 0;
1256

1257 1258 1259
	nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
	if (!nl_wowlan)
		return -ENOBUFS;
1260

1261
	if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
1262
	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1263
	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
1264
	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1265
	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
1266
	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1267
	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
1268
	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1269
	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
1270
	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1271
	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
1272
	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1273
	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
1274
	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1275
	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
1276 1277
	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
		return -ENOBUFS;
1278

1279
	if (rdev->wiphy.wowlan->n_patterns) {
1280
		struct nl80211_pattern_support pat = {
1281 1282 1283 1284
			.max_patterns = rdev->wiphy.wowlan->n_patterns,
			.min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
			.max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
			.max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
1285
		};
1286

1287 1288 1289 1290
		if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
			    sizeof(pat), &pat))
			return -ENOBUFS;
	}
1291

1292 1293 1294 1295 1296
	if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
	    nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
			rdev->wiphy.wowlan->max_nd_match_sets))
		return -ENOBUFS;

1297
	if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
1298 1299
		return -ENOBUFS;

1300
	nla_nest_end(msg, nl_wowlan);
1301

1302 1303 1304
	return 0;
}
#endif
1305

1306
static int nl80211_send_coalesce(struct sk_buff *msg,
1307
				 struct cfg80211_registered_device *rdev)
1308 1309 1310
{
	struct nl80211_coalesce_rule_support rule;

1311
	if (!rdev->wiphy.coalesce)
1312 1313
		return 0;

1314 1315 1316 1317 1318 1319
	rule.max_rules = rdev->wiphy.coalesce->n_rules;
	rule.max_delay = rdev->wiphy.coalesce->max_delay;
	rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
	rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
	rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
	rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
1320 1321 1322 1323 1324 1325 1326

	if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
		return -ENOBUFS;

	return 0;
}

1327 1328 1329 1330 1331 1332
static int nl80211_send_band_rateinfo(struct sk_buff *msg,
				      struct ieee80211_supported_band *sband)
{
	struct nlattr *nl_rates, *nl_rate;
	struct ieee80211_rate *rate;
	int i;
1333

1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345
	/* add HT info */
	if (sband->ht_cap.ht_supported &&
	    (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
		     sizeof(sband->ht_cap.mcs),
		     &sband->ht_cap.mcs) ||
	     nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
			 sband->ht_cap.cap) ||
	     nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
			sband->ht_cap.ampdu_factor) ||
	     nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
			sband->ht_cap.ampdu_density)))
		return -ENOBUFS;
1346

1347 1348 1349 1350 1351 1352 1353 1354
	/* add VHT info */
	if (sband->vht_cap.vht_supported &&
	    (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
		     sizeof(sband->vht_cap.vht_mcs),
		     &sband->vht_cap.vht_mcs) ||
	     nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
			 sband->vht_cap.cap)))
		return -ENOBUFS;
1355

1356 1357 1358 1359
	/* add bitrates */
	nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
	if (!nl_rates)
		return -ENOBUFS;
1360

1361 1362 1363 1364
	for (i = 0; i < sband->n_bitrates; i++) {
		nl_rate = nla_nest_start(msg, i);
		if (!nl_rate)
			return -ENOBUFS;
1365

1366 1367 1368 1369 1370 1371 1372 1373
		rate = &sband->bitrates[i];
		if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
				rate->bitrate))
			return -ENOBUFS;
		if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
		    nla_put_flag(msg,
				 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
			return -ENOBUFS;
1374

1375 1376
		nla_nest_end(msg, nl_rate);
	}
J
Johannes Berg 已提交
1377

1378
	nla_nest_end(msg, nl_rates);
1379

1380 1381
	return 0;
}
1382

1383 1384 1385 1386 1387 1388 1389 1390
static int
nl80211_send_mgmt_stypes(struct sk_buff *msg,
			 const struct ieee80211_txrx_stypes *mgmt_stypes)
{
	u16 stypes;
	struct nlattr *nl_ftypes, *nl_ifs;
	enum nl80211_iftype ift;
	int i;
1391

1392 1393
	if (!mgmt_stypes)
		return 0;
1394

1395 1396 1397
	nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
	if (!nl_ifs)
		return -ENOBUFS;
1398

1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411
	for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
		nl_ftypes = nla_nest_start(msg, ift);
		if (!nl_ftypes)
			return -ENOBUFS;
		i = 0;
		stypes = mgmt_stypes[ift].tx;
		while (stypes) {
			if ((stypes & 1) &&
			    nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
					(i << 4) | IEEE80211_FTYPE_MGMT))
				return -ENOBUFS;
			stypes >>= 1;
			i++;
1412
		}
1413 1414
		nla_nest_end(msg, nl_ftypes);
	}
1415

1416
	nla_nest_end(msg, nl_ifs);
1417

1418 1419 1420
	nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
	if (!nl_ifs)
		return -ENOBUFS;
1421

1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438
	for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
		nl_ftypes = nla_nest_start(msg, ift);
		if (!nl_ftypes)
			return -ENOBUFS;
		i = 0;
		stypes = mgmt_stypes[ift].rx;
		while (stypes) {
			if ((stypes & 1) &&
			    nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
					(i << 4) | IEEE80211_FTYPE_MGMT))
				return -ENOBUFS;
			stypes >>= 1;
			i++;
		}
		nla_nest_end(msg, nl_ftypes);
	}
	nla_nest_end(msg, nl_ifs);
1439

1440 1441
	return 0;
}
1442

1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499
#define CMD(op, n)							\
	 do {								\
		if (rdev->ops->op) {					\
			i++;						\
			if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) 	\
				goto nla_put_failure;			\
		}							\
	} while (0)

static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
					struct sk_buff *msg)
{
	int i = 0;

	/*
	 * do *NOT* add anything into this function, new things need to be
	 * advertised only to new versions of userspace that can deal with
	 * the split (and they can't possibly care about new features...
	 */
	CMD(add_virtual_intf, NEW_INTERFACE);
	CMD(change_virtual_intf, SET_INTERFACE);
	CMD(add_key, NEW_KEY);
	CMD(start_ap, START_AP);
	CMD(add_station, NEW_STATION);
	CMD(add_mpath, NEW_MPATH);
	CMD(update_mesh_config, SET_MESH_CONFIG);
	CMD(change_bss, SET_BSS);
	CMD(auth, AUTHENTICATE);
	CMD(assoc, ASSOCIATE);
	CMD(deauth, DEAUTHENTICATE);
	CMD(disassoc, DISASSOCIATE);
	CMD(join_ibss, JOIN_IBSS);
	CMD(join_mesh, JOIN_MESH);
	CMD(set_pmksa, SET_PMKSA);
	CMD(del_pmksa, DEL_PMKSA);
	CMD(flush_pmksa, FLUSH_PMKSA);
	if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
		CMD(remain_on_channel, REMAIN_ON_CHANNEL);
	CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
	CMD(mgmt_tx, FRAME);
	CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
	if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
		i++;
		if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
			goto nla_put_failure;
	}
	if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
	    rdev->ops->join_mesh) {
		i++;
		if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
			goto nla_put_failure;
	}
	CMD(set_wds_peer, SET_WDS_PEER);
	if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
		CMD(tdls_mgmt, TDLS_MGMT);
		CMD(tdls_oper, TDLS_OPER);
	}
1500
	if (rdev->wiphy.max_sched_scan_reqs)
1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531
		CMD(sched_scan_start, START_SCHED_SCAN);
	CMD(probe_client, PROBE_CLIENT);
	CMD(set_noack_map, SET_NOACK_MAP);
	if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
		i++;
		if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
			goto nla_put_failure;
	}
	CMD(start_p2p_device, START_P2P_DEVICE);
	CMD(set_mcast_rate, SET_MCAST_RATE);
#ifdef CONFIG_NL80211_TESTMODE
	CMD(testmode_cmd, TESTMODE);
#endif

	if (rdev->ops->connect || rdev->ops->auth) {
		i++;
		if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
			goto nla_put_failure;
	}

	if (rdev->ops->disconnect || rdev->ops->deauth) {
		i++;
		if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
			goto nla_put_failure;
	}

	return i;
 nla_put_failure:
	return -ENOBUFS;
}

1532 1533 1534
struct nl80211_dump_wiphy_state {
	s64 filter_wiphy;
	long start;
1535
	long split_start, band_start, chan_start, capa_start;
1536 1537 1538
	bool split;
};

1539
static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
1540
			      enum nl80211_commands cmd,
1541
			      struct sk_buff *msg, u32 portid, u32 seq,
1542
			      int flags, struct nl80211_dump_wiphy_state *state)
1543 1544 1545 1546 1547
{
	void *hdr;
	struct nlattr *nl_bands, *nl_band;
	struct nlattr *nl_freqs, *nl_freq;
	struct nlattr *nl_cmds;
1548
	enum nl80211_band band;
1549 1550 1551
	struct ieee80211_channel *chan;
	int i;
	const struct ieee80211_txrx_stypes *mgmt_stypes =
1552
				rdev->wiphy.mgmt_stypes;
1553
	u32 features;
1554

1555
	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
1556 1557
	if (!hdr)
		return -ENOBUFS;
1558

1559 1560
	if (WARN_ON(!state))
		return -EINVAL;
1561

1562
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
1563
	    nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
1564
			   wiphy_name(&rdev->wiphy)) ||
1565 1566
	    nla_put_u32(msg, NL80211_ATTR_GENERATION,
			cfg80211_rdev_list_generation))
1567 1568
		goto nla_put_failure;

1569 1570 1571
	if (cmd != NL80211_CMD_NEW_WIPHY)
		goto finish;

1572
	switch (state->split_start) {
1573 1574
	case 0:
		if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
1575
			       rdev->wiphy.retry_short) ||
1576
		    nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
1577
			       rdev->wiphy.retry_long) ||
1578
		    nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
1579
				rdev->wiphy.frag_threshold) ||
1580
		    nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
1581
				rdev->wiphy.rts_threshold) ||
1582
		    nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
1583
			       rdev->wiphy.coverage_class) ||
1584
		    nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
1585
			       rdev->wiphy.max_scan_ssids) ||
1586
		    nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
1587
			       rdev->wiphy.max_sched_scan_ssids) ||
1588
		    nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
1589
				rdev->wiphy.max_scan_ie_len) ||
1590
		    nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
1591
				rdev->wiphy.max_sched_scan_ie_len) ||
1592
		    nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
1593 1594 1595 1596 1597 1598 1599
			       rdev->wiphy.max_match_sets) ||
		    nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
				rdev->wiphy.max_sched_scan_plans) ||
		    nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
				rdev->wiphy.max_sched_scan_plan_interval) ||
		    nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
				rdev->wiphy.max_sched_scan_plan_iterations))
1600
			goto nla_put_failure;
1601

1602
		if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
1603
		    nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
1604
			goto nla_put_failure;
1605
		if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
1606 1607
		    nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
			goto nla_put_failure;
1608
		if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
1609 1610
		    nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
			goto nla_put_failure;
1611
		if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
1612 1613
		    nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
			goto nla_put_failure;
1614
		if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
1615 1616
		    nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
			goto nla_put_failure;
1617
		if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
1618
		    nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
1619
			goto nla_put_failure;
1620 1621
		state->split_start++;
		if (state->split)
1622 1623 1624
			break;
	case 1:
		if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
1625 1626
			    sizeof(u32) * rdev->wiphy.n_cipher_suites,
			    rdev->wiphy.cipher_suites))
1627
			goto nla_put_failure;
1628

1629
		if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
1630
			       rdev->wiphy.max_num_pmkids))
1631
			goto nla_put_failure;
S
Samuel Ortiz 已提交
1632

1633
		if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
1634
		    nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
1635
			goto nla_put_failure;
S
Samuel Ortiz 已提交
1636

1637
		if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
1638
				rdev->wiphy.available_antennas_tx) ||
1639
		    nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
1640
				rdev->wiphy.available_antennas_rx))
1641
			goto nla_put_failure;
S
Samuel Ortiz 已提交
1642

1643
		if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
1644
		    nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
1645
				rdev->wiphy.probe_resp_offload))
1646
			goto nla_put_failure;
1647

1648 1649 1650
		if ((rdev->wiphy.available_antennas_tx ||
		     rdev->wiphy.available_antennas_rx) &&
		    rdev->ops->get_antenna) {
1651 1652
			u32 tx_ant = 0, rx_ant = 0;
			int res;
1653

1654
			res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
1655 1656 1657 1658 1659 1660 1661 1662 1663 1664
			if (!res) {
				if (nla_put_u32(msg,
						NL80211_ATTR_WIPHY_ANTENNA_TX,
						tx_ant) ||
				    nla_put_u32(msg,
						NL80211_ATTR_WIPHY_ANTENNA_RX,
						rx_ant))
					goto nla_put_failure;
			}
		}
1665

1666 1667
		state->split_start++;
		if (state->split)
1668 1669 1670
			break;
	case 2:
		if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
1671
					rdev->wiphy.interface_modes))
1672
				goto nla_put_failure;
1673 1674
		state->split_start++;
		if (state->split)
1675 1676 1677 1678 1679
			break;
	case 3:
		nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
		if (!nl_bands)
			goto nla_put_failure;
1680

1681
		for (band = state->band_start;
1682
		     band < NUM_NL80211_BANDS; band++) {
1683
			struct ieee80211_supported_band *sband;
1684

1685
			sband = rdev->wiphy.bands[band];
1686

1687 1688 1689 1690 1691
			if (!sband)
				continue;

			nl_band = nla_nest_start(msg, band);
			if (!nl_band)
1692
				goto nla_put_failure;
1693

1694
			switch (state->chan_start) {
1695 1696
			case 0:
				if (nl80211_send_band_rateinfo(msg, sband))
1697
					goto nla_put_failure;
1698 1699
				state->chan_start++;
				if (state->split)
1700 1701 1702 1703 1704 1705 1706 1707
					break;
			default:
				/* add frequencies */
				nl_freqs = nla_nest_start(
					msg, NL80211_BAND_ATTR_FREQS);
				if (!nl_freqs)
					goto nla_put_failure;

1708
				for (i = state->chan_start - 1;
1709 1710 1711 1712 1713 1714 1715 1716
				     i < sband->n_channels;
				     i++) {
					nl_freq = nla_nest_start(msg, i);
					if (!nl_freq)
						goto nla_put_failure;

					chan = &sband->channels[i];

1717
					if (nl80211_msg_put_channel(
1718
							msg, &rdev->wiphy, chan,
1719
							state->split))
1720 1721 1722
						goto nla_put_failure;

					nla_nest_end(msg, nl_freq);
1723
					if (state->split)
1724 1725 1726
						break;
				}
				if (i < sband->n_channels)
1727
					state->chan_start = i + 2;
1728
				else
1729
					state->chan_start = 0;
1730 1731 1732 1733 1734
				nla_nest_end(msg, nl_freqs);
			}

			nla_nest_end(msg, nl_band);

1735
			if (state->split) {
1736
				/* start again here */
1737
				if (state->chan_start)
1738 1739
					band--;
				break;
1740 1741
			}
		}
1742
		nla_nest_end(msg, nl_bands);
1743

1744
		if (band < NUM_NL80211_BANDS)
1745
			state->band_start = band + 1;
1746
		else
1747
			state->band_start = 0;
J
Johannes Berg 已提交
1748

1749
		/* if bands & channels are done, continue outside */
1750 1751 1752
		if (state->band_start == 0 && state->chan_start == 0)
			state->split_start++;
		if (state->split)
1753 1754 1755 1756
			break;
	case 4:
		nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
		if (!nl_cmds)
1757 1758
			goto nla_put_failure;

1759 1760 1761
		i = nl80211_add_commands_unsplit(rdev, msg);
		if (i < 0)
			goto nla_put_failure;
1762
		if (state->split) {
1763 1764
			CMD(crit_proto_start, CRIT_PROTOCOL_START);
			CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
1765
			if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
1766
				CMD(channel_switch, CHANNEL_SWITCH);
1767
			CMD(set_qos_map, SET_QOS_MAP);
1768 1769
			if (rdev->wiphy.features &
					NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
1770
				CMD(add_tx_ts, ADD_TX_TS);
1771
			CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
1772
			CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
1773
		}
1774
#undef CMD
J
Johannes Berg 已提交
1775

1776
		nla_nest_end(msg, nl_cmds);
1777 1778
		state->split_start++;
		if (state->split)
1779 1780
			break;
	case 5:
1781 1782
		if (rdev->ops->remain_on_channel &&
		    (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
1783 1784
		    nla_put_u32(msg,
				NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
1785
				rdev->wiphy.max_remain_on_channel_duration))
1786 1787
			goto nla_put_failure;

1788
		if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
1789 1790 1791 1792 1793
		    nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
			goto nla_put_failure;

		if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
			goto nla_put_failure;
1794 1795
		state->split_start++;
		if (state->split)
1796 1797 1798
			break;
	case 6:
#ifdef CONFIG_PM
1799
		if (nl80211_send_wowlan(msg, rdev, state->split))
1800
			goto nla_put_failure;
1801 1802
		state->split_start++;
		if (state->split)
1803 1804
			break;
#else
1805
		state->split_start++;
1806
#endif
1807 1808
	case 7:
		if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
1809
					rdev->wiphy.software_iftypes))
1810
			goto nla_put_failure;
J
Johannes Berg 已提交
1811

1812
		if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
1813
						   state->split))
1814
			goto nla_put_failure;
1815

1816 1817
		state->split_start++;
		if (state->split)
1818 1819
			break;
	case 8:
1820
		if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
1821
		    nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
1822
				rdev->wiphy.ap_sme_capa))
1823
			goto nla_put_failure;
1824

1825
		features = rdev->wiphy.features;
1826 1827 1828 1829 1830
		/*
		 * We can only add the per-channel limit information if the
		 * dump is split, otherwise it makes it too big. Therefore
		 * only advertise it in that case.
		 */
1831
		if (state->split)
1832 1833
			features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
		if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
1834
			goto nla_put_failure;
J
Johannes Berg 已提交
1835

1836
		if (rdev->wiphy.ht_capa_mod_mask &&
1837
		    nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
1838 1839
			    sizeof(*rdev->wiphy.ht_capa_mod_mask),
			    rdev->wiphy.ht_capa_mod_mask))
1840
			goto nla_put_failure;
1841

1842 1843
		if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
		    rdev->wiphy.max_acl_mac_addrs &&
1844
		    nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
1845
				rdev->wiphy.max_acl_mac_addrs))
1846
			goto nla_put_failure;
1847

1848 1849 1850 1851 1852 1853 1854 1855 1856 1857
		/*
		 * Any information below this point is only available to
		 * applications that can deal with it being split. This
		 * helps ensure that newly added capabilities don't break
		 * older tools by overrunning their buffers.
		 *
		 * We still increment split_start so that in the split
		 * case we'll continue with more data in the next round,
		 * but break unconditionally so unsplit data stops here.
		 */
1858
		state->split_start++;
1859 1860
		break;
	case 9:
1861
		if (rdev->wiphy.extended_capabilities &&
1862
		    (nla_put(msg, NL80211_ATTR_EXT_CAPA,
1863 1864
			     rdev->wiphy.extended_capabilities_len,
			     rdev->wiphy.extended_capabilities) ||
1865
		     nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1866 1867
			     rdev->wiphy.extended_capabilities_len,
			     rdev->wiphy.extended_capabilities_mask)))
1868
			goto nla_put_failure;
1869

1870
		if (rdev->wiphy.vht_capa_mod_mask &&
1871
		    nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
1872 1873
			    sizeof(*rdev->wiphy.vht_capa_mod_mask),
			    rdev->wiphy.vht_capa_mod_mask))
1874 1875
			goto nla_put_failure;

1876 1877 1878
		state->split_start++;
		break;
	case 10:
1879
		if (nl80211_send_coalesce(msg, rdev))
1880 1881
			goto nla_put_failure;

1882
		if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
1883 1884 1885
		    (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
		     nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
			goto nla_put_failure;
1886

1887
		if (rdev->wiphy.max_ap_assoc_sta &&
1888
		    nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
1889
				rdev->wiphy.max_ap_assoc_sta))
1890 1891
			goto nla_put_failure;

J
Johannes Berg 已提交
1892 1893 1894
		state->split_start++;
		break;
	case 11:
1895
		if (rdev->wiphy.n_vendor_commands) {
1896 1897 1898 1899 1900 1901 1902
			const struct nl80211_vendor_cmd_info *info;
			struct nlattr *nested;

			nested = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA);
			if (!nested)
				goto nla_put_failure;

1903 1904
			for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
				info = &rdev->wiphy.vendor_commands[i].info;
1905 1906 1907 1908 1909 1910
				if (nla_put(msg, i + 1, sizeof(*info), info))
					goto nla_put_failure;
			}
			nla_nest_end(msg, nested);
		}

1911
		if (rdev->wiphy.n_vendor_events) {
1912 1913
			const struct nl80211_vendor_cmd_info *info;
			struct nlattr *nested;
J
Johannes Berg 已提交
1914

1915 1916 1917
			nested = nla_nest_start(msg,
						NL80211_ATTR_VENDOR_EVENTS);
			if (!nested)
J
Johannes Berg 已提交
1918
				goto nla_put_failure;
1919

1920 1921
			for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
				info = &rdev->wiphy.vendor_events[i];
1922 1923 1924 1925 1926
				if (nla_put(msg, i + 1, sizeof(*info), info))
					goto nla_put_failure;
			}
			nla_nest_end(msg, nested);
		}
1927 1928 1929 1930 1931 1932 1933
		state->split_start++;
		break;
	case 12:
		if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
		    nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
			       rdev->wiphy.max_num_csa_counters))
			goto nla_put_failure;
1934

1935 1936 1937 1938
		if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
		    nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
			goto nla_put_failure;

1939 1940 1941 1942 1943
		if (rdev->wiphy.max_sched_scan_reqs &&
		    nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
				rdev->wiphy.max_sched_scan_reqs))
			goto nla_put_failure;

1944 1945 1946 1947 1948
		if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
			    sizeof(rdev->wiphy.ext_features),
			    rdev->wiphy.ext_features))
			goto nla_put_failure;

1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967
		if (rdev->wiphy.bss_select_support) {
			struct nlattr *nested;
			u32 bss_select_support = rdev->wiphy.bss_select_support;

			nested = nla_nest_start(msg, NL80211_ATTR_BSS_SELECT);
			if (!nested)
				goto nla_put_failure;

			i = 0;
			while (bss_select_support) {
				if ((bss_select_support & 1) &&
				    nla_put_flag(msg, i))
					goto nla_put_failure;
				i++;
				bss_select_support >>= 1;
			}
			nla_nest_end(msg, nested);
		}

1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008
		state->split_start++;
		break;
	case 13:
		if (rdev->wiphy.num_iftype_ext_capab &&
		    rdev->wiphy.iftype_ext_capab) {
			struct nlattr *nested_ext_capab, *nested;

			nested = nla_nest_start(msg,
						NL80211_ATTR_IFTYPE_EXT_CAPA);
			if (!nested)
				goto nla_put_failure;

			for (i = state->capa_start;
			     i < rdev->wiphy.num_iftype_ext_capab; i++) {
				const struct wiphy_iftype_ext_capab *capab;

				capab = &rdev->wiphy.iftype_ext_capab[i];

				nested_ext_capab = nla_nest_start(msg, i);
				if (!nested_ext_capab ||
				    nla_put_u32(msg, NL80211_ATTR_IFTYPE,
						capab->iftype) ||
				    nla_put(msg, NL80211_ATTR_EXT_CAPA,
					    capab->extended_capabilities_len,
					    capab->extended_capabilities) ||
				    nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
					    capab->extended_capabilities_len,
					    capab->extended_capabilities_mask))
					goto nla_put_failure;

				nla_nest_end(msg, nested_ext_capab);
				if (state->split)
					break;
			}
			nla_nest_end(msg, nested);
			if (i < rdev->wiphy.num_iftype_ext_capab) {
				state->capa_start = i + 1;
				break;
			}
		}

L
Luca Coelho 已提交
2009 2010 2011 2012
		if (nla_put_u32(msg, NL80211_ATTR_BANDS,
				rdev->wiphy.nan_supported_bands))
			goto nla_put_failure;

2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034
		if (wiphy_ext_feature_isset(&rdev->wiphy,
					    NL80211_EXT_FEATURE_TXQS)) {
			struct cfg80211_txq_stats txqstats = {};
			int res;

			res = rdev_get_txq_stats(rdev, NULL, &txqstats);
			if (!res &&
			    !nl80211_put_txq_stats(msg, &txqstats,
						   NL80211_ATTR_TXQ_STATS))
				goto nla_put_failure;

			if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT,
					rdev->wiphy.txq_limit))
				goto nla_put_failure;
			if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT,
					rdev->wiphy.txq_memory_limit))
				goto nla_put_failure;
			if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM,
					rdev->wiphy.txq_quantum))
				goto nla_put_failure;
		}

2035
		/* done */
2036
		state->split_start = 0;
2037 2038
		break;
	}
2039
 finish:
2040 2041
	genlmsg_end(msg, hdr);
	return 0;
2042 2043

 nla_put_failure:
2044 2045
	genlmsg_cancel(msg, hdr);
	return -EMSGSIZE;
2046 2047
}

2048 2049 2050 2051
static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
				    struct netlink_callback *cb,
				    struct nl80211_dump_wiphy_state *state)
{
2052
	struct nlattr **tb = genl_family_attrbuf(&nl80211_fam);
2053 2054
	int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize, tb,
			      nl80211_fam.maxattr, nl80211_policy, NULL);
2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068
	/* ignore parse errors for backward compatibility */
	if (ret)
		return 0;

	state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
	if (tb[NL80211_ATTR_WIPHY])
		state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
	if (tb[NL80211_ATTR_WDEV])
		state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
	if (tb[NL80211_ATTR_IFINDEX]) {
		struct net_device *netdev;
		struct cfg80211_registered_device *rdev;
		int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);

2069
		netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
2070 2071 2072
		if (!netdev)
			return -ENODEV;
		if (netdev->ieee80211_ptr) {
2073
			rdev = wiphy_to_rdev(
2074 2075 2076 2077 2078 2079 2080 2081
				netdev->ieee80211_ptr->wiphy);
			state->filter_wiphy = rdev->wiphy_idx;
		}
	}

	return 0;
}

2082 2083
static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
{
2084
	int idx = 0, ret;
2085
	struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
2086
	struct cfg80211_registered_device *rdev;
2087

2088
	rtnl_lock();
2089 2090
	if (!state) {
		state = kzalloc(sizeof(*state), GFP_KERNEL);
J
John W. Linville 已提交
2091 2092
		if (!state) {
			rtnl_unlock();
2093
			return -ENOMEM;
2094
		}
2095 2096 2097 2098 2099 2100
		state->filter_wiphy = -1;
		ret = nl80211_dump_wiphy_parse(skb, cb, state);
		if (ret) {
			kfree(state);
			rtnl_unlock();
			return ret;
2101
		}
2102
		cb->args[0] = (long)state;
2103 2104
	}

2105 2106
	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
		if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
2107
			continue;
2108
		if (++idx <= state->start)
2109
			continue;
2110
		if (state->filter_wiphy != -1 &&
2111
		    state->filter_wiphy != rdev->wiphy_idx)
2112 2113 2114
			continue;
		/* attempt to fit multiple wiphy data chunks into the skb */
		do {
2115 2116
			ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
						 skb,
2117 2118
						 NETLINK_CB(cb->skb).portid,
						 cb->nlh->nlmsg_seq,
2119
						 NLM_F_MULTI, state);
2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134
			if (ret < 0) {
				/*
				 * If sending the wiphy data didn't fit (ENOBUFS
				 * or EMSGSIZE returned), this SKB is still
				 * empty (so it's not too big because another
				 * wiphy dataset is already in the skb) and
				 * we've not tried to adjust the dump allocation
				 * yet ... then adjust the alloc size to be
				 * bigger, and return 1 but with the empty skb.
				 * This results in an empty message being RX'ed
				 * in userspace, but that is ignored.
				 *
				 * We can then retry with the larger buffer.
				 */
				if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
2135
				    !skb->len && !state->split &&
2136 2137
				    cb->min_dump_alloc < 4096) {
					cb->min_dump_alloc = 4096;
2138
					state->split_start = 0;
2139
					rtnl_unlock();
2140 2141 2142 2143
					return 1;
				}
				idx--;
				break;
2144
			}
2145
		} while (state->split_start > 0);
2146
		break;
2147
	}
2148
	rtnl_unlock();
2149

2150
	state->start = idx;
2151 2152 2153 2154

	return skb->len;
}

2155 2156 2157 2158 2159 2160
static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
{
	kfree((void *)cb->args[0]);
	return 0;
}

2161 2162 2163
static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
{
	struct sk_buff *msg;
2164
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
2165
	struct nl80211_dump_wiphy_state state = {};
2166

2167
	msg = nlmsg_new(4096, GFP_KERNEL);
2168
	if (!msg)
2169
		return -ENOMEM;
2170

2171 2172
	if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
			       info->snd_portid, info->snd_seq, 0,
2173
			       &state) < 0) {
2174 2175 2176
		nlmsg_free(msg);
		return -ENOBUFS;
	}
2177

J
Johannes Berg 已提交
2178
	return genlmsg_reply(msg, info);
2179 2180
}

2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191
static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
	[NL80211_TXQ_ATTR_QUEUE]		= { .type = NLA_U8 },
	[NL80211_TXQ_ATTR_TXOP]			= { .type = NLA_U16 },
	[NL80211_TXQ_ATTR_CWMIN]		= { .type = NLA_U16 },
	[NL80211_TXQ_ATTR_CWMAX]		= { .type = NLA_U16 },
	[NL80211_TXQ_ATTR_AIFS]			= { .type = NLA_U8 },
};

static int parse_txq_params(struct nlattr *tb[],
			    struct ieee80211_txq_params *txq_params)
{
2192 2193
	u8 ac;

2194
	if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
2195 2196 2197 2198
	    !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
	    !tb[NL80211_TXQ_ATTR_AIFS])
		return -EINVAL;

2199
	ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
2200 2201 2202 2203 2204
	txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
	txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
	txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
	txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);

2205
	if (ac >= NL80211_NUM_ACS)
2206
		return -EINVAL;
2207
	txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS);
2208 2209 2210
	return 0;
}

2211 2212 2213
static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
{
	/*
2214 2215 2216 2217 2218 2219 2220 2221 2222
	 * You can only set the channel explicitly for WDS interfaces,
	 * all others have their channel managed via their respective
	 * "establish a connection" command (connect, join, ...)
	 *
	 * For AP/GO and mesh mode, the channel can be set with the
	 * channel userspace API, but is only stored and passed to the
	 * low-level driver when the AP starts or the mesh is joined.
	 * This is for backward compatibility, userspace can also give
	 * the channel in the start-ap or join-mesh commands instead.
2223 2224
	 *
	 * Monitors are special as they are normally slaved to
2225 2226
	 * whatever else is going on, so they have their own special
	 * operation to set the monitor channel if possible.
2227 2228 2229 2230
	 */
	return !wdev ||
		wdev->iftype == NL80211_IFTYPE_AP ||
		wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
2231 2232
		wdev->iftype == NL80211_IFTYPE_MONITOR ||
		wdev->iftype == NL80211_IFTYPE_P2P_GO;
2233 2234
}

2235 2236 2237 2238
static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
				 struct genl_info *info,
				 struct cfg80211_chan_def *chandef)
{
2239
	u32 control_freq;
2240 2241 2242 2243 2244 2245 2246

	if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
		return -EINVAL;

	control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);

	chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
2247 2248 2249
	chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
	chandef->center_freq1 = control_freq;
	chandef->center_freq2 = 0;
2250 2251 2252 2253 2254

	/* Primary channel not allowed */
	if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
		return -EINVAL;

2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267
	if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
		enum nl80211_channel_type chantype;

		chantype = nla_get_u32(
				info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);

		switch (chantype) {
		case NL80211_CHAN_NO_HT:
		case NL80211_CHAN_HT20:
		case NL80211_CHAN_HT40PLUS:
		case NL80211_CHAN_HT40MINUS:
			cfg80211_chandef_create(chandef, chandef->chan,
						chantype);
2268 2269 2270 2271 2272 2273 2274 2275 2276
			/* user input for center_freq is incorrect */
			if (info->attrs[NL80211_ATTR_CENTER_FREQ1] &&
			    chandef->center_freq1 != nla_get_u32(
					info->attrs[NL80211_ATTR_CENTER_FREQ1]))
				return -EINVAL;
			/* center_freq2 must be zero */
			if (info->attrs[NL80211_ATTR_CENTER_FREQ2] &&
			    nla_get_u32(info->attrs[NL80211_ATTR_CENTER_FREQ2]))
				return -EINVAL;
2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293
			break;
		default:
			return -EINVAL;
		}
	} else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
		chandef->width =
			nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
		if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
			chandef->center_freq1 =
				nla_get_u32(
					info->attrs[NL80211_ATTR_CENTER_FREQ1]);
		if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
			chandef->center_freq2 =
				nla_get_u32(
					info->attrs[NL80211_ATTR_CENTER_FREQ2]);
	}

2294
	if (!cfg80211_chandef_valid(chandef))
2295 2296
		return -EINVAL;

2297 2298
	if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
				     IEEE80211_CHAN_DISABLED))
2299 2300
		return -EINVAL;

2301 2302 2303 2304 2305
	if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
	     chandef->width == NL80211_CHAN_WIDTH_10) &&
	    !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ))
		return -EINVAL;

2306 2307 2308
	return 0;
}

2309
static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
2310
				 struct net_device *dev,
2311 2312
				 struct genl_info *info)
{
2313
	struct cfg80211_chan_def chandef;
2314
	int result;
2315
	enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
2316
	struct wireless_dev *wdev = NULL;
2317

2318 2319
	if (dev)
		wdev = dev->ieee80211_ptr;
2320 2321
	if (!nl80211_can_set_dev_channel(wdev))
		return -EOPNOTSUPP;
2322 2323
	if (wdev)
		iftype = wdev->iftype;
2324

2325 2326 2327
	result = nl80211_parse_chandef(rdev, info, &chandef);
	if (result)
		return result;
2328

2329
	switch (iftype) {
2330 2331
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_P2P_GO:
2332 2333
		if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
						   iftype)) {
2334 2335 2336
			result = -EINVAL;
			break;
		}
2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353
		if (wdev->beacon_interval) {
			if (!dev || !rdev->ops->set_ap_chanwidth ||
			    !(rdev->wiphy.features &
			      NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
				result = -EBUSY;
				break;
			}

			/* Only allow dynamic channel width changes */
			if (chandef.chan != wdev->preset_chandef.chan) {
				result = -EBUSY;
				break;
			}
			result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
			if (result)
				break;
		}
2354
		wdev->preset_chandef = chandef;
2355 2356
		result = 0;
		break;
2357
	case NL80211_IFTYPE_MESH_POINT:
2358
		result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
2359
		break;
2360
	case NL80211_IFTYPE_MONITOR:
2361
		result = cfg80211_set_monitor_channel(rdev, &chandef);
2362
		break;
2363
	default:
2364
		result = -EINVAL;
2365 2366 2367 2368 2369 2370 2371
	}

	return result;
}

static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
{
2372 2373
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *netdev = info->user_ptr[1];
2374

2375
	return __nl80211_set_channel(rdev, netdev, info);
2376 2377
}

2378 2379
static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
{
2380 2381 2382
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
J
Johannes Berg 已提交
2383
	const u8 *bssid;
2384 2385 2386 2387

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

2388 2389
	if (netif_running(dev))
		return -EBUSY;
2390

2391 2392
	if (!rdev->ops->set_wds_peer)
		return -EOPNOTSUPP;
2393

2394 2395
	if (wdev->iftype != NL80211_IFTYPE_WDS)
		return -EOPNOTSUPP;
2396 2397

	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
2398
	return rdev_set_wds_peer(rdev, dev, bssid);
2399 2400
}

2401 2402 2403
static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev;
2404 2405
	struct net_device *netdev = NULL;
	struct wireless_dev *wdev;
B
Bill Jordan 已提交
2406
	int result = 0, rem_txq_params = 0;
2407
	struct nlattr *nl_txq_params;
2408 2409 2410
	u32 changed;
	u8 retry_short = 0, retry_long = 0;
	u32 frag_threshold = 0, rts_threshold = 0;
2411
	u8 coverage_class = 0;
2412
	u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0;
2413

2414 2415
	ASSERT_RTNL();

2416 2417 2418 2419 2420 2421 2422 2423 2424
	/*
	 * Try to find the wiphy and netdev. Normally this
	 * function shouldn't need the netdev, but this is
	 * done for backward compatibility -- previously
	 * setting the channel was done per wiphy, but now
	 * it is per netdev. Previous userland like hostapd
	 * also passed a netdev to set_wiphy, so that it is
	 * possible to let that go to the right netdev!
	 */
2425

2426 2427 2428
	if (info->attrs[NL80211_ATTR_IFINDEX]) {
		int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);

2429
		netdev = __dev_get_by_index(genl_info_net(info), ifindex);
2430
		if (netdev && netdev->ieee80211_ptr)
2431
			rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
2432
		else
2433
			netdev = NULL;
2434 2435
	}

2436
	if (!netdev) {
2437 2438
		rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
						  info->attrs);
2439
		if (IS_ERR(rdev))
2440
			return PTR_ERR(rdev);
2441 2442 2443
		wdev = NULL;
		netdev = NULL;
		result = 0;
2444
	} else
2445 2446 2447 2448 2449 2450
		wdev = netdev->ieee80211_ptr;

	/*
	 * end workaround code, by now the rdev is available
	 * and locked, and wdev may or may not be NULL.
	 */
2451 2452

	if (info->attrs[NL80211_ATTR_WIPHY_NAME])
2453 2454
		result = cfg80211_dev_rename(
			rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
2455 2456

	if (result)
2457
		return result;
2458 2459 2460 2461 2462

	if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
		struct ieee80211_txq_params txq_params;
		struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];

2463 2464
		if (!rdev->ops->set_txq_params)
			return -EOPNOTSUPP;
2465

2466 2467
		if (!netdev)
			return -EINVAL;
2468

2469
		if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2470 2471
		    netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
			return -EINVAL;
2472

2473 2474
		if (!netif_running(netdev))
			return -ENETDOWN;
2475

2476 2477 2478
		nla_for_each_nested(nl_txq_params,
				    info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
				    rem_txq_params) {
2479 2480
			result = nla_parse_nested(tb, NL80211_TXQ_ATTR_MAX,
						  nl_txq_params,
2481 2482
						  txq_params_policy,
						  info->extack);
2483 2484
			if (result)
				return result;
2485 2486
			result = parse_txq_params(tb, &txq_params);
			if (result)
2487
				return result;
2488

2489 2490
			result = rdev_set_txq_params(rdev, netdev,
						     &txq_params);
2491
			if (result)
2492
				return result;
2493 2494
		}
	}
2495

2496
	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
2497 2498 2499 2500
		result = __nl80211_set_channel(
			rdev,
			nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
			info);
2501
		if (result)
2502
			return result;
2503 2504
	}

2505
	if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
2506
		struct wireless_dev *txp_wdev = wdev;
2507 2508 2509
		enum nl80211_tx_power_setting type;
		int idx, mbm = 0;

2510 2511 2512
		if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
			txp_wdev = NULL;

2513 2514
		if (!rdev->ops->set_tx_power)
			return -EOPNOTSUPP;
2515 2516 2517 2518 2519

		idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
		type = nla_get_u32(info->attrs[idx]);

		if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
2520 2521
		    (type != NL80211_TX_POWER_AUTOMATIC))
			return -EINVAL;
2522 2523 2524 2525 2526 2527

		if (type != NL80211_TX_POWER_AUTOMATIC) {
			idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
			mbm = nla_get_u32(info->attrs[idx]);
		}

2528
		result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
2529
		if (result)
2530
			return result;
2531 2532
	}

2533 2534 2535
	if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
	    info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
		u32 tx_ant, rx_ant;
2536

2537 2538
		if ((!rdev->wiphy.available_antennas_tx &&
		     !rdev->wiphy.available_antennas_rx) ||
2539 2540
		    !rdev->ops->set_antenna)
			return -EOPNOTSUPP;
2541 2542 2543 2544

		tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
		rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);

2545
		/* reject antenna configurations which don't match the
2546 2547
		 * available antenna masks, except for the "all" mask */
		if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
2548 2549
		    (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
			return -EINVAL;
2550

2551 2552
		tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
		rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
2553

2554
		result = rdev_set_antenna(rdev, tx_ant, rx_ant);
2555
		if (result)
2556
			return result;
2557 2558
	}

2559 2560 2561 2562 2563
	changed = 0;

	if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
		retry_short = nla_get_u8(
			info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
2564 2565 2566
		if (retry_short == 0)
			return -EINVAL;

2567 2568 2569 2570 2571 2572
		changed |= WIPHY_PARAM_RETRY_SHORT;
	}

	if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
		retry_long = nla_get_u8(
			info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
2573 2574 2575
		if (retry_long == 0)
			return -EINVAL;

2576 2577 2578 2579 2580 2581
		changed |= WIPHY_PARAM_RETRY_LONG;
	}

	if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
		frag_threshold = nla_get_u32(
			info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
2582 2583 2584
		if (frag_threshold < 256)
			return -EINVAL;

2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602
		if (frag_threshold != (u32) -1) {
			/*
			 * Fragments (apart from the last one) are required to
			 * have even length. Make the fragmentation code
			 * simpler by stripping LSB should someone try to use
			 * odd threshold value.
			 */
			frag_threshold &= ~0x1;
		}
		changed |= WIPHY_PARAM_FRAG_THRESHOLD;
	}

	if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
		rts_threshold = nla_get_u32(
			info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
		changed |= WIPHY_PARAM_RTS_THRESHOLD;
	}

2603
	if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
2604 2605 2606
		if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
			return -EINVAL;

2607 2608 2609 2610 2611
		coverage_class = nla_get_u8(
			info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
		changed |= WIPHY_PARAM_COVERAGE_CLASS;
	}

2612 2613 2614 2615 2616
	if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
		if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
			return -EOPNOTSUPP;

		changed |= WIPHY_PARAM_DYN_ACK;
2617 2618
	}

2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645
	if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) {
		if (!wiphy_ext_feature_isset(&rdev->wiphy,
					     NL80211_EXT_FEATURE_TXQS))
			return -EOPNOTSUPP;
		txq_limit = nla_get_u32(
			info->attrs[NL80211_ATTR_TXQ_LIMIT]);
		changed |= WIPHY_PARAM_TXQ_LIMIT;
	}

	if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) {
		if (!wiphy_ext_feature_isset(&rdev->wiphy,
					     NL80211_EXT_FEATURE_TXQS))
			return -EOPNOTSUPP;
		txq_memory_limit = nla_get_u32(
			info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]);
		changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT;
	}

	if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) {
		if (!wiphy_ext_feature_isset(&rdev->wiphy,
					     NL80211_EXT_FEATURE_TXQS))
			return -EOPNOTSUPP;
		txq_quantum = nla_get_u32(
			info->attrs[NL80211_ATTR_TXQ_QUANTUM]);
		changed |= WIPHY_PARAM_TXQ_QUANTUM;
	}

2646 2647 2648
	if (changed) {
		u8 old_retry_short, old_retry_long;
		u32 old_frag_threshold, old_rts_threshold;
2649
		u8 old_coverage_class;
2650
		u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum;
2651

2652 2653
		if (!rdev->ops->set_wiphy_params)
			return -EOPNOTSUPP;
2654 2655 2656 2657 2658

		old_retry_short = rdev->wiphy.retry_short;
		old_retry_long = rdev->wiphy.retry_long;
		old_frag_threshold = rdev->wiphy.frag_threshold;
		old_rts_threshold = rdev->wiphy.rts_threshold;
2659
		old_coverage_class = rdev->wiphy.coverage_class;
2660 2661 2662
		old_txq_limit = rdev->wiphy.txq_limit;
		old_txq_memory_limit = rdev->wiphy.txq_memory_limit;
		old_txq_quantum = rdev->wiphy.txq_quantum;
2663 2664 2665 2666 2667 2668 2669 2670 2671

		if (changed & WIPHY_PARAM_RETRY_SHORT)
			rdev->wiphy.retry_short = retry_short;
		if (changed & WIPHY_PARAM_RETRY_LONG)
			rdev->wiphy.retry_long = retry_long;
		if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
			rdev->wiphy.frag_threshold = frag_threshold;
		if (changed & WIPHY_PARAM_RTS_THRESHOLD)
			rdev->wiphy.rts_threshold = rts_threshold;
2672 2673
		if (changed & WIPHY_PARAM_COVERAGE_CLASS)
			rdev->wiphy.coverage_class = coverage_class;
2674 2675 2676 2677 2678 2679
		if (changed & WIPHY_PARAM_TXQ_LIMIT)
			rdev->wiphy.txq_limit = txq_limit;
		if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT)
			rdev->wiphy.txq_memory_limit = txq_memory_limit;
		if (changed & WIPHY_PARAM_TXQ_QUANTUM)
			rdev->wiphy.txq_quantum = txq_quantum;
2680

2681
		result = rdev_set_wiphy_params(rdev, changed);
2682 2683 2684 2685 2686
		if (result) {
			rdev->wiphy.retry_short = old_retry_short;
			rdev->wiphy.retry_long = old_retry_long;
			rdev->wiphy.frag_threshold = old_frag_threshold;
			rdev->wiphy.rts_threshold = old_rts_threshold;
2687
			rdev->wiphy.coverage_class = old_coverage_class;
2688 2689 2690
			rdev->wiphy.txq_limit = old_txq_limit;
			rdev->wiphy.txq_memory_limit = old_txq_memory_limit;
			rdev->wiphy.txq_quantum = old_txq_quantum;
2691
			return result;
2692 2693
		}
	}
2694
	return 0;
2695 2696
}

2697 2698 2699
static inline u64 wdev_id(struct wireless_dev *wdev)
{
	return (u64)wdev->identifier |
2700
	       ((u64)wiphy_to_rdev(wdev->wiphy)->wiphy_idx << 32);
2701
}
2702

2703
static int nl80211_send_chandef(struct sk_buff *msg,
2704
				const struct cfg80211_chan_def *chandef)
2705
{
2706 2707
	if (WARN_ON(!cfg80211_chandef_valid(chandef)))
		return -EINVAL;
2708

2709 2710 2711
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
			chandef->chan->center_freq))
		return -ENOBUFS;
2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728
	switch (chandef->width) {
	case NL80211_CHAN_WIDTH_20_NOHT:
	case NL80211_CHAN_WIDTH_20:
	case NL80211_CHAN_WIDTH_40:
		if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
				cfg80211_get_chandef_type(chandef)))
			return -ENOBUFS;
		break;
	default:
		break;
	}
	if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
		return -ENOBUFS;
	if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
		return -ENOBUFS;
	if (chandef->center_freq2 &&
	    nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
2729 2730 2731 2732
		return -ENOBUFS;
	return 0;
}

2733
static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
2734
			      struct cfg80211_registered_device *rdev,
2735
			      struct wireless_dev *wdev, bool removal)
2736
{
2737
	struct net_device *dev = wdev->netdev;
2738
	u8 cmd = NL80211_CMD_NEW_INTERFACE;
2739 2740
	void *hdr;

2741 2742 2743 2744
	if (removal)
		cmd = NL80211_CMD_DEL_INTERFACE;

	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
2745 2746 2747
	if (!hdr)
		return -1;

2748 2749
	if (dev &&
	    (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
2750
	     nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
2751 2752 2753 2754
		goto nla_put_failure;

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
2755 2756
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD) ||
2757
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
2758 2759 2760 2761
	    nla_put_u32(msg, NL80211_ATTR_GENERATION,
			rdev->devlist_generation ^
			(cfg80211_rdev_list_generation << 2)))
		goto nla_put_failure;
2762

2763
	if (rdev->ops->get_channel) {
2764 2765 2766 2767 2768 2769 2770 2771
		int ret;
		struct cfg80211_chan_def chandef;

		ret = rdev_get_channel(rdev, wdev, &chandef);
		if (ret == 0) {
			if (nl80211_send_chandef(msg, &chandef))
				goto nla_put_failure;
		}
2772 2773
	}

2774 2775 2776 2777 2778 2779 2780 2781 2782 2783
	if (rdev->ops->get_tx_power) {
		int dbm, ret;

		ret = rdev_get_tx_power(rdev, wdev, &dbm);
		if (ret == 0 &&
		    nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
				DBM_TO_MBM(dbm)))
			goto nla_put_failure;
	}

2784 2785 2786 2787 2788
	wdev_lock(wdev);
	switch (wdev->iftype) {
	case NL80211_IFTYPE_AP:
		if (wdev->ssid_len &&
		    nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
2789
			goto nla_put_failure_locked;
2790 2791 2792 2793 2794 2795 2796
		break;
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_P2P_CLIENT:
	case NL80211_IFTYPE_ADHOC: {
		const u8 *ssid_ie;
		if (!wdev->current_bss)
			break;
2797
		rcu_read_lock();
2798 2799
		ssid_ie = ieee80211_bss_get_ie(&wdev->current_bss->pub,
					       WLAN_EID_SSID);
2800 2801 2802 2803
		if (ssid_ie &&
		    nla_put(msg, NL80211_ATTR_SSID, ssid_ie[1], ssid_ie + 2))
			goto nla_put_failure_rcu_locked;
		rcu_read_unlock();
2804 2805 2806 2807 2808
		break;
		}
	default:
		/* nothing */
		break;
2809
	}
2810
	wdev_unlock(wdev);
2811

2812 2813 2814 2815 2816 2817 2818 2819 2820 2821
	if (rdev->ops->get_txq_stats) {
		struct cfg80211_txq_stats txqstats = {};
		int ret = rdev_get_txq_stats(rdev, wdev, &txqstats);

		if (ret == 0 &&
		    !nl80211_put_txq_stats(msg, &txqstats,
					   NL80211_ATTR_TXQ_STATS))
			goto nla_put_failure;
	}

2822 2823
	genlmsg_end(msg, hdr);
	return 0;
2824

2825 2826
 nla_put_failure_rcu_locked:
	rcu_read_unlock();
2827 2828
 nla_put_failure_locked:
	wdev_unlock(wdev);
2829
 nla_put_failure:
2830 2831
	genlmsg_cancel(msg, hdr);
	return -EMSGSIZE;
2832 2833 2834 2835 2836 2837 2838 2839
}

static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
{
	int wp_idx = 0;
	int if_idx = 0;
	int wp_start = cb->args[0];
	int if_start = cb->args[1];
2840
	int filter_wiphy = -1;
2841
	struct cfg80211_registered_device *rdev;
2842
	struct wireless_dev *wdev;
2843
	int ret;
2844

2845
	rtnl_lock();
2846 2847 2848 2849 2850 2851 2852
	if (!cb->args[2]) {
		struct nl80211_dump_wiphy_state state = {
			.filter_wiphy = -1,
		};

		ret = nl80211_dump_wiphy_parse(skb, cb, &state);
		if (ret)
2853
			goto out_unlock;
2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868

		filter_wiphy = state.filter_wiphy;

		/*
		 * if filtering, set cb->args[2] to +1 since 0 is the default
		 * value needed to determine that parsing is necessary.
		 */
		if (filter_wiphy >= 0)
			cb->args[2] = filter_wiphy + 1;
		else
			cb->args[2] = -1;
	} else if (cb->args[2] > 0) {
		filter_wiphy = cb->args[2] - 1;
	}

2869 2870
	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
		if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
2871
			continue;
J
Johannes Berg 已提交
2872 2873
		if (wp_idx < wp_start) {
			wp_idx++;
2874
			continue;
J
Johannes Berg 已提交
2875
		}
2876 2877 2878 2879

		if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
			continue;

2880 2881
		if_idx = 0;

2882
		list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
J
Johannes Berg 已提交
2883 2884
			if (if_idx < if_start) {
				if_idx++;
2885
				continue;
J
Johannes Berg 已提交
2886
			}
2887
			if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
2888
					       cb->nlh->nlmsg_seq, NLM_F_MULTI,
2889
					       rdev, wdev, false) < 0) {
J
Johannes Berg 已提交
2890 2891 2892
				goto out;
			}
			if_idx++;
2893
		}
J
Johannes Berg 已提交
2894 2895

		wp_idx++;
2896
	}
J
Johannes Berg 已提交
2897
 out:
2898 2899 2900
	cb->args[0] = wp_idx;
	cb->args[1] = if_idx;

2901 2902 2903 2904 2905
	ret = skb->len;
 out_unlock:
	rtnl_unlock();

	return ret;
2906 2907 2908 2909 2910
}

static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
{
	struct sk_buff *msg;
2911
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
2912
	struct wireless_dev *wdev = info->user_ptr[1];
2913

2914
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2915
	if (!msg)
2916
		return -ENOMEM;
2917

2918
	if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
2919
			       rdev, wdev, false) < 0) {
2920 2921 2922
		nlmsg_free(msg);
		return -ENOBUFS;
	}
2923

J
Johannes Berg 已提交
2924
	return genlmsg_reply(msg, info);
2925 2926
}

2927 2928 2929 2930 2931 2932
static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
	[NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
	[NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
	[NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
	[NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
	[NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
2933
	[NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
2934 2935 2936 2937 2938 2939 2940 2941 2942 2943 2944 2945
};

static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
{
	struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
	int flag;

	*mntrflags = 0;

	if (!nla)
		return -EINVAL;

2946 2947
	if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX, nla,
			     mntr_flags_policy, NULL))
2948 2949 2950 2951 2952 2953
		return -EINVAL;

	for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
		if (flags[flag])
			*mntrflags |= (1<<flag);

2954 2955
	*mntrflags |= MONITOR_FLAG_CHANGED;

2956 2957 2958
	return 0;
}

2959 2960 2961 2962 2963 2964 2965 2966 2967 2968 2969 2970 2971 2972 2973 2974 2975 2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994 2995 2996
static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
				     enum nl80211_iftype type,
				     struct genl_info *info,
				     struct vif_params *params)
{
	bool change = false;
	int err;

	if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
		if (type != NL80211_IFTYPE_MONITOR)
			return -EINVAL;

		err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
					  &params->flags);
		if (err)
			return err;

		change = true;
	}

	if (params->flags & MONITOR_FLAG_ACTIVE &&
	    !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
		return -EOPNOTSUPP;

	if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
		const u8 *mumimo_groups;
		u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;

		if (type != NL80211_IFTYPE_MONITOR)
			return -EINVAL;

		if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
			return -EOPNOTSUPP;

		mumimo_groups =
			nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);

		/* bits 0 and 63 are reserved and must be zero */
2997 2998
		if ((mumimo_groups[0] & BIT(0)) ||
		    (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7)))
2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021
			return -EINVAL;

		params->vht_mumimo_groups = mumimo_groups;
		change = true;
	}

	if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
		u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;

		if (type != NL80211_IFTYPE_MONITOR)
			return -EINVAL;

		if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
			return -EOPNOTSUPP;

		params->vht_mumimo_follow_addr =
			nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
		change = true;
	}

	return change ? 1 : 0;
}

3022
static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
3023 3024
			       struct net_device *netdev, u8 use_4addr,
			       enum nl80211_iftype iftype)
3025
{
3026
	if (!use_4addr) {
3027
		if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
3028
			return -EBUSY;
3029
		return 0;
3030
	}
3031 3032 3033 3034 3035 3036 3037 3038 3039 3040 3041 3042 3043 3044 3045 3046 3047

	switch (iftype) {
	case NL80211_IFTYPE_AP_VLAN:
		if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
			return 0;
		break;
	case NL80211_IFTYPE_STATION:
		if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
			return 0;
		break;
	default:
		break;
	}

	return -EOPNOTSUPP;
}

3048 3049
static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
{
3050
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3051
	struct vif_params params;
3052
	int err;
J
Johannes Berg 已提交
3053
	enum nl80211_iftype otype, ntype;
3054
	struct net_device *dev = info->user_ptr[1];
3055
	bool change = false;
3056

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

J
Johannes Berg 已提交
3059
	otype = ntype = dev->ieee80211_ptr->iftype;
3060

3061
	if (info->attrs[NL80211_ATTR_IFTYPE]) {
3062
		ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
J
Johannes Berg 已提交
3063
		if (otype != ntype)
3064
			change = true;
3065 3066
		if (ntype > NL80211_IFTYPE_MAX)
			return -EINVAL;
3067 3068
	}

3069
	if (info->attrs[NL80211_ATTR_MESH_ID]) {
3070 3071
		struct wireless_dev *wdev = dev->ieee80211_ptr;

3072 3073
		if (ntype != NL80211_IFTYPE_MESH_POINT)
			return -EINVAL;
3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084
		if (netif_running(dev))
			return -EBUSY;

		wdev_lock(wdev);
		BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
			     IEEE80211_MAX_MESH_ID_LEN);
		wdev->mesh_id_up_len =
			nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
		memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
		       wdev->mesh_id_up_len);
		wdev_unlock(wdev);
3085 3086
	}

3087 3088 3089
	if (info->attrs[NL80211_ATTR_4ADDR]) {
		params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
		change = true;
3090
		err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
3091
		if (err)
3092
			return err;
3093 3094 3095 3096
	} else {
		params.use_4addr = -1;
	}

3097 3098 3099 3100
	err = nl80211_parse_mon_options(rdev, ntype, info, &params);
	if (err < 0)
		return err;
	if (err > 0)
3101
		change = true;
3102

3103
	if (change)
3104
		err = cfg80211_change_iface(rdev, dev, ntype, &params);
3105 3106
	else
		err = 0;
J
Johannes Berg 已提交
3107

3108 3109 3110
	if (!err && params.use_4addr != -1)
		dev->ieee80211_ptr->use_4addr = params.use_4addr;

3111 3112 3113 3114 3115
	return err;
}

static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
{
3116
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3117
	struct vif_params params;
3118
	struct wireless_dev *wdev;
3119
	struct sk_buff *msg;
3120 3121 3122
	int err;
	enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;

3123 3124 3125
	/* to avoid failing a new interface creation due to pending removal */
	cfg80211_destroy_ifaces(rdev);

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

3128 3129 3130 3131 3132 3133 3134 3135 3136
	if (!info->attrs[NL80211_ATTR_IFNAME])
		return -EINVAL;

	if (info->attrs[NL80211_ATTR_IFTYPE]) {
		type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
		if (type > NL80211_IFTYPE_MAX)
			return -EINVAL;
	}

3137
	if (!rdev->ops->add_virtual_intf ||
3138 3139
	    !(rdev->wiphy.interface_modes & (1 << type)))
		return -EOPNOTSUPP;
3140

3141
	if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
3142 3143
	     rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
	    info->attrs[NL80211_ATTR_MAC]) {
3144 3145 3146 3147 3148 3149
		nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
			   ETH_ALEN);
		if (!is_valid_ether_addr(params.macaddr))
			return -EADDRNOTAVAIL;
	}

3150
	if (info->attrs[NL80211_ATTR_4ADDR]) {
3151
		params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
3152
		err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
3153
		if (err)
3154
			return err;
3155
	}
3156

3157 3158 3159
	err = nl80211_parse_mon_options(rdev, type, info, &params);
	if (err < 0)
		return err;
3160

3161 3162 3163 3164
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg)
		return -ENOMEM;

3165 3166
	wdev = rdev_add_virtual_intf(rdev,
				nla_data(info->attrs[NL80211_ATTR_IFNAME]),
3167
				NET_NAME_USER, type, &params);
3168 3169 3170 3171
	if (WARN_ON(!wdev)) {
		nlmsg_free(msg);
		return -EPROTO;
	} else if (IS_ERR(wdev)) {
3172
		nlmsg_free(msg);
3173
		return PTR_ERR(wdev);
3174
	}
3175

3176
	if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
3177 3178
		wdev->owner_nlportid = info->snd_portid;

3179 3180 3181 3182
	switch (type) {
	case NL80211_IFTYPE_MESH_POINT:
		if (!info->attrs[NL80211_ATTR_MESH_ID])
			break;
3183 3184 3185 3186 3187 3188 3189 3190
		wdev_lock(wdev);
		BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
			     IEEE80211_MAX_MESH_ID_LEN);
		wdev->mesh_id_up_len =
			nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
		memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
		       wdev->mesh_id_up_len);
		wdev_unlock(wdev);
3191
		break;
3192
	case NL80211_IFTYPE_NAN:
3193 3194
	case NL80211_IFTYPE_P2P_DEVICE:
		/*
3195
		 * P2P Device and NAN do not have a netdev, so don't go
3196 3197 3198 3199 3200 3201 3202 3203 3204
		 * through the netdev notifier and must be added here
		 */
		mutex_init(&wdev->mtx);
		INIT_LIST_HEAD(&wdev->event_list);
		spin_lock_init(&wdev->event_lock);
		INIT_LIST_HEAD(&wdev->mgmt_registrations);
		spin_lock_init(&wdev->mgmt_registrations_lock);

		wdev->identifier = ++rdev->wdev_id;
3205
		list_add_rcu(&wdev->list, &rdev->wiphy.wdev_list);
3206 3207 3208 3209
		rdev->devlist_generation++;
		break;
	default:
		break;
3210 3211
	}

3212
	if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
3213
			       rdev, wdev, false) < 0) {
3214 3215 3216 3217
		nlmsg_free(msg);
		return -ENOBUFS;
	}

3218 3219 3220 3221 3222 3223 3224 3225
	/*
	 * For wdevs which have no associated netdev object (e.g. of type
	 * NL80211_IFTYPE_P2P_DEVICE), emit the NEW_INTERFACE event here.
	 * For all other types, the event will be generated from the
	 * netdev notifier
	 */
	if (!wdev->netdev)
		nl80211_notify_iface(rdev, wdev, NL80211_CMD_NEW_INTERFACE);
3226

3227
	return genlmsg_reply(msg, info);
3228 3229 3230 3231
}

static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
{
3232
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3233
	struct wireless_dev *wdev = info->user_ptr[1];
3234

3235 3236
	if (!rdev->ops->del_virtual_intf)
		return -EOPNOTSUPP;
3237

3238 3239 3240 3241 3242 3243 3244 3245 3246 3247
	/*
	 * If we remove a wireless device without a netdev then clear
	 * user_ptr[1] so that nl80211_post_doit won't dereference it
	 * to check if it needs to do dev_put(). Otherwise it crashes
	 * since the wdev has been freed, unlike with a netdev where
	 * we need the dev_put() for the netdev to really be freed.
	 */
	if (!wdev->netdev)
		info->user_ptr[1] = NULL;

3248
	return rdev_del_virtual_intf(rdev, wdev);
3249 3250
}

3251 3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264
static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	u16 noack_map;

	if (!info->attrs[NL80211_ATTR_NOACK_MAP])
		return -EINVAL;

	if (!rdev->ops->set_noack_map)
		return -EOPNOTSUPP;

	noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);

3265
	return rdev_set_noack_map(rdev, dev, noack_map);
3266 3267
}

3268 3269 3270
struct get_key_cookie {
	struct sk_buff *msg;
	int error;
3271
	int idx;
3272 3273 3274 3275
};

static void get_key_callback(void *c, struct key_params *params)
{
3276
	struct nlattr *key;
3277 3278
	struct get_key_cookie *cookie = c;

3279 3280 3281 3282 3283 3284 3285 3286 3287 3288
	if ((params->key &&
	     nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
		     params->key_len, params->key)) ||
	    (params->seq &&
	     nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
		     params->seq_len, params->seq)) ||
	    (params->cipher &&
	     nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
			 params->cipher)))
		goto nla_put_failure;
3289

3290 3291 3292 3293
	key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
	if (!key)
		goto nla_put_failure;

3294 3295 3296 3297 3298 3299 3300 3301 3302 3303
	if ((params->key &&
	     nla_put(cookie->msg, NL80211_KEY_DATA,
		     params->key_len, params->key)) ||
	    (params->seq &&
	     nla_put(cookie->msg, NL80211_KEY_SEQ,
		     params->seq_len, params->seq)) ||
	    (params->cipher &&
	     nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
			 params->cipher)))
		goto nla_put_failure;
3304

3305 3306
	if (nla_put_u8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx))
		goto nla_put_failure;
3307 3308 3309

	nla_nest_end(cookie->msg, key);

3310 3311 3312 3313 3314 3315 3316
	return;
 nla_put_failure:
	cookie->error = 1;
}

static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
{
3317
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3318
	int err;
3319
	struct net_device *dev = info->user_ptr[1];
3320
	u8 key_idx = 0;
3321 3322
	const u8 *mac_addr = NULL;
	bool pairwise;
3323 3324 3325 3326 3327 3328 3329 3330 3331
	struct get_key_cookie cookie = {
		.error = 0,
	};
	void *hdr;
	struct sk_buff *msg;

	if (info->attrs[NL80211_ATTR_KEY_IDX])
		key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);

3332
	if (key_idx > 5)
3333 3334 3335 3336 3337
		return -EINVAL;

	if (info->attrs[NL80211_ATTR_MAC])
		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);

3338 3339 3340
	pairwise = !!mac_addr;
	if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
		u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
3341

3342 3343 3344 3345 3346 3347 3348 3349
		if (kt >= NUM_NL80211_KEYTYPES)
			return -EINVAL;
		if (kt != NL80211_KEYTYPE_GROUP &&
		    kt != NL80211_KEYTYPE_PAIRWISE)
			return -EINVAL;
		pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
	}

3350 3351
	if (!rdev->ops->get_key)
		return -EOPNOTSUPP;
3352

3353 3354 3355
	if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
		return -ENOENT;

3356
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3357 3358
	if (!msg)
		return -ENOMEM;
3359

3360
	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
3361
			     NL80211_CMD_NEW_KEY);
3362
	if (!hdr)
3363
		goto nla_put_failure;
3364 3365

	cookie.msg = msg;
3366
	cookie.idx = key_idx;
3367

3368 3369 3370 3371 3372 3373
	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
		goto nla_put_failure;
	if (mac_addr &&
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
		goto nla_put_failure;
3374

3375 3376
	err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
			   get_key_callback);
3377 3378

	if (err)
N
Niko Jokinen 已提交
3379
		goto free_msg;
3380 3381 3382 3383 3384

	if (cookie.error)
		goto nla_put_failure;

	genlmsg_end(msg, hdr);
3385
	return genlmsg_reply(msg, info);
3386 3387 3388

 nla_put_failure:
	err = -ENOBUFS;
N
Niko Jokinen 已提交
3389
 free_msg:
3390 3391 3392 3393 3394 3395
	nlmsg_free(msg);
	return err;
}

static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
{
3396
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3397
	struct key_parse key;
3398
	int err;
3399
	struct net_device *dev = info->user_ptr[1];
3400

3401 3402 3403
	err = nl80211_parse_key(info, &key);
	if (err)
		return err;
3404

3405
	if (key.idx < 0)
3406 3407
		return -EINVAL;

3408 3409
	/* only support setting default key */
	if (!key.def && !key.defmgmt)
3410 3411
		return -EINVAL;

3412
	wdev_lock(dev->ieee80211_ptr);
3413

3414 3415 3416 3417 3418
	if (key.def) {
		if (!rdev->ops->set_default_key) {
			err = -EOPNOTSUPP;
			goto out;
		}
3419

3420 3421 3422 3423
		err = nl80211_key_allowed(dev->ieee80211_ptr);
		if (err)
			goto out;

3424
		err = rdev_set_default_key(rdev, dev, key.idx,
3425 3426 3427 3428
						 key.def_uni, key.def_multi);

		if (err)
			goto out;
J
Johannes Berg 已提交
3429

J
Johannes Berg 已提交
3430
#ifdef CONFIG_CFG80211_WEXT
3431 3432 3433 3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447
		dev->ieee80211_ptr->wext.default_key = key.idx;
#endif
	} else {
		if (key.def_uni || !key.def_multi) {
			err = -EINVAL;
			goto out;
		}

		if (!rdev->ops->set_default_mgmt_key) {
			err = -EOPNOTSUPP;
			goto out;
		}

		err = nl80211_key_allowed(dev->ieee80211_ptr);
		if (err)
			goto out;

3448
		err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
3449 3450 3451 3452 3453
		if (err)
			goto out;

#ifdef CONFIG_CFG80211_WEXT
		dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
3454
#endif
3455 3456 3457
	}

 out:
J
Johannes Berg 已提交
3458
	wdev_unlock(dev->ieee80211_ptr);
3459 3460 3461 3462 3463 3464

	return err;
}

static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
{
3465
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
J
Johannes Berg 已提交
3466
	int err;
3467
	struct net_device *dev = info->user_ptr[1];
3468
	struct key_parse key;
3469
	const u8 *mac_addr = NULL;
3470

3471 3472 3473
	err = nl80211_parse_key(info, &key);
	if (err)
		return err;
3474

3475
	if (!key.p.key)
3476 3477 3478 3479 3480
		return -EINVAL;

	if (info->attrs[NL80211_ATTR_MAC])
		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);

3481 3482 3483 3484 3485 3486 3487 3488 3489 3490 3491 3492
	if (key.type == -1) {
		if (mac_addr)
			key.type = NL80211_KEYTYPE_PAIRWISE;
		else
			key.type = NL80211_KEYTYPE_GROUP;
	}

	/* for now */
	if (key.type != NL80211_KEYTYPE_PAIRWISE &&
	    key.type != NL80211_KEYTYPE_GROUP)
		return -EINVAL;

3493 3494
	if (!rdev->ops->add_key)
		return -EOPNOTSUPP;
3495

3496 3497 3498
	if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
					   key.type == NL80211_KEYTYPE_PAIRWISE,
					   mac_addr))
3499
		return -EINVAL;
3500

J
Johannes Berg 已提交
3501 3502 3503
	wdev_lock(dev->ieee80211_ptr);
	err = nl80211_key_allowed(dev->ieee80211_ptr);
	if (!err)
3504 3505 3506
		err = rdev_add_key(rdev, dev, key.idx,
				   key.type == NL80211_KEYTYPE_PAIRWISE,
				    mac_addr, &key.p);
J
Johannes Berg 已提交
3507
	wdev_unlock(dev->ieee80211_ptr);
3508 3509 3510 3511 3512 3513

	return err;
}

static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
{
3514
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3515
	int err;
3516
	struct net_device *dev = info->user_ptr[1];
3517
	u8 *mac_addr = NULL;
3518
	struct key_parse key;
3519

3520 3521 3522
	err = nl80211_parse_key(info, &key);
	if (err)
		return err;
3523 3524 3525 3526

	if (info->attrs[NL80211_ATTR_MAC])
		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);

3527 3528 3529 3530 3531 3532 3533 3534 3535 3536 3537 3538
	if (key.type == -1) {
		if (mac_addr)
			key.type = NL80211_KEYTYPE_PAIRWISE;
		else
			key.type = NL80211_KEYTYPE_GROUP;
	}

	/* for now */
	if (key.type != NL80211_KEYTYPE_PAIRWISE &&
	    key.type != NL80211_KEYTYPE_GROUP)
		return -EINVAL;

3539 3540
	if (!rdev->ops->del_key)
		return -EOPNOTSUPP;
3541

J
Johannes Berg 已提交
3542 3543
	wdev_lock(dev->ieee80211_ptr);
	err = nl80211_key_allowed(dev->ieee80211_ptr);
3544

3545
	if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
3546 3547 3548
	    !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
		err = -ENOENT;

J
Johannes Berg 已提交
3549
	if (!err)
3550 3551 3552
		err = rdev_del_key(rdev, dev, key.idx,
				   key.type == NL80211_KEYTYPE_PAIRWISE,
				   mac_addr);
3553

J
Johannes Berg 已提交
3554
#ifdef CONFIG_CFG80211_WEXT
3555
	if (!err) {
3556
		if (key.idx == dev->ieee80211_ptr->wext.default_key)
3557
			dev->ieee80211_ptr->wext.default_key = -1;
3558
		else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
3559 3560 3561
			dev->ieee80211_ptr->wext.default_mgmt_key = -1;
	}
#endif
J
Johannes Berg 已提交
3562
	wdev_unlock(dev->ieee80211_ptr);
3563

3564 3565 3566
	return err;
}

3567 3568 3569 3570 3571 3572 3573 3574 3575 3576 3577 3578 3579 3580 3581 3582 3583 3584 3585 3586 3587 3588 3589 3590 3591 3592 3593 3594 3595 3596 3597 3598 3599 3600 3601 3602 3603 3604 3605 3606 3607 3608 3609 3610 3611 3612 3613 3614 3615 3616 3617 3618 3619 3620 3621 3622 3623 3624 3625 3626 3627 3628 3629 3630 3631 3632 3633 3634 3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645 3646 3647 3648 3649 3650 3651 3652 3653 3654 3655 3656 3657
/* This function returns an error or the number of nested attributes */
static int validate_acl_mac_addrs(struct nlattr *nl_attr)
{
	struct nlattr *attr;
	int n_entries = 0, tmp;

	nla_for_each_nested(attr, nl_attr, tmp) {
		if (nla_len(attr) != ETH_ALEN)
			return -EINVAL;

		n_entries++;
	}

	return n_entries;
}

/*
 * This function parses ACL information and allocates memory for ACL data.
 * On successful return, the calling function is responsible to free the
 * ACL buffer returned by this function.
 */
static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
						struct genl_info *info)
{
	enum nl80211_acl_policy acl_policy;
	struct nlattr *attr;
	struct cfg80211_acl_data *acl;
	int i = 0, n_entries, tmp;

	if (!wiphy->max_acl_mac_addrs)
		return ERR_PTR(-EOPNOTSUPP);

	if (!info->attrs[NL80211_ATTR_ACL_POLICY])
		return ERR_PTR(-EINVAL);

	acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
	if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
	    acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
		return ERR_PTR(-EINVAL);

	if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
		return ERR_PTR(-EINVAL);

	n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
	if (n_entries < 0)
		return ERR_PTR(n_entries);

	if (n_entries > wiphy->max_acl_mac_addrs)
		return ERR_PTR(-ENOTSUPP);

	acl = kzalloc(sizeof(*acl) + (sizeof(struct mac_address) * n_entries),
		      GFP_KERNEL);
	if (!acl)
		return ERR_PTR(-ENOMEM);

	nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
		memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
		i++;
	}

	acl->n_acl_entries = n_entries;
	acl->acl_policy = acl_policy;

	return acl;
}

static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct cfg80211_acl_data *acl;
	int err;

	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
		return -EOPNOTSUPP;

	if (!dev->ieee80211_ptr->beacon_interval)
		return -EINVAL;

	acl = parse_acl_data(&rdev->wiphy, info);
	if (IS_ERR(acl))
		return PTR_ERR(acl);

	err = rdev_set_mac_acl(rdev, dev, acl);

	kfree(acl);

	return err;
}

3658 3659 3660 3661 3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675 3676 3677 3678 3679 3680 3681 3682 3683 3684 3685 3686 3687 3688 3689 3690 3691 3692 3693 3694 3695 3696 3697 3698 3699 3700 3701 3702 3703 3704 3705 3706 3707 3708 3709 3710 3711 3712 3713 3714 3715 3716 3717 3718 3719 3720 3721 3722 3723 3724 3725 3726 3727 3728 3729 3730 3731 3732 3733 3734 3735 3736 3737 3738 3739 3740 3741 3742 3743 3744 3745 3746 3747 3748 3749 3750 3751 3752 3753 3754 3755 3756 3757 3758 3759 3760 3761 3762 3763 3764 3765 3766 3767 3768 3769 3770 3771 3772 3773 3774 3775 3776 3777 3778 3779 3780 3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791 3792 3793 3794 3795 3796 3797 3798 3799 3800 3801 3802 3803 3804 3805 3806 3807 3808 3809 3810 3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823 3824 3825 3826
static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
			   u8 *rates, u8 rates_len)
{
	u8 i;
	u32 mask = 0;

	for (i = 0; i < rates_len; i++) {
		int rate = (rates[i] & 0x7f) * 5;
		int ridx;

		for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
			struct ieee80211_rate *srate =
				&sband->bitrates[ridx];
			if (rate == srate->bitrate) {
				mask |= 1 << ridx;
				break;
			}
		}
		if (ridx == sband->n_bitrates)
			return 0; /* rate not found */
	}

	return mask;
}

static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
			       u8 *rates, u8 rates_len,
			       u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
{
	u8 i;

	memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);

	for (i = 0; i < rates_len; i++) {
		int ridx, rbit;

		ridx = rates[i] / 8;
		rbit = BIT(rates[i] % 8);

		/* check validity */
		if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
			return false;

		/* check availability */
		if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
			mcs[ridx] |= rbit;
		else
			return false;
	}

	return true;
}

static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
{
	u16 mcs_mask = 0;

	switch (vht_mcs_map) {
	case IEEE80211_VHT_MCS_NOT_SUPPORTED:
		break;
	case IEEE80211_VHT_MCS_SUPPORT_0_7:
		mcs_mask = 0x00FF;
		break;
	case IEEE80211_VHT_MCS_SUPPORT_0_8:
		mcs_mask = 0x01FF;
		break;
	case IEEE80211_VHT_MCS_SUPPORT_0_9:
		mcs_mask = 0x03FF;
		break;
	default:
		break;
	}

	return mcs_mask;
}

static void vht_build_mcs_mask(u16 vht_mcs_map,
			       u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
{
	u8 nss;

	for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
		vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
		vht_mcs_map >>= 2;
	}
}

static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
			     struct nl80211_txrate_vht *txrate,
			     u16 mcs[NL80211_VHT_NSS_MAX])
{
	u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
	u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
	u8 i;

	if (!sband->vht_cap.vht_supported)
		return false;

	memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);

	/* Build vht_mcs_mask from VHT capabilities */
	vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);

	for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
		if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
			mcs[i] = txrate->mcs[i];
		else
			return false;
	}

	return true;
}

static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
	[NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
				    .len = NL80211_MAX_SUPP_RATES },
	[NL80211_TXRATE_HT] = { .type = NLA_BINARY,
				.len = NL80211_MAX_SUPP_HT_RATES },
	[NL80211_TXRATE_VHT] = { .len = sizeof(struct nl80211_txrate_vht)},
	[NL80211_TXRATE_GI] = { .type = NLA_U8 },
};

static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
					 struct cfg80211_bitrate_mask *mask)
{
	struct nlattr *tb[NL80211_TXRATE_MAX + 1];
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	int rem, i;
	struct nlattr *tx_rates;
	struct ieee80211_supported_band *sband;
	u16 vht_tx_mcs_map;

	memset(mask, 0, sizeof(*mask));
	/* Default to all rates enabled */
	for (i = 0; i < NUM_NL80211_BANDS; i++) {
		sband = rdev->wiphy.bands[i];

		if (!sband)
			continue;

		mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
		memcpy(mask->control[i].ht_mcs,
		       sband->ht_cap.mcs.rx_mask,
		       sizeof(mask->control[i].ht_mcs));

		if (!sband->vht_cap.vht_supported)
			continue;

		vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
		vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
	}

	/* if no rates are given set it back to the defaults */
	if (!info->attrs[NL80211_ATTR_TX_RATES])
		goto out;

	/* The nested attribute uses enum nl80211_band as the index. This maps
	 * directly to the enum nl80211_band values used in cfg80211.
	 */
	BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
	nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
		enum nl80211_band band = nla_type(tx_rates);
		int err;

		if (band < 0 || band >= NUM_NL80211_BANDS)
			return -EINVAL;
		sband = rdev->wiphy.bands[band];
		if (sband == NULL)
			return -EINVAL;
3827
		err = nla_parse_nested(tb, NL80211_TXRATE_MAX, tx_rates,
3828
				       nl80211_txattr_policy, info->extack);
3829 3830 3831 3832 3833 3834 3835 3836 3837 3838 3839 3840 3841 3842 3843 3844 3845 3846 3847 3848 3849 3850 3851 3852 3853 3854 3855 3856 3857 3858 3859 3860 3861 3862 3863 3864 3865 3866 3867 3868 3869 3870 3871 3872 3873 3874 3875 3876 3877 3878 3879 3880 3881 3882 3883 3884 3885 3886
		if (err)
			return err;
		if (tb[NL80211_TXRATE_LEGACY]) {
			mask->control[band].legacy = rateset_to_mask(
				sband,
				nla_data(tb[NL80211_TXRATE_LEGACY]),
				nla_len(tb[NL80211_TXRATE_LEGACY]));
			if ((mask->control[band].legacy == 0) &&
			    nla_len(tb[NL80211_TXRATE_LEGACY]))
				return -EINVAL;
		}
		if (tb[NL80211_TXRATE_HT]) {
			if (!ht_rateset_to_mask(
					sband,
					nla_data(tb[NL80211_TXRATE_HT]),
					nla_len(tb[NL80211_TXRATE_HT]),
					mask->control[band].ht_mcs))
				return -EINVAL;
		}
		if (tb[NL80211_TXRATE_VHT]) {
			if (!vht_set_mcs_mask(
					sband,
					nla_data(tb[NL80211_TXRATE_VHT]),
					mask->control[band].vht_mcs))
				return -EINVAL;
		}
		if (tb[NL80211_TXRATE_GI]) {
			mask->control[band].gi =
				nla_get_u8(tb[NL80211_TXRATE_GI]);
			if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
				return -EINVAL;
		}

		if (mask->control[band].legacy == 0) {
			/* don't allow empty legacy rates if HT or VHT
			 * are not even supported.
			 */
			if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
			      rdev->wiphy.bands[band]->vht_cap.vht_supported))
				return -EINVAL;

			for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
				if (mask->control[band].ht_mcs[i])
					goto out;

			for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
				if (mask->control[band].vht_mcs[i])
					goto out;

			/* legacy and mcs rates may not be both empty */
			return -EINVAL;
		}
	}

out:
	return 0;
}

3887 3888 3889
static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
				   enum nl80211_band band,
				   struct cfg80211_bitrate_mask *beacon_rate)
3890
{
3891 3892
	u32 count_ht, count_vht, i;
	u32 rate = beacon_rate->control[band].legacy;
3893 3894 3895 3896 3897 3898 3899

	/* Allow only one rate */
	if (hweight32(rate) > 1)
		return -EINVAL;

	count_ht = 0;
	for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
3900
		if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
3901
			return -EINVAL;
3902
		} else if (beacon_rate->control[band].ht_mcs[i]) {
3903 3904 3905 3906 3907 3908 3909 3910 3911 3912
			count_ht++;
			if (count_ht > 1)
				return -EINVAL;
		}
		if (count_ht && rate)
			return -EINVAL;
	}

	count_vht = 0;
	for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
3913
		if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
3914
			return -EINVAL;
3915
		} else if (beacon_rate->control[band].vht_mcs[i]) {
3916 3917 3918 3919 3920 3921 3922 3923 3924 3925 3926
			count_vht++;
			if (count_vht > 1)
				return -EINVAL;
		}
		if (count_vht && rate)
			return -EINVAL;
	}

	if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
		return -EINVAL;

3927 3928 3929 3930 3931 3932 3933 3934 3935 3936 3937 3938 3939
	if (rate &&
	    !wiphy_ext_feature_isset(&rdev->wiphy,
				     NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
		return -EINVAL;
	if (count_ht &&
	    !wiphy_ext_feature_isset(&rdev->wiphy,
				     NL80211_EXT_FEATURE_BEACON_RATE_HT))
		return -EINVAL;
	if (count_vht &&
	    !wiphy_ext_feature_isset(&rdev->wiphy,
				     NL80211_EXT_FEATURE_BEACON_RATE_VHT))
		return -EINVAL;

3940 3941 3942
	return 0;
}

3943
static int nl80211_parse_beacon(struct nlattr *attrs[],
3944
				struct cfg80211_beacon_data *bcn)
3945
{
3946
	bool haveinfo = false;
3947

3948 3949 3950 3951
	if (!is_valid_ie_attr(attrs[NL80211_ATTR_BEACON_TAIL]) ||
	    !is_valid_ie_attr(attrs[NL80211_ATTR_IE]) ||
	    !is_valid_ie_attr(attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
	    !is_valid_ie_attr(attrs[NL80211_ATTR_IE_ASSOC_RESP]))
3952 3953
		return -EINVAL;

3954
	memset(bcn, 0, sizeof(*bcn));
3955

3956 3957 3958
	if (attrs[NL80211_ATTR_BEACON_HEAD]) {
		bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
		bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
3959 3960 3961
		if (!bcn->head_len)
			return -EINVAL;
		haveinfo = true;
3962 3963
	}

3964 3965 3966
	if (attrs[NL80211_ATTR_BEACON_TAIL]) {
		bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
		bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
3967
		haveinfo = true;
3968 3969
	}

3970 3971
	if (!haveinfo)
		return -EINVAL;
J
Johannes Berg 已提交
3972

3973 3974 3975
	if (attrs[NL80211_ATTR_IE]) {
		bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
		bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
3976 3977
	}

3978
	if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
3979
		bcn->proberesp_ies =
3980
			nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
3981
		bcn->proberesp_ies_len =
3982
			nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
3983 3984
	}

3985
	if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
3986
		bcn->assocresp_ies =
3987
			nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
3988
		bcn->assocresp_ies_len =
3989
			nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
3990 3991
	}

3992 3993 3994
	if (attrs[NL80211_ATTR_PROBE_RESP]) {
		bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
		bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
3995 3996
	}

3997 3998 3999
	return 0;
}

4000 4001 4002 4003 4004 4005 4006 4007 4008 4009 4010 4011 4012 4013 4014 4015 4016 4017 4018 4019 4020 4021 4022 4023
static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
					    const u8 *rates)
{
	int i;

	if (!rates)
		return;

	for (i = 0; i < rates[1]; i++) {
		if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
			params->ht_required = true;
		if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
			params->vht_required = true;
	}
}

/*
 * Since the nl80211 API didn't include, from the beginning, attributes about
 * HT/VHT requirements/capabilities, we parse them out of the IEs for the
 * benefit of drivers that rebuild IEs in the firmware.
 */
static void nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
{
	const struct cfg80211_beacon_data *bcn = &params->beacon;
4024 4025
	size_t ies_len = bcn->tail_len;
	const u8 *ies = bcn->tail;
4026 4027 4028 4029 4030 4031 4032 4033 4034 4035 4036 4037 4038 4039 4040 4041 4042
	const u8 *rates;
	const u8 *cap;

	rates = cfg80211_find_ie(WLAN_EID_SUPP_RATES, ies, ies_len);
	nl80211_check_ap_rate_selectors(params, rates);

	rates = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
	nl80211_check_ap_rate_selectors(params, rates);

	cap = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies, ies_len);
	if (cap && cap[1] >= sizeof(*params->ht_cap))
		params->ht_cap = (void *)(cap + 2);
	cap = cfg80211_find_ie(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
	if (cap && cap[1] >= sizeof(*params->vht_cap))
		params->vht_cap = (void *)(cap + 2);
}

4043 4044 4045 4046 4047 4048
static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
				   struct cfg80211_ap_settings *params)
{
	struct wireless_dev *wdev;
	bool ret = false;

4049
	list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
4050 4051 4052 4053
		if (wdev->iftype != NL80211_IFTYPE_AP &&
		    wdev->iftype != NL80211_IFTYPE_P2P_GO)
			continue;

4054
		if (!wdev->preset_chandef.chan)
4055 4056
			continue;

4057
		params->chandef = wdev->preset_chandef;
4058 4059 4060 4061 4062 4063 4064
		ret = true;
		break;
	}

	return ret;
}

4065 4066 4067 4068 4069 4070 4071 4072 4073 4074 4075 4076
static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
				    enum nl80211_auth_type auth_type,
				    enum nl80211_commands cmd)
{
	if (auth_type > NL80211_AUTHTYPE_MAX)
		return false;

	switch (cmd) {
	case NL80211_CMD_AUTHENTICATE:
		if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
		    auth_type == NL80211_AUTHTYPE_SAE)
			return false;
4077 4078 4079 4080 4081 4082
		if (!wiphy_ext_feature_isset(&rdev->wiphy,
					     NL80211_EXT_FEATURE_FILS_STA) &&
		    (auth_type == NL80211_AUTHTYPE_FILS_SK ||
		     auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
		     auth_type == NL80211_AUTHTYPE_FILS_PK))
			return false;
4083 4084
		return true;
	case NL80211_CMD_CONNECT:
4085 4086
		if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
		    auth_type == NL80211_AUTHTYPE_SAE)
4087
			return false;
4088

4089 4090 4091 4092 4093 4094 4095 4096 4097 4098
		/* FILS with SK PFS or PK not supported yet */
		if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
		    auth_type == NL80211_AUTHTYPE_FILS_PK)
			return false;
		if (!wiphy_ext_feature_isset(
			    &rdev->wiphy,
			    NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
		    auth_type == NL80211_AUTHTYPE_FILS_SK)
			return false;
		return true;
4099 4100 4101 4102
	case NL80211_CMD_START_AP:
		/* SAE not supported yet */
		if (auth_type == NL80211_AUTHTYPE_SAE)
			return false;
4103 4104 4105 4106 4107
		/* FILS not supported yet */
		if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
		    auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
		    auth_type == NL80211_AUTHTYPE_FILS_PK)
			return false;
4108 4109 4110 4111 4112 4113
		return true;
	default:
		return false;
	}
}

4114 4115 4116 4117 4118 4119 4120 4121 4122 4123 4124 4125 4126 4127 4128 4129 4130 4131 4132 4133 4134 4135 4136 4137 4138 4139
static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_ap_settings params;
	int err;

	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
		return -EOPNOTSUPP;

	if (!rdev->ops->start_ap)
		return -EOPNOTSUPP;

	if (wdev->beacon_interval)
		return -EALREADY;

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

	/* these are required for START_AP */
	if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
	    !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
	    !info->attrs[NL80211_ATTR_BEACON_HEAD])
		return -EINVAL;

4140
	err = nl80211_parse_beacon(info->attrs, &params.beacon);
4141 4142 4143 4144 4145 4146 4147 4148
	if (err)
		return err;

	params.beacon_interval =
		nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
	params.dtim_period =
		nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);

4149 4150
	err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
					   params.beacon_interval);
4151 4152 4153 4154 4155 4156 4157 4158 4159 4160 4161 4162 4163 4164 4165 4166 4167 4168 4169 4170 4171 4172 4173 4174 4175 4176 4177 4178 4179 4180 4181 4182 4183
	if (err)
		return err;

	/*
	 * In theory, some of these attributes should be required here
	 * but since they were not used when the command was originally
	 * added, keep them optional for old user space programs to let
	 * them continue to work with drivers that do not need the
	 * additional information -- drivers must check!
	 */
	if (info->attrs[NL80211_ATTR_SSID]) {
		params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
		params.ssid_len =
			nla_len(info->attrs[NL80211_ATTR_SSID]);
		if (params.ssid_len == 0 ||
		    params.ssid_len > IEEE80211_MAX_SSID_LEN)
			return -EINVAL;
	}

	if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
		params.hidden_ssid = nla_get_u32(
			info->attrs[NL80211_ATTR_HIDDEN_SSID]);
		if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
		    params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
		    params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
			return -EINVAL;
	}

	params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];

	if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
		params.auth_type = nla_get_u32(
			info->attrs[NL80211_ATTR_AUTH_TYPE]);
4184 4185
		if (!nl80211_valid_auth_type(rdev, params.auth_type,
					     NL80211_CMD_START_AP))
4186 4187 4188 4189 4190 4191 4192 4193 4194
			return -EINVAL;
	} else
		params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;

	err = nl80211_crypto_settings(rdev, info, &params.crypto,
				      NL80211_MAX_NR_CIPHER_SUITES);
	if (err)
		return err;

4195 4196 4197 4198 4199 4200 4201
	if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
		if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
			return -EOPNOTSUPP;
		params.inactivity_timeout = nla_get_u16(
			info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
	}

4202 4203 4204 4205 4206 4207 4208 4209 4210 4211 4212 4213 4214 4215 4216 4217 4218 4219 4220 4221 4222 4223 4224 4225 4226 4227
	if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
			return -EINVAL;
		params.p2p_ctwindow =
			nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
		if (params.p2p_ctwindow > 127)
			return -EINVAL;
		if (params.p2p_ctwindow != 0 &&
		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
			return -EINVAL;
	}

	if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
		u8 tmp;

		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
			return -EINVAL;
		tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
		if (tmp > 1)
			return -EINVAL;
		params.p2p_opp_ps = tmp;
		if (params.p2p_opp_ps != 0 &&
		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
			return -EINVAL;
	}

4228
	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
4229 4230 4231 4232 4233
		err = nl80211_parse_chandef(rdev, info, &params.chandef);
		if (err)
			return err;
	} else if (wdev->preset_chandef.chan) {
		params.chandef = wdev->preset_chandef;
4234
	} else if (!nl80211_get_ap_channel(rdev, &params))
4235 4236
		return -EINVAL;

4237 4238
	if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
					   wdev->iftype))
4239 4240
		return -EINVAL;

4241 4242 4243 4244 4245
	if (info->attrs[NL80211_ATTR_TX_RATES]) {
		err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
		if (err)
			return err;

4246 4247
		err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
					      &params.beacon_rate);
4248 4249 4250 4251
		if (err)
			return err;
	}

4252 4253 4254 4255 4256 4257 4258 4259 4260 4261 4262 4263 4264 4265 4266 4267 4268 4269 4270 4271 4272 4273 4274
	if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
		params.smps_mode =
			nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
		switch (params.smps_mode) {
		case NL80211_SMPS_OFF:
			break;
		case NL80211_SMPS_STATIC:
			if (!(rdev->wiphy.features &
			      NL80211_FEATURE_STATIC_SMPS))
				return -EINVAL;
			break;
		case NL80211_SMPS_DYNAMIC:
			if (!(rdev->wiphy.features &
			      NL80211_FEATURE_DYNAMIC_SMPS))
				return -EINVAL;
			break;
		default:
			return -EINVAL;
		}
	} else {
		params.smps_mode = NL80211_SMPS_OFF;
	}

4275 4276 4277 4278
	params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
	if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
		return -EOPNOTSUPP;

4279 4280 4281 4282 4283 4284
	if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
		params.acl = parse_acl_data(&rdev->wiphy, info);
		if (IS_ERR(params.acl))
			return PTR_ERR(params.acl);
	}

4285 4286
	nl80211_calculate_ap_params(&params);

4287
	wdev_lock(wdev);
4288
	err = rdev_start_ap(rdev, dev, &params);
4289
	if (!err) {
4290
		wdev->preset_chandef = params.chandef;
4291
		wdev->beacon_interval = params.beacon_interval;
4292
		wdev->chandef = params.chandef;
4293 4294
		wdev->ssid_len = params.ssid_len;
		memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
4295 4296 4297

		if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
			wdev->conn_owner_nlportid = info->snd_portid;
4298
	}
4299
	wdev_unlock(wdev);
4300 4301 4302

	kfree(params.acl);

4303
	return err;
4304 4305
}

4306 4307 4308 4309 4310 4311 4312 4313 4314 4315 4316 4317 4318 4319 4320 4321 4322 4323
static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_beacon_data params;
	int err;

	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
		return -EOPNOTSUPP;

	if (!rdev->ops->change_beacon)
		return -EOPNOTSUPP;

	if (!wdev->beacon_interval)
		return -EINVAL;

4324
	err = nl80211_parse_beacon(info->attrs, &params);
4325 4326 4327
	if (err)
		return err;

4328 4329 4330 4331 4332
	wdev_lock(wdev);
	err = rdev_change_beacon(rdev, dev, &params);
	wdev_unlock(wdev);

	return err;
4333 4334 4335
}

static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
4336
{
4337 4338
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
4339

4340
	return cfg80211_stop_ap(rdev, dev, false);
4341 4342
}

4343 4344 4345 4346
static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
	[NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
	[NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
	[NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
4347
	[NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
4348
	[NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
4349
	[NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
4350 4351
};

4352
static int parse_station_flags(struct genl_info *info,
4353
			       enum nl80211_iftype iftype,
4354
			       struct station_parameters *params)
4355 4356
{
	struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
4357
	struct nlattr *nla;
4358 4359
	int flag;

4360 4361 4362 4363 4364 4365 4366 4367 4368 4369 4370
	/*
	 * Try parsing the new attribute first so userspace
	 * can specify both for older kernels.
	 */
	nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
	if (nla) {
		struct nl80211_sta_flag_update *sta_flags;

		sta_flags = nla_data(nla);
		params->sta_flags_mask = sta_flags->mask;
		params->sta_flags_set = sta_flags->set;
4371
		params->sta_flags_set &= params->sta_flags_mask;
4372 4373 4374 4375 4376 4377 4378
		if ((params->sta_flags_mask |
		     params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
			return -EINVAL;
		return 0;
	}

	/* if present, parse the old attribute */
4379

4380
	nla = info->attrs[NL80211_ATTR_STA_FLAGS];
4381 4382 4383
	if (!nla)
		return 0;

4384
	if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX, nla,
4385
			     sta_flags_policy, info->extack))
4386 4387
		return -EINVAL;

4388 4389 4390 4391 4392 4393 4394 4395 4396 4397 4398 4399 4400 4401 4402 4403 4404 4405 4406 4407 4408 4409 4410 4411 4412 4413 4414
	/*
	 * Only allow certain flags for interface types so that
	 * other attributes are silently ignored. Remember that
	 * this is backward compatibility code with old userspace
	 * and shouldn't be hit in other cases anyway.
	 */
	switch (iftype) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
	case NL80211_IFTYPE_P2P_GO:
		params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
					 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
					 BIT(NL80211_STA_FLAG_WME) |
					 BIT(NL80211_STA_FLAG_MFP);
		break;
	case NL80211_IFTYPE_P2P_CLIENT:
	case NL80211_IFTYPE_STATION:
		params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
					 BIT(NL80211_STA_FLAG_TDLS_PEER);
		break;
	case NL80211_IFTYPE_MESH_POINT:
		params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
					 BIT(NL80211_STA_FLAG_MFP) |
					 BIT(NL80211_STA_FLAG_AUTHORIZED);
	default:
		return -EINVAL;
	}
4415

4416 4417
	for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
		if (flags[flag]) {
4418
			params->sta_flags_set |= (1<<flag);
4419

4420 4421 4422 4423 4424 4425
			/* no longer support new API additions in old API */
			if (flag > NL80211_STA_FLAG_MAX_OLD_API)
				return -EINVAL;
		}
	}

4426 4427 4428
	return 0;
}

4429 4430 4431 4432
static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
				 int attr)
{
	struct nlattr *rate;
4433 4434
	u32 bitrate;
	u16 bitrate_compat;
4435
	enum nl80211_rate_info rate_flg;
4436 4437 4438

	rate = nla_nest_start(msg, attr);
	if (!rate)
4439
		return false;
4440 4441 4442

	/* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
	bitrate = cfg80211_calculate_bitrate(info);
4443 4444
	/* report 16-bit bitrate only if we can */
	bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
4445 4446 4447 4448 4449 4450 4451
	if (bitrate > 0 &&
	    nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
		return false;
	if (bitrate_compat > 0 &&
	    nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
		return false;

4452 4453 4454 4455 4456 4457 4458 4459 4460 4461 4462 4463 4464 4465 4466 4467 4468 4469 4470 4471 4472 4473 4474 4475 4476 4477 4478
	switch (info->bw) {
	case RATE_INFO_BW_5:
		rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
		break;
	case RATE_INFO_BW_10:
		rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
		break;
	default:
		WARN_ON(1);
		/* fall through */
	case RATE_INFO_BW_20:
		rate_flg = 0;
		break;
	case RATE_INFO_BW_40:
		rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
		break;
	case RATE_INFO_BW_80:
		rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
		break;
	case RATE_INFO_BW_160:
		rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
		break;
	}

	if (rate_flg && nla_put_flag(msg, rate_flg))
		return false;

4479 4480 4481 4482 4483 4484 4485 4486 4487 4488 4489 4490 4491 4492 4493
	if (info->flags & RATE_INFO_FLAGS_MCS) {
		if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
			return false;
		if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
		    nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
			return false;
	} else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
		if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
			return false;
		if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
			return false;
		if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
		    nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
			return false;
	}
4494 4495 4496 4497 4498

	nla_nest_end(msg, rate);
	return true;
}

4499 4500 4501 4502 4503 4504 4505 4506 4507 4508 4509 4510 4511 4512 4513 4514 4515 4516 4517 4518 4519 4520 4521 4522 4523 4524
static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
			       int id)
{
	void *attr;
	int i = 0;

	if (!mask)
		return true;

	attr = nla_nest_start(msg, id);
	if (!attr)
		return false;

	for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
		if (!(mask & BIT(i)))
			continue;

		if (nla_put_u8(msg, i, signal[i]))
			return false;
	}

	nla_nest_end(msg, attr);

	return true;
}

4525 4526
static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
				u32 seq, int flags,
4527 4528
				struct cfg80211_registered_device *rdev,
				struct net_device *dev,
4529
				const u8 *mac_addr, struct station_info *sinfo)
4530 4531
{
	void *hdr;
4532
	struct nlattr *sinfoattr, *bss_param;
4533

4534
	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
4535 4536 4537
	if (!hdr)
		return -1;

4538 4539 4540 4541
	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
	    nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
		goto nla_put_failure;
4542

4543 4544
	sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
	if (!sinfoattr)
4545
		goto nla_put_failure;
4546 4547

#define PUT_SINFO(attr, memb, type) do {				\
4548
	BUILD_BUG_ON(sizeof(type) == sizeof(u64));			\
4549
	if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) &&	\
4550 4551 4552 4553
	    nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr,		\
			     sinfo->memb))				\
		goto nla_put_failure;					\
	} while (0)
4554 4555 4556 4557 4558 4559
#define PUT_SINFO_U64(attr, memb) do {					\
	if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) &&	\
	    nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr,		\
			      sinfo->memb, NL80211_STA_INFO_PAD))	\
		goto nla_put_failure;					\
	} while (0)
4560 4561 4562 4563 4564 4565

	PUT_SINFO(CONNECTED_TIME, connected_time, u32);
	PUT_SINFO(INACTIVE_TIME, inactive_time, u32);

	if (sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES) |
			     BIT(NL80211_STA_INFO_RX_BYTES64)) &&
4566
	    nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
4567
			(u32)sinfo->rx_bytes))
4568
		goto nla_put_failure;
4569 4570 4571

	if (sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES) |
			     BIT(NL80211_STA_INFO_TX_BYTES64)) &&
4572
	    nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
4573 4574
			(u32)sinfo->tx_bytes))
		goto nla_put_failure;
4575

4576 4577
	PUT_SINFO_U64(RX_BYTES64, rx_bytes);
	PUT_SINFO_U64(TX_BYTES64, tx_bytes);
4578 4579 4580
	PUT_SINFO(LLID, llid, u16);
	PUT_SINFO(PLID, plid, u16);
	PUT_SINFO(PLINK_STATE, plink_state, u8);
4581
	PUT_SINFO_U64(RX_DURATION, rx_duration);
4582

4583 4584
	switch (rdev->wiphy.signal_type) {
	case CFG80211_SIGNAL_TYPE_MBM:
4585 4586
		PUT_SINFO(SIGNAL, signal, u8);
		PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
4587 4588 4589 4590
		break;
	default:
		break;
	}
4591
	if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL)) {
4592 4593 4594 4595 4596
		if (!nl80211_put_signal(msg, sinfo->chains,
					sinfo->chain_signal,
					NL80211_STA_INFO_CHAIN_SIGNAL))
			goto nla_put_failure;
	}
4597
	if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
4598 4599 4600 4601 4602
		if (!nl80211_put_signal(msg, sinfo->chains,
					sinfo->chain_signal_avg,
					NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
			goto nla_put_failure;
	}
4603
	if (sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE)) {
4604 4605 4606 4607
		if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
					  NL80211_STA_INFO_TX_BITRATE))
			goto nla_put_failure;
	}
4608
	if (sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE)) {
4609 4610
		if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
					  NL80211_STA_INFO_RX_BITRATE))
4611 4612
			goto nla_put_failure;
	}
4613 4614 4615 4616 4617 4618 4619 4620 4621 4622 4623 4624

	PUT_SINFO(RX_PACKETS, rx_packets, u32);
	PUT_SINFO(TX_PACKETS, tx_packets, u32);
	PUT_SINFO(TX_RETRIES, tx_retries, u32);
	PUT_SINFO(TX_FAILED, tx_failed, u32);
	PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
	PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
	PUT_SINFO(LOCAL_PM, local_pm, u32);
	PUT_SINFO(PEER_PM, peer_pm, u32);
	PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);

	if (sinfo->filled & BIT(NL80211_STA_INFO_BSS_PARAM)) {
4625 4626 4627 4628
		bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
		if (!bss_param)
			goto nla_put_failure;

4629 4630 4631 4632 4633 4634 4635 4636 4637 4638 4639
		if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
		     nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
		    ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
		     nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
		    ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
		     nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
		    nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
			       sinfo->bss_param.dtim_period) ||
		    nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
				sinfo->bss_param.beacon_interval))
			goto nla_put_failure;
4640 4641 4642

		nla_nest_end(msg, bss_param);
	}
4643
	if ((sinfo->filled & BIT(NL80211_STA_INFO_STA_FLAGS)) &&
4644 4645 4646 4647
	    nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
		    sizeof(struct nl80211_sta_flag_update),
		    &sinfo->sta_flags))
		goto nla_put_failure;
4648

4649 4650 4651
	PUT_SINFO_U64(T_OFFSET, t_offset);
	PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
	PUT_SINFO_U64(BEACON_RX, rx_beacon);
4652
	PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
4653
	PUT_SINFO(ACK_SIGNAL, ack_signal, u8);
4654 4655 4656
	if (wiphy_ext_feature_isset(&rdev->wiphy,
				    NL80211_EXT_FEATURE_DATA_ACK_SIGNAL_SUPPORT))
		PUT_SINFO(DATA_ACK_SIGNAL_AVG, avg_ack_signal, s8);
4657 4658

#undef PUT_SINFO
4659
#undef PUT_SINFO_U64
4660

4661
	if (sinfo->pertid) {
4662 4663 4664 4665 4666 4667 4668 4669 4670 4671 4672 4673 4674 4675 4676 4677 4678 4679 4680 4681
		struct nlattr *tidsattr;
		int tid;

		tidsattr = nla_nest_start(msg, NL80211_STA_INFO_TID_STATS);
		if (!tidsattr)
			goto nla_put_failure;

		for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
			struct cfg80211_tid_stats *tidstats;
			struct nlattr *tidattr;

			tidstats = &sinfo->pertid[tid];

			if (!tidstats->filled)
				continue;

			tidattr = nla_nest_start(msg, tid + 1);
			if (!tidattr)
				goto nla_put_failure;

4682
#define PUT_TIDVAL_U64(attr, memb) do {					\
4683
	if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) &&	\
4684 4685
	    nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr,		\
			      tidstats->memb, NL80211_TID_STATS_PAD))	\
4686 4687 4688
		goto nla_put_failure;					\
	} while (0)

4689 4690 4691 4692
			PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
			PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
			PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
			PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
4693

4694
#undef PUT_TIDVAL_U64
4695 4696 4697 4698 4699 4700
			if ((tidstats->filled &
			     BIT(NL80211_TID_STATS_TXQ_STATS)) &&
			    !nl80211_put_txq_stats(msg, &tidstats->txq_stats,
						   NL80211_TID_STATS_TXQ_STATS))
				goto nla_put_failure;

4701 4702 4703 4704 4705 4706
			nla_nest_end(msg, tidattr);
		}

		nla_nest_end(msg, tidsattr);
	}

4707
	nla_nest_end(msg, sinfoattr);
4708

4709
	if (sinfo->assoc_req_ies_len &&
4710 4711 4712
	    nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
		    sinfo->assoc_req_ies))
		goto nla_put_failure;
4713

4714
	cfg80211_sinfo_release_content(sinfo);
4715 4716
	genlmsg_end(msg, hdr);
	return 0;
4717 4718

 nla_put_failure:
4719
	cfg80211_sinfo_release_content(sinfo);
4720 4721
	genlmsg_cancel(msg, hdr);
	return -EMSGSIZE;
4722 4723
}

4724
static int nl80211_dump_station(struct sk_buff *skb,
J
Johannes Berg 已提交
4725
				struct netlink_callback *cb)
4726
{
4727
	struct station_info sinfo;
4728
	struct cfg80211_registered_device *rdev;
4729
	struct wireless_dev *wdev;
4730
	u8 mac_addr[ETH_ALEN];
4731
	int sta_idx = cb->args[2];
4732 4733
	int err;

4734
	rtnl_lock();
4735
	err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
4736
	if (err)
4737
		goto out_err;
J
Johannes Berg 已提交
4738

4739 4740 4741 4742 4743
	if (!wdev->netdev) {
		err = -EINVAL;
		goto out_err;
	}

4744
	if (!rdev->ops->dump_station) {
4745
		err = -EOPNOTSUPP;
J
Johannes Berg 已提交
4746 4747 4748 4749
		goto out_err;
	}

	while (1) {
4750
		memset(&sinfo, 0, sizeof(sinfo));
4751
		err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
4752
					mac_addr, &sinfo);
J
Johannes Berg 已提交
4753 4754 4755
		if (err == -ENOENT)
			break;
		if (err)
J
Johannes Berg 已提交
4756
			goto out_err;
J
Johannes Berg 已提交
4757

4758
		if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
4759
				NETLINK_CB(cb->skb).portid,
J
Johannes Berg 已提交
4760
				cb->nlh->nlmsg_seq, NLM_F_MULTI,
4761
				rdev, wdev->netdev, mac_addr,
4762
				&sinfo) < 0)
J
Johannes Berg 已提交
4763 4764 4765 4766 4767 4768
			goto out;

		sta_idx++;
	}

 out:
4769
	cb->args[2] = sta_idx;
J
Johannes Berg 已提交
4770 4771
	err = skb->len;
 out_err:
4772
	rtnl_unlock();
J
Johannes Berg 已提交
4773 4774

	return err;
4775
}
4776

4777 4778
static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
{
4779 4780
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
4781
	struct station_info sinfo;
4782 4783
	struct sk_buff *msg;
	u8 *mac_addr = NULL;
4784
	int err;
4785

4786
	memset(&sinfo, 0, sizeof(sinfo));
4787

4788 4789
	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;
4790 4791 4792

	mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);

4793 4794
	if (!rdev->ops->get_station)
		return -EOPNOTSUPP;
J
Johannes Berg 已提交
4795

4796
	err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
4797
	if (err)
4798
		return err;
4799

4800
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4801
	if (!msg) {
D
Denis Kenzior 已提交
4802
		cfg80211_sinfo_release_content(&sinfo);
4803
		return -ENOMEM;
4804
	}
4805

4806 4807
	if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
				 info->snd_portid, info->snd_seq, 0,
4808
				 rdev, dev, mac_addr, &sinfo) < 0) {
4809
		nlmsg_free(msg);
4810
		return -ENOBUFS;
4811
	}
J
Johannes Berg 已提交
4812

4813
	return genlmsg_reply(msg, info);
4814 4815
}

4816 4817 4818 4819
int cfg80211_check_station_change(struct wiphy *wiphy,
				  struct station_parameters *params,
				  enum cfg80211_station_type statype)
{
4820 4821
	if (params->listen_interval != -1 &&
	    statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4822
		return -EINVAL;
4823

4824 4825 4826 4827
	if (params->support_p2p_ps != -1 &&
	    statype != CFG80211_STA_AP_CLIENT_UNASSOC)
		return -EINVAL;

4828
	if (params->aid &&
4829 4830
	    !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
	    statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4831 4832 4833 4834 4835 4836
		return -EINVAL;

	/* When you run into this, adjust the code below for the new flag */
	BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);

	switch (statype) {
4837 4838
	case CFG80211_STA_MESH_PEER_KERNEL:
	case CFG80211_STA_MESH_PEER_USER:
4839 4840 4841 4842 4843 4844 4845 4846 4847 4848 4849 4850 4851 4852 4853 4854 4855 4856 4857 4858 4859 4860 4861 4862 4863 4864 4865 4866 4867 4868 4869 4870 4871 4872 4873 4874 4875 4876 4877 4878 4879
		/*
		 * No ignoring the TDLS flag here -- the userspace mesh
		 * code doesn't have the bug of including TDLS in the
		 * mask everywhere.
		 */
		if (params->sta_flags_mask &
				~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
				  BIT(NL80211_STA_FLAG_MFP) |
				  BIT(NL80211_STA_FLAG_AUTHORIZED)))
			return -EINVAL;
		break;
	case CFG80211_STA_TDLS_PEER_SETUP:
	case CFG80211_STA_TDLS_PEER_ACTIVE:
		if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
			return -EINVAL;
		/* ignore since it can't change */
		params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
		break;
	default:
		/* disallow mesh-specific things */
		if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
			return -EINVAL;
		if (params->local_pm)
			return -EINVAL;
		if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
			return -EINVAL;
	}

	if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
	    statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
		/* TDLS can't be set, ... */
		if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
			return -EINVAL;
		/*
		 * ... but don't bother the driver with it. This works around
		 * a hostapd/wpa_supplicant issue -- it always includes the
		 * TLDS_PEER flag in the mask even for AP mode.
		 */
		params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
	}

4880 4881
	if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
	    statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
4882 4883 4884 4885 4886 4887 4888 4889 4890 4891 4892
		/* reject other things that can't change */
		if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
			return -EINVAL;
		if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
			return -EINVAL;
		if (params->supported_rates)
			return -EINVAL;
		if (params->ext_capab || params->ht_capa || params->vht_capa)
			return -EINVAL;
	}

4893 4894
	if (statype != CFG80211_STA_AP_CLIENT &&
	    statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
4895 4896 4897 4898 4899 4900 4901 4902 4903 4904 4905
		if (params->vlan)
			return -EINVAL;
	}

	switch (statype) {
	case CFG80211_STA_AP_MLME_CLIENT:
		/* Use this only for authorizing/unauthorizing a station */
		if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
			return -EOPNOTSUPP;
		break;
	case CFG80211_STA_AP_CLIENT:
4906
	case CFG80211_STA_AP_CLIENT_UNASSOC:
4907 4908 4909 4910 4911 4912 4913 4914 4915 4916 4917 4918 4919 4920 4921 4922 4923 4924 4925 4926 4927 4928 4929 4930 4931 4932 4933 4934 4935 4936 4937 4938 4939 4940 4941 4942
		/* accept only the listed bits */
		if (params->sta_flags_mask &
				~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
				  BIT(NL80211_STA_FLAG_AUTHENTICATED) |
				  BIT(NL80211_STA_FLAG_ASSOCIATED) |
				  BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
				  BIT(NL80211_STA_FLAG_WME) |
				  BIT(NL80211_STA_FLAG_MFP)))
			return -EINVAL;

		/* but authenticated/associated only if driver handles it */
		if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
		    params->sta_flags_mask &
				(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
				 BIT(NL80211_STA_FLAG_ASSOCIATED)))
			return -EINVAL;
		break;
	case CFG80211_STA_IBSS:
	case CFG80211_STA_AP_STA:
		/* reject any changes other than AUTHORIZED */
		if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
			return -EINVAL;
		break;
	case CFG80211_STA_TDLS_PEER_SETUP:
		/* reject any changes other than AUTHORIZED or WME */
		if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
					       BIT(NL80211_STA_FLAG_WME)))
			return -EINVAL;
		/* force (at least) rates when authorizing */
		if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
		    !params->supported_rates)
			return -EINVAL;
		break;
	case CFG80211_STA_TDLS_PEER_ACTIVE:
		/* reject any changes */
		return -EINVAL;
4943
	case CFG80211_STA_MESH_PEER_KERNEL:
4944 4945 4946
		if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
			return -EINVAL;
		break;
4947
	case CFG80211_STA_MESH_PEER_USER:
4948 4949
		if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
		    params->plink_action != NL80211_PLINK_ACTION_BLOCK)
4950 4951 4952 4953
			return -EINVAL;
		break;
	}

4954 4955 4956 4957 4958 4959 4960 4961 4962
	/*
	 * Older kernel versions ignored this attribute entirely, so don't
	 * reject attempts to update it but mark it as unused instead so the
	 * driver won't look at the data.
	 */
	if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
	    statype != CFG80211_STA_TDLS_PEER_SETUP)
		params->opmode_notif_used = false;

4963 4964 4965 4966
	return 0;
}
EXPORT_SYMBOL(cfg80211_check_station_change);

4967
/*
4968
 * Get vlan interface making sure it is running and on the right wiphy.
4969
 */
4970 4971
static struct net_device *get_vlan(struct genl_info *info,
				   struct cfg80211_registered_device *rdev)
4972
{
4973
	struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
4974 4975 4976 4977 4978 4979 4980 4981 4982 4983 4984 4985 4986
	struct net_device *v;
	int ret;

	if (!vlanattr)
		return NULL;

	v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
	if (!v)
		return ERR_PTR(-ENODEV);

	if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
		ret = -EINVAL;
		goto error;
4987
	}
4988

4989 4990 4991 4992 4993 4994 4995
	if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
	    v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
	    v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
		ret = -EINVAL;
		goto error;
	}

4996 4997 4998 4999 5000 5001 5002 5003 5004
	if (!netif_running(v)) {
		ret = -ENETDOWN;
		goto error;
	}

	return v;
 error:
	dev_put(v);
	return ERR_PTR(ret);
5005 5006
}

5007 5008
static const struct nla_policy
nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
5009 5010 5011 5012
	[NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
	[NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
};

5013 5014
static int nl80211_parse_sta_wme(struct genl_info *info,
				 struct station_parameters *params)
5015 5016 5017 5018 5019 5020 5021 5022 5023 5024 5025
{
	struct nlattr *tb[NL80211_STA_WME_MAX + 1];
	struct nlattr *nla;
	int err;

	/* parse WME attributes if present */
	if (!info->attrs[NL80211_ATTR_STA_WME])
		return 0;

	nla = info->attrs[NL80211_ATTR_STA_WME];
	err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
5026
			       nl80211_sta_wme_policy, info->extack);
5027 5028 5029 5030 5031 5032 5033 5034 5035 5036 5037 5038 5039 5040 5041 5042 5043 5044 5045 5046
	if (err)
		return err;

	if (tb[NL80211_STA_WME_UAPSD_QUEUES])
		params->uapsd_queues = nla_get_u8(
			tb[NL80211_STA_WME_UAPSD_QUEUES]);
	if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
		return -EINVAL;

	if (tb[NL80211_STA_WME_MAX_SP])
		params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);

	if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
		return -EINVAL;

	params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;

	return 0;
}

5047 5048 5049 5050 5051 5052 5053 5054 5055 5056 5057 5058 5059 5060 5061 5062 5063 5064 5065 5066 5067 5068 5069 5070 5071 5072 5073 5074 5075 5076 5077 5078 5079 5080 5081
static int nl80211_parse_sta_channel_info(struct genl_info *info,
				      struct station_parameters *params)
{
	if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
		params->supported_channels =
		     nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
		params->supported_channels_len =
		     nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
		/*
		 * Need to include at least one (first channel, number of
		 * channels) tuple for each subband, and must have proper
		 * tuples for the rest of the data as well.
		 */
		if (params->supported_channels_len < 2)
			return -EINVAL;
		if (params->supported_channels_len % 2)
			return -EINVAL;
	}

	if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
		params->supported_oper_classes =
		 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
		params->supported_oper_classes_len =
		  nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
		/*
		 * The value of the Length field of the Supported Operating
		 * Classes element is between 2 and 253.
		 */
		if (params->supported_oper_classes_len < 2 ||
		    params->supported_oper_classes_len > 253)
			return -EINVAL;
	}
	return 0;
}

5082 5083 5084
static int nl80211_set_station_tdls(struct genl_info *info,
				    struct station_parameters *params)
{
5085
	int err;
5086
	/* Dummy STA entry gets updated once the peer capabilities are known */
5087 5088
	if (info->attrs[NL80211_ATTR_PEER_AID])
		params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
5089 5090 5091 5092 5093 5094 5095
	if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
		params->ht_capa =
			nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
		params->vht_capa =
			nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);

5096 5097 5098 5099
	err = nl80211_parse_sta_channel_info(info, params);
	if (err)
		return err;

5100 5101 5102
	return nl80211_parse_sta_wme(info, params);
}

5103 5104
static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
{
5105 5106
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
5107
	struct station_parameters params;
5108 5109
	u8 *mac_addr;
	int err;
5110 5111 5112

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

5113 5114 5115
	if (!rdev->ops->change_station)
		return -EOPNOTSUPP;

5116 5117 5118 5119 5120
	/*
	 * AID and listen_interval properties can be set only for unassociated
	 * station. Include these parameters here and will check them in
	 * cfg80211_check_station_change().
	 */
5121 5122
	if (info->attrs[NL80211_ATTR_STA_AID])
		params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
5123 5124 5125 5126 5127 5128

	if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
		params.listen_interval =
		     nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
	else
		params.listen_interval = -1;
5129

5130 5131 5132 5133 5134 5135 5136 5137 5138 5139 5140 5141
	if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
		u8 tmp;

		tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
		if (tmp >= NUM_NL80211_P2P_PS_STATUS)
			return -EINVAL;

		params.support_p2p_ps = tmp;
	} else {
		params.support_p2p_ps = -1;
	}

5142 5143 5144 5145 5146 5147 5148 5149 5150 5151 5152 5153
	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);

	if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
		params.supported_rates =
			nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
		params.supported_rates_len =
			nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
	}

5154 5155 5156 5157 5158 5159 5160 5161 5162 5163 5164 5165 5166
	if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
		params.capability =
			nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
		params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
	}

	if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
		params.ext_capab =
			nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
		params.ext_capab_len =
			nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
	}

5167
	if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5168 5169
		return -EINVAL;

5170
	if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
5171
		params.plink_action =
5172 5173 5174 5175
			nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
		if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
			return -EINVAL;
	}
5176

5177
	if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
5178
		params.plink_state =
5179 5180 5181
			nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
		if (params.plink_state >= NUM_NL80211_PLINK_STATES)
			return -EINVAL;
5182 5183 5184 5185 5186 5187
		if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) {
			params.peer_aid = nla_get_u16(
				info->attrs[NL80211_ATTR_MESH_PEER_AID]);
			if (params.peer_aid > IEEE80211_MAX_AID)
				return -EINVAL;
		}
5188 5189
		params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
	}
5190

5191 5192 5193 5194 5195 5196 5197 5198 5199 5200 5201
	if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) {
		enum nl80211_mesh_power_mode pm = nla_get_u32(
			info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);

		if (pm <= NL80211_MESH_POWER_UNKNOWN ||
		    pm > NL80211_MESH_POWER_MAX)
			return -EINVAL;

		params.local_pm = pm;
	}

5202 5203 5204 5205 5206 5207
	if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
		params.opmode_notif_used = true;
		params.opmode_notif =
			nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
	}

5208 5209 5210 5211 5212 5213 5214 5215 5216
	/* Include parameters for TDLS peer (will check later) */
	err = nl80211_set_station_tdls(info, &params);
	if (err)
		return err;

	params.vlan = get_vlan(info, rdev);
	if (IS_ERR(params.vlan))
		return PTR_ERR(params.vlan);

5217 5218 5219
	switch (dev->ieee80211_ptr->iftype) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
5220 5221
	case NL80211_IFTYPE_P2P_GO:
	case NL80211_IFTYPE_P2P_CLIENT:
5222
	case NL80211_IFTYPE_STATION:
5223
	case NL80211_IFTYPE_ADHOC:
5224 5225 5226
	case NL80211_IFTYPE_MESH_POINT:
		break;
	default:
5227 5228
		err = -EOPNOTSUPP;
		goto out_put_vlan;
5229 5230
	}

5231
	/* driver will call cfg80211_check_station_change() */
5232
	err = rdev_change_station(rdev, dev, mac_addr, &params);
5233

5234
 out_put_vlan:
5235 5236
	if (params.vlan)
		dev_put(params.vlan);
J
Johannes Berg 已提交
5237

5238 5239 5240 5241 5242
	return err;
}

static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
{
5243
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
5244
	int err;
5245
	struct net_device *dev = info->user_ptr[1];
5246 5247
	struct station_parameters params;
	u8 *mac_addr = NULL;
5248 5249
	u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
			 BIT(NL80211_STA_FLAG_ASSOCIATED);
5250 5251 5252

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

5253 5254 5255
	if (!rdev->ops->add_station)
		return -EOPNOTSUPP;

5256 5257 5258 5259 5260 5261 5262 5263 5264
	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
		return -EINVAL;

5265 5266
	if (!info->attrs[NL80211_ATTR_STA_AID] &&
	    !info->attrs[NL80211_ATTR_PEER_AID])
5267 5268
		return -EINVAL;

5269 5270 5271 5272 5273 5274 5275
	mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
	params.supported_rates =
		nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
	params.supported_rates_len =
		nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
	params.listen_interval =
		nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
5276

5277 5278 5279 5280 5281 5282 5283 5284 5285 5286 5287 5288 5289 5290 5291 5292 5293
	if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
		u8 tmp;

		tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
		if (tmp >= NUM_NL80211_P2P_PS_STATUS)
			return -EINVAL;

		params.support_p2p_ps = tmp;
	} else {
		/*
		 * if not specified, assume it's supported for P2P GO interface,
		 * and is NOT supported for AP interface
		 */
		params.support_p2p_ps =
			dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
	}

5294
	if (info->attrs[NL80211_ATTR_PEER_AID])
5295
		params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
5296 5297
	else
		params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
5298 5299
	if (!params.aid || params.aid > IEEE80211_MAX_AID)
		return -EINVAL;
5300

5301 5302 5303 5304 5305 5306 5307 5308 5309 5310 5311 5312 5313
	if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
		params.capability =
			nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
		params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
	}

	if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
		params.ext_capab =
			nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
		params.ext_capab_len =
			nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
	}

5314 5315 5316
	if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
		params.ht_capa =
			nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5317

M
Mahesh Palivela 已提交
5318 5319 5320 5321
	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
		params.vht_capa =
			nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);

5322 5323 5324 5325 5326 5327
	if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
		params.opmode_notif_used = true;
		params.opmode_notif =
			nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
	}

5328
	if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
5329
		params.plink_action =
5330 5331 5332 5333
			nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
		if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
			return -EINVAL;
	}
5334

5335 5336 5337 5338
	err = nl80211_parse_sta_channel_info(info, &params);
	if (err)
		return err;

5339 5340 5341
	err = nl80211_parse_sta_wme(info, &params);
	if (err)
		return err;
5342

5343
	if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5344 5345
		return -EINVAL;

5346 5347 5348 5349 5350 5351 5352 5353 5354 5355
	/* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
	 * as userspace might just pass through the capabilities from the IEs
	 * directly, rather than enforcing this restriction and returning an
	 * error in this case.
	 */
	if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
		params.ht_capa = NULL;
		params.vht_capa = NULL;
	}

5356 5357 5358
	/* When you run into this, adjust the code below for the new flag */
	BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);

5359 5360 5361 5362
	switch (dev->ieee80211_ptr->iftype) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
	case NL80211_IFTYPE_P2P_GO:
5363 5364 5365 5366
		/* ignore WME attributes if iface/sta is not capable */
		if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
		    !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
			params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5367

5368
		/* TDLS peers cannot be added */
5369 5370
		if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
		    info->attrs[NL80211_ATTR_PEER_AID])
5371
			return -EINVAL;
5372 5373
		/* but don't bother the driver with it */
		params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5374

5375 5376 5377
		/* allow authenticated/associated only if driver handles it */
		if (!(rdev->wiphy.features &
				NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
5378
		    params.sta_flags_mask & auth_assoc)
5379 5380
			return -EINVAL;

5381 5382 5383 5384 5385 5386 5387 5388 5389 5390 5391 5392 5393 5394 5395
		/* Older userspace, or userspace wanting to be compatible with
		 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
		 * and assoc flags in the mask, but assumes the station will be
		 * added as associated anyway since this was the required driver
		 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
		 * introduced.
		 * In order to not bother drivers with this quirk in the API
		 * set the flags in both the mask and set for new stations in
		 * this case.
		 */
		if (!(params.sta_flags_mask & auth_assoc)) {
			params.sta_flags_mask |= auth_assoc;
			params.sta_flags_set |= auth_assoc;
		}

5396 5397 5398 5399 5400 5401
		/* must be last in here for error handling */
		params.vlan = get_vlan(info, rdev);
		if (IS_ERR(params.vlan))
			return PTR_ERR(params.vlan);
		break;
	case NL80211_IFTYPE_MESH_POINT:
5402 5403 5404
		/* ignore uAPSD data */
		params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;

5405 5406 5407
		/* associated is disallowed */
		if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
			return -EINVAL;
5408
		/* TDLS peers cannot be added */
5409 5410
		if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
		    info->attrs[NL80211_ATTR_PEER_AID])
5411 5412 5413
			return -EINVAL;
		break;
	case NL80211_IFTYPE_STATION:
5414
	case NL80211_IFTYPE_P2P_CLIENT:
5415 5416 5417
		/* ignore uAPSD data */
		params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;

5418 5419 5420 5421
		/* these are disallowed */
		if (params.sta_flags_mask &
				(BIT(NL80211_STA_FLAG_ASSOCIATED) |
				 BIT(NL80211_STA_FLAG_AUTHENTICATED)))
5422
			return -EINVAL;
5423 5424 5425 5426 5427 5428 5429 5430 5431
		/* Only TDLS peers can be added */
		if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
			return -EINVAL;
		/* Can only add if TDLS ... */
		if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
			return -EOPNOTSUPP;
		/* ... with external setup is supported */
		if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
			return -EOPNOTSUPP;
5432 5433 5434 5435 5436
		/*
		 * Older wpa_supplicant versions always mark the TDLS peer
		 * as authorized, but it shouldn't yet be.
		 */
		params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
5437 5438 5439
		break;
	default:
		return -EOPNOTSUPP;
5440 5441
	}

5442
	/* be aware of params.vlan when changing code here */
5443

5444
	err = rdev_add_station(rdev, dev, mac_addr, &params);
5445 5446 5447 5448 5449 5450 5451 5452

	if (params.vlan)
		dev_put(params.vlan);
	return err;
}

static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
{
5453 5454
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
5455 5456 5457
	struct station_del_parameters params;

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

	if (info->attrs[NL80211_ATTR_MAC])
5460
		params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
5461

5462
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5463
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
5464
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
5465 5466
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
		return -EINVAL;
5467

5468 5469
	if (!rdev->ops->del_station)
		return -EOPNOTSUPP;
J
Johannes Berg 已提交
5470

5471 5472 5473 5474 5475 5476 5477 5478 5479 5480 5481 5482 5483 5484 5485 5486 5487 5488 5489 5490 5491
	if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
		params.subtype =
			nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
		if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
		    params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
			return -EINVAL;
	} else {
		/* Default to Deauthentication frame */
		params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
	}

	if (info->attrs[NL80211_ATTR_REASON_CODE]) {
		params.reason_code =
			nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
		if (params.reason_code == 0)
			return -EINVAL; /* 0 is reserved */
	} else {
		/* Default to reason code 2 */
		params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
	}

5492
	return rdev_del_station(rdev, dev, &params);
5493 5494
}

5495
static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
5496 5497 5498 5499 5500 5501 5502
				int flags, struct net_device *dev,
				u8 *dst, u8 *next_hop,
				struct mpath_info *pinfo)
{
	void *hdr;
	struct nlattr *pinfoattr;

5503
	hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
5504 5505 5506
	if (!hdr)
		return -1;

5507 5508 5509 5510 5511
	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
	    nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
	    nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
		goto nla_put_failure;
5512

5513 5514 5515
	pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
	if (!pinfoattr)
		goto nla_put_failure;
5516 5517 5518 5519 5520 5521 5522 5523 5524 5525 5526 5527 5528 5529 5530 5531 5532 5533 5534 5535 5536 5537
	if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
	    nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
			pinfo->frame_qlen))
		goto nla_put_failure;
	if (((pinfo->filled & MPATH_INFO_SN) &&
	     nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
	    ((pinfo->filled & MPATH_INFO_METRIC) &&
	     nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
			 pinfo->metric)) ||
	    ((pinfo->filled & MPATH_INFO_EXPTIME) &&
	     nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
			 pinfo->exptime)) ||
	    ((pinfo->filled & MPATH_INFO_FLAGS) &&
	     nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
			pinfo->flags)) ||
	    ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
	     nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
			 pinfo->discovery_timeout)) ||
	    ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
	     nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
			pinfo->discovery_retries)))
		goto nla_put_failure;
5538 5539 5540

	nla_nest_end(msg, pinfoattr);

5541 5542
	genlmsg_end(msg, hdr);
	return 0;
5543 5544

 nla_put_failure:
5545 5546
	genlmsg_cancel(msg, hdr);
	return -EMSGSIZE;
5547 5548 5549
}

static int nl80211_dump_mpath(struct sk_buff *skb,
J
Johannes Berg 已提交
5550
			      struct netlink_callback *cb)
5551 5552
{
	struct mpath_info pinfo;
5553
	struct cfg80211_registered_device *rdev;
5554
	struct wireless_dev *wdev;
5555 5556
	u8 dst[ETH_ALEN];
	u8 next_hop[ETH_ALEN];
5557
	int path_idx = cb->args[2];
5558 5559
	int err;

5560
	rtnl_lock();
5561
	err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
5562
	if (err)
5563
		goto out_err;
J
Johannes Berg 已提交
5564

5565
	if (!rdev->ops->dump_mpath) {
5566
		err = -EOPNOTSUPP;
J
Johannes Berg 已提交
5567 5568 5569
		goto out_err;
	}

5570
	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5571
		err = -EOPNOTSUPP;
5572
		goto out_err;
5573 5574
	}

J
Johannes Berg 已提交
5575
	while (1) {
5576
		err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
5577
				      next_hop, &pinfo);
J
Johannes Berg 已提交
5578
		if (err == -ENOENT)
5579
			break;
J
Johannes Berg 已提交
5580
		if (err)
J
Johannes Berg 已提交
5581
			goto out_err;
5582

5583
		if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
J
Johannes Berg 已提交
5584
				       cb->nlh->nlmsg_seq, NLM_F_MULTI,
5585
				       wdev->netdev, dst, next_hop,
J
Johannes Berg 已提交
5586 5587
				       &pinfo) < 0)
			goto out;
5588

J
Johannes Berg 已提交
5589
		path_idx++;
5590 5591
	}

J
Johannes Berg 已提交
5592
 out:
5593
	cb->args[2] = path_idx;
J
Johannes Berg 已提交
5594 5595
	err = skb->len;
 out_err:
5596
	rtnl_unlock();
J
Johannes Berg 已提交
5597
	return err;
5598 5599 5600 5601
}

static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
{
5602
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
5603
	int err;
5604
	struct net_device *dev = info->user_ptr[1];
5605 5606 5607 5608 5609 5610 5611 5612 5613 5614 5615 5616
	struct mpath_info pinfo;
	struct sk_buff *msg;
	u8 *dst = NULL;
	u8 next_hop[ETH_ALEN];

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

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);

5617 5618
	if (!rdev->ops->get_mpath)
		return -EOPNOTSUPP;
5619

5620 5621
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
		return -EOPNOTSUPP;
5622

5623
	err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
5624
	if (err)
5625
		return err;
5626

5627
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5628
	if (!msg)
5629
		return -ENOMEM;
5630

5631
	if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
5632 5633 5634 5635
				 dev, dst, next_hop, &pinfo) < 0) {
		nlmsg_free(msg);
		return -ENOBUFS;
	}
J
Johannes Berg 已提交
5636

5637
	return genlmsg_reply(msg, info);
5638 5639 5640 5641
}

static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
{
5642 5643
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
5644 5645 5646 5647 5648 5649 5650 5651 5652 5653 5654 5655
	u8 *dst = NULL;
	u8 *next_hop = NULL;

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
		return -EINVAL;

	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
	next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);

5656 5657
	if (!rdev->ops->change_mpath)
		return -EOPNOTSUPP;
5658

5659 5660
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
		return -EOPNOTSUPP;
5661

5662
	return rdev_change_mpath(rdev, dev, dst, next_hop);
5663
}
5664

5665 5666
static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
{
5667 5668
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
5669 5670 5671 5672 5673 5674 5675 5676 5677 5678 5679 5680
	u8 *dst = NULL;
	u8 *next_hop = NULL;

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
		return -EINVAL;

	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
	next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);

5681 5682
	if (!rdev->ops->add_mpath)
		return -EOPNOTSUPP;
5683

5684 5685
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
		return -EOPNOTSUPP;
5686

5687
	return rdev_add_mpath(rdev, dev, dst, next_hop);
5688 5689 5690 5691
}

static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
{
5692 5693
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
5694 5695 5696 5697 5698
	u8 *dst = NULL;

	if (info->attrs[NL80211_ATTR_MAC])
		dst = nla_data(info->attrs[NL80211_ATTR_MAC]);

5699 5700
	if (!rdev->ops->del_mpath)
		return -EOPNOTSUPP;
J
Johannes Berg 已提交
5701

5702
	return rdev_del_mpath(rdev, dev, dst);
5703 5704
}

5705 5706 5707 5708 5709 5710 5711 5712 5713 5714 5715 5716 5717 5718 5719 5720 5721 5722 5723 5724 5725 5726 5727 5728 5729 5730 5731 5732 5733 5734 5735 5736 5737 5738 5739 5740 5741 5742 5743 5744 5745 5746 5747 5748 5749 5750 5751 5752 5753 5754 5755
static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	int err;
	struct net_device *dev = info->user_ptr[1];
	struct mpath_info pinfo;
	struct sk_buff *msg;
	u8 *dst = NULL;
	u8 mpp[ETH_ALEN];

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

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);

	if (!rdev->ops->get_mpp)
		return -EOPNOTSUPP;

	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
		return -EOPNOTSUPP;

	err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
	if (err)
		return err;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg)
		return -ENOMEM;

	if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
			       dev, dst, mpp, &pinfo) < 0) {
		nlmsg_free(msg);
		return -ENOBUFS;
	}

	return genlmsg_reply(msg, info);
}

static int nl80211_dump_mpp(struct sk_buff *skb,
			    struct netlink_callback *cb)
{
	struct mpath_info pinfo;
	struct cfg80211_registered_device *rdev;
	struct wireless_dev *wdev;
	u8 dst[ETH_ALEN];
	u8 mpp[ETH_ALEN];
	int path_idx = cb->args[2];
	int err;

5756
	rtnl_lock();
5757 5758
	err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
	if (err)
5759
		goto out_err;
5760 5761 5762 5763 5764 5765 5766 5767 5768 5769 5770 5771 5772 5773 5774 5775 5776 5777 5778 5779 5780 5781 5782 5783 5784 5785 5786 5787 5788 5789 5790 5791

	if (!rdev->ops->dump_mpp) {
		err = -EOPNOTSUPP;
		goto out_err;
	}

	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
		err = -EOPNOTSUPP;
		goto out_err;
	}

	while (1) {
		err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
				    mpp, &pinfo);
		if (err == -ENOENT)
			break;
		if (err)
			goto out_err;

		if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
				       cb->nlh->nlmsg_seq, NLM_F_MULTI,
				       wdev->netdev, dst, mpp,
				       &pinfo) < 0)
			goto out;

		path_idx++;
	}

 out:
	cb->args[2] = path_idx;
	err = skb->len;
 out_err:
5792
	rtnl_unlock();
5793 5794 5795
	return err;
}

5796 5797
static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
{
5798 5799
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
5800
	struct wireless_dev *wdev = dev->ieee80211_ptr;
5801
	struct bss_parameters params;
5802
	int err;
5803 5804 5805 5806 5807 5808

	memset(&params, 0, sizeof(params));
	/* default to not changing parameters */
	params.use_cts_prot = -1;
	params.use_short_preamble = -1;
	params.use_short_slot_time = -1;
5809
	params.ap_isolate = -1;
5810
	params.ht_opmode = -1;
5811 5812
	params.p2p_ctwindow = -1;
	params.p2p_opp_ps = -1;
5813 5814 5815 5816 5817 5818 5819 5820 5821 5822

	if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
		params.use_cts_prot =
		    nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
	if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
		params.use_short_preamble =
		    nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
	if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
		params.use_short_slot_time =
		    nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
5823 5824 5825 5826 5827 5828
	if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
		params.basic_rates =
			nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
		params.basic_rates_len =
			nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
	}
5829 5830
	if (info->attrs[NL80211_ATTR_AP_ISOLATE])
		params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
5831 5832 5833
	if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
		params.ht_opmode =
			nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
5834

5835 5836 5837 5838 5839 5840 5841 5842 5843 5844 5845 5846 5847 5848 5849 5850 5851 5852 5853 5854 5855 5856 5857 5858 5859 5860
	if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
			return -EINVAL;
		params.p2p_ctwindow =
			nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
		if (params.p2p_ctwindow < 0)
			return -EINVAL;
		if (params.p2p_ctwindow != 0 &&
		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
			return -EINVAL;
	}

	if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
		u8 tmp;

		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
			return -EINVAL;
		tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
		if (tmp > 1)
			return -EINVAL;
		params.p2p_opp_ps = tmp;
		if (params.p2p_opp_ps &&
		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
			return -EINVAL;
	}

5861 5862
	if (!rdev->ops->change_bss)
		return -EOPNOTSUPP;
5863

5864
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5865 5866
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
		return -EOPNOTSUPP;
J
Johannes Berg 已提交
5867

5868 5869 5870 5871 5872
	wdev_lock(wdev);
	err = rdev_change_bss(rdev, dev, &params);
	wdev_unlock(wdev);

	return err;
5873 5874
}

5875 5876 5877
static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
{
	char *data = NULL;
5878
	bool is_indoor;
5879
	enum nl80211_user_reg_hint_type user_reg_hint_type;
5880 5881
	u32 owner_nlportid;

5882 5883 5884 5885 5886 5887
	/*
	 * You should only get this when cfg80211 hasn't yet initialized
	 * completely when built-in to the kernel right between the time
	 * window between nl80211_init() and regulatory_init(), if that is
	 * even possible.
	 */
5888
	if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
5889
		return -EINPROGRESS;
5890

5891 5892 5893 5894 5895 5896 5897 5898 5899
	if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
		user_reg_hint_type =
		  nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
	else
		user_reg_hint_type = NL80211_USER_REG_HINT_USER;

	switch (user_reg_hint_type) {
	case NL80211_USER_REG_HINT_USER:
	case NL80211_USER_REG_HINT_CELL_BASE:
5900 5901 5902 5903 5904 5905
		if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
			return -EINVAL;

		data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
		return regulatory_hint_user(data, user_reg_hint_type);
	case NL80211_USER_REG_HINT_INDOOR:
5906 5907 5908 5909 5910 5911 5912 5913 5914
		if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
			owner_nlportid = info->snd_portid;
			is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
		} else {
			owner_nlportid = 0;
			is_indoor = true;
		}

		return regulatory_hint_indoor(is_indoor, owner_nlportid);
5915 5916 5917
	default:
		return -EINVAL;
	}
5918 5919
}

5920 5921 5922 5923 5924
static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info)
{
	return reg_reload_regdb();
}

5925
static int nl80211_get_mesh_config(struct sk_buff *skb,
5926
				   struct genl_info *info)
5927
{
5928 5929
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
5930 5931 5932
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct mesh_config cur_params;
	int err = 0;
5933 5934 5935 5936
	void *hdr;
	struct nlattr *pinfoattr;
	struct sk_buff *msg;

5937 5938 5939
	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
		return -EOPNOTSUPP;

5940
	if (!rdev->ops->get_mesh_config)
5941
		return -EOPNOTSUPP;
5942

5943 5944 5945 5946 5947
	wdev_lock(wdev);
	/* If not connected, get default parameters */
	if (!wdev->mesh_id_len)
		memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
	else
5948
		err = rdev_get_mesh_config(rdev, dev, &cur_params);
5949 5950
	wdev_unlock(wdev);

5951
	if (err)
5952
		return err;
5953 5954

	/* Draw up a netlink message to send back */
5955
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5956 5957
	if (!msg)
		return -ENOMEM;
5958
	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
5959
			     NL80211_CMD_GET_MESH_CONFIG);
5960
	if (!hdr)
5961
		goto out;
5962
	pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
5963 5964
	if (!pinfoattr)
		goto nla_put_failure;
5965 5966 5967 5968 5969 5970 5971 5972 5973 5974 5975 5976 5977 5978 5979 5980 5981
	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
			cur_params.dot11MeshRetryTimeout) ||
	    nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
			cur_params.dot11MeshConfirmTimeout) ||
	    nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
			cur_params.dot11MeshHoldingTimeout) ||
	    nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
			cur_params.dot11MeshMaxPeerLinks) ||
	    nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
		       cur_params.dot11MeshMaxRetries) ||
	    nla_put_u8(msg, NL80211_MESHCONF_TTL,
		       cur_params.dot11MeshTTL) ||
	    nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
		       cur_params.element_ttl) ||
	    nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
		       cur_params.auto_open_plinks) ||
5982 5983
	    nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
			cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
5984 5985 5986 5987 5988 5989 5990 5991 5992 5993 5994 5995 5996 5997 5998 5999 6000 6001 6002 6003 6004 6005
	    nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
		       cur_params.dot11MeshHWMPmaxPREQretries) ||
	    nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
			cur_params.path_refresh_time) ||
	    nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
			cur_params.min_discovery_timeout) ||
	    nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
			cur_params.dot11MeshHWMPactivePathTimeout) ||
	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
			cur_params.dot11MeshHWMPpreqMinInterval) ||
	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
			cur_params.dot11MeshHWMPperrMinInterval) ||
	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
			cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
	    nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
		       cur_params.dot11MeshHWMPRootMode) ||
	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
			cur_params.dot11MeshHWMPRannInterval) ||
	    nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
		       cur_params.dot11MeshGateAnnouncementProtocol) ||
	    nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
		       cur_params.dot11MeshForwarding) ||
6006
	    nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
6007 6008
			cur_params.rssi_threshold) ||
	    nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
6009 6010 6011 6012
			cur_params.ht_opmode) ||
	    nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
			cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
6013 6014
			cur_params.dot11MeshHWMProotInterval) ||
	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
6015 6016 6017 6018
			cur_params.dot11MeshHWMPconfirmationInterval) ||
	    nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
			cur_params.power_mode) ||
	    nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
6019 6020 6021
			cur_params.dot11MeshAwakeWindowDuration) ||
	    nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
			cur_params.plink_timeout))
6022
		goto nla_put_failure;
6023 6024
	nla_nest_end(msg, pinfoattr);
	genlmsg_end(msg, hdr);
6025
	return genlmsg_reply(msg, info);
6026

J
Johannes Berg 已提交
6027
 nla_put_failure:
6028
 out:
Y
Yuri Ershov 已提交
6029
	nlmsg_free(msg);
6030
	return -ENOBUFS;
6031 6032
}

A
Alexey Dobriyan 已提交
6033
static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
6034 6035 6036 6037 6038 6039
	[NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
	[NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
	[NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
	[NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
	[NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
	[NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
6040
	[NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
6041
	[NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
6042
	[NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
6043 6044 6045 6046 6047
	[NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
	[NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
	[NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
	[NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
	[NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
6048
	[NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
6049
	[NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
6050
	[NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
6051
	[NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
6052
	[NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
6053
	[NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
6054 6055
	[NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
	[NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
6056 6057
	[NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
	[NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
6058
	[NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
6059 6060
	[NL80211_MESHCONF_POWER_MODE] = { .type = NLA_U32 },
	[NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
6061
	[NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
6062 6063
};

6064 6065
static const struct nla_policy
	nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
6066
	[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
6067 6068
	[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
	[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
6069
	[NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
6070
	[NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
6071
	[NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
6072
	[NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
6073
				    .len = IEEE80211_MAX_DATA_LEN },
6074
	[NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
6075 6076
};

6077 6078 6079 6080 6081 6082 6083 6084 6085 6086 6087 6088 6089 6090 6091 6092 6093 6094 6095 6096 6097 6098 6099 6100 6101 6102 6103 6104 6105 6106 6107 6108 6109 6110 6111 6112 6113 6114 6115 6116 6117 6118 6119 6120 6121
static int nl80211_check_bool(const struct nlattr *nla, u8 min, u8 max, bool *out)
{
	u8 val = nla_get_u8(nla);
	if (val < min || val > max)
		return -EINVAL;
	*out = val;
	return 0;
}

static int nl80211_check_u8(const struct nlattr *nla, u8 min, u8 max, u8 *out)
{
	u8 val = nla_get_u8(nla);
	if (val < min || val > max)
		return -EINVAL;
	*out = val;
	return 0;
}

static int nl80211_check_u16(const struct nlattr *nla, u16 min, u16 max, u16 *out)
{
	u16 val = nla_get_u16(nla);
	if (val < min || val > max)
		return -EINVAL;
	*out = val;
	return 0;
}

static int nl80211_check_u32(const struct nlattr *nla, u32 min, u32 max, u32 *out)
{
	u32 val = nla_get_u32(nla);
	if (val < min || val > max)
		return -EINVAL;
	*out = val;
	return 0;
}

static int nl80211_check_s32(const struct nlattr *nla, s32 min, s32 max, s32 *out)
{
	s32 val = nla_get_s32(nla);
	if (val < min || val > max)
		return -EINVAL;
	*out = val;
	return 0;
}

6122 6123 6124 6125 6126 6127 6128 6129 6130 6131 6132 6133
static int nl80211_check_power_mode(const struct nlattr *nla,
				    enum nl80211_mesh_power_mode min,
				    enum nl80211_mesh_power_mode max,
				    enum nl80211_mesh_power_mode *out)
{
	u32 val = nla_get_u32(nla);
	if (val < min || val > max)
		return -EINVAL;
	*out = val;
	return 0;
}

6134
static int nl80211_parse_mesh_config(struct genl_info *info,
6135 6136
				     struct mesh_config *cfg,
				     u32 *mask_out)
6137 6138
{
	struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
6139
	u32 mask = 0;
6140
	u16 ht_opmode;
6141

6142 6143 6144
#define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, min, max, mask, attr, fn) \
do {									    \
	if (tb[attr]) {							    \
6145
		if (fn(tb[attr], min, max, &cfg->param))		    \
6146 6147 6148 6149
			return -EINVAL;					    \
		mask |= (1 << (attr - 1));				    \
	}								    \
} while (0)
6150

6151
	if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
6152 6153
		return -EINVAL;
	if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
6154
			     info->attrs[NL80211_ATTR_MESH_CONFIG],
6155
			     nl80211_meshconf_params_policy, info->extack))
6156 6157 6158 6159 6160 6161 6162
		return -EINVAL;

	/* This makes sure that there aren't more than 32 mesh config
	 * parameters (otherwise our bitfield scheme would not work.) */
	BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);

	/* Fill in the params struct */
6163
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, 1, 255,
6164
				  mask, NL80211_MESHCONF_RETRY_TIMEOUT,
6165
				  nl80211_check_u16);
6166
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, 1, 255,
6167
				  mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
6168
				  nl80211_check_u16);
6169
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, 1, 255,
6170
				  mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
6171
				  nl80211_check_u16);
6172
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, 0, 255,
6173
				  mask, NL80211_MESHCONF_MAX_PEER_LINKS,
6174
				  nl80211_check_u16);
6175
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, 0, 16,
6176
				  mask, NL80211_MESHCONF_MAX_RETRIES,
6177
				  nl80211_check_u8);
6178
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, 1, 255,
6179
				  mask, NL80211_MESHCONF_TTL, nl80211_check_u8);
6180
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, 1, 255,
6181
				  mask, NL80211_MESHCONF_ELEMENT_TTL,
6182
				  nl80211_check_u8);
6183
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, 0, 1,
6184
				  mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
6185
				  nl80211_check_bool);
6186 6187
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
				  1, 255, mask,
6188
				  NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
6189
				  nl80211_check_u32);
6190
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, 0, 255,
6191
				  mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
6192
				  nl80211_check_u8);
6193
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, 1, 65535,
6194
				  mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
6195
				  nl80211_check_u32);
6196
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, 1, 65535,
6197
				  mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
6198
				  nl80211_check_u16);
6199 6200
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
				  1, 65535, mask,
6201
				  NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
6202
				  nl80211_check_u32);
6203
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
6204 6205
				  1, 65535, mask,
				  NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
6206
				  nl80211_check_u16);
6207
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
6208 6209
				  1, 65535, mask,
				  NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
6210
				  nl80211_check_u16);
6211
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6212 6213
				  dot11MeshHWMPnetDiameterTraversalTime,
				  1, 65535, mask,
6214
				  NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
6215
				  nl80211_check_u16);
6216 6217
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, 0, 4,
				  mask, NL80211_MESHCONF_HWMP_ROOTMODE,
6218
				  nl80211_check_u8);
6219 6220
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, 1, 65535,
				  mask, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
6221
				  nl80211_check_u16);
6222
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6223 6224
				  dot11MeshGateAnnouncementProtocol, 0, 1,
				  mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
6225
				  nl80211_check_bool);
6226
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, 0, 1,
6227
				  mask, NL80211_MESHCONF_FORWARDING,
6228
				  nl80211_check_bool);
6229
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, -255, 0,
6230
				  mask, NL80211_MESHCONF_RSSI_THRESHOLD,
6231
				  nl80211_check_s32);
6232 6233 6234 6235 6236 6237 6238 6239 6240 6241 6242 6243 6244 6245 6246 6247 6248 6249 6250 6251 6252 6253 6254 6255 6256 6257 6258 6259 6260
	/*
	 * Check HT operation mode based on
	 * IEEE 802.11 2012 8.4.2.59 HT Operation element.
	 */
	if (tb[NL80211_MESHCONF_HT_OPMODE]) {
		ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);

		if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
				  IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
				  IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
			return -EINVAL;

		if ((ht_opmode & IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT) &&
		    (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
			return -EINVAL;

		switch (ht_opmode & IEEE80211_HT_OP_MODE_PROTECTION) {
		case IEEE80211_HT_OP_MODE_PROTECTION_NONE:
		case IEEE80211_HT_OP_MODE_PROTECTION_20MHZ:
			if (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)
				return -EINVAL;
			break;
		case IEEE80211_HT_OP_MODE_PROTECTION_NONMEMBER:
		case IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED:
			if (!(ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
				return -EINVAL;
			break;
		}
		cfg->ht_opmode = ht_opmode;
6261
		mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
6262
	}
6263
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
6264
				  1, 65535, mask,
6265
				  NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
6266
				  nl80211_check_u32);
6267
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, 1, 65535,
6268
				  mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
6269
				  nl80211_check_u16);
6270
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6271 6272
				  dot11MeshHWMPconfirmationInterval,
				  1, 65535, mask,
6273
				  NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
6274
				  nl80211_check_u16);
6275 6276 6277 6278
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode,
				  NL80211_MESH_POWER_ACTIVE,
				  NL80211_MESH_POWER_MAX,
				  mask, NL80211_MESHCONF_POWER_MODE,
6279
				  nl80211_check_power_mode);
6280 6281
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration,
				  0, 65535, mask,
6282
				  NL80211_MESHCONF_AWAKE_WINDOW, nl80211_check_u16);
6283
	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, 0, 0xffffffff,
6284
				  mask, NL80211_MESHCONF_PLINK_TIMEOUT,
6285
				  nl80211_check_u32);
6286 6287
	if (mask_out)
		*mask_out = mask;
6288

6289 6290 6291 6292 6293
	return 0;

#undef FILL_IN_MESH_PARAM_IF_SET
}

6294 6295 6296
static int nl80211_parse_mesh_setup(struct genl_info *info,
				     struct mesh_setup *setup)
{
6297
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6298 6299 6300 6301 6302 6303
	struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];

	if (!info->attrs[NL80211_ATTR_MESH_SETUP])
		return -EINVAL;
	if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
			     info->attrs[NL80211_ATTR_MESH_SETUP],
6304
			     nl80211_mesh_setup_params_policy, info->extack))
6305 6306
		return -EINVAL;

6307 6308 6309 6310 6311 6312
	if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
		setup->sync_method =
		(nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
		 IEEE80211_SYNC_METHOD_VENDOR :
		 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;

6313 6314 6315 6316 6317 6318 6319 6320 6321 6322 6323 6324
	if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
		setup->path_sel_proto =
		(nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
		 IEEE80211_PATH_PROTOCOL_VENDOR :
		 IEEE80211_PATH_PROTOCOL_HWMP;

	if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
		setup->path_metric =
		(nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
		 IEEE80211_PATH_METRIC_VENDOR :
		 IEEE80211_PATH_METRIC_AIRTIME;

6325
	if (tb[NL80211_MESH_SETUP_IE]) {
6326
		struct nlattr *ieattr =
6327
			tb[NL80211_MESH_SETUP_IE];
6328 6329
		if (!is_valid_ie_attr(ieattr))
			return -EINVAL;
6330 6331
		setup->ie = nla_data(ieattr);
		setup->ie_len = nla_len(ieattr);
6332
	}
6333 6334 6335 6336
	if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
	    !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
		return -EINVAL;
	setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
6337 6338
	setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
	setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
6339 6340
	if (setup->is_secure)
		setup->user_mpm = true;
6341

6342 6343 6344 6345 6346 6347 6348
	if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
		if (!setup->user_mpm)
			return -EINVAL;
		setup->auth_id =
			nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
	}

6349 6350 6351
	return 0;
}

6352
static int nl80211_update_mesh_config(struct sk_buff *skb,
6353
				      struct genl_info *info)
6354 6355 6356
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
6357
	struct wireless_dev *wdev = dev->ieee80211_ptr;
6358 6359 6360 6361
	struct mesh_config cfg;
	u32 mask;
	int err;

6362 6363 6364
	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
		return -EOPNOTSUPP;

6365
	if (!rdev->ops->update_mesh_config)
6366 6367
		return -EOPNOTSUPP;

6368
	err = nl80211_parse_mesh_config(info, &cfg, &mask);
6369 6370 6371
	if (err)
		return err;

6372 6373 6374 6375 6376
	wdev_lock(wdev);
	if (!wdev->mesh_id_len)
		err = -ENOLINK;

	if (!err)
6377
		err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
6378 6379 6380 6381

	wdev_unlock(wdev);

	return err;
6382 6383
}

6384 6385
static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
			      struct sk_buff *msg)
6386 6387 6388 6389
{
	struct nlattr *nl_reg_rules;
	unsigned int i;

6390 6391 6392
	if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
	    (regdom->dfs_region &&
	     nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
6393
		goto nla_put_failure;
6394

6395 6396
	nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
	if (!nl_reg_rules)
6397
		goto nla_put_failure;
6398

6399
	for (i = 0; i < regdom->n_reg_rules; i++) {
6400 6401 6402 6403
		struct nlattr *nl_reg_rule;
		const struct ieee80211_reg_rule *reg_rule;
		const struct ieee80211_freq_range *freq_range;
		const struct ieee80211_power_rule *power_rule;
6404
		unsigned int max_bandwidth_khz;
6405

6406
		reg_rule = &regdom->reg_rules[i];
6407 6408 6409 6410 6411
		freq_range = &reg_rule->freq_range;
		power_rule = &reg_rule->power_rule;

		nl_reg_rule = nla_nest_start(msg, i);
		if (!nl_reg_rule)
6412
			goto nla_put_failure;
6413

6414 6415 6416 6417 6418
		max_bandwidth_khz = freq_range->max_bandwidth_khz;
		if (!max_bandwidth_khz)
			max_bandwidth_khz = reg_get_max_bandwidth(regdom,
								  reg_rule);

6419 6420 6421 6422 6423 6424 6425
		if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
				reg_rule->flags) ||
		    nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
				freq_range->start_freq_khz) ||
		    nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
				freq_range->end_freq_khz) ||
		    nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
6426
				max_bandwidth_khz) ||
6427 6428 6429
		    nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
				power_rule->max_antenna_gain) ||
		    nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
6430 6431 6432
				power_rule->max_eirp) ||
		    nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
				reg_rule->dfs_cac_ms))
6433
			goto nla_put_failure;
6434 6435 6436 6437 6438

		nla_nest_end(msg, nl_reg_rule);
	}

	nla_nest_end(msg, nl_reg_rules);
6439 6440 6441 6442 6443 6444 6445 6446 6447 6448 6449 6450 6451 6452 6453 6454 6455 6456 6457 6458 6459 6460 6461 6462
	return 0;

nla_put_failure:
	return -EMSGSIZE;
}

static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
{
	const struct ieee80211_regdomain *regdom = NULL;
	struct cfg80211_registered_device *rdev;
	struct wiphy *wiphy = NULL;
	struct sk_buff *msg;
	void *hdr;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg)
		return -ENOBUFS;

	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
			     NL80211_CMD_GET_REG);
	if (!hdr)
		goto put_failure;

	if (info->attrs[NL80211_ATTR_WIPHY]) {
6463 6464
		bool self_managed;

6465 6466 6467 6468 6469 6470 6471
		rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
		if (IS_ERR(rdev)) {
			nlmsg_free(msg);
			return PTR_ERR(rdev);
		}

		wiphy = &rdev->wiphy;
6472 6473
		self_managed = wiphy->regulatory_flags &
			       REGULATORY_WIPHY_SELF_MANAGED;
6474 6475
		regdom = get_wiphy_regdom(wiphy);

6476 6477 6478 6479 6480 6481
		/* a self-managed-reg device must have a private regdom */
		if (WARN_ON(!regdom && self_managed)) {
			nlmsg_free(msg);
			return -EINVAL;
		}

6482 6483 6484 6485 6486 6487 6488 6489 6490 6491 6492 6493 6494 6495 6496 6497 6498 6499 6500
		if (regdom &&
		    nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
			goto nla_put_failure;
	}

	if (!wiphy && reg_last_request_cell_base() &&
	    nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
			NL80211_USER_REG_HINT_CELL_BASE))
		goto nla_put_failure;

	rcu_read_lock();

	if (!regdom)
		regdom = rcu_dereference(cfg80211_regdomain);

	if (nl80211_put_regdom(regdom, msg))
		goto nla_put_failure_rcu;

	rcu_read_unlock();
6501 6502

	genlmsg_end(msg, hdr);
6503
	return genlmsg_reply(msg, info);
6504

6505 6506
nla_put_failure_rcu:
	rcu_read_unlock();
6507
nla_put_failure:
6508
put_failure:
Y
Yuri Ershov 已提交
6509
	nlmsg_free(msg);
6510
	return -EMSGSIZE;
6511 6512
}

6513 6514 6515 6516 6517 6518 6519 6520 6521 6522
static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
			       u32 seq, int flags, struct wiphy *wiphy,
			       const struct ieee80211_regdomain *regdom)
{
	void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
				   NL80211_CMD_GET_REG);

	if (!hdr)
		return -1;

M
Michal Kubecek 已提交
6523
	genl_dump_check_consistent(cb, hdr);
6524 6525 6526 6527 6528 6529 6530 6531 6532 6533 6534 6535 6536

	if (nl80211_put_regdom(regdom, msg))
		goto nla_put_failure;

	if (!wiphy && reg_last_request_cell_base() &&
	    nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
			NL80211_USER_REG_HINT_CELL_BASE))
		goto nla_put_failure;

	if (wiphy &&
	    nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
		goto nla_put_failure;

6537 6538 6539 6540
	if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
	    nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
		goto nla_put_failure;

6541 6542
	genlmsg_end(msg, hdr);
	return 0;
6543 6544 6545 6546 6547 6548 6549 6550 6551 6552 6553 6554 6555 6556 6557 6558 6559 6560 6561 6562 6563 6564 6565 6566 6567 6568 6569 6570 6571 6572 6573 6574 6575 6576 6577 6578 6579 6580 6581 6582 6583 6584 6585 6586 6587 6588 6589 6590

nla_put_failure:
	genlmsg_cancel(msg, hdr);
	return -EMSGSIZE;
}

static int nl80211_get_reg_dump(struct sk_buff *skb,
				struct netlink_callback *cb)
{
	const struct ieee80211_regdomain *regdom = NULL;
	struct cfg80211_registered_device *rdev;
	int err, reg_idx, start = cb->args[2];

	rtnl_lock();

	if (cfg80211_regdomain && start == 0) {
		err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
					  NLM_F_MULTI, NULL,
					  rtnl_dereference(cfg80211_regdomain));
		if (err < 0)
			goto out_err;
	}

	/* the global regdom is idx 0 */
	reg_idx = 1;
	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
		regdom = get_wiphy_regdom(&rdev->wiphy);
		if (!regdom)
			continue;

		if (++reg_idx <= start)
			continue;

		err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
					  NLM_F_MULTI, &rdev->wiphy, regdom);
		if (err < 0) {
			reg_idx--;
			break;
		}
	}

	cb->args[2] = reg_idx;
	err = skb->len;
out_err:
	rtnl_unlock();
	return err;
}

6591 6592 6593 6594 6595 6596 6597 6598 6599 6600 6601 6602 6603 6604 6605 6606 6607 6608 6609 6610 6611 6612 6613 6614 6615 6616 6617 6618 6619 6620 6621 6622 6623 6624 6625 6626 6627 6628 6629 6630 6631 6632 6633 6634 6635 6636 6637 6638 6639 6640 6641
#ifdef CONFIG_CFG80211_CRDA_SUPPORT
static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
	[NL80211_ATTR_REG_RULE_FLAGS]		= { .type = NLA_U32 },
	[NL80211_ATTR_FREQ_RANGE_START]		= { .type = NLA_U32 },
	[NL80211_ATTR_FREQ_RANGE_END]		= { .type = NLA_U32 },
	[NL80211_ATTR_FREQ_RANGE_MAX_BW]	= { .type = NLA_U32 },
	[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]	= { .type = NLA_U32 },
	[NL80211_ATTR_POWER_RULE_MAX_EIRP]	= { .type = NLA_U32 },
	[NL80211_ATTR_DFS_CAC_TIME]		= { .type = NLA_U32 },
};

static int parse_reg_rule(struct nlattr *tb[],
	struct ieee80211_reg_rule *reg_rule)
{
	struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
	struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;

	if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
		return -EINVAL;
	if (!tb[NL80211_ATTR_FREQ_RANGE_START])
		return -EINVAL;
	if (!tb[NL80211_ATTR_FREQ_RANGE_END])
		return -EINVAL;
	if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
		return -EINVAL;
	if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
		return -EINVAL;

	reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);

	freq_range->start_freq_khz =
		nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
	freq_range->end_freq_khz =
		nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
	freq_range->max_bandwidth_khz =
		nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);

	power_rule->max_eirp =
		nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);

	if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
		power_rule->max_antenna_gain =
			nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);

	if (tb[NL80211_ATTR_DFS_CAC_TIME])
		reg_rule->dfs_cac_ms =
			nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);

	return 0;
}

6642 6643 6644 6645
static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
	struct nlattr *nl_reg_rule;
6646 6647
	char *alpha2;
	int rem_reg_rules, r;
6648
	u32 num_rules = 0, rule_idx = 0, size_of_regd;
6649
	enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
6650
	struct ieee80211_regdomain *rd;
6651 6652 6653 6654 6655 6656 6657 6658 6659

	if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_REG_RULES])
		return -EINVAL;

	alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);

6660 6661 6662
	if (info->attrs[NL80211_ATTR_DFS_REGION])
		dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);

6663
	nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
J
Johannes Berg 已提交
6664
			    rem_reg_rules) {
6665 6666
		num_rules++;
		if (num_rules > NL80211_MAX_SUPP_REG_RULES)
6667
			return -EINVAL;
6668 6669
	}

6670 6671 6672
	if (!reg_is_valid_request(alpha2))
		return -EINVAL;

6673
	size_of_regd = sizeof(struct ieee80211_regdomain) +
J
Johannes Berg 已提交
6674
		       num_rules * sizeof(struct ieee80211_reg_rule);
6675 6676

	rd = kzalloc(size_of_regd, GFP_KERNEL);
6677 6678
	if (!rd)
		return -ENOMEM;
6679 6680 6681 6682 6683

	rd->n_reg_rules = num_rules;
	rd->alpha2[0] = alpha2[0];
	rd->alpha2[1] = alpha2[1];

6684 6685 6686 6687 6688 6689 6690
	/*
	 * Disable DFS master mode if the DFS region was
	 * not supported or known on this kernel.
	 */
	if (reg_supported_dfs_region(dfs_region))
		rd->dfs_region = dfs_region;

6691
	nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
J
Johannes Berg 已提交
6692
			    rem_reg_rules) {
6693
		r = nla_parse_nested(tb, NL80211_REG_RULE_ATTR_MAX,
6694 6695
				     nl_reg_rule, reg_rule_policy,
				     info->extack);
6696 6697
		if (r)
			goto bad_reg;
6698 6699 6700 6701 6702 6703
		r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
		if (r)
			goto bad_reg;

		rule_idx++;

6704 6705
		if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
			r = -EINVAL;
6706
			goto bad_reg;
6707
		}
6708 6709
	}

6710 6711
	/* set_regdom takes ownership of rd */
	return set_regdom(rd, REGD_SOURCE_CRDA);
6712
 bad_reg:
6713
	kfree(rd);
6714
	return r;
6715
}
6716
#endif /* CONFIG_CFG80211_CRDA_SUPPORT */
6717

6718 6719 6720 6721 6722
static int validate_scan_freqs(struct nlattr *freqs)
{
	struct nlattr *attr1, *attr2;
	int n_channels = 0, tmp1, tmp2;

6723 6724 6725 6726
	nla_for_each_nested(attr1, freqs, tmp1)
		if (nla_len(attr1) != sizeof(u32))
			return 0;

6727 6728 6729 6730 6731 6732 6733 6734 6735 6736 6737 6738 6739 6740 6741 6742 6743 6744 6745 6746
	nla_for_each_nested(attr1, freqs, tmp1) {
		n_channels++;
		/*
		 * Some hardware has a limited channel list for
		 * scanning, and it is pretty much nonsensical
		 * to scan for a channel twice, so disallow that
		 * and don't require drivers to check that the
		 * channel list they get isn't longer than what
		 * they can scan, as long as they can scan all
		 * the channels they registered at once.
		 */
		nla_for_each_nested(attr2, freqs, tmp2)
			if (attr1 != attr2 &&
			    nla_get_u32(attr1) == nla_get_u32(attr2))
				return 0;
	}

	return n_channels;
}

6747
static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
6748
{
6749
	return b < NUM_NL80211_BANDS && wiphy->bands[b];
6750 6751 6752 6753 6754 6755 6756 6757 6758 6759 6760 6761 6762 6763 6764 6765
}

static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
			    struct cfg80211_bss_selection *bss_select)
{
	struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
	struct nlattr *nest;
	int err;
	bool found = false;
	int i;

	/* only process one nested attribute */
	nest = nla_data(nla);
	if (!nla_ok(nest, nla_len(nest)))
		return -EINVAL;

6766
	err = nla_parse_nested(attr, NL80211_BSS_SELECT_ATTR_MAX, nest,
6767
			       nl80211_bss_select_policy, NULL);
6768 6769 6770 6771 6772 6773 6774 6775 6776 6777 6778 6779 6780 6781 6782 6783 6784 6785 6786 6787 6788 6789 6790 6791 6792 6793 6794 6795 6796 6797 6798 6799 6800 6801 6802 6803 6804 6805 6806 6807 6808 6809 6810 6811 6812 6813
	if (err)
		return err;

	/* only one attribute may be given */
	for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
		if (attr[i]) {
			if (found)
				return -EINVAL;
			found = true;
		}
	}

	bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;

	if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
		bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;

	if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
		bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
		bss_select->param.band_pref =
			nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
		if (!is_band_valid(wiphy, bss_select->param.band_pref))
			return -EINVAL;
	}

	if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
		struct nl80211_bss_select_rssi_adjust *adj_param;

		adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
		bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
		bss_select->param.adjust.band = adj_param->band;
		bss_select->param.adjust.delta = adj_param->delta;
		if (!is_band_valid(wiphy, bss_select->param.adjust.band))
			return -EINVAL;
	}

	/* user-space did not provide behaviour attribute */
	if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
		return -EINVAL;

	if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
		return -EINVAL;

	return 0;
}

6814 6815 6816 6817 6818 6819
static int nl80211_parse_random_mac(struct nlattr **attrs,
				    u8 *mac_addr, u8 *mac_addr_mask)
{
	int i;

	if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
6820 6821
		eth_zero_addr(mac_addr);
		eth_zero_addr(mac_addr_mask);
6822 6823 6824 6825 6826 6827 6828 6829 6830 6831 6832 6833 6834 6835 6836 6837 6838 6839 6840 6841 6842 6843 6844 6845 6846 6847 6848 6849 6850
		mac_addr[0] = 0x2;
		mac_addr_mask[0] = 0x3;

		return 0;
	}

	/* need both or none */
	if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
		return -EINVAL;

	memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
	memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);

	/* don't allow or configure an mcast address */
	if (!is_multicast_ether_addr(mac_addr_mask) ||
	    is_multicast_ether_addr(mac_addr))
		return -EINVAL;

	/*
	 * allow users to pass a MAC address that has bits set outside
	 * of the mask, but don't bother drivers with having to deal
	 * with such bits
	 */
	for (i = 0; i < ETH_ALEN; i++)
		mac_addr[i] &= mac_addr_mask[i];

	return 0;
}

6851 6852 6853 6854 6855 6856 6857 6858 6859 6860 6861 6862 6863
static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev)
{
	ASSERT_WDEV_LOCK(wdev);

	if (!cfg80211_beaconing_iface_active(wdev))
		return true;

	if (!(wdev->chandef.chan->flags & IEEE80211_CHAN_RADAR))
		return true;

	return regulatory_pre_cac_allowed(wdev->wiphy);
}

6864 6865 6866 6867 6868 6869 6870 6871 6872 6873 6874 6875 6876 6877 6878 6879 6880 6881 6882 6883 6884 6885 6886 6887 6888 6889 6890 6891 6892 6893 6894 6895
static int
nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev,
			 void *request, struct nlattr **attrs,
			 bool is_sched_scan)
{
	u8 *mac_addr, *mac_addr_mask;
	u32 *flags;
	enum nl80211_feature_flags randomness_flag;

	if (!attrs[NL80211_ATTR_SCAN_FLAGS])
		return 0;

	if (is_sched_scan) {
		struct cfg80211_sched_scan_request *req = request;

		randomness_flag = wdev ?
				  NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR :
				  NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
		flags = &req->flags;
		mac_addr = req->mac_addr;
		mac_addr_mask = req->mac_addr_mask;
	} else {
		struct cfg80211_scan_request *req = request;

		randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
		flags = &req->flags;
		mac_addr = req->mac_addr;
		mac_addr_mask = req->mac_addr_mask;
	}

	*flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]);

6896 6897 6898 6899 6900 6901 6902 6903 6904 6905 6906
	if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
	     !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
	    ((*flags & NL80211_SCAN_FLAG_LOW_SPAN) &&
	     !wiphy_ext_feature_isset(wiphy,
				      NL80211_EXT_FEATURE_LOW_SPAN_SCAN)) ||
	    ((*flags & NL80211_SCAN_FLAG_LOW_POWER) &&
	     !wiphy_ext_feature_isset(wiphy,
				      NL80211_EXT_FEATURE_LOW_POWER_SCAN)) ||
	    ((*flags & NL80211_SCAN_FLAG_HIGH_ACCURACY) &&
	     !wiphy_ext_feature_isset(wiphy,
				      NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN)))
6907 6908 6909 6910 6911 6912 6913 6914 6915 6916 6917 6918 6919 6920 6921 6922 6923 6924 6925 6926 6927 6928 6929 6930 6931 6932 6933 6934 6935 6936 6937 6938 6939 6940 6941 6942 6943
		return -EOPNOTSUPP;

	if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
		int err;

		if (!(wiphy->features & randomness_flag) ||
		    (wdev && wdev->current_bss))
			return -EOPNOTSUPP;

		err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask);
		if (err)
			return err;
	}

	if ((*flags & NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME) &&
	    !wiphy_ext_feature_isset(wiphy,
				     NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME))
		return -EOPNOTSUPP;

	if ((*flags & NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP) &&
	   !wiphy_ext_feature_isset(wiphy,
				    NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP))
		return -EOPNOTSUPP;

	if ((*flags & NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) &&
	    !wiphy_ext_feature_isset(wiphy,
				     NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION))
		return -EOPNOTSUPP;

	if ((*flags & NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE) &&
	    !wiphy_ext_feature_isset(wiphy,
				     NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE))
		return -EOPNOTSUPP;

	return 0;
}

6944 6945
static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
{
6946
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
J
Johannes Berg 已提交
6947
	struct wireless_dev *wdev = info->user_ptr[1];
6948 6949 6950
	struct cfg80211_scan_request *request;
	struct nlattr *attr;
	struct wiphy *wiphy;
6951
	int err, tmp, n_ssids = 0, n_channels, i;
6952
	size_t ie_len;
6953

6954 6955 6956
	if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
		return -EINVAL;

6957
	wiphy = &rdev->wiphy;
6958

6959 6960 6961
	if (wdev->iftype == NL80211_IFTYPE_NAN)
		return -EOPNOTSUPP;

6962 6963
	if (!rdev->ops->scan)
		return -EOPNOTSUPP;
6964

6965
	if (rdev->scan_req || rdev->scan_msg) {
6966 6967 6968
		err = -EBUSY;
		goto unlock;
	}
6969 6970

	if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6971 6972
		n_channels = validate_scan_freqs(
				info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
6973 6974 6975 6976
		if (!n_channels) {
			err = -EINVAL;
			goto unlock;
		}
6977
	} else {
6978
		n_channels = ieee80211_get_num_supported_channels(wiphy);
6979 6980 6981 6982 6983 6984
	}

	if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
		nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
			n_ssids++;

6985 6986 6987 6988
	if (n_ssids > wiphy->max_scan_ssids) {
		err = -EINVAL;
		goto unlock;
	}
6989

6990 6991 6992 6993 6994
	if (info->attrs[NL80211_ATTR_IE])
		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
	else
		ie_len = 0;

6995 6996 6997 6998
	if (ie_len > wiphy->max_scan_ie_len) {
		err = -EINVAL;
		goto unlock;
	}
6999

7000
	request = kzalloc(sizeof(*request)
7001 7002
			+ sizeof(*request->ssids) * n_ssids
			+ sizeof(*request->channels) * n_channels
7003
			+ ie_len, GFP_KERNEL);
7004 7005 7006 7007
	if (!request) {
		err = -ENOMEM;
		goto unlock;
	}
7008 7009

	if (n_ssids)
7010
		request->ssids = (void *)&request->channels[n_channels];
7011
	request->n_ssids = n_ssids;
7012
	if (ie_len) {
7013
		if (n_ssids)
7014 7015 7016 7017
			request->ie = (void *)(request->ssids + n_ssids);
		else
			request->ie = (void *)(request->channels + n_channels);
	}
7018

J
Johannes Berg 已提交
7019
	i = 0;
7020 7021 7022
	if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
		/* user specified, bail out if channel not found */
		nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
J
Johannes Berg 已提交
7023 7024 7025 7026 7027
			struct ieee80211_channel *chan;

			chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));

			if (!chan) {
7028 7029 7030
				err = -EINVAL;
				goto out_free;
			}
J
Johannes Berg 已提交
7031 7032 7033 7034 7035 7036

			/* ignore disabled channels */
			if (chan->flags & IEEE80211_CHAN_DISABLED)
				continue;

			request->channels[i] = chan;
7037 7038 7039
			i++;
		}
	} else {
7040
		enum nl80211_band band;
7041

7042
		/* all channels */
7043
		for (band = 0; band < NUM_NL80211_BANDS; band++) {
7044
			int j;
7045

7046 7047 7048
			if (!wiphy->bands[band])
				continue;
			for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
J
Johannes Berg 已提交
7049 7050 7051 7052 7053 7054 7055 7056
				struct ieee80211_channel *chan;

				chan = &wiphy->bands[band]->channels[j];

				if (chan->flags & IEEE80211_CHAN_DISABLED)
					continue;

				request->channels[i] = chan;
7057 7058 7059 7060 7061
				i++;
			}
		}
	}

J
Johannes Berg 已提交
7062 7063 7064 7065 7066 7067 7068
	if (!i) {
		err = -EINVAL;
		goto out_free;
	}

	request->n_channels = i;

7069 7070 7071 7072 7073 7074 7075 7076 7077 7078 7079 7080 7081 7082 7083 7084 7085 7086 7087
	wdev_lock(wdev);
	if (!cfg80211_off_channel_oper_allowed(wdev)) {
		struct ieee80211_channel *chan;

		if (request->n_channels != 1) {
			wdev_unlock(wdev);
			err = -EBUSY;
			goto out_free;
		}

		chan = request->channels[0];
		if (chan->center_freq != wdev->chandef.chan->center_freq) {
			wdev_unlock(wdev);
			err = -EBUSY;
			goto out_free;
		}
	}
	wdev_unlock(wdev);

7088
	i = 0;
7089
	if (n_ssids) {
7090
		nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
7091
			if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
7092 7093 7094
				err = -EINVAL;
				goto out_free;
			}
7095
			request->ssids[i].ssid_len = nla_len(attr);
7096 7097 7098 7099 7100
			memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
			i++;
		}
	}

7101 7102
	if (info->attrs[NL80211_ATTR_IE]) {
		request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
7103 7104
		memcpy((void *)request->ie,
		       nla_data(info->attrs[NL80211_ATTR_IE]),
7105 7106 7107
		       request->ie_len);
	}

7108
	for (i = 0; i < NUM_NL80211_BANDS; i++)
7109 7110 7111
		if (wiphy->bands[i])
			request->rates[i] =
				(1 << wiphy->bands[i]->n_bitrates) - 1;
7112 7113 7114 7115 7116

	if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
		nla_for_each_nested(attr,
				    info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
				    tmp) {
7117
			enum nl80211_band band = nla_type(attr);
7118

7119
			if (band < 0 || band >= NUM_NL80211_BANDS) {
7120 7121 7122
				err = -EINVAL;
				goto out_free;
			}
7123 7124 7125 7126

			if (!wiphy->bands[band])
				continue;

7127 7128 7129 7130 7131 7132 7133 7134 7135
			err = ieee80211_get_ratemask(wiphy->bands[band],
						     nla_data(attr),
						     nla_len(attr),
						     &request->rates[band]);
			if (err)
				goto out_free;
		}
	}

7136 7137 7138 7139 7140 7141 7142 7143 7144 7145 7146 7147 7148
	if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
		if (!wiphy_ext_feature_isset(wiphy,
					NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
			err = -EOPNOTSUPP;
			goto out_free;
		}

		request->duration =
			nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
		request->duration_mandatory =
			nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
	}

7149 7150 7151 7152
	err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs,
				       false);
	if (err)
		goto out_free;
7153

7154 7155 7156
	request->no_cck =
		nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);

7157 7158 7159 7160 7161 7162 7163 7164 7165 7166 7167 7168 7169 7170
	/* Initial implementation used NL80211_ATTR_MAC to set the specific
	 * BSSID to scan for. This was problematic because that same attribute
	 * was already used for another purpose (local random MAC address). The
	 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
	 * compatibility with older userspace components, also use the
	 * NL80211_ATTR_MAC value here if it can be determined to be used for
	 * the specific BSSID use case instead of the random MAC address
	 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
	 */
	if (info->attrs[NL80211_ATTR_BSSID])
		memcpy(request->bssid,
		       nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
	else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
		 info->attrs[NL80211_ATTR_MAC])
7171 7172 7173 7174 7175
		memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
		       ETH_ALEN);
	else
		eth_broadcast_addr(request->bssid);

J
Johannes Berg 已提交
7176
	request->wdev = wdev;
7177
	request->wiphy = &rdev->wiphy;
7178
	request->scan_start = jiffies;
7179

7180
	rdev->scan_req = request;
7181
	err = rdev_scan(rdev, request);
7182

7183
	if (!err) {
J
Johannes Berg 已提交
7184 7185 7186
		nl80211_send_scan_start(rdev, wdev);
		if (wdev->netdev)
			dev_hold(wdev->netdev);
7187
	} else {
7188
 out_free:
7189
		rdev->scan_req = NULL;
7190 7191
		kfree(request);
	}
J
Johannes Berg 已提交
7192

7193
 unlock:
7194 7195 7196
	return err;
}

7197 7198 7199 7200 7201 7202 7203 7204 7205 7206 7207 7208 7209 7210 7211 7212 7213 7214
static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev = info->user_ptr[1];

	if (!rdev->ops->abort_scan)
		return -EOPNOTSUPP;

	if (rdev->scan_msg)
		return 0;

	if (!rdev->scan_req)
		return -ENOENT;

	rdev_abort_scan(rdev, wdev);
	return 0;
}

7215 7216 7217 7218 7219 7220 7221 7222 7223 7224 7225 7226 7227
static int
nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
			       struct cfg80211_sched_scan_request *request,
			       struct nlattr **attrs)
{
	int tmp, err, i = 0;
	struct nlattr *attr;

	if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
		u32 interval;

		/*
		 * If scan plans are not specified,
7228
		 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
7229 7230 7231 7232 7233 7234 7235 7236 7237 7238 7239 7240 7241 7242 7243 7244 7245 7246 7247 7248 7249 7250 7251 7252 7253 7254
		 * case one scan plan will be set with the specified scan
		 * interval and infinite number of iterations.
		 */
		interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
		if (!interval)
			return -EINVAL;

		request->scan_plans[0].interval =
			DIV_ROUND_UP(interval, MSEC_PER_SEC);
		if (!request->scan_plans[0].interval)
			return -EINVAL;

		if (request->scan_plans[0].interval >
		    wiphy->max_sched_scan_plan_interval)
			request->scan_plans[0].interval =
				wiphy->max_sched_scan_plan_interval;

		return 0;
	}

	nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
		struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];

		if (WARN_ON(i >= n_plans))
			return -EINVAL;

7255
		err = nla_parse_nested(plan, NL80211_SCHED_SCAN_PLAN_MAX,
7256
				       attr, nl80211_plan_policy, NULL);
7257 7258 7259 7260 7261 7262 7263 7264 7265 7266 7267 7268 7269 7270 7271 7272 7273 7274 7275 7276 7277 7278 7279 7280 7281 7282 7283 7284 7285 7286 7287 7288 7289 7290 7291 7292 7293 7294 7295 7296 7297
		if (err)
			return err;

		if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
			return -EINVAL;

		request->scan_plans[i].interval =
			nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
		if (!request->scan_plans[i].interval ||
		    request->scan_plans[i].interval >
		    wiphy->max_sched_scan_plan_interval)
			return -EINVAL;

		if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
			request->scan_plans[i].iterations =
				nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
			if (!request->scan_plans[i].iterations ||
			    (request->scan_plans[i].iterations >
			     wiphy->max_sched_scan_plan_iterations))
				return -EINVAL;
		} else if (i < n_plans - 1) {
			/*
			 * All scan plans but the last one must specify
			 * a finite number of iterations
			 */
			return -EINVAL;
		}

		i++;
	}

	/*
	 * The last scan plan must not specify the number of
	 * iterations, it is supposed to run infinitely
	 */
	if (request->scan_plans[n_plans - 1].iterations)
		return  -EINVAL;

	return 0;
}

7298
static struct cfg80211_sched_scan_request *
7299
nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
7300
			 struct nlattr **attrs, int max_match_sets)
7301 7302 7303
{
	struct cfg80211_sched_scan_request *request;
	struct nlattr *attr;
7304
	int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
7305
	enum nl80211_band band;
7306
	size_t ie_len;
7307
	struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
7308
	s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
7309

7310 7311
	if (!is_valid_ie_attr(attrs[NL80211_ATTR_IE]))
		return ERR_PTR(-EINVAL);
7312

7313
	if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7314
		n_channels = validate_scan_freqs(
7315
				attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
7316
		if (!n_channels)
7317
			return ERR_PTR(-EINVAL);
7318
	} else {
7319
		n_channels = ieee80211_get_num_supported_channels(wiphy);
7320 7321
	}

7322 7323
	if (attrs[NL80211_ATTR_SCAN_SSIDS])
		nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
7324 7325 7326
				    tmp)
			n_ssids++;

7327
	if (n_ssids > wiphy->max_sched_scan_ssids)
7328
		return ERR_PTR(-EINVAL);
7329

7330 7331 7332 7333 7334 7335 7336 7337 7338
	/*
	 * First, count the number of 'real' matchsets. Due to an issue with
	 * the old implementation, matchsets containing only the RSSI attribute
	 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
	 * RSSI for all matchsets, rather than their own matchset for reporting
	 * all APs with a strong RSSI. This is needed to be compatible with
	 * older userspace that treated a matchset with only the RSSI as the
	 * global RSSI for all other matchsets - if there are other matchsets.
	 */
7339
	if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
7340
		nla_for_each_nested(attr,
7341
				    attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
7342 7343 7344
				    tmp) {
			struct nlattr *rssi;

7345 7346
			err = nla_parse_nested(tb,
					       NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7347 7348
					       attr, nl80211_match_policy,
					       NULL);
7349
			if (err)
7350
				return ERR_PTR(err);
7351 7352 7353 7354 7355 7356

			/* SSID and BSSID are mutually exclusive */
			if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] &&
			    tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID])
				return ERR_PTR(-EINVAL);

7357
			/* add other standalone attributes here */
7358 7359
			if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] ||
			    tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) {
7360 7361 7362 7363 7364 7365 7366 7367 7368 7369 7370 7371
				n_match_sets++;
				continue;
			}
			rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
			if (rssi)
				default_match_rssi = nla_get_s32(rssi);
		}
	}

	/* However, if there's no other matchset, add the RSSI one */
	if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
		n_match_sets = 1;
7372

7373
	if (n_match_sets > max_match_sets)
7374
		return ERR_PTR(-EINVAL);
7375

7376 7377
	if (attrs[NL80211_ATTR_IE])
		ie_len = nla_len(attrs[NL80211_ATTR_IE]);
7378 7379 7380
	else
		ie_len = 0;

7381
	if (ie_len > wiphy->max_sched_scan_ie_len)
7382
		return ERR_PTR(-EINVAL);
7383

7384 7385 7386 7387 7388 7389 7390 7391 7392 7393 7394 7395 7396 7397 7398 7399 7400 7401 7402 7403 7404 7405 7406 7407 7408 7409 7410
	if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
		/*
		 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
		 * each scan plan already specifies its own interval
		 */
		if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
			return ERR_PTR(-EINVAL);

		nla_for_each_nested(attr,
				    attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
			n_plans++;
	} else {
		/*
		 * The scan interval attribute is kept for backward
		 * compatibility. If no scan plans are specified and sched scan
		 * interval is specified, one scan plan will be set with this
		 * scan interval and infinite number of iterations.
		 */
		if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
			return ERR_PTR(-EINVAL);

		n_plans = 1;
	}

	if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
		return ERR_PTR(-EINVAL);

7411 7412 7413 7414 7415 7416
	if (!wiphy_ext_feature_isset(
		    wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
	    (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
	     attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
		return ERR_PTR(-EINVAL);

7417
	request = kzalloc(sizeof(*request)
7418
			+ sizeof(*request->ssids) * n_ssids
7419
			+ sizeof(*request->match_sets) * n_match_sets
7420
			+ sizeof(*request->scan_plans) * n_plans
7421
			+ sizeof(*request->channels) * n_channels
7422
			+ ie_len, GFP_KERNEL);
7423 7424
	if (!request)
		return ERR_PTR(-ENOMEM);
7425 7426 7427 7428 7429

	if (n_ssids)
		request->ssids = (void *)&request->channels[n_channels];
	request->n_ssids = n_ssids;
	if (ie_len) {
7430
		if (n_ssids)
7431 7432 7433 7434 7435
			request->ie = (void *)(request->ssids + n_ssids);
		else
			request->ie = (void *)(request->channels + n_channels);
	}

7436 7437 7438
	if (n_match_sets) {
		if (request->ie)
			request->match_sets = (void *)(request->ie + ie_len);
7439
		else if (n_ssids)
7440 7441 7442 7443 7444 7445 7446 7447
			request->match_sets =
				(void *)(request->ssids + n_ssids);
		else
			request->match_sets =
				(void *)(request->channels + n_channels);
	}
	request->n_match_sets = n_match_sets;

7448 7449 7450 7451 7452 7453 7454 7455 7456 7457 7458 7459
	if (n_match_sets)
		request->scan_plans = (void *)(request->match_sets +
					       n_match_sets);
	else if (request->ie)
		request->scan_plans = (void *)(request->ie + ie_len);
	else if (n_ssids)
		request->scan_plans = (void *)(request->ssids + n_ssids);
	else
		request->scan_plans = (void *)(request->channels + n_channels);

	request->n_scan_plans = n_plans;

7460
	i = 0;
7461
	if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7462 7463
		/* user specified, bail out if channel not found */
		nla_for_each_nested(attr,
7464
				    attrs[NL80211_ATTR_SCAN_FREQUENCIES],
7465 7466 7467 7468 7469 7470 7471 7472 7473 7474 7475 7476 7477 7478 7479 7480 7481 7482 7483
				    tmp) {
			struct ieee80211_channel *chan;

			chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));

			if (!chan) {
				err = -EINVAL;
				goto out_free;
			}

			/* ignore disabled channels */
			if (chan->flags & IEEE80211_CHAN_DISABLED)
				continue;

			request->channels[i] = chan;
			i++;
		}
	} else {
		/* all channels */
7484
		for (band = 0; band < NUM_NL80211_BANDS; band++) {
7485
			int j;
7486

7487 7488 7489 7490 7491 7492 7493 7494 7495 7496 7497 7498 7499 7500 7501 7502 7503 7504 7505 7506 7507 7508 7509 7510
			if (!wiphy->bands[band])
				continue;
			for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
				struct ieee80211_channel *chan;

				chan = &wiphy->bands[band]->channels[j];

				if (chan->flags & IEEE80211_CHAN_DISABLED)
					continue;

				request->channels[i] = chan;
				i++;
			}
		}
	}

	if (!i) {
		err = -EINVAL;
		goto out_free;
	}

	request->n_channels = i;

	i = 0;
7511
	if (n_ssids) {
7512
		nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
7513
				    tmp) {
7514
			if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
7515 7516 7517
				err = -EINVAL;
				goto out_free;
			}
7518
			request->ssids[i].ssid_len = nla_len(attr);
7519 7520 7521 7522 7523 7524
			memcpy(request->ssids[i].ssid, nla_data(attr),
			       nla_len(attr));
			i++;
		}
	}

7525
	i = 0;
7526
	if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
7527
		nla_for_each_nested(attr,
7528
				    attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
7529
				    tmp) {
7530
			struct nlattr *ssid, *bssid, *rssi;
7531

7532 7533
			err = nla_parse_nested(tb,
					       NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7534 7535
					       attr, nl80211_match_policy,
					       NULL);
7536 7537
			if (err)
				goto out_free;
7538
			ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
7539 7540
			bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID];
			if (ssid || bssid) {
7541 7542 7543 7544 7545 7546 7547 7548 7549
				if (WARN_ON(i >= n_match_sets)) {
					/* this indicates a programming error,
					 * the loop above should have verified
					 * things properly
					 */
					err = -EINVAL;
					goto out_free;
				}

7550 7551 7552 7553 7554 7555 7556 7557 7558 7559 7560 7561 7562 7563 7564 7565 7566
				if (ssid) {
					if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
						err = -EINVAL;
						goto out_free;
					}
					memcpy(request->match_sets[i].ssid.ssid,
					       nla_data(ssid), nla_len(ssid));
					request->match_sets[i].ssid.ssid_len =
						nla_len(ssid);
				}
				if (bssid) {
					if (nla_len(bssid) != ETH_ALEN) {
						err = -EINVAL;
						goto out_free;
					}
					memcpy(request->match_sets[i].bssid,
					       nla_data(bssid), ETH_ALEN);
7567
				}
7568

K
Kirtika Ruchandani 已提交
7569
				/* special attribute - old implementation w/a */
7570 7571 7572 7573 7574 7575
				request->match_sets[i].rssi_thold =
					default_match_rssi;
				rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
				if (rssi)
					request->match_sets[i].rssi_thold =
						nla_get_s32(rssi);
7576 7577 7578
			}
			i++;
		}
7579 7580

		/* there was no other matchset, so the RSSI one is alone */
7581
		if (i == 0 && n_match_sets)
7582 7583 7584 7585 7586 7587 7588 7589 7590
			request->match_sets[0].rssi_thold = default_match_rssi;

		request->min_rssi_thold = INT_MAX;
		for (i = 0; i < n_match_sets; i++)
			request->min_rssi_thold =
				min(request->match_sets[i].rssi_thold,
				    request->min_rssi_thold);
	} else {
		request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
7591 7592
	}

7593 7594
	if (ie_len) {
		request->ie_len = ie_len;
7595
		memcpy((void *)request->ie,
7596
		       nla_data(attrs[NL80211_ATTR_IE]),
7597 7598 7599
		       request->ie_len);
	}

7600 7601 7602
	err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true);
	if (err)
		goto out_free;
7603

7604 7605 7606 7607
	if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
		request->delay =
			nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);

7608 7609 7610 7611 7612 7613 7614 7615 7616 7617 7618 7619 7620 7621 7622 7623 7624 7625 7626 7627
	if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
		request->relative_rssi = nla_get_s8(
			attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
		request->relative_rssi_set = true;
	}

	if (request->relative_rssi_set &&
	    attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
		struct nl80211_bss_select_rssi_adjust *rssi_adjust;

		rssi_adjust = nla_data(
			attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
		request->rssi_adjust.band = rssi_adjust->band;
		request->rssi_adjust.delta = rssi_adjust->delta;
		if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
			err = -EINVAL;
			goto out_free;
		}
	}

7628 7629 7630 7631
	err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
	if (err)
		goto out_free;

7632
	request->scan_start = jiffies;
7633

7634
	return request;
7635 7636 7637

out_free:
	kfree(request);
7638 7639 7640 7641 7642 7643 7644 7645
	return ERR_PTR(err);
}

static int nl80211_start_sched_scan(struct sk_buff *skb,
				    struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
7646
	struct wireless_dev *wdev = dev->ieee80211_ptr;
7647
	struct cfg80211_sched_scan_request *sched_scan_req;
7648
	bool want_multi;
7649 7650
	int err;

7651
	if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
7652 7653
		return -EOPNOTSUPP;

7654 7655 7656 7657
	want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
	err = cfg80211_sched_scan_req_possible(rdev, want_multi);
	if (err)
		return err;
7658

7659
	sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
7660 7661
						  info->attrs,
						  rdev->wiphy.max_match_sets);
7662 7663

	err = PTR_ERR_OR_ZERO(sched_scan_req);
7664 7665 7666
	if (err)
		goto out_err;

7667 7668 7669 7670 7671 7672 7673 7674
	/* leave request id zero for legacy request
	 * or if driver does not support multi-scheduled scan
	 */
	if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) {
		while (!sched_scan_req->reqid)
			sched_scan_req->reqid = rdev->wiphy.cookie_counter++;
	}

7675
	err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
7676 7677 7678
	if (err)
		goto out_free;

7679 7680 7681
	sched_scan_req->dev = dev;
	sched_scan_req->wiphy = &rdev->wiphy;

7682 7683 7684
	if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
		sched_scan_req->owner_nlportid = info->snd_portid;

7685
	cfg80211_add_sched_scan_req(rdev, sched_scan_req);
7686

7687
	nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
7688 7689 7690
	return 0;

out_free:
7691
	kfree(sched_scan_req);
7692
out_err:
7693 7694 7695 7696 7697 7698
	return err;
}

static int nl80211_stop_sched_scan(struct sk_buff *skb,
				   struct genl_info *info)
{
7699
	struct cfg80211_sched_scan_request *req;
7700
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
7701
	u64 cookie;
7702

7703
	if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
7704 7705
		return -EOPNOTSUPP;

7706 7707 7708 7709 7710 7711 7712 7713 7714 7715 7716 7717 7718 7719
	if (info->attrs[NL80211_ATTR_COOKIE]) {
		cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
		return __cfg80211_stop_sched_scan(rdev, cookie, false);
	}

	req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
				     struct cfg80211_sched_scan_request,
				     list);
	if (!req || req->reqid ||
	    (req->owner_nlportid &&
	     req->owner_nlportid != info->snd_portid))
		return -ENOENT;

	return cfg80211_stop_sched_scan_req(rdev, req, false);
7720 7721
}

7722 7723 7724 7725 7726 7727
static int nl80211_start_radar_detection(struct sk_buff *skb,
					 struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
7728
	struct wiphy *wiphy = wdev->wiphy;
7729
	struct cfg80211_chan_def chandef;
7730
	enum nl80211_dfs_regions dfs_region;
7731
	unsigned int cac_time_ms;
7732 7733
	int err;

7734
	dfs_region = reg_get_dfs_region(wiphy);
7735 7736 7737
	if (dfs_region == NL80211_DFS_UNSET)
		return -EINVAL;

7738 7739 7740 7741
	err = nl80211_parse_chandef(rdev, info, &chandef);
	if (err)
		return err;

7742 7743 7744
	if (netif_carrier_ok(dev))
		return -EBUSY;

7745 7746 7747
	if (wdev->cac_started)
		return -EBUSY;

7748
	err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
7749 7750 7751 7752 7753 7754
	if (err < 0)
		return err;

	if (err == 0)
		return -EINVAL;

7755
	if (!cfg80211_chandef_dfs_usable(wiphy, &chandef))
7756 7757
		return -EINVAL;

7758 7759 7760 7761
	/* CAC start is offloaded to HW and can't be started manually */
	if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD))
		return -EOPNOTSUPP;

7762 7763 7764
	if (!rdev->ops->start_radar_detection)
		return -EOPNOTSUPP;

7765 7766 7767 7768
	cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
	if (WARN_ON(!cac_time_ms))
		cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;

7769
	err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
7770
	if (!err) {
7771
		wdev->chandef = chandef;
7772 7773
		wdev->cac_started = true;
		wdev->cac_start_time = jiffies;
7774
		wdev->cac_time_ms = cac_time_ms;
7775 7776 7777 7778
	}
	return err;
}

7779 7780 7781 7782 7783 7784 7785 7786 7787 7788 7789
static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_csa_settings params;
	/* csa_attrs is defined static to avoid waste of stack size - this
	 * function is called under RTNL lock, so this should not be a problem.
	 */
	static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
	int err;
7790
	bool need_new_beacon = false;
7791
	bool need_handle_dfs_flag = true;
7792
	int len, i;
7793
	u32 cs_count;
7794 7795 7796 7797 7798

	if (!rdev->ops->channel_switch ||
	    !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
		return -EOPNOTSUPP;

7799 7800 7801 7802
	switch (dev->ieee80211_ptr->iftype) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_P2P_GO:
		need_new_beacon = true;
7803 7804 7805 7806 7807 7808
		/* For all modes except AP the handle_dfs flag needs to be
		 * supplied to tell the kernel that userspace will handle radar
		 * events when they happen. Otherwise a switch to a channel
		 * requiring DFS will be rejected.
		 */
		need_handle_dfs_flag = false;
7809 7810 7811

		/* useless if AP is not running */
		if (!wdev->beacon_interval)
7812
			return -ENOTCONN;
7813 7814
		break;
	case NL80211_IFTYPE_ADHOC:
7815 7816 7817
		if (!wdev->ssid_len)
			return -ENOTCONN;
		break;
7818
	case NL80211_IFTYPE_MESH_POINT:
7819 7820
		if (!wdev->mesh_id_len)
			return -ENOTCONN;
7821 7822
		break;
	default:
7823
		return -EOPNOTSUPP;
7824
	}
7825 7826 7827 7828 7829 7830 7831 7832

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

	if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
	    !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
		return -EINVAL;

	/* only important for AP, IBSS and mesh create IEs internally */
7833
	if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
7834 7835
		return -EINVAL;

7836 7837 7838 7839 7840 7841 7842 7843
	/* Even though the attribute is u32, the specification says
	 * u8, so let's make sure we don't overflow.
	 */
	cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
	if (cs_count > 255)
		return -EINVAL;

	params.count = cs_count;
7844

7845 7846 7847
	if (!need_new_beacon)
		goto skip_beacons;

7848 7849 7850 7851 7852 7853
	err = nl80211_parse_beacon(info->attrs, &params.beacon_after);
	if (err)
		return err;

	err = nla_parse_nested(csa_attrs, NL80211_ATTR_MAX,
			       info->attrs[NL80211_ATTR_CSA_IES],
7854
			       nl80211_policy, info->extack);
7855 7856 7857 7858 7859 7860 7861 7862 7863 7864
	if (err)
		return err;

	err = nl80211_parse_beacon(csa_attrs, &params.beacon_csa);
	if (err)
		return err;

	if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
		return -EINVAL;

7865 7866
	len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
	if (!len || (len % sizeof(u16)))
7867 7868
		return -EINVAL;

7869 7870 7871 7872
	params.n_counter_offsets_beacon = len / sizeof(u16);
	if (rdev->wiphy.max_num_csa_counters &&
	    (params.n_counter_offsets_beacon >
	     rdev->wiphy.max_num_csa_counters))
7873 7874
		return -EINVAL;

7875 7876 7877 7878 7879 7880 7881 7882 7883 7884 7885 7886 7887 7888
	params.counter_offsets_beacon =
		nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);

	/* sanity checks - counters should fit and be the same */
	for (i = 0; i < params.n_counter_offsets_beacon; i++) {
		u16 offset = params.counter_offsets_beacon[i];

		if (offset >= params.beacon_csa.tail_len)
			return -EINVAL;

		if (params.beacon_csa.tail[offset] != params.count)
			return -EINVAL;
	}

7889
	if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
7890 7891
		len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
		if (!len || (len % sizeof(u16)))
7892 7893
			return -EINVAL;

7894 7895
		params.n_counter_offsets_presp = len / sizeof(u16);
		if (rdev->wiphy.max_num_csa_counters &&
7896
		    (params.n_counter_offsets_presp >
7897
		     rdev->wiphy.max_num_csa_counters))
7898
			return -EINVAL;
7899 7900 7901 7902 7903 7904 7905 7906 7907 7908 7909 7910 7911 7912 7913

		params.counter_offsets_presp =
			nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);

		/* sanity checks - counters should fit and be the same */
		for (i = 0; i < params.n_counter_offsets_presp; i++) {
			u16 offset = params.counter_offsets_presp[i];

			if (offset >= params.beacon_csa.probe_resp_len)
				return -EINVAL;

			if (params.beacon_csa.probe_resp[offset] !=
			    params.count)
				return -EINVAL;
		}
7914 7915
	}

7916
skip_beacons:
7917 7918 7919 7920
	err = nl80211_parse_chandef(rdev, info, &params.chandef);
	if (err)
		return err;

7921 7922
	if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
					   wdev->iftype))
7923 7924
		return -EINVAL;

7925 7926 7927 7928 7929 7930
	err = cfg80211_chandef_dfs_required(wdev->wiphy,
					    &params.chandef,
					    wdev->iftype);
	if (err < 0)
		return err;

7931
	if (err > 0) {
7932
		params.radar_required = true;
7933 7934 7935 7936 7937
		if (need_handle_dfs_flag &&
		    !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) {
			return -EINVAL;
		}
	}
7938 7939 7940 7941

	if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
		params.block_tx = true;

7942 7943 7944 7945 7946
	wdev_lock(wdev);
	err = rdev_channel_switch(rdev, dev, &params);
	wdev_unlock(wdev);

	return err;
7947 7948
}

7949 7950
static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
			    u32 seq, int flags,
7951
			    struct cfg80211_registered_device *rdev,
J
Johannes Berg 已提交
7952 7953
			    struct wireless_dev *wdev,
			    struct cfg80211_internal_bss *intbss)
7954
{
J
Johannes Berg 已提交
7955
	struct cfg80211_bss *res = &intbss->pub;
7956
	const struct cfg80211_bss_ies *ies;
7957 7958
	void *hdr;
	struct nlattr *bss;
J
Johannes Berg 已提交
7959 7960

	ASSERT_WDEV_LOCK(wdev);
7961

7962
	hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
7963 7964 7965 7966
			     NL80211_CMD_NEW_SCAN_RESULTS);
	if (!hdr)
		return -1;

M
Michal Kubecek 已提交
7967
	genl_dump_check_consistent(cb, hdr);
7968

7969 7970 7971
	if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
		goto nla_put_failure;
	if (wdev->netdev &&
7972 7973
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
		goto nla_put_failure;
7974 7975
	if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD))
7976
		goto nla_put_failure;
7977 7978 7979 7980

	bss = nla_nest_start(msg, NL80211_ATTR_BSS);
	if (!bss)
		goto nla_put_failure;
7981
	if ((!is_zero_ether_addr(res->bssid) &&
7982
	     nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
7983
		goto nla_put_failure;
7984 7985

	rcu_read_lock();
7986 7987 7988 7989 7990 7991 7992 7993
	/* indicate whether we have probe response data or not */
	if (rcu_access_pointer(res->proberesp_ies) &&
	    nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
		goto fail_unlock_rcu;

	/* this pointer prefers to be pointed to probe response data
	 * but is always valid
	 */
7994
	ies = rcu_dereference(res->ies);
J
Johannes Berg 已提交
7995
	if (ies) {
7996 7997
		if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
				      NL80211_BSS_PAD))
J
Johannes Berg 已提交
7998 7999 8000 8001
			goto fail_unlock_rcu;
		if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
					ies->len, ies->data))
			goto fail_unlock_rcu;
8002
	}
8003 8004

	/* and this pointer is always (unless driver didn't know) beacon data */
8005
	ies = rcu_dereference(res->beacon_ies);
8006
	if (ies && ies->from_beacon) {
8007 8008
		if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
				      NL80211_BSS_PAD))
J
Johannes Berg 已提交
8009 8010 8011 8012
			goto fail_unlock_rcu;
		if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
					ies->len, ies->data))
			goto fail_unlock_rcu;
8013 8014 8015
	}
	rcu_read_unlock();

8016 8017 8018 8019 8020
	if (res->beacon_interval &&
	    nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
		goto nla_put_failure;
	if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
	    nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
8021
	    nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
8022 8023 8024
	    nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
			jiffies_to_msecs(jiffies - intbss->ts)))
		goto nla_put_failure;
8025

8026 8027 8028 8029 8030 8031 8032
	if (intbss->parent_tsf &&
	    (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
			       intbss->parent_tsf, NL80211_BSS_PAD) ||
	     nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
		     intbss->parent_bssid)))
		goto nla_put_failure;

8033
	if (intbss->ts_boottime &&
8034 8035
	    nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
			      intbss->ts_boottime, NL80211_BSS_PAD))
8036 8037
		goto nla_put_failure;

8038 8039 8040 8041 8042
	if (!nl80211_put_signal(msg, intbss->pub.chains,
				intbss->pub.chain_signal,
				NL80211_BSS_CHAIN_SIGNAL))
		goto nla_put_failure;

J
Johannes Berg 已提交
8043
	switch (rdev->wiphy.signal_type) {
8044
	case CFG80211_SIGNAL_TYPE_MBM:
8045 8046
		if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
			goto nla_put_failure;
8047 8048
		break;
	case CFG80211_SIGNAL_TYPE_UNSPEC:
8049 8050
		if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
			goto nla_put_failure;
8051 8052 8053 8054 8055
		break;
	default:
		break;
	}

J
Johannes Berg 已提交
8056
	switch (wdev->iftype) {
8057
	case NL80211_IFTYPE_P2P_CLIENT:
J
Johannes Berg 已提交
8058
	case NL80211_IFTYPE_STATION:
8059 8060 8061 8062
		if (intbss == wdev->current_bss &&
		    nla_put_u32(msg, NL80211_BSS_STATUS,
				NL80211_BSS_STATUS_ASSOCIATED))
			goto nla_put_failure;
J
Johannes Berg 已提交
8063 8064
		break;
	case NL80211_IFTYPE_ADHOC:
8065 8066 8067 8068
		if (intbss == wdev->current_bss &&
		    nla_put_u32(msg, NL80211_BSS_STATUS,
				NL80211_BSS_STATUS_IBSS_JOINED))
			goto nla_put_failure;
J
Johannes Berg 已提交
8069 8070 8071 8072 8073
		break;
	default:
		break;
	}

8074 8075
	nla_nest_end(msg, bss);

8076 8077
	genlmsg_end(msg, hdr);
	return 0;
8078

J
Johannes Berg 已提交
8079 8080
 fail_unlock_rcu:
	rcu_read_unlock();
8081 8082 8083 8084 8085
 nla_put_failure:
	genlmsg_cancel(msg, hdr);
	return -EMSGSIZE;
}

8086
static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
8087
{
J
Johannes Berg 已提交
8088
	struct cfg80211_registered_device *rdev;
8089
	struct cfg80211_internal_bss *scan;
J
Johannes Berg 已提交
8090
	struct wireless_dev *wdev;
8091
	int start = cb->args[2], idx = 0;
8092 8093
	int err;

8094
	rtnl_lock();
8095
	err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
8096 8097
	if (err) {
		rtnl_unlock();
8098
		return err;
8099
	}
8100

J
Johannes Berg 已提交
8101 8102
	wdev_lock(wdev);
	spin_lock_bh(&rdev->bss_lock);
8103 8104 8105 8106 8107 8108 8109 8110 8111

	/*
	 * dump_scan will be called multiple times to break up the scan results
	 * into multiple messages.  It is unlikely that any more bss-es will be
	 * expired after the first call, so only call only call this on the
	 * first dump_scan invocation.
	 */
	if (start == 0)
		cfg80211_bss_expire(rdev);
J
Johannes Berg 已提交
8112

8113 8114
	cb->seq = rdev->bss_generation;

J
Johannes Berg 已提交
8115
	list_for_each_entry(scan, &rdev->bss_list, list) {
8116 8117
		if (++idx <= start)
			continue;
8118
		if (nl80211_send_bss(skb, cb,
8119
				cb->nlh->nlmsg_seq, NLM_F_MULTI,
J
Johannes Berg 已提交
8120
				rdev, wdev, scan) < 0) {
8121
			idx--;
8122
			break;
8123 8124 8125
		}
	}

J
Johannes Berg 已提交
8126 8127
	spin_unlock_bh(&rdev->bss_lock);
	wdev_unlock(wdev);
8128

8129
	cb->args[2] = idx;
8130
	rtnl_unlock();
8131

8132
	return skb->len;
8133 8134
}

8135
static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
8136 8137 8138
			       int flags, struct net_device *dev,
			       bool allow_radio_stats,
			       struct survey_info *survey)
8139 8140 8141 8142
{
	void *hdr;
	struct nlattr *infoattr;

8143 8144 8145 8146
	/* skip radio stats if userspace didn't request them */
	if (!survey->channel && !allow_radio_stats)
		return 0;

8147
	hdr = nl80211hdr_put(msg, portid, seq, flags,
8148 8149 8150 8151
			     NL80211_CMD_NEW_SURVEY_RESULTS);
	if (!hdr)
		return -ENOMEM;

8152 8153
	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
		goto nla_put_failure;
8154 8155 8156 8157 8158

	infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
	if (!infoattr)
		goto nla_put_failure;

8159 8160
	if (survey->channel &&
	    nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
8161 8162 8163 8164 8165 8166 8167 8168 8169
			survey->channel->center_freq))
		goto nla_put_failure;

	if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
	    nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
		goto nla_put_failure;
	if ((survey->filled & SURVEY_INFO_IN_USE) &&
	    nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
		goto nla_put_failure;
8170
	if ((survey->filled & SURVEY_INFO_TIME) &&
8171 8172
	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
			survey->time, NL80211_SURVEY_INFO_PAD))
8173
		goto nla_put_failure;
8174
	if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
8175 8176
	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
			      survey->time_busy, NL80211_SURVEY_INFO_PAD))
8177
		goto nla_put_failure;
8178
	if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
8179 8180
	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
			      survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
8181
		goto nla_put_failure;
8182
	if ((survey->filled & SURVEY_INFO_TIME_RX) &&
8183 8184
	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
			      survey->time_rx, NL80211_SURVEY_INFO_PAD))
8185
		goto nla_put_failure;
8186
	if ((survey->filled & SURVEY_INFO_TIME_TX) &&
8187 8188
	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
			      survey->time_tx, NL80211_SURVEY_INFO_PAD))
8189
		goto nla_put_failure;
8190
	if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
8191 8192
	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
			      survey->time_scan, NL80211_SURVEY_INFO_PAD))
8193
		goto nla_put_failure;
8194 8195 8196

	nla_nest_end(msg, infoattr);

8197 8198
	genlmsg_end(msg, hdr);
	return 0;
8199 8200 8201 8202 8203 8204

 nla_put_failure:
	genlmsg_cancel(msg, hdr);
	return -EMSGSIZE;
}

8205
static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
8206
{
8207
	struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
8208
	struct survey_info survey;
8209
	struct cfg80211_registered_device *rdev;
8210 8211
	struct wireless_dev *wdev;
	int survey_idx = cb->args[2];
8212
	int res;
8213
	bool radio_stats;
8214

8215
	rtnl_lock();
8216
	res = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
8217
	if (res)
8218
		goto out_err;
8219

8220
	/* prepare_wdev_dump parsed the attributes */
8221
	radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
8222

8223 8224 8225 8226 8227
	if (!wdev->netdev) {
		res = -EINVAL;
		goto out_err;
	}

8228
	if (!rdev->ops->dump_survey) {
8229 8230 8231 8232 8233
		res = -EOPNOTSUPP;
		goto out_err;
	}

	while (1) {
8234
		res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
8235 8236 8237 8238 8239
		if (res == -ENOENT)
			break;
		if (res)
			goto out_err;

8240 8241 8242
		/* don't send disabled channels, but do send non-channel data */
		if (survey.channel &&
		    survey.channel->flags & IEEE80211_CHAN_DISABLED) {
8243 8244 8245 8246
			survey_idx++;
			continue;
		}

8247
		if (nl80211_send_survey(skb,
8248
				NETLINK_CB(cb->skb).portid,
8249
				cb->nlh->nlmsg_seq, NLM_F_MULTI,
8250
				wdev->netdev, radio_stats, &survey) < 0)
8251 8252 8253 8254 8255
			goto out;
		survey_idx++;
	}

 out:
8256
	cb->args[2] = survey_idx;
8257 8258
	res = skb->len;
 out_err:
8259
	rtnl_unlock();
8260 8261 8262
	return res;
}

S
Samuel Ortiz 已提交
8263 8264 8265 8266 8267 8268
static bool nl80211_valid_wpa_versions(u32 wpa_versions)
{
	return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
				  NL80211_WPA_VERSION_2));
}

8269 8270
static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
{
8271 8272
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
J
Johannes Berg 已提交
8273
	struct ieee80211_channel *chan;
8274 8275
	const u8 *bssid, *ssid, *ie = NULL, *auth_data = NULL;
	int err, ssid_len, ie_len = 0, auth_data_len = 0;
J
Johannes Berg 已提交
8276
	enum nl80211_auth_type auth_type;
J
Johannes Berg 已提交
8277
	struct key_parse key;
8278
	bool local_state_change;
8279

8280 8281 8282 8283 8284 8285
	if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

8286 8287 8288
	if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
		return -EINVAL;

J
Johannes Berg 已提交
8289 8290 8291 8292 8293 8294
	if (!info->attrs[NL80211_ATTR_SSID])
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
		return -EINVAL;

J
Johannes Berg 已提交
8295 8296 8297 8298 8299
	err = nl80211_parse_key(info, &key);
	if (err)
		return err;

	if (key.idx >= 0) {
8300 8301
		if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
			return -EINVAL;
J
Johannes Berg 已提交
8302 8303 8304 8305 8306 8307 8308
		if (!key.p.key || !key.p.key_len)
			return -EINVAL;
		if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
		     key.p.key_len != WLAN_KEY_LEN_WEP40) &&
		    (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
		     key.p.key_len != WLAN_KEY_LEN_WEP104))
			return -EINVAL;
8309
		if (key.idx > 3)
J
Johannes Berg 已提交
8310 8311 8312 8313 8314 8315
			return -EINVAL;
	} else {
		key.p.key_len = 0;
		key.p.key = NULL;
	}

8316 8317 8318
	if (key.idx >= 0) {
		int i;
		bool ok = false;
8319

8320 8321 8322 8323 8324 8325
		for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
			if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
				ok = true;
				break;
			}
		}
8326 8327
		if (!ok)
			return -EINVAL;
8328 8329
	}

8330 8331
	if (!rdev->ops->auth)
		return -EOPNOTSUPP;
8332

8333
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8334 8335
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;
8336

J
Johannes Berg 已提交
8337
	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8338 8339 8340
	chan = nl80211_get_valid_chan(&rdev->wiphy,
				      info->attrs[NL80211_ATTR_WIPHY_FREQ]);
	if (!chan)
8341
		return -EINVAL;
8342

J
Johannes Berg 已提交
8343 8344
	ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
	ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8345 8346

	if (info->attrs[NL80211_ATTR_IE]) {
J
Johannes Berg 已提交
8347 8348
		ie = nla_data(info->attrs[NL80211_ATTR_IE]);
		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8349 8350
	}

J
Johannes Berg 已提交
8351
	auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
8352
	if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
8353
		return -EINVAL;
8354

8355 8356 8357 8358
	if ((auth_type == NL80211_AUTHTYPE_SAE ||
	     auth_type == NL80211_AUTHTYPE_FILS_SK ||
	     auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
	     auth_type == NL80211_AUTHTYPE_FILS_PK) &&
8359
	    !info->attrs[NL80211_ATTR_AUTH_DATA])
8360 8361
		return -EINVAL;

8362
	if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
8363 8364 8365 8366
		if (auth_type != NL80211_AUTHTYPE_SAE &&
		    auth_type != NL80211_AUTHTYPE_FILS_SK &&
		    auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
		    auth_type != NL80211_AUTHTYPE_FILS_PK)
8367
			return -EINVAL;
8368 8369
		auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
		auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
8370
		/* need to include at least Auth Transaction and Status Code */
8371
		if (auth_data_len < 4)
8372 8373 8374
			return -EINVAL;
	}

8375 8376
	local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];

8377 8378 8379 8380 8381 8382 8383
	/*
	 * Since we no longer track auth state, ignore
	 * requests to only change local state.
	 */
	if (local_state_change)
		return 0;

8384 8385 8386 8387
	wdev_lock(dev->ieee80211_ptr);
	err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
				 ssid, ssid_len, ie, ie_len,
				 key.p.key, key.p.key_len, key.idx,
8388
				 auth_data, auth_data_len);
8389 8390
	wdev_unlock(dev->ieee80211_ptr);
	return err;
8391 8392
}

8393 8394 8395 8396 8397 8398 8399 8400 8401 8402 8403 8404 8405 8406 8407 8408
static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev,
				     struct genl_info *info)
{
	if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
		GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set");
		return -EINVAL;
	}

	if (!rdev->ops->tx_control_port ||
	    !wiphy_ext_feature_isset(&rdev->wiphy,
				     NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
		return -EOPNOTSUPP;

	return 0;
}

8409 8410
static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
				   struct genl_info *info,
8411 8412
				   struct cfg80211_crypto_settings *settings,
				   int cipher_limit)
S
Samuel Ortiz 已提交
8413
{
8414 8415
	memset(settings, 0, sizeof(*settings));

S
Samuel Ortiz 已提交
8416 8417
	settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];

8418 8419
	if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
		u16 proto;
8420

8421 8422 8423 8424 8425 8426 8427 8428 8429 8430 8431
		proto = nla_get_u16(
			info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
		settings->control_port_ethertype = cpu_to_be16(proto);
		if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
		    proto != ETH_P_PAE)
			return -EINVAL;
		if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
			settings->control_port_no_encrypt = true;
	} else
		settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);

8432 8433 8434 8435 8436 8437 8438 8439 8440
	if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
		int r = validate_pae_over_nl80211(rdev, info);

		if (r < 0)
			return r;

		settings->control_port_over_nl80211 = true;
	}

S
Samuel Ortiz 已提交
8441 8442 8443 8444 8445 8446 8447 8448 8449 8450 8451
	if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
		void *data;
		int len, i;

		data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
		len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
		settings->n_ciphers_pairwise = len / sizeof(u32);

		if (len % sizeof(u32))
			return -EINVAL;

8452
		if (settings->n_ciphers_pairwise > cipher_limit)
S
Samuel Ortiz 已提交
8453 8454 8455 8456 8457
			return -EINVAL;

		memcpy(settings->ciphers_pairwise, data, len);

		for (i = 0; i < settings->n_ciphers_pairwise; i++)
8458 8459
			if (!cfg80211_supported_cipher_suite(
					&rdev->wiphy,
S
Samuel Ortiz 已提交
8460 8461 8462 8463 8464 8465 8466
					settings->ciphers_pairwise[i]))
				return -EINVAL;
	}

	if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
		settings->cipher_group =
			nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
8467 8468
		if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
						     settings->cipher_group))
S
Samuel Ortiz 已提交
8469 8470 8471 8472 8473 8474 8475 8476 8477 8478 8479 8480
			return -EINVAL;
	}

	if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
		settings->wpa_versions =
			nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
		if (!nl80211_valid_wpa_versions(settings->wpa_versions))
			return -EINVAL;
	}

	if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
		void *data;
8481
		int len;
S
Samuel Ortiz 已提交
8482 8483 8484 8485 8486 8487 8488 8489

		data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
		len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
		settings->n_akm_suites = len / sizeof(u32);

		if (len % sizeof(u32))
			return -EINVAL;

8490 8491 8492
		if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
			return -EINVAL;

S
Samuel Ortiz 已提交
8493 8494 8495
		memcpy(settings->akm_suites, data, len);
	}

8496 8497 8498 8499 8500 8501 8502 8503 8504
	if (info->attrs[NL80211_ATTR_PMK]) {
		if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN)
			return -EINVAL;
		if (!wiphy_ext_feature_isset(&rdev->wiphy,
					     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK))
			return -EINVAL;
		settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]);
	}

S
Samuel Ortiz 已提交
8505 8506 8507
	return 0;
}

8508 8509
static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
{
8510 8511
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
8512
	struct ieee80211_channel *chan;
8513 8514 8515
	struct cfg80211_assoc_request req = {};
	const u8 *bssid, *ssid;
	int err, ssid_len = 0;
8516

8517 8518 8519 8520
	if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_MAC] ||
J
Johannes Berg 已提交
8521 8522
	    !info->attrs[NL80211_ATTR_SSID] ||
	    !info->attrs[NL80211_ATTR_WIPHY_FREQ])
8523 8524
		return -EINVAL;

8525 8526
	if (!rdev->ops->assoc)
		return -EOPNOTSUPP;
8527

8528
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8529 8530
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;
8531

J
Johannes Berg 已提交
8532
	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8533

8534 8535 8536
	chan = nl80211_get_valid_chan(&rdev->wiphy,
				      info->attrs[NL80211_ATTR_WIPHY_FREQ]);
	if (!chan)
8537
		return -EINVAL;
8538

J
Johannes Berg 已提交
8539 8540
	ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
	ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8541 8542

	if (info->attrs[NL80211_ATTR_IE]) {
8543 8544
		req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
		req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8545 8546
	}

8547
	if (info->attrs[NL80211_ATTR_USE_MFP]) {
8548
		enum nl80211_mfp mfp =
8549
			nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
8550
		if (mfp == NL80211_MFP_REQUIRED)
8551
			req.use_mfp = true;
8552 8553
		else if (mfp != NL80211_MFP_NO)
			return -EINVAL;
8554 8555
	}

8556
	if (info->attrs[NL80211_ATTR_PREV_BSSID])
8557
		req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
8558

8559
	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
8560
		req.flags |= ASSOC_REQ_DISABLE_HT;
8561 8562

	if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8563 8564 8565
		memcpy(&req.ht_capa_mask,
		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
		       sizeof(req.ht_capa_mask));
8566 8567

	if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8568
		if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8569
			return -EINVAL;
8570 8571 8572
		memcpy(&req.ht_capa,
		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
		       sizeof(req.ht_capa));
8573 8574
	}

8575
	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
8576
		req.flags |= ASSOC_REQ_DISABLE_VHT;
8577 8578

	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
8579 8580 8581
		memcpy(&req.vht_capa_mask,
		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
		       sizeof(req.vht_capa_mask));
8582 8583

	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
8584
		if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
8585
			return -EINVAL;
8586 8587 8588
		memcpy(&req.vht_capa,
		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
		       sizeof(req.vht_capa));
8589 8590
	}

8591
	if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
B
Beni Lev 已提交
8592 8593 8594 8595 8596
		if (!((rdev->wiphy.features &
			NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
		       (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
		    !wiphy_ext_feature_isset(&rdev->wiphy,
					     NL80211_EXT_FEATURE_RRM))
8597 8598 8599 8600
			return -EINVAL;
		req.flags |= ASSOC_REQ_USE_RRM;
	}

8601 8602 8603 8604 8605 8606 8607 8608 8609
	if (info->attrs[NL80211_ATTR_FILS_KEK]) {
		req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
		req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
		if (!info->attrs[NL80211_ATTR_FILS_NONCES])
			return -EINVAL;
		req.fils_nonces =
			nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
	}

8610
	err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
8611 8612
	if (!err) {
		wdev_lock(dev->ieee80211_ptr);
8613

8614 8615
		err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
					  ssid, ssid_len, &req);
8616 8617 8618 8619 8620 8621 8622 8623

		if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
			dev->ieee80211_ptr->conn_owner_nlportid =
				info->snd_portid;
			memcpy(dev->ieee80211_ptr->disconnect_bssid,
			       bssid, ETH_ALEN);
		}

8624 8625
		wdev_unlock(dev->ieee80211_ptr);
	}
8626 8627 8628 8629 8630 8631

	return err;
}

static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
{
8632 8633
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
J
Johannes Berg 已提交
8634
	const u8 *ie = NULL, *bssid;
8635
	int ie_len = 0, err;
J
Johannes Berg 已提交
8636
	u16 reason_code;
8637
	bool local_state_change;
8638

8639 8640 8641 8642 8643 8644 8645 8646 8647
	if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_REASON_CODE])
		return -EINVAL;

8648 8649
	if (!rdev->ops->deauth)
		return -EOPNOTSUPP;
8650

8651
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8652 8653
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;
8654

J
Johannes Berg 已提交
8655
	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8656

J
Johannes Berg 已提交
8657 8658
	reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
	if (reason_code == 0) {
8659
		/* Reason Code 0 is reserved */
8660
		return -EINVAL;
8661
	}
8662 8663

	if (info->attrs[NL80211_ATTR_IE]) {
J
Johannes Berg 已提交
8664 8665
		ie = nla_data(info->attrs[NL80211_ATTR_IE]);
		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8666 8667
	}

8668 8669
	local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];

8670 8671 8672 8673 8674
	wdev_lock(dev->ieee80211_ptr);
	err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
				   local_state_change);
	wdev_unlock(dev->ieee80211_ptr);
	return err;
8675 8676 8677 8678
}

static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
{
8679 8680
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
J
Johannes Berg 已提交
8681
	const u8 *ie = NULL, *bssid;
8682
	int ie_len = 0, err;
J
Johannes Berg 已提交
8683
	u16 reason_code;
8684
	bool local_state_change;
8685

8686 8687 8688 8689 8690 8691 8692 8693 8694
	if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_REASON_CODE])
		return -EINVAL;

8695 8696
	if (!rdev->ops->disassoc)
		return -EOPNOTSUPP;
8697

8698
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8699 8700
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;
8701

J
Johannes Berg 已提交
8702
	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8703

J
Johannes Berg 已提交
8704 8705
	reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
	if (reason_code == 0) {
8706
		/* Reason Code 0 is reserved */
8707
		return -EINVAL;
8708
	}
8709 8710

	if (info->attrs[NL80211_ATTR_IE]) {
J
Johannes Berg 已提交
8711 8712
		ie = nla_data(info->attrs[NL80211_ATTR_IE]);
		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8713 8714
	}

8715 8716
	local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];

8717 8718 8719 8720 8721
	wdev_lock(dev->ieee80211_ptr);
	err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
				     local_state_change);
	wdev_unlock(dev->ieee80211_ptr);
	return err;
8722 8723
}

8724 8725
static bool
nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
8726
			 int mcast_rate[NUM_NL80211_BANDS],
8727 8728 8729 8730 8731 8732
			 int rateval)
{
	struct wiphy *wiphy = &rdev->wiphy;
	bool found = false;
	int band, i;

8733
	for (band = 0; band < NUM_NL80211_BANDS; band++) {
8734 8735 8736 8737 8738 8739 8740 8741 8742 8743 8744 8745 8746 8747 8748 8749 8750 8751
		struct ieee80211_supported_band *sband;

		sband = wiphy->bands[band];
		if (!sband)
			continue;

		for (i = 0; i < sband->n_bitrates; i++) {
			if (sband->bitrates[i].bitrate == rateval) {
				mcast_rate[band] = i + 1;
				found = true;
				break;
			}
		}
	}

	return found;
}

J
Johannes Berg 已提交
8752 8753
static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
{
8754 8755
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
J
Johannes Berg 已提交
8756 8757
	struct cfg80211_ibss_params ibss;
	struct wiphy *wiphy;
J
Johannes Berg 已提交
8758
	struct cfg80211_cached_keys *connkeys = NULL;
J
Johannes Berg 已提交
8759 8760
	int err;

8761 8762
	memset(&ibss, 0, sizeof(ibss));

J
Johannes Berg 已提交
8763 8764 8765
	if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
		return -EINVAL;

8766
	if (!info->attrs[NL80211_ATTR_SSID] ||
J
Johannes Berg 已提交
8767 8768 8769
	    !nla_len(info->attrs[NL80211_ATTR_SSID]))
		return -EINVAL;

8770 8771
	ibss.beacon_interval = 100;

8772
	if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
8773 8774
		ibss.beacon_interval =
			nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
8775

8776 8777
	err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
					   ibss.beacon_interval);
8778 8779
	if (err)
		return err;
8780

8781 8782
	if (!rdev->ops->join_ibss)
		return -EOPNOTSUPP;
J
Johannes Berg 已提交
8783

8784 8785
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
		return -EOPNOTSUPP;
J
Johannes Berg 已提交
8786

8787
	wiphy = &rdev->wiphy;
J
Johannes Berg 已提交
8788

J
Johannes Berg 已提交
8789
	if (info->attrs[NL80211_ATTR_MAC]) {
J
Johannes Berg 已提交
8790
		ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
J
Johannes Berg 已提交
8791 8792 8793 8794

		if (!is_valid_ether_addr(ibss.bssid))
			return -EINVAL;
	}
J
Johannes Berg 已提交
8795 8796 8797 8798 8799 8800 8801 8802
	ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
	ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);

	if (info->attrs[NL80211_ATTR_IE]) {
		ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
		ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
	}

8803 8804 8805
	err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
	if (err)
		return err;
J
Johannes Berg 已提交
8806

8807 8808
	if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
				     NL80211_IFTYPE_ADHOC))
8809 8810
		return -EINVAL;

8811
	switch (ibss.chandef.width) {
8812 8813
	case NL80211_CHAN_WIDTH_5:
	case NL80211_CHAN_WIDTH_10:
8814 8815 8816 8817
	case NL80211_CHAN_WIDTH_20_NOHT:
		break;
	case NL80211_CHAN_WIDTH_20:
	case NL80211_CHAN_WIDTH_40:
8818 8819 8820 8821 8822 8823 8824 8825 8826 8827 8828 8829
		if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
			return -EINVAL;
		break;
	case NL80211_CHAN_WIDTH_80:
	case NL80211_CHAN_WIDTH_80P80:
	case NL80211_CHAN_WIDTH_160:
		if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
			return -EINVAL;
		if (!wiphy_ext_feature_isset(&rdev->wiphy,
					     NL80211_EXT_FEATURE_VHT_IBSS))
			return -EINVAL;
		break;
8830
	default:
8831
		return -EINVAL;
8832
	}
8833

J
Johannes Berg 已提交
8834
	ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
J
Johannes Berg 已提交
8835 8836
	ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];

8837 8838 8839 8840 8841 8842
	if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
		u8 *rates =
			nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
		int n_rates =
			nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
		struct ieee80211_supported_band *sband =
8843
			wiphy->bands[ibss.chandef.chan->band];
8844

8845 8846 8847 8848
		err = ieee80211_get_ratemask(sband, rates, n_rates,
					     &ibss.basic_rates);
		if (err)
			return err;
8849
	}
8850

8851 8852 8853 8854 8855 8856 8857 8858 8859 8860 8861 8862 8863
	if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
		memcpy(&ibss.ht_capa_mask,
		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
		       sizeof(ibss.ht_capa_mask));

	if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
		if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
			return -EINVAL;
		memcpy(&ibss.ht_capa,
		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
		       sizeof(ibss.ht_capa));
	}

8864 8865 8866 8867
	if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
	    !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
			nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
		return -EINVAL;
8868

8869
	if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
8870 8871
		bool no_ht = false;

8872
		connkeys = nl80211_parse_connkeys(rdev, info, &no_ht);
8873 8874
		if (IS_ERR(connkeys))
			return PTR_ERR(connkeys);
8875

8876 8877
		if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
		    no_ht) {
8878
			kzfree(connkeys);
8879 8880
			return -EINVAL;
		}
8881
	}
J
Johannes Berg 已提交
8882

8883 8884 8885
	ibss.control_port =
		nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);

8886 8887 8888 8889 8890 8891 8892 8893 8894
	if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
		int r = validate_pae_over_nl80211(rdev, info);

		if (r < 0)
			return r;

		ibss.control_port_over_nl80211 = true;
	}

8895 8896 8897
	ibss.userspace_handles_dfs =
		nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);

8898 8899
	wdev_lock(dev->ieee80211_ptr);
	err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
J
Johannes Berg 已提交
8900
	if (err)
8901
		kzfree(connkeys);
8902 8903 8904 8905
	else if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
		dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
	wdev_unlock(dev->ieee80211_ptr);

J
Johannes Berg 已提交
8906 8907 8908 8909 8910
	return err;
}

static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
{
8911 8912
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
J
Johannes Berg 已提交
8913

8914 8915
	if (!rdev->ops->leave_ibss)
		return -EOPNOTSUPP;
J
Johannes Berg 已提交
8916

8917 8918
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
		return -EOPNOTSUPP;
J
Johannes Berg 已提交
8919

8920
	return cfg80211_leave_ibss(rdev, dev, false);
J
Johannes Berg 已提交
8921 8922
}

8923 8924 8925 8926
static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
8927
	int mcast_rate[NUM_NL80211_BANDS];
8928 8929 8930 8931
	u32 nla_rate;
	int err;

	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
8932 8933
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
8934 8935 8936 8937 8938 8939 8940 8941 8942 8943 8944 8945 8946 8947
		return -EOPNOTSUPP;

	if (!rdev->ops->set_mcast_rate)
		return -EOPNOTSUPP;

	memset(mcast_rate, 0, sizeof(mcast_rate));

	if (!info->attrs[NL80211_ATTR_MCAST_RATE])
		return -EINVAL;

	nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
	if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
		return -EINVAL;

8948
	err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
8949 8950 8951 8952

	return err;
}

J
Johannes Berg 已提交
8953 8954
static struct sk_buff *
__cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
8955 8956
			    struct wireless_dev *wdev, int approxlen,
			    u32 portid, u32 seq, enum nl80211_commands cmd,
8957 8958 8959
			    enum nl80211_attrs attr,
			    const struct nl80211_vendor_cmd_info *info,
			    gfp_t gfp)
J
Johannes Berg 已提交
8960 8961 8962 8963 8964 8965 8966 8967 8968 8969 8970 8971 8972 8973 8974 8975 8976
{
	struct sk_buff *skb;
	void *hdr;
	struct nlattr *data;

	skb = nlmsg_new(approxlen + 100, gfp);
	if (!skb)
		return NULL;

	hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
	if (!hdr) {
		kfree_skb(skb);
		return NULL;
	}

	if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
		goto nla_put_failure;
8977 8978 8979 8980 8981 8982 8983 8984 8985 8986

	if (info) {
		if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
				info->vendor_id))
			goto nla_put_failure;
		if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
				info->subcmd))
			goto nla_put_failure;
	}

8987
	if (wdev) {
8988 8989
		if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
				      wdev_id(wdev), NL80211_ATTR_PAD))
8990 8991 8992 8993 8994 8995 8996
			goto nla_put_failure;
		if (wdev->netdev &&
		    nla_put_u32(skb, NL80211_ATTR_IFINDEX,
				wdev->netdev->ifindex))
			goto nla_put_failure;
	}

J
Johannes Berg 已提交
8997
	data = nla_nest_start(skb, attr);
8998 8999
	if (!data)
		goto nla_put_failure;
J
Johannes Berg 已提交
9000 9001 9002 9003 9004 9005 9006 9007 9008 9009 9010

	((void **)skb->cb)[0] = rdev;
	((void **)skb->cb)[1] = hdr;
	((void **)skb->cb)[2] = data;

	return skb;

 nla_put_failure:
	kfree_skb(skb);
	return NULL;
}
9011

9012
struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
9013
					   struct wireless_dev *wdev,
9014 9015 9016 9017 9018
					   enum nl80211_commands cmd,
					   enum nl80211_attrs attr,
					   int vendor_event_idx,
					   int approxlen, gfp_t gfp)
{
9019
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
9020 9021 9022 9023 9024 9025 9026 9027 9028 9029 9030 9031 9032 9033 9034 9035 9036 9037 9038
	const struct nl80211_vendor_cmd_info *info;

	switch (cmd) {
	case NL80211_CMD_TESTMODE:
		if (WARN_ON(vendor_event_idx != -1))
			return NULL;
		info = NULL;
		break;
	case NL80211_CMD_VENDOR:
		if (WARN_ON(vendor_event_idx < 0 ||
			    vendor_event_idx >= wiphy->n_vendor_events))
			return NULL;
		info = &wiphy->vendor_events[vendor_event_idx];
		break;
	default:
		WARN_ON(1);
		return NULL;
	}

9039
	return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, 0, 0,
9040 9041 9042 9043 9044 9045 9046 9047 9048 9049 9050
					   cmd, attr, info, gfp);
}
EXPORT_SYMBOL(__cfg80211_alloc_event_skb);

void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
{
	struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
	void *hdr = ((void **)skb->cb)[1];
	struct nlattr *data = ((void **)skb->cb)[2];
	enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;

9051 9052 9053
	/* clear CB data for netlink core to own from now on */
	memset(skb->cb, 0, sizeof(skb->cb));

9054 9055 9056 9057 9058 9059 9060 9061 9062 9063 9064
	nla_nest_end(skb, data);
	genlmsg_end(skb, hdr);

	if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
		mcgrp = NL80211_MCGRP_VENDOR;

	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), skb, 0,
				mcgrp, gfp);
}
EXPORT_SYMBOL(__cfg80211_send_event_skb);

9065 9066 9067
#ifdef CONFIG_NL80211_TESTMODE
static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
{
9068
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9069 9070
	struct wireless_dev *wdev =
		__cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
9071 9072
	int err;

9073 9074 9075 9076 9077 9078 9079 9080 9081 9082 9083 9084
	if (!rdev->ops->testmode_cmd)
		return -EOPNOTSUPP;

	if (IS_ERR(wdev)) {
		err = PTR_ERR(wdev);
		if (err != -EINVAL)
			return err;
		wdev = NULL;
	} else if (wdev->wiphy != &rdev->wiphy) {
		return -EINVAL;
	}

9085 9086 9087
	if (!info->attrs[NL80211_ATTR_TESTDATA])
		return -EINVAL;

J
Johannes Berg 已提交
9088
	rdev->cur_cmd_info = info;
9089
	err = rdev_testmode_cmd(rdev, wdev,
9090 9091
				nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
				nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
J
Johannes Berg 已提交
9092
	rdev->cur_cmd_info = NULL;
9093 9094 9095 9096

	return err;
}

W
Wey-Yi Guy 已提交
9097 9098 9099
static int nl80211_testmode_dump(struct sk_buff *skb,
				 struct netlink_callback *cb)
{
9100
	struct cfg80211_registered_device *rdev;
W
Wey-Yi Guy 已提交
9101 9102 9103 9104 9105
	int err;
	long phy_idx;
	void *data = NULL;
	int data_len = 0;

9106 9107
	rtnl_lock();

W
Wey-Yi Guy 已提交
9108 9109 9110 9111 9112 9113
	if (cb->args[0]) {
		/*
		 * 0 is a valid index, but not valid for args[0],
		 * so we need to offset by 1.
		 */
		phy_idx = cb->args[0] - 1;
9114 9115 9116 9117 9118 9119

		rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
		if (!rdev) {
			err = -ENOENT;
			goto out_err;
		}
W
Wey-Yi Guy 已提交
9120
	} else {
9121 9122
		struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);

W
Wey-Yi Guy 已提交
9123
		err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
9124 9125
				  attrbuf, nl80211_fam.maxattr,
				  nl80211_policy, NULL);
W
Wey-Yi Guy 已提交
9126
		if (err)
9127
			goto out_err;
9128

9129
		rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
9130
		if (IS_ERR(rdev)) {
9131 9132
			err = PTR_ERR(rdev);
			goto out_err;
9133
		}
9134 9135
		phy_idx = rdev->wiphy_idx;

9136 9137
		if (attrbuf[NL80211_ATTR_TESTDATA])
			cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
W
Wey-Yi Guy 已提交
9138 9139 9140 9141 9142 9143 9144
	}

	if (cb->args[1]) {
		data = nla_data((void *)cb->args[1]);
		data_len = nla_len((void *)cb->args[1]);
	}

9145
	if (!rdev->ops->testmode_dump) {
W
Wey-Yi Guy 已提交
9146 9147 9148 9149 9150
		err = -EOPNOTSUPP;
		goto out_err;
	}

	while (1) {
9151
		void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
W
Wey-Yi Guy 已提交
9152 9153 9154 9155
					   cb->nlh->nlmsg_seq, NLM_F_MULTI,
					   NL80211_CMD_TESTMODE);
		struct nlattr *tmdata;

9156 9157 9158
		if (!hdr)
			break;

9159
		if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
W
Wey-Yi Guy 已提交
9160 9161 9162 9163 9164 9165 9166 9167 9168
			genlmsg_cancel(skb, hdr);
			break;
		}

		tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
		if (!tmdata) {
			genlmsg_cancel(skb, hdr);
			break;
		}
9169
		err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
W
Wey-Yi Guy 已提交
9170 9171 9172 9173 9174 9175 9176 9177 9178 9179 9180 9181 9182 9183 9184 9185 9186
		nla_nest_end(skb, tmdata);

		if (err == -ENOBUFS || err == -ENOENT) {
			genlmsg_cancel(skb, hdr);
			break;
		} else if (err) {
			genlmsg_cancel(skb, hdr);
			goto out_err;
		}

		genlmsg_end(skb, hdr);
	}

	err = skb->len;
	/* see above */
	cb->args[0] = phy_idx + 1;
 out_err:
9187
	rtnl_unlock();
W
Wey-Yi Guy 已提交
9188 9189
	return err;
}
9190 9191
#endif

S
Samuel Ortiz 已提交
9192 9193
static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
{
9194 9195
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
S
Samuel Ortiz 已提交
9196 9197
	struct cfg80211_connect_params connect;
	struct wiphy *wiphy;
J
Johannes Berg 已提交
9198
	struct cfg80211_cached_keys *connkeys = NULL;
S
Samuel Ortiz 已提交
9199 9200 9201 9202 9203 9204 9205 9206 9207 9208 9209 9210 9211 9212
	int err;

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

	if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_SSID] ||
	    !nla_len(info->attrs[NL80211_ATTR_SSID]))
		return -EINVAL;

	if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
		connect.auth_type =
			nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
9213 9214
		if (!nl80211_valid_auth_type(rdev, connect.auth_type,
					     NL80211_CMD_CONNECT))
S
Samuel Ortiz 已提交
9215 9216 9217 9218 9219 9220
			return -EINVAL;
	} else
		connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;

	connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];

9221 9222 9223 9224 9225 9226
	if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] &&
	    !wiphy_ext_feature_isset(&rdev->wiphy,
				     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
		return -EINVAL;
	connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS];

9227
	err = nl80211_crypto_settings(rdev, info, &connect.crypto,
9228
				      NL80211_MAX_NR_CIPHER_SUITES);
S
Samuel Ortiz 已提交
9229 9230 9231
	if (err)
		return err;

9232
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9233 9234
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;
S
Samuel Ortiz 已提交
9235

9236
	wiphy = &rdev->wiphy;
S
Samuel Ortiz 已提交
9237

9238 9239 9240 9241 9242 9243 9244
	connect.bg_scan_period = -1;
	if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
		(wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
		connect.bg_scan_period =
			nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
	}

S
Samuel Ortiz 已提交
9245 9246
	if (info->attrs[NL80211_ATTR_MAC])
		connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9247 9248 9249
	else if (info->attrs[NL80211_ATTR_MAC_HINT])
		connect.bssid_hint =
			nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
S
Samuel Ortiz 已提交
9250 9251 9252 9253 9254 9255 9256 9257
	connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
	connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);

	if (info->attrs[NL80211_ATTR_IE]) {
		connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
		connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
	}

9258 9259
	if (info->attrs[NL80211_ATTR_USE_MFP]) {
		connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
9260 9261 9262 9263 9264
		if (connect.mfp == NL80211_MFP_OPTIONAL &&
		    !wiphy_ext_feature_isset(&rdev->wiphy,
					     NL80211_EXT_FEATURE_MFP_OPTIONAL))
			return -EOPNOTSUPP;

9265
		if (connect.mfp != NL80211_MFP_REQUIRED &&
9266 9267
		    connect.mfp != NL80211_MFP_NO &&
		    connect.mfp != NL80211_MFP_OPTIONAL)
9268 9269 9270 9271 9272
			return -EINVAL;
	} else {
		connect.mfp = NL80211_MFP_NO;
	}

9273 9274 9275 9276
	if (info->attrs[NL80211_ATTR_PREV_BSSID])
		connect.prev_bssid =
			nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);

S
Samuel Ortiz 已提交
9277
	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9278 9279 9280
		connect.channel = nl80211_get_valid_chan(
			wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
		if (!connect.channel)
9281 9282
			return -EINVAL;
	} else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
9283 9284 9285
		connect.channel_hint = nl80211_get_valid_chan(
			wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
		if (!connect.channel_hint)
9286
			return -EINVAL;
S
Samuel Ortiz 已提交
9287 9288
	}

J
Johannes Berg 已提交
9289
	if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
9290
		connkeys = nl80211_parse_connkeys(rdev, info, NULL);
9291 9292
		if (IS_ERR(connkeys))
			return PTR_ERR(connkeys);
J
Johannes Berg 已提交
9293 9294
	}

9295 9296 9297 9298 9299 9300 9301 9302 9303
	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
		connect.flags |= ASSOC_REQ_DISABLE_HT;

	if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
		memcpy(&connect.ht_capa_mask,
		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
		       sizeof(connect.ht_capa_mask));

	if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
9304
		if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
9305
			kzfree(connkeys);
9306
			return -EINVAL;
9307
		}
9308 9309 9310 9311 9312
		memcpy(&connect.ht_capa,
		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
		       sizeof(connect.ht_capa));
	}

9313 9314 9315 9316 9317 9318 9319 9320 9321 9322
	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
		connect.flags |= ASSOC_REQ_DISABLE_VHT;

	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
		memcpy(&connect.vht_capa_mask,
		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
		       sizeof(connect.vht_capa_mask));

	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
		if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
9323
			kzfree(connkeys);
9324 9325 9326 9327 9328 9329 9330
			return -EINVAL;
		}
		memcpy(&connect.vht_capa,
		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
		       sizeof(connect.vht_capa));
	}

9331
	if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
B
Beni Lev 已提交
9332 9333 9334 9335 9336
		if (!((rdev->wiphy.features &
			NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
		       (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
		    !wiphy_ext_feature_isset(&rdev->wiphy,
					     NL80211_EXT_FEATURE_RRM)) {
9337
			kzfree(connkeys);
9338
			return -EINVAL;
9339
		}
9340 9341 9342
		connect.flags |= ASSOC_REQ_USE_RRM;
	}

9343
	connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
9344
	if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
9345 9346 9347 9348
		kzfree(connkeys);
		return -EOPNOTSUPP;
	}

9349 9350 9351 9352 9353 9354 9355 9356 9357 9358 9359 9360 9361 9362 9363
	if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
		/* bss selection makes no sense if bssid is set */
		if (connect.bssid) {
			kzfree(connkeys);
			return -EINVAL;
		}

		err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
				       wiphy, &connect.bss_select);
		if (err) {
			kzfree(connkeys);
			return err;
		}
	}

9364 9365 9366 9367 9368 9369 9370 9371 9372 9373 9374 9375 9376 9377 9378 9379 9380 9381 9382 9383 9384 9385 9386 9387 9388 9389 9390 9391 9392
	if (wiphy_ext_feature_isset(&rdev->wiphy,
				    NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
	    info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
	    info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
	    info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
	    info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
		connect.fils_erp_username =
			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
		connect.fils_erp_username_len =
			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
		connect.fils_erp_realm =
			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
		connect.fils_erp_realm_len =
			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
		connect.fils_erp_next_seq_num =
			nla_get_u16(
			   info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
		connect.fils_erp_rrk =
			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
		connect.fils_erp_rrk_len =
			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
	} else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
		   info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
		   info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
		   info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
		kzfree(connkeys);
		return -EINVAL;
	}

9393 9394
	if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) {
		if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9395
			kzfree(connkeys);
9396 9397 9398 9399 9400 9401 9402
			GENL_SET_ERR_MSG(info,
					 "external auth requires connection ownership");
			return -EINVAL;
		}
		connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT;
	}

9403
	wdev_lock(dev->ieee80211_ptr);
9404

9405 9406
	err = cfg80211_connect(rdev, dev, &connect, connkeys,
			       connect.prev_bssid);
J
Johannes Berg 已提交
9407
	if (err)
9408
		kzfree(connkeys);
9409 9410 9411 9412 9413 9414 9415 9416 9417 9418 9419 9420 9421

	if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
		dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
		if (connect.bssid)
			memcpy(dev->ieee80211_ptr->disconnect_bssid,
			       connect.bssid, ETH_ALEN);
		else
			memset(dev->ieee80211_ptr->disconnect_bssid,
			       0, ETH_ALEN);
	}

	wdev_unlock(dev->ieee80211_ptr);

S
Samuel Ortiz 已提交
9422 9423 9424
	return err;
}

9425 9426 9427 9428 9429 9430 9431 9432 9433 9434 9435 9436 9437 9438 9439 9440 9441 9442 9443 9444 9445 9446 9447 9448 9449 9450 9451 9452 9453 9454 9455
static int nl80211_update_connect_params(struct sk_buff *skb,
					 struct genl_info *info)
{
	struct cfg80211_connect_params connect = {};
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	u32 changed = 0;
	int ret;

	if (!rdev->ops->update_connect_params)
		return -EOPNOTSUPP;

	if (info->attrs[NL80211_ATTR_IE]) {
		if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
			return -EINVAL;
		connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
		connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
		changed |= UPDATE_ASSOC_IES;
	}

	wdev_lock(dev->ieee80211_ptr);
	if (!wdev->current_bss)
		ret = -ENOLINK;
	else
		ret = rdev_update_connect_params(rdev, dev, &connect, changed);
	wdev_unlock(dev->ieee80211_ptr);

	return ret;
}

S
Samuel Ortiz 已提交
9456 9457
static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
{
9458 9459
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
S
Samuel Ortiz 已提交
9460
	u16 reason;
9461
	int ret;
S
Samuel Ortiz 已提交
9462 9463 9464 9465 9466 9467 9468 9469 9470

	if (!info->attrs[NL80211_ATTR_REASON_CODE])
		reason = WLAN_REASON_DEAUTH_LEAVING;
	else
		reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);

	if (reason == 0)
		return -EINVAL;

9471
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9472 9473
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;
S
Samuel Ortiz 已提交
9474

9475 9476 9477 9478
	wdev_lock(dev->ieee80211_ptr);
	ret = cfg80211_disconnect(rdev, dev, reason, true);
	wdev_unlock(dev->ieee80211_ptr);
	return ret;
S
Samuel Ortiz 已提交
9479 9480
}

9481 9482
static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
{
9483
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9484 9485 9486
	struct net *net;
	int err;

9487 9488 9489 9490 9491 9492
	if (info->attrs[NL80211_ATTR_PID]) {
		u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);

		net = get_net_ns_by_pid(pid);
	} else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
		u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
9493

9494 9495 9496 9497
		net = get_net_ns_by_fd(fd);
	} else {
		return -EINVAL;
	}
9498

9499 9500
	if (IS_ERR(net))
		return PTR_ERR(net);
9501 9502 9503 9504

	err = 0;

	/* check if anything to do */
9505 9506
	if (!net_eq(wiphy_net(&rdev->wiphy), net))
		err = cfg80211_switch_netns(rdev, net);
9507 9508 9509 9510 9511

	put_net(net);
	return err;
}

S
Samuel Ortiz 已提交
9512 9513
static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
{
9514
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
S
Samuel Ortiz 已提交
9515 9516
	int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
			struct cfg80211_pmksa *pmksa) = NULL;
9517
	struct net_device *dev = info->user_ptr[1];
S
Samuel Ortiz 已提交
9518 9519 9520 9521 9522 9523 9524 9525
	struct cfg80211_pmksa pmksa;

	memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));

	if (!info->attrs[NL80211_ATTR_PMKID])
		return -EINVAL;

	pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
9526 9527 9528 9529 9530 9531 9532 9533 9534 9535 9536 9537 9538 9539 9540 9541 9542 9543

	if (info->attrs[NL80211_ATTR_MAC]) {
		pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
	} else if (info->attrs[NL80211_ATTR_SSID] &&
		   info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
		   (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA ||
		    info->attrs[NL80211_ATTR_PMK])) {
		pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
		pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
		pmksa.cache_id =
			nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
	} else {
		return -EINVAL;
	}
	if (info->attrs[NL80211_ATTR_PMK]) {
		pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
		pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
	}
S
Samuel Ortiz 已提交
9544

9545
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9546 9547
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;
S
Samuel Ortiz 已提交
9548 9549 9550 9551 9552 9553 9554 9555 9556 9557 9558 9559 9560

	switch (info->genlhdr->cmd) {
	case NL80211_CMD_SET_PMKSA:
		rdev_ops = rdev->ops->set_pmksa;
		break;
	case NL80211_CMD_DEL_PMKSA:
		rdev_ops = rdev->ops->del_pmksa;
		break;
	default:
		WARN_ON(1);
		break;
	}

9561 9562
	if (!rdev_ops)
		return -EOPNOTSUPP;
S
Samuel Ortiz 已提交
9563

9564
	return rdev_ops(&rdev->wiphy, dev, &pmksa);
S
Samuel Ortiz 已提交
9565 9566 9567 9568
}

static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
{
9569 9570
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
S
Samuel Ortiz 已提交
9571

9572
	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9573 9574
	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;
S
Samuel Ortiz 已提交
9575

9576 9577
	if (!rdev->ops->flush_pmksa)
		return -EOPNOTSUPP;
S
Samuel Ortiz 已提交
9578

9579
	return rdev_flush_pmksa(rdev, dev);
S
Samuel Ortiz 已提交
9580 9581
}

9582 9583 9584 9585 9586
static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	u8 action_code, dialog_token;
9587
	u32 peer_capability = 0;
9588 9589
	u16 status_code;
	u8 *peer;
9590
	bool initiator;
9591 9592 9593 9594 9595 9596 9597 9598 9599 9600 9601 9602 9603 9604 9605 9606

	if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
	    !rdev->ops->tdls_mgmt)
		return -EOPNOTSUPP;

	if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
	    !info->attrs[NL80211_ATTR_STATUS_CODE] ||
	    !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
	    !info->attrs[NL80211_ATTR_IE] ||
	    !info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
	action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
	status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
	dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
9607
	initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
9608 9609 9610
	if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
		peer_capability =
			nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
9611

9612
	return rdev_tdls_mgmt(rdev, dev, peer, action_code,
9613
			      dialog_token, status_code, peer_capability,
9614
			      initiator,
9615 9616
			      nla_data(info->attrs[NL80211_ATTR_IE]),
			      nla_len(info->attrs[NL80211_ATTR_IE]));
9617 9618 9619 9620 9621 9622 9623 9624 9625 9626 9627 9628 9629 9630 9631 9632 9633 9634 9635 9636
}

static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	enum nl80211_tdls_operation operation;
	u8 *peer;

	if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
	    !rdev->ops->tdls_oper)
		return -EOPNOTSUPP;

	if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
	    !info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);

9637
	return rdev_tdls_oper(rdev, dev, peer, operation);
9638 9639
}

9640 9641 9642
static int nl80211_remain_on_channel(struct sk_buff *skb,
				     struct genl_info *info)
{
9643
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9644
	struct wireless_dev *wdev = info->user_ptr[1];
9645
	struct cfg80211_chan_def chandef;
9646
	const struct cfg80211_chan_def *compat_chandef;
9647 9648 9649
	struct sk_buff *msg;
	void *hdr;
	u64 cookie;
9650
	u32 duration;
9651 9652 9653 9654 9655 9656 9657 9658
	int err;

	if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
	    !info->attrs[NL80211_ATTR_DURATION])
		return -EINVAL;

	duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);

9659 9660 9661 9662
	if (!rdev->ops->remain_on_channel ||
	    !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
		return -EOPNOTSUPP;

9663
	/*
9664 9665
	 * We should be on that channel for at least a minimum amount of
	 * time (10ms) but no longer than the driver supports.
9666
	 */
9667
	if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9668
	    duration > rdev->wiphy.max_remain_on_channel_duration)
9669 9670
		return -EINVAL;

9671 9672 9673
	err = nl80211_parse_chandef(rdev, info, &chandef);
	if (err)
		return err;
9674

9675 9676 9677 9678 9679 9680 9681 9682 9683 9684 9685 9686
	wdev_lock(wdev);
	if (!cfg80211_off_channel_oper_allowed(wdev) &&
	    !cfg80211_chandef_identical(&wdev->chandef, &chandef)) {
		compat_chandef = cfg80211_chandef_compatible(&wdev->chandef,
							     &chandef);
		if (compat_chandef != &chandef) {
			wdev_unlock(wdev);
			return -EBUSY;
		}
	}
	wdev_unlock(wdev);

9687
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9688 9689
	if (!msg)
		return -ENOMEM;
9690

9691
	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9692
			     NL80211_CMD_REMAIN_ON_CHANNEL);
9693 9694
	if (!hdr) {
		err = -ENOBUFS;
9695 9696 9697
		goto free_msg;
	}

9698 9699
	err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
				     duration, &cookie);
9700 9701 9702 9703

	if (err)
		goto free_msg;

9704 9705
	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
			      NL80211_ATTR_PAD))
9706
		goto nla_put_failure;
9707 9708

	genlmsg_end(msg, hdr);
9709 9710

	return genlmsg_reply(msg, info);
9711 9712 9713 9714 9715 9716 9717 9718 9719 9720 9721

 nla_put_failure:
	err = -ENOBUFS;
 free_msg:
	nlmsg_free(msg);
	return err;
}

static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
					    struct genl_info *info)
{
9722
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9723
	struct wireless_dev *wdev = info->user_ptr[1];
9724 9725 9726 9727 9728
	u64 cookie;

	if (!info->attrs[NL80211_ATTR_COOKIE])
		return -EINVAL;

9729 9730
	if (!rdev->ops->cancel_remain_on_channel)
		return -EOPNOTSUPP;
9731 9732 9733

	cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);

9734
	return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
9735 9736
}

9737 9738 9739 9740
static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
				       struct genl_info *info)
{
	struct cfg80211_bitrate_mask mask;
9741
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9742
	struct net_device *dev = info->user_ptr[1];
9743
	int err;
9744

9745 9746
	if (!rdev->ops->set_bitrate_mask)
		return -EOPNOTSUPP;
9747

9748 9749 9750
	err = nl80211_parse_tx_bitrate_mask(info, &mask);
	if (err)
		return err;
9751

9752
	return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
9753 9754
}

9755
static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
9756
{
9757
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9758
	struct wireless_dev *wdev = info->user_ptr[1];
9759
	u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
9760 9761 9762 9763

	if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
		return -EINVAL;

9764 9765
	if (info->attrs[NL80211_ATTR_FRAME_TYPE])
		frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
9766

9767 9768 9769 9770 9771 9772 9773 9774
	switch (wdev->iftype) {
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_P2P_CLIENT:
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
	case NL80211_IFTYPE_MESH_POINT:
	case NL80211_IFTYPE_P2P_GO:
9775
	case NL80211_IFTYPE_P2P_DEVICE:
9776
		break;
9777
	case NL80211_IFTYPE_NAN:
9778
	default:
9779
		return -EOPNOTSUPP;
9780
	}
9781 9782

	/* not much point in registering if we can't reply */
9783 9784
	if (!rdev->ops->mgmt_tx)
		return -EOPNOTSUPP;
9785

9786
	return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
9787 9788 9789 9790
			nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
			nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
}

9791
static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
9792
{
9793
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9794
	struct wireless_dev *wdev = info->user_ptr[1];
9795
	struct cfg80211_chan_def chandef;
9796
	int err;
J
Johannes Berg 已提交
9797
	void *hdr = NULL;
9798
	u64 cookie;
9799
	struct sk_buff *msg = NULL;
9800 9801 9802 9803
	struct cfg80211_mgmt_tx_params params = {
		.dont_wait_for_ack =
			info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
	};
9804

9805
	if (!info->attrs[NL80211_ATTR_FRAME])
9806 9807
		return -EINVAL;

9808 9809
	if (!rdev->ops->mgmt_tx)
		return -EOPNOTSUPP;
9810

9811
	switch (wdev->iftype) {
9812 9813 9814
	case NL80211_IFTYPE_P2P_DEVICE:
		if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
			return -EINVAL;
9815 9816 9817 9818 9819 9820 9821 9822
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_P2P_CLIENT:
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
	case NL80211_IFTYPE_MESH_POINT:
	case NL80211_IFTYPE_P2P_GO:
		break;
9823
	case NL80211_IFTYPE_NAN:
9824
	default:
9825
		return -EOPNOTSUPP;
9826
	}
9827

9828
	if (info->attrs[NL80211_ATTR_DURATION]) {
9829
		if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
9830
			return -EINVAL;
9831
		params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
9832 9833 9834 9835 9836

		/*
		 * We should wait on the channel for at least a minimum amount
		 * of time (10ms) but no longer than the driver supports.
		 */
9837 9838
		if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
		    params.wait > rdev->wiphy.max_remain_on_channel_duration)
9839
			return -EINVAL;
9840 9841
	}

9842
	params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
9843

9844
	if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
9845 9846
		return -EINVAL;

9847
	params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
9848

9849 9850 9851 9852 9853 9854 9855 9856 9857 9858
	/* get the channel if any has been specified, otherwise pass NULL to
	 * the driver. The latter will use the current one
	 */
	chandef.chan = NULL;
	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
		err = nl80211_parse_chandef(rdev, info, &chandef);
		if (err)
			return err;
	}

9859
	if (!chandef.chan && params.offchan)
9860
		return -EINVAL;
9861

9862 9863 9864 9865 9866 9867 9868
	wdev_lock(wdev);
	if (params.offchan && !cfg80211_off_channel_oper_allowed(wdev)) {
		wdev_unlock(wdev);
		return -EBUSY;
	}
	wdev_unlock(wdev);

9869 9870 9871 9872 9873 9874 9875 9876 9877 9878 9879 9880 9881 9882 9883 9884 9885 9886 9887 9888 9889
	params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
	params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);

	if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
		int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
		int i;

		if (len % sizeof(u16))
			return -EINVAL;

		params.n_csa_offsets = len / sizeof(u16);
		params.csa_offsets =
			nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);

		/* check that all the offsets fit the frame */
		for (i = 0; i < params.n_csa_offsets; i++) {
			if (params.csa_offsets[i] >= params.len)
				return -EINVAL;
		}
	}

9890
	if (!params.dont_wait_for_ack) {
9891 9892 9893
		msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
		if (!msg)
			return -ENOMEM;
9894

9895
		hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9896
				     NL80211_CMD_FRAME);
9897 9898
		if (!hdr) {
			err = -ENOBUFS;
9899 9900
			goto free_msg;
		}
9901
	}
9902

9903 9904
	params.chan = chandef.chan;
	err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
9905 9906 9907
	if (err)
		goto free_msg;

9908
	if (msg) {
9909 9910
		if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
				      NL80211_ATTR_PAD))
9911
			goto nla_put_failure;
9912

9913 9914 9915 9916 9917
		genlmsg_end(msg, hdr);
		return genlmsg_reply(msg, info);
	}

	return 0;
9918 9919 9920 9921 9922 9923 9924 9925

 nla_put_failure:
	err = -ENOBUFS;
 free_msg:
	nlmsg_free(msg);
	return err;
}

9926 9927 9928
static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9929
	struct wireless_dev *wdev = info->user_ptr[1];
9930 9931 9932 9933 9934 9935 9936 9937
	u64 cookie;

	if (!info->attrs[NL80211_ATTR_COOKIE])
		return -EINVAL;

	if (!rdev->ops->mgmt_tx_cancel_wait)
		return -EOPNOTSUPP;

9938 9939 9940 9941 9942 9943 9944
	switch (wdev->iftype) {
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_P2P_CLIENT:
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_AP_VLAN:
	case NL80211_IFTYPE_P2P_GO:
9945
	case NL80211_IFTYPE_P2P_DEVICE:
9946
		break;
9947
	case NL80211_IFTYPE_NAN:
9948
	default:
9949
		return -EOPNOTSUPP;
9950
	}
9951 9952 9953

	cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);

9954
	return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
9955 9956
}

K
Kalle Valo 已提交
9957 9958
static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
{
9959
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
K
Kalle Valo 已提交
9960
	struct wireless_dev *wdev;
9961
	struct net_device *dev = info->user_ptr[1];
K
Kalle Valo 已提交
9962 9963 9964 9965
	u8 ps_state;
	bool state;
	int err;

9966 9967
	if (!info->attrs[NL80211_ATTR_PS_STATE])
		return -EINVAL;
K
Kalle Valo 已提交
9968 9969 9970

	ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);

9971 9972
	if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
		return -EINVAL;
K
Kalle Valo 已提交
9973 9974 9975

	wdev = dev->ieee80211_ptr;

9976 9977
	if (!rdev->ops->set_power_mgmt)
		return -EOPNOTSUPP;
K
Kalle Valo 已提交
9978 9979 9980 9981

	state = (ps_state == NL80211_PS_ENABLED) ? true : false;

	if (state == wdev->ps)
9982
		return 0;
K
Kalle Valo 已提交
9983

9984
	err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
9985 9986
	if (!err)
		wdev->ps = state;
K
Kalle Valo 已提交
9987 9988 9989 9990 9991
	return err;
}

static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
{
9992
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
K
Kalle Valo 已提交
9993 9994
	enum nl80211_ps_state ps_state;
	struct wireless_dev *wdev;
9995
	struct net_device *dev = info->user_ptr[1];
K
Kalle Valo 已提交
9996 9997 9998 9999 10000 10001
	struct sk_buff *msg;
	void *hdr;
	int err;

	wdev = dev->ieee80211_ptr;

10002 10003
	if (!rdev->ops->set_power_mgmt)
		return -EOPNOTSUPP;
K
Kalle Valo 已提交
10004 10005

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10006 10007
	if (!msg)
		return -ENOMEM;
K
Kalle Valo 已提交
10008

10009
	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
K
Kalle Valo 已提交
10010 10011
			     NL80211_CMD_GET_POWER_SAVE);
	if (!hdr) {
10012
		err = -ENOBUFS;
K
Kalle Valo 已提交
10013 10014 10015 10016 10017 10018 10019 10020
		goto free_msg;
	}

	if (wdev->ps)
		ps_state = NL80211_PS_ENABLED;
	else
		ps_state = NL80211_PS_DISABLED;

10021 10022
	if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
		goto nla_put_failure;
K
Kalle Valo 已提交
10023 10024

	genlmsg_end(msg, hdr);
10025
	return genlmsg_reply(msg, info);
K
Kalle Valo 已提交
10026

10027
 nla_put_failure:
K
Kalle Valo 已提交
10028
	err = -ENOBUFS;
10029
 free_msg:
K
Kalle Valo 已提交
10030 10031 10032 10033
	nlmsg_free(msg);
	return err;
}

10034 10035
static const struct nla_policy
nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
10036
	[NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
10037 10038
	[NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
	[NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
10039 10040 10041
	[NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
	[NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
	[NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
10042
	[NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
10043 10044
};

10045
static int nl80211_set_cqm_txe(struct genl_info *info,
J
Johannes Berg 已提交
10046
			       u32 rate, u32 pkts, u32 intvl)
10047 10048 10049
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
10050
	struct wireless_dev *wdev = dev->ieee80211_ptr;
10051

J
Johannes Berg 已提交
10052
	if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
10053 10054 10055 10056 10057 10058 10059 10060 10061
		return -EINVAL;

	if (!rdev->ops->set_cqm_txe_config)
		return -EOPNOTSUPP;

	if (wdev->iftype != NL80211_IFTYPE_STATION &&
	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;

10062
	return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
10063 10064
}

10065 10066 10067 10068 10069 10070 10071 10072 10073 10074 10075 10076 10077 10078 10079 10080 10081 10082 10083 10084 10085
static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
				    struct net_device *dev)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	s32 last, low, high;
	u32 hyst;
	int i, n;
	int err;

	/* RSSI reporting disabled? */
	if (!wdev->cqm_config)
		return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);

	/*
	 * Obtain current RSSI value if possible, if not and no RSSI threshold
	 * event has been received yet, we should receive an event after a
	 * connection is established and enough beacons received to calculate
	 * the average.
	 */
	if (!wdev->cqm_config->last_rssi_event_value && wdev->current_bss &&
	    rdev->ops->get_station) {
10086
		struct station_info sinfo = {};
10087 10088 10089 10090
		u8 *mac_addr;

		mac_addr = wdev->current_bss->pub.bssid;

10091 10092
		err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
		if (err)
10093 10094
			return err;

10095
		if (sinfo.filled & BIT(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
10096
			wdev->cqm_config->last_rssi_event_value =
10097
				(s8) sinfo.rx_beacon_signal_avg;
10098 10099 10100 10101 10102 10103 10104 10105 10106 10107 10108 10109 10110 10111 10112 10113 10114 10115
	}

	last = wdev->cqm_config->last_rssi_event_value;
	hyst = wdev->cqm_config->rssi_hyst;
	n = wdev->cqm_config->n_rssi_thresholds;

	for (i = 0; i < n; i++)
		if (last < wdev->cqm_config->rssi_thresholds[i])
			break;

	low = i > 0 ?
		(wdev->cqm_config->rssi_thresholds[i - 1] - hyst) : S32_MIN;
	high = i < n ?
		(wdev->cqm_config->rssi_thresholds[i] + hyst - 1) : S32_MAX;

	return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
}

10116
static int nl80211_set_cqm_rssi(struct genl_info *info,
10117 10118
				const s32 *thresholds, int n_thresholds,
				u32 hysteresis)
10119
{
10120 10121
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
10122
	struct wireless_dev *wdev = dev->ieee80211_ptr;
10123 10124
	int i, err;
	s32 prev = S32_MIN;
10125

10126 10127 10128 10129
	/* Check all values negative and sorted */
	for (i = 0; i < n_thresholds; i++) {
		if (thresholds[i] > 0 || thresholds[i] <= prev)
			return -EINVAL;
10130

10131 10132
		prev = thresholds[i];
	}
10133

10134
	if (wdev->iftype != NL80211_IFTYPE_STATION &&
10135 10136
	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;
10137

10138 10139 10140 10141 10142 10143 10144 10145 10146 10147 10148 10149 10150 10151 10152 10153 10154 10155 10156 10157 10158 10159 10160 10161 10162 10163 10164 10165 10166 10167 10168 10169 10170 10171 10172 10173 10174 10175 10176 10177 10178 10179 10180 10181
	wdev_lock(wdev);
	cfg80211_cqm_config_free(wdev);
	wdev_unlock(wdev);

	if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) {
		if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */
			return rdev_set_cqm_rssi_config(rdev, dev, 0, 0);

		return rdev_set_cqm_rssi_config(rdev, dev,
						thresholds[0], hysteresis);
	}

	if (!wiphy_ext_feature_isset(&rdev->wiphy,
				     NL80211_EXT_FEATURE_CQM_RSSI_LIST))
		return -EOPNOTSUPP;

	if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
		n_thresholds = 0;

	wdev_lock(wdev);
	if (n_thresholds) {
		struct cfg80211_cqm_config *cqm_config;

		cqm_config = kzalloc(sizeof(struct cfg80211_cqm_config) +
				     n_thresholds * sizeof(s32), GFP_KERNEL);
		if (!cqm_config) {
			err = -ENOMEM;
			goto unlock;
		}

		cqm_config->rssi_hyst = hysteresis;
		cqm_config->n_rssi_thresholds = n_thresholds;
		memcpy(cqm_config->rssi_thresholds, thresholds,
		       n_thresholds * sizeof(s32));

		wdev->cqm_config = cqm_config;
	}

	err = cfg80211_cqm_rssi_update(rdev, dev);

unlock:
	wdev_unlock(wdev);

	return err;
10182 10183 10184 10185 10186 10187 10188 10189 10190
}

static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
	struct nlattr *cqm;
	int err;

	cqm = info->attrs[NL80211_ATTR_CQM];
10191 10192
	if (!cqm)
		return -EINVAL;
10193 10194

	err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
10195
			       nl80211_attr_cqm_policy, info->extack);
10196
	if (err)
10197
		return err;
10198 10199 10200

	if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
	    attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
10201 10202 10203
		const s32 *thresholds =
			nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
		int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
10204
		u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
10205

10206 10207 10208 10209 10210
		if (len % 4)
			return -EINVAL;

		return nl80211_set_cqm_rssi(info, thresholds, len / 4,
					    hysteresis);
10211 10212 10213 10214 10215 10216 10217 10218 10219 10220 10221 10222 10223
	}

	if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
	    attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
	    attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
		u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
		u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
		u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);

		return nl80211_set_cqm_txe(info, rate, pkts, intvl);
	}

	return -EINVAL;
10224 10225
}

10226 10227 10228 10229 10230 10231 10232 10233 10234 10235 10236 10237 10238 10239 10240 10241 10242 10243 10244 10245 10246 10247
static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct ocb_setup setup = {};
	int err;

	err = nl80211_parse_chandef(rdev, info, &setup.chandef);
	if (err)
		return err;

	return cfg80211_join_ocb(rdev, dev, &setup);
}

static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];

	return cfg80211_leave_ocb(rdev, dev);
}

10248 10249 10250 10251 10252
static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct mesh_config cfg;
10253
	struct mesh_setup setup;
10254 10255 10256 10257
	int err;

	/* start with default */
	memcpy(&cfg, &default_mesh_config, sizeof(cfg));
10258
	memcpy(&setup, &default_mesh_setup, sizeof(setup));
10259

10260
	if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
10261
		/* and parse parameters if given */
10262
		err = nl80211_parse_mesh_config(info, &cfg, NULL);
10263 10264 10265 10266 10267 10268 10269 10270
		if (err)
			return err;
	}

	if (!info->attrs[NL80211_ATTR_MESH_ID] ||
	    !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
		return -EINVAL;

10271 10272 10273
	setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
	setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);

10274 10275 10276 10277 10278
	if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
	    !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
			    nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
			return -EINVAL;

10279 10280 10281
	if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
		setup.beacon_interval =
			nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
10282

10283 10284 10285
		err = cfg80211_validate_beacon_int(rdev,
						   NL80211_IFTYPE_MESH_POINT,
						   setup.beacon_interval);
10286 10287
		if (err)
			return err;
10288 10289 10290 10291 10292 10293 10294 10295 10296
	}

	if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
		setup.dtim_period =
			nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
		if (setup.dtim_period < 1 || setup.dtim_period > 100)
			return -EINVAL;
	}

10297 10298 10299 10300 10301 10302 10303
	if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
		/* parse additional setup parameters if given */
		err = nl80211_parse_mesh_setup(info, &setup);
		if (err)
			return err;
	}

10304 10305 10306
	if (setup.user_mpm)
		cfg.auto_open_plinks = false;

10307
	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
10308 10309 10310
		err = nl80211_parse_chandef(rdev, info, &setup.chandef);
		if (err)
			return err;
10311
	} else {
10312
		/* __cfg80211_join_mesh() will sort it out */
10313
		setup.chandef.chan = NULL;
10314 10315
	}

10316 10317 10318 10319 10320 10321 10322 10323 10324 10325 10326 10327 10328 10329 10330 10331 10332
	if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
		u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
		int n_rates =
			nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
		struct ieee80211_supported_band *sband;

		if (!setup.chandef.chan)
			return -EINVAL;

		sband = rdev->wiphy.bands[setup.chandef.chan->band];

		err = ieee80211_get_ratemask(sband, rates, n_rates,
					     &setup.basic_rates);
		if (err)
			return err;
	}

10333 10334 10335 10336 10337
	if (info->attrs[NL80211_ATTR_TX_RATES]) {
		err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
		if (err)
			return err;

10338 10339 10340
		if (!setup.chandef.chan)
			return -EINVAL;

10341 10342 10343 10344 10345 10346
		err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
					      &setup.beacon_rate);
		if (err)
			return err;
	}

10347 10348 10349
	setup.userspace_handles_dfs =
		nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);

10350 10351 10352 10353 10354 10355 10356 10357 10358
	if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
		int r = validate_pae_over_nl80211(rdev, info);

		if (r < 0)
			return r;

		setup.control_port_over_nl80211 = true;
	}

10359 10360 10361 10362 10363 10364 10365
	wdev_lock(dev->ieee80211_ptr);
	err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg);
	if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER])
		dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
	wdev_unlock(dev->ieee80211_ptr);

	return err;
10366 10367 10368 10369 10370 10371 10372 10373 10374 10375
}

static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];

	return cfg80211_leave_mesh(rdev, dev);
}

10376
#ifdef CONFIG_PM
10377 10378 10379
static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
					struct cfg80211_registered_device *rdev)
{
10380
	struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
10381 10382 10383
	struct nlattr *nl_pats, *nl_pat;
	int i, pat_len;

10384
	if (!wowlan->n_patterns)
10385 10386 10387 10388 10389 10390
		return 0;

	nl_pats = nla_nest_start(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
	if (!nl_pats)
		return -ENOBUFS;

10391
	for (i = 0; i < wowlan->n_patterns; i++) {
10392 10393 10394
		nl_pat = nla_nest_start(msg, i + 1);
		if (!nl_pat)
			return -ENOBUFS;
10395
		pat_len = wowlan->patterns[i].pattern_len;
10396
		if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
10397
			    wowlan->patterns[i].mask) ||
10398 10399 10400
		    nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
			    wowlan->patterns[i].pattern) ||
		    nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
10401
				wowlan->patterns[i].pkt_offset))
10402 10403 10404 10405 10406 10407 10408 10409
			return -ENOBUFS;
		nla_nest_end(msg, nl_pat);
	}
	nla_nest_end(msg, nl_pats);

	return 0;
}

10410 10411 10412 10413 10414 10415 10416 10417 10418 10419 10420 10421
static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
				   struct cfg80211_wowlan_tcp *tcp)
{
	struct nlattr *nl_tcp;

	if (!tcp)
		return 0;

	nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
	if (!nl_tcp)
		return -ENOBUFS;

10422 10423
	if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
	    nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
10424 10425 10426 10427 10428 10429 10430 10431 10432 10433 10434 10435 10436 10437 10438 10439 10440 10441 10442 10443 10444 10445 10446 10447
	    nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
	    nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
	    nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
	    nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
		    tcp->payload_len, tcp->payload) ||
	    nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
			tcp->data_interval) ||
	    nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
		    tcp->wake_len, tcp->wake_data) ||
	    nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
		    DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
		return -ENOBUFS;

	if (tcp->payload_seq.len &&
	    nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
		    sizeof(tcp->payload_seq), &tcp->payload_seq))
		return -ENOBUFS;

	if (tcp->payload_tok.len &&
	    nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
		    sizeof(tcp->payload_tok) + tcp->tokens_size,
		    &tcp->payload_tok))
		return -ENOBUFS;

10448 10449
	nla_nest_end(msg, nl_tcp);

10450 10451 10452
	return 0;
}

10453 10454 10455
static int nl80211_send_wowlan_nd(struct sk_buff *msg,
				  struct cfg80211_sched_scan_request *req)
{
10456
	struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
10457 10458 10459 10460 10461 10462 10463 10464 10465
	int i;

	if (!req)
		return 0;

	nd = nla_nest_start(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
	if (!nd)
		return -ENOBUFS;

10466 10467 10468
	if (req->n_scan_plans == 1 &&
	    nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
			req->scan_plans[0].interval * 1000))
10469 10470
		return -ENOBUFS;

10471 10472 10473
	if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
		return -ENOBUFS;

10474 10475 10476 10477 10478 10479 10480 10481 10482 10483 10484 10485 10486 10487
	if (req->relative_rssi_set) {
		struct nl80211_bss_select_rssi_adjust rssi_adjust;

		if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
			       req->relative_rssi))
			return -ENOBUFS;

		rssi_adjust.band = req->rssi_adjust.band;
		rssi_adjust.delta = req->rssi_adjust.delta;
		if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
			    sizeof(rssi_adjust), &rssi_adjust))
			return -ENOBUFS;
	}

10488 10489 10490 10491
	freqs = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
	if (!freqs)
		return -ENOBUFS;

10492 10493 10494 10495
	for (i = 0; i < req->n_channels; i++) {
		if (nla_put_u32(msg, i, req->channels[i]->center_freq))
			return -ENOBUFS;
	}
10496 10497 10498 10499 10500

	nla_nest_end(msg, freqs);

	if (req->n_match_sets) {
		matches = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_MATCH);
10501 10502 10503
		if (!matches)
			return -ENOBUFS;

10504 10505
		for (i = 0; i < req->n_match_sets; i++) {
			match = nla_nest_start(msg, i);
10506 10507 10508
			if (!match)
				return -ENOBUFS;

10509 10510 10511 10512
			if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
				    req->match_sets[i].ssid.ssid_len,
				    req->match_sets[i].ssid.ssid))
				return -ENOBUFS;
10513 10514 10515 10516 10517
			nla_nest_end(msg, match);
		}
		nla_nest_end(msg, matches);
	}

10518 10519 10520 10521 10522 10523
	scan_plans = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
	if (!scan_plans)
		return -ENOBUFS;

	for (i = 0; i < req->n_scan_plans; i++) {
		scan_plan = nla_nest_start(msg, i + 1);
10524 10525 10526
		if (!scan_plan)
			return -ENOBUFS;

10527 10528 10529 10530 10531 10532 10533 10534 10535 10536 10537
		if (!scan_plan ||
		    nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
				req->scan_plans[i].interval) ||
		    (req->scan_plans[i].iterations &&
		     nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
				 req->scan_plans[i].iterations)))
			return -ENOBUFS;
		nla_nest_end(msg, scan_plan);
	}
	nla_nest_end(msg, scan_plans);

10538 10539 10540 10541 10542
	nla_nest_end(msg, nd);

	return 0;
}

J
Johannes Berg 已提交
10543 10544 10545 10546 10547
static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct sk_buff *msg;
	void *hdr;
10548
	u32 size = NLMSG_DEFAULT_SIZE;
J
Johannes Berg 已提交
10549

10550
	if (!rdev->wiphy.wowlan)
J
Johannes Berg 已提交
10551 10552
		return -EOPNOTSUPP;

10553
	if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
10554
		/* adjust size to have room for all the data */
10555 10556 10557 10558
		size += rdev->wiphy.wowlan_config->tcp->tokens_size +
			rdev->wiphy.wowlan_config->tcp->payload_len +
			rdev->wiphy.wowlan_config->tcp->wake_len +
			rdev->wiphy.wowlan_config->tcp->wake_len / 8;
10559 10560 10561
	}

	msg = nlmsg_new(size, GFP_KERNEL);
J
Johannes Berg 已提交
10562 10563 10564
	if (!msg)
		return -ENOMEM;

10565
	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
J
Johannes Berg 已提交
10566 10567 10568 10569
			     NL80211_CMD_GET_WOWLAN);
	if (!hdr)
		goto nla_put_failure;

10570
	if (rdev->wiphy.wowlan_config) {
J
Johannes Berg 已提交
10571 10572 10573 10574 10575 10576
		struct nlattr *nl_wowlan;

		nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
		if (!nl_wowlan)
			goto nla_put_failure;

10577
		if ((rdev->wiphy.wowlan_config->any &&
10578
		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
10579
		    (rdev->wiphy.wowlan_config->disconnect &&
10580
		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
10581
		    (rdev->wiphy.wowlan_config->magic_pkt &&
10582
		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
10583
		    (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
10584
		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
10585
		    (rdev->wiphy.wowlan_config->eap_identity_req &&
10586
		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
10587
		    (rdev->wiphy.wowlan_config->four_way_handshake &&
10588
		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
10589
		    (rdev->wiphy.wowlan_config->rfkill_release &&
10590 10591
		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
			goto nla_put_failure;
10592

10593 10594
		if (nl80211_send_wowlan_patterns(msg, rdev))
			goto nla_put_failure;
10595

10596 10597
		if (nl80211_send_wowlan_tcp(msg,
					    rdev->wiphy.wowlan_config->tcp))
10598
			goto nla_put_failure;
10599 10600 10601 10602 10603

		if (nl80211_send_wowlan_nd(
			    msg,
			    rdev->wiphy.wowlan_config->nd_config))
			goto nla_put_failure;
10604

J
Johannes Berg 已提交
10605 10606 10607 10608 10609 10610 10611 10612 10613 10614 10615
		nla_nest_end(msg, nl_wowlan);
	}

	genlmsg_end(msg, hdr);
	return genlmsg_reply(msg, info);

nla_put_failure:
	nlmsg_free(msg);
	return -ENOBUFS;
}

10616 10617 10618 10619 10620 10621 10622 10623 10624 10625 10626 10627
static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
				    struct nlattr *attr,
				    struct cfg80211_wowlan *trig)
{
	struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
	struct cfg80211_wowlan_tcp *cfg;
	struct nl80211_wowlan_tcp_data_token *tok = NULL;
	struct nl80211_wowlan_tcp_data_seq *seq = NULL;
	u32 size;
	u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
	int err, port;

10628
	if (!rdev->wiphy.wowlan->tcp)
10629 10630
		return -EINVAL;

10631
	err = nla_parse_nested(tb, MAX_NL80211_WOWLAN_TCP, attr,
10632
			       nl80211_wowlan_tcp_policy, NULL);
10633 10634 10635 10636 10637 10638 10639 10640 10641 10642 10643 10644 10645 10646
	if (err)
		return err;

	if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
	    !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
	    !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
	    !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
	    !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
	    !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
	    !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
	    !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
		return -EINVAL;

	data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
10647
	if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
10648 10649 10650
		return -EINVAL;

	if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
10651
			rdev->wiphy.wowlan->tcp->data_interval_max ||
10652
	    nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
10653 10654 10655
		return -EINVAL;

	wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
10656
	if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
10657 10658 10659 10660 10661 10662 10663 10664 10665 10666 10667 10668 10669 10670
		return -EINVAL;

	wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
	if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
		return -EINVAL;

	if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
		u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);

		tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
		tokens_size = tokln - sizeof(*tok);

		if (!tok->len || tokens_size % tok->len)
			return -EINVAL;
10671
		if (!rdev->wiphy.wowlan->tcp->tok)
10672
			return -EINVAL;
10673
		if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
10674
			return -EINVAL;
10675
		if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
10676
			return -EINVAL;
10677
		if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
10678 10679 10680 10681 10682 10683 10684
			return -EINVAL;
		if (tok->offset + tok->len > data_size)
			return -EINVAL;
	}

	if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
		seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
10685
		if (!rdev->wiphy.wowlan->tcp->seq)
10686 10687 10688 10689 10690 10691 10692 10693 10694 10695 10696 10697 10698 10699 10700
			return -EINVAL;
		if (seq->len == 0 || seq->len > 4)
			return -EINVAL;
		if (seq->len + seq->offset > data_size)
			return -EINVAL;
	}

	size = sizeof(*cfg);
	size += data_size;
	size += wake_size + wake_mask_size;
	size += tokens_size;

	cfg = kzalloc(size, GFP_KERNEL);
	if (!cfg)
		return -ENOMEM;
10701 10702
	cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
	cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
10703 10704 10705 10706 10707 10708 10709 10710 10711 10712 10713 10714 10715 10716 10717 10718 10719 10720 10721 10722 10723 10724 10725 10726 10727 10728 10729 10730 10731 10732 10733 10734 10735 10736 10737 10738 10739 10740 10741 10742 10743 10744 10745 10746 10747 10748 10749 10750 10751 10752 10753 10754 10755 10756 10757 10758 10759
	memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
	       ETH_ALEN);
	if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
		port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
	else
		port = 0;
#ifdef CONFIG_INET
	/* allocate a socket and port for it and use it */
	err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
			    IPPROTO_TCP, &cfg->sock, 1);
	if (err) {
		kfree(cfg);
		return err;
	}
	if (inet_csk_get_port(cfg->sock->sk, port)) {
		sock_release(cfg->sock);
		kfree(cfg);
		return -EADDRINUSE;
	}
	cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
#else
	if (!port) {
		kfree(cfg);
		return -EINVAL;
	}
	cfg->src_port = port;
#endif

	cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
	cfg->payload_len = data_size;
	cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
	memcpy((void *)cfg->payload,
	       nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
	       data_size);
	if (seq)
		cfg->payload_seq = *seq;
	cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
	cfg->wake_len = wake_size;
	cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
	memcpy((void *)cfg->wake_data,
	       nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
	       wake_size);
	cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
			 data_size + wake_size;
	memcpy((void *)cfg->wake_mask,
	       nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
	       wake_mask_size);
	if (tok) {
		cfg->tokens_size = tokens_size;
		memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
	}

	trig->tcp = cfg;

	return 0;
}

10760 10761 10762 10763 10764 10765 10766 10767 10768 10769 10770 10771 10772 10773 10774 10775 10776
static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
				   const struct wiphy_wowlan_support *wowlan,
				   struct nlattr *attr,
				   struct cfg80211_wowlan *trig)
{
	struct nlattr **tb;
	int err;

	tb = kzalloc(NUM_NL80211_ATTR * sizeof(*tb), GFP_KERNEL);
	if (!tb)
		return -ENOMEM;

	if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
		err = -EOPNOTSUPP;
		goto out;
	}

10777 10778
	err = nla_parse_nested(tb, NL80211_ATTR_MAX, attr, nl80211_policy,
			       NULL);
10779 10780 10781
	if (err)
		goto out;

10782 10783
	trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
						   wowlan->max_nd_match_sets);
10784 10785 10786 10787 10788 10789 10790 10791 10792
	err = PTR_ERR_OR_ZERO(trig->nd_config);
	if (err)
		trig->nd_config = NULL;

out:
	kfree(tb);
	return err;
}

J
Johannes Berg 已提交
10793 10794 10795 10796 10797
static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
	struct cfg80211_wowlan new_triggers = {};
10798
	struct cfg80211_wowlan *ntrig;
10799
	const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
J
Johannes Berg 已提交
10800
	int err, i;
10801
	bool prev_enabled = rdev->wiphy.wowlan_config;
10802
	bool regular = false;
J
Johannes Berg 已提交
10803

10804
	if (!wowlan)
J
Johannes Berg 已提交
10805 10806
		return -EOPNOTSUPP;

10807 10808
	if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
		cfg80211_rdev_free_wowlan(rdev);
10809
		rdev->wiphy.wowlan_config = NULL;
10810 10811
		goto set_wakeup;
	}
J
Johannes Berg 已提交
10812

10813 10814
	err = nla_parse_nested(tb, MAX_NL80211_WOWLAN_TRIG,
			       info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
10815
			       nl80211_wowlan_policy, info->extack);
J
Johannes Berg 已提交
10816 10817 10818 10819 10820 10821 10822 10823 10824 10825 10826 10827 10828
	if (err)
		return err;

	if (tb[NL80211_WOWLAN_TRIG_ANY]) {
		if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
			return -EINVAL;
		new_triggers.any = true;
	}

	if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
		if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
			return -EINVAL;
		new_triggers.disconnect = true;
10829
		regular = true;
J
Johannes Berg 已提交
10830 10831 10832 10833 10834 10835
	}

	if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
		if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
			return -EINVAL;
		new_triggers.magic_pkt = true;
10836
		regular = true;
J
Johannes Berg 已提交
10837 10838
	}

10839 10840 10841 10842 10843 10844 10845
	if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
		return -EINVAL;

	if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
		if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
			return -EINVAL;
		new_triggers.gtk_rekey_failure = true;
10846
		regular = true;
10847 10848 10849 10850 10851 10852
	}

	if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
		if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
			return -EINVAL;
		new_triggers.eap_identity_req = true;
10853
		regular = true;
10854 10855 10856 10857 10858 10859
	}

	if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
		if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
			return -EINVAL;
		new_triggers.four_way_handshake = true;
10860
		regular = true;
10861 10862 10863 10864 10865 10866
	}

	if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
		if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
			return -EINVAL;
		new_triggers.rfkill_release = true;
10867
		regular = true;
10868 10869
	}

J
Johannes Berg 已提交
10870 10871 10872
	if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
		struct nlattr *pat;
		int n_patterns = 0;
10873
		int rem, pat_len, mask_len, pkt_offset;
10874
		struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
J
Johannes Berg 已提交
10875

10876 10877
		regular = true;

J
Johannes Berg 已提交
10878 10879 10880 10881 10882 10883 10884 10885 10886 10887 10888 10889 10890 10891 10892 10893 10894
		nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
				    rem)
			n_patterns++;
		if (n_patterns > wowlan->n_patterns)
			return -EINVAL;

		new_triggers.patterns = kcalloc(n_patterns,
						sizeof(new_triggers.patterns[0]),
						GFP_KERNEL);
		if (!new_triggers.patterns)
			return -ENOMEM;

		new_triggers.n_patterns = n_patterns;
		i = 0;

		nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
				    rem) {
10895 10896
			u8 *mask_pat;

10897
			nla_parse_nested(pat_tb, MAX_NL80211_PKTPAT, pat,
10898 10899
					 nl80211_packet_pattern_policy,
					 info->extack);
J
Johannes Berg 已提交
10900
			err = -EINVAL;
10901 10902
			if (!pat_tb[NL80211_PKTPAT_MASK] ||
			    !pat_tb[NL80211_PKTPAT_PATTERN])
J
Johannes Berg 已提交
10903
				goto error;
10904
			pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
J
Johannes Berg 已提交
10905
			mask_len = DIV_ROUND_UP(pat_len, 8);
10906
			if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
J
Johannes Berg 已提交
10907 10908 10909 10910 10911
				goto error;
			if (pat_len > wowlan->pattern_max_len ||
			    pat_len < wowlan->pattern_min_len)
				goto error;

10912
			if (!pat_tb[NL80211_PKTPAT_OFFSET])
10913 10914 10915
				pkt_offset = 0;
			else
				pkt_offset = nla_get_u32(
10916
					pat_tb[NL80211_PKTPAT_OFFSET]);
10917 10918 10919 10920
			if (pkt_offset > wowlan->max_pkt_offset)
				goto error;
			new_triggers.patterns[i].pkt_offset = pkt_offset;

10921 10922
			mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
			if (!mask_pat) {
J
Johannes Berg 已提交
10923 10924 10925
				err = -ENOMEM;
				goto error;
			}
10926 10927
			new_triggers.patterns[i].mask = mask_pat;
			memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
J
Johannes Berg 已提交
10928
			       mask_len);
10929 10930
			mask_pat += mask_len;
			new_triggers.patterns[i].pattern = mask_pat;
J
Johannes Berg 已提交
10931
			new_triggers.patterns[i].pattern_len = pat_len;
10932
			memcpy(mask_pat,
10933
			       nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
J
Johannes Berg 已提交
10934 10935 10936 10937 10938
			       pat_len);
			i++;
		}
	}

10939
	if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
10940
		regular = true;
10941 10942 10943 10944 10945 10946 10947
		err = nl80211_parse_wowlan_tcp(
			rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
			&new_triggers);
		if (err)
			goto error;
	}

10948
	if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
10949
		regular = true;
10950 10951 10952 10953 10954 10955 10956
		err = nl80211_parse_wowlan_nd(
			rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
			&new_triggers);
		if (err)
			goto error;
	}

10957 10958 10959 10960 10961 10962 10963 10964 10965 10966 10967
	/* The 'any' trigger means the device continues operating more or less
	 * as in its normal operation mode and wakes up the host on most of the
	 * normal interrupts (like packet RX, ...)
	 * It therefore makes little sense to combine with the more constrained
	 * wakeup trigger modes.
	 */
	if (new_triggers.any && regular) {
		err = -EINVAL;
		goto error;
	}

10968 10969 10970 10971
	ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
	if (!ntrig) {
		err = -ENOMEM;
		goto error;
J
Johannes Berg 已提交
10972
	}
10973
	cfg80211_rdev_free_wowlan(rdev);
10974
	rdev->wiphy.wowlan_config = ntrig;
J
Johannes Berg 已提交
10975

10976
 set_wakeup:
10977 10978 10979
	if (rdev->ops->set_wakeup &&
	    prev_enabled != !!rdev->wiphy.wowlan_config)
		rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
10980

J
Johannes Berg 已提交
10981 10982 10983 10984 10985
	return 0;
 error:
	for (i = 0; i < new_triggers.n_patterns; i++)
		kfree(new_triggers.patterns[i].mask);
	kfree(new_triggers.patterns);
10986 10987 10988
	if (new_triggers.tcp && new_triggers.tcp->sock)
		sock_release(new_triggers.tcp->sock);
	kfree(new_triggers.tcp);
10989
	kfree(new_triggers.nd_config);
J
Johannes Berg 已提交
10990 10991
	return err;
}
10992
#endif
J
Johannes Berg 已提交
10993

10994 10995 10996 10997 10998 10999 11000 11001 11002 11003 11004 11005 11006 11007 11008 11009 11010 11011 11012 11013 11014 11015 11016 11017 11018 11019 11020 11021 11022 11023 11024 11025 11026 11027 11028 11029 11030 11031 11032 11033 11034 11035 11036 11037 11038 11039 11040 11041 11042 11043 11044 11045 11046 11047 11048 11049 11050 11051 11052 11053 11054 11055 11056 11057 11058 11059 11060 11061 11062 11063 11064 11065 11066 11067 11068 11069 11070 11071 11072 11073 11074 11075 11076 11077 11078 11079 11080 11081 11082 11083 11084 11085 11086 11087 11088 11089 11090 11091 11092 11093 11094 11095 11096 11097 11098 11099 11100 11101 11102 11103 11104 11105 11106 11107 11108
static int nl80211_send_coalesce_rules(struct sk_buff *msg,
				       struct cfg80211_registered_device *rdev)
{
	struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
	int i, j, pat_len;
	struct cfg80211_coalesce_rules *rule;

	if (!rdev->coalesce->n_rules)
		return 0;

	nl_rules = nla_nest_start(msg, NL80211_ATTR_COALESCE_RULE);
	if (!nl_rules)
		return -ENOBUFS;

	for (i = 0; i < rdev->coalesce->n_rules; i++) {
		nl_rule = nla_nest_start(msg, i + 1);
		if (!nl_rule)
			return -ENOBUFS;

		rule = &rdev->coalesce->rules[i];
		if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
				rule->delay))
			return -ENOBUFS;

		if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
				rule->condition))
			return -ENOBUFS;

		nl_pats = nla_nest_start(msg,
				NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
		if (!nl_pats)
			return -ENOBUFS;

		for (j = 0; j < rule->n_patterns; j++) {
			nl_pat = nla_nest_start(msg, j + 1);
			if (!nl_pat)
				return -ENOBUFS;
			pat_len = rule->patterns[j].pattern_len;
			if (nla_put(msg, NL80211_PKTPAT_MASK,
				    DIV_ROUND_UP(pat_len, 8),
				    rule->patterns[j].mask) ||
			    nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
				    rule->patterns[j].pattern) ||
			    nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
					rule->patterns[j].pkt_offset))
				return -ENOBUFS;
			nla_nest_end(msg, nl_pat);
		}
		nla_nest_end(msg, nl_pats);
		nla_nest_end(msg, nl_rule);
	}
	nla_nest_end(msg, nl_rules);

	return 0;
}

static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct sk_buff *msg;
	void *hdr;

	if (!rdev->wiphy.coalesce)
		return -EOPNOTSUPP;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg)
		return -ENOMEM;

	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
			     NL80211_CMD_GET_COALESCE);
	if (!hdr)
		goto nla_put_failure;

	if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
		goto nla_put_failure;

	genlmsg_end(msg, hdr);
	return genlmsg_reply(msg, info);

nla_put_failure:
	nlmsg_free(msg);
	return -ENOBUFS;
}

void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
{
	struct cfg80211_coalesce *coalesce = rdev->coalesce;
	int i, j;
	struct cfg80211_coalesce_rules *rule;

	if (!coalesce)
		return;

	for (i = 0; i < coalesce->n_rules; i++) {
		rule = &coalesce->rules[i];
		for (j = 0; j < rule->n_patterns; j++)
			kfree(rule->patterns[j].mask);
		kfree(rule->patterns);
	}
	kfree(coalesce->rules);
	kfree(coalesce);
	rdev->coalesce = NULL;
}

static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
				       struct nlattr *rule,
				       struct cfg80211_coalesce_rules *new_rule)
{
	int err, i;
	const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
	struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
	int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
	struct nlattr *pat_tb[NUM_NL80211_PKTPAT];

11109
	err = nla_parse_nested(tb, NL80211_ATTR_COALESCE_RULE_MAX, rule,
11110
			       nl80211_coalesce_policy, NULL);
11111 11112 11113 11114 11115 11116 11117 11118 11119 11120 11121 11122 11123 11124 11125 11126 11127 11128 11129 11130 11131 11132 11133 11134 11135 11136 11137 11138 11139 11140 11141 11142 11143 11144 11145
	if (err)
		return err;

	if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
		new_rule->delay =
			nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
	if (new_rule->delay > coalesce->max_delay)
		return -EINVAL;

	if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
		new_rule->condition =
			nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
	if (new_rule->condition != NL80211_COALESCE_CONDITION_MATCH &&
	    new_rule->condition != NL80211_COALESCE_CONDITION_NO_MATCH)
		return -EINVAL;

	if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
		return -EINVAL;

	nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
			    rem)
		n_patterns++;
	if (n_patterns > coalesce->n_patterns)
		return -EINVAL;

	new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
				     GFP_KERNEL);
	if (!new_rule->patterns)
		return -ENOMEM;

	new_rule->n_patterns = n_patterns;
	i = 0;

	nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
			    rem) {
11146 11147
		u8 *mask_pat;

11148 11149
		nla_parse_nested(pat_tb, MAX_NL80211_PKTPAT, pat,
				 nl80211_packet_pattern_policy, NULL);
11150 11151 11152 11153 11154 11155 11156 11157 11158 11159 11160 11161 11162 11163 11164 11165 11166 11167 11168
		if (!pat_tb[NL80211_PKTPAT_MASK] ||
		    !pat_tb[NL80211_PKTPAT_PATTERN])
			return -EINVAL;
		pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
		mask_len = DIV_ROUND_UP(pat_len, 8);
		if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
			return -EINVAL;
		if (pat_len > coalesce->pattern_max_len ||
		    pat_len < coalesce->pattern_min_len)
			return -EINVAL;

		if (!pat_tb[NL80211_PKTPAT_OFFSET])
			pkt_offset = 0;
		else
			pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
		if (pkt_offset > coalesce->max_pkt_offset)
			return -EINVAL;
		new_rule->patterns[i].pkt_offset = pkt_offset;

11169 11170
		mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
		if (!mask_pat)
11171
			return -ENOMEM;
11172 11173 11174 11175 11176 11177 11178

		new_rule->patterns[i].mask = mask_pat;
		memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
		       mask_len);

		mask_pat += mask_len;
		new_rule->patterns[i].pattern = mask_pat;
11179
		new_rule->patterns[i].pattern_len = pat_len;
11180 11181
		memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
		       pat_len);
11182 11183 11184 11185 11186 11187 11188 11189 11190 11191 11192 11193 11194 11195 11196 11197 11198 11199 11200 11201 11202
		i++;
	}

	return 0;
}

static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
	struct cfg80211_coalesce new_coalesce = {};
	struct cfg80211_coalesce *n_coalesce;
	int err, rem_rule, n_rules = 0, i, j;
	struct nlattr *rule;
	struct cfg80211_coalesce_rules *tmp_rule;

	if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
		return -EOPNOTSUPP;

	if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
		cfg80211_rdev_free_coalesce(rdev);
11203
		rdev_set_coalesce(rdev, NULL);
11204 11205 11206 11207 11208 11209 11210 11211 11212 11213 11214 11215 11216 11217 11218 11219 11220 11221 11222 11223 11224 11225 11226 11227 11228 11229 11230
		return 0;
	}

	nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
			    rem_rule)
		n_rules++;
	if (n_rules > coalesce->n_rules)
		return -EINVAL;

	new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
				     GFP_KERNEL);
	if (!new_coalesce.rules)
		return -ENOMEM;

	new_coalesce.n_rules = n_rules;
	i = 0;

	nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
			    rem_rule) {
		err = nl80211_parse_coalesce_rule(rdev, rule,
						  &new_coalesce.rules[i]);
		if (err)
			goto error;

		i++;
	}

11231
	err = rdev_set_coalesce(rdev, &new_coalesce);
11232 11233 11234 11235 11236 11237 11238 11239 11240 11241 11242 11243 11244 11245 11246 11247 11248 11249 11250 11251 11252 11253 11254 11255
	if (err)
		goto error;

	n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
	if (!n_coalesce) {
		err = -ENOMEM;
		goto error;
	}
	cfg80211_rdev_free_coalesce(rdev);
	rdev->coalesce = n_coalesce;

	return 0;
error:
	for (i = 0; i < new_coalesce.n_rules; i++) {
		tmp_rule = &new_coalesce.rules[i];
		for (j = 0; j < tmp_rule->n_patterns; j++)
			kfree(tmp_rule->patterns[j].mask);
		kfree(tmp_rule->patterns);
	}
	kfree(new_coalesce.rules);

	return err;
}

11256 11257 11258 11259 11260 11261 11262 11263 11264 11265 11266 11267
static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct nlattr *tb[NUM_NL80211_REKEY_DATA];
	struct cfg80211_gtk_rekey_data rekey_data;
	int err;

	if (!info->attrs[NL80211_ATTR_REKEY_DATA])
		return -EINVAL;

11268 11269
	err = nla_parse_nested(tb, MAX_NL80211_REKEY_DATA,
			       info->attrs[NL80211_ATTR_REKEY_DATA],
11270
			       nl80211_rekey_policy, info->extack);
11271 11272 11273
	if (err)
		return err;

11274 11275 11276
	if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] ||
	    !tb[NL80211_REKEY_DATA_KCK])
		return -EINVAL;
11277 11278 11279 11280 11281 11282 11283
	if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
		return -ERANGE;
	if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
		return -ERANGE;
	if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
		return -ERANGE;

11284 11285 11286
	rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
	rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
	rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
11287 11288 11289 11290 11291 11292 11293 11294 11295 11296 11297 11298

	wdev_lock(wdev);
	if (!wdev->current_bss) {
		err = -ENOTCONN;
		goto out;
	}

	if (!rdev->ops->set_rekey_data) {
		err = -EOPNOTSUPP;
		goto out;
	}

11299
	err = rdev_set_rekey_data(rdev, dev, &rekey_data);
11300 11301 11302 11303 11304
 out:
	wdev_unlock(wdev);
	return err;
}

11305 11306 11307 11308 11309 11310 11311 11312 11313 11314
static int nl80211_register_unexpected_frame(struct sk_buff *skb,
					     struct genl_info *info)
{
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;

	if (wdev->iftype != NL80211_IFTYPE_AP &&
	    wdev->iftype != NL80211_IFTYPE_P2P_GO)
		return -EINVAL;

11315
	if (wdev->ap_unexpected_nlportid)
11316 11317
		return -EBUSY;

11318
	wdev->ap_unexpected_nlportid = info->snd_portid;
11319 11320 11321
	return 0;
}

J
Johannes Berg 已提交
11322 11323 11324 11325 11326 11327 11328 11329 11330 11331 11332 11333 11334 11335 11336 11337 11338 11339 11340 11341 11342 11343 11344 11345 11346 11347
static int nl80211_probe_client(struct sk_buff *skb,
				struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct sk_buff *msg;
	void *hdr;
	const u8 *addr;
	u64 cookie;
	int err;

	if (wdev->iftype != NL80211_IFTYPE_AP &&
	    wdev->iftype != NL80211_IFTYPE_P2P_GO)
		return -EOPNOTSUPP;

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	if (!rdev->ops->probe_client)
		return -EOPNOTSUPP;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg)
		return -ENOMEM;

11348
	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
J
Johannes Berg 已提交
11349
			     NL80211_CMD_PROBE_CLIENT);
11350 11351
	if (!hdr) {
		err = -ENOBUFS;
J
Johannes Berg 已提交
11352 11353 11354 11355 11356
		goto free_msg;
	}

	addr = nla_data(info->attrs[NL80211_ATTR_MAC]);

11357
	err = rdev_probe_client(rdev, dev, addr, &cookie);
J
Johannes Berg 已提交
11358 11359 11360
	if (err)
		goto free_msg;

11361 11362
	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
			      NL80211_ATTR_PAD))
11363
		goto nla_put_failure;
J
Johannes Berg 已提交
11364 11365 11366 11367 11368 11369 11370 11371 11372 11373 11374 11375

	genlmsg_end(msg, hdr);

	return genlmsg_reply(msg, info);

 nla_put_failure:
	err = -ENOBUFS;
 free_msg:
	nlmsg_free(msg);
	return err;
}

11376 11377 11378
static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11379 11380
	struct cfg80211_beacon_registration *reg, *nreg;
	int rv;
11381 11382 11383 11384

	if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
		return -EOPNOTSUPP;

11385 11386 11387 11388 11389 11390 11391 11392 11393 11394 11395 11396 11397 11398 11399
	nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
	if (!nreg)
		return -ENOMEM;

	/* First, check if already registered. */
	spin_lock_bh(&rdev->beacon_registrations_lock);
	list_for_each_entry(reg, &rdev->beacon_registrations, list) {
		if (reg->nlportid == info->snd_portid) {
			rv = -EALREADY;
			goto out_err;
		}
	}
	/* Add it to the list */
	nreg->nlportid = info->snd_portid;
	list_add(&nreg->list, &rdev->beacon_registrations);
11400

11401
	spin_unlock_bh(&rdev->beacon_registrations_lock);
11402 11403

	return 0;
11404 11405 11406 11407
out_err:
	spin_unlock_bh(&rdev->beacon_registrations_lock);
	kfree(nreg);
	return rv;
11408 11409
}

11410 11411 11412 11413 11414 11415 11416 11417 11418 11419 11420 11421
static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev = info->user_ptr[1];
	int err;

	if (!rdev->ops->start_p2p_device)
		return -EOPNOTSUPP;

	if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
		return -EOPNOTSUPP;

11422
	if (wdev_running(wdev))
11423 11424
		return 0;

11425 11426
	if (rfkill_blocked(rdev->rfkill))
		return -ERFKILL;
11427

11428
	err = rdev_start_p2p_device(rdev, wdev);
11429 11430 11431
	if (err)
		return err;

11432
	wdev->is_running = true;
11433 11434 11435 11436 11437 11438 11439 11440 11441 11442 11443 11444 11445 11446 11447 11448
	rdev->opencount++;

	return 0;
}

static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev = info->user_ptr[1];

	if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
		return -EOPNOTSUPP;

	if (!rdev->ops->stop_p2p_device)
		return -EOPNOTSUPP;

11449
	cfg80211_stop_p2p_device(rdev, wdev);
11450 11451 11452 11453

	return 0;
}

11454 11455 11456 11457 11458 11459 11460 11461 11462 11463
static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev = info->user_ptr[1];
	struct cfg80211_nan_conf conf = {};
	int err;

	if (wdev->iftype != NL80211_IFTYPE_NAN)
		return -EOPNOTSUPP;

11464
	if (wdev_running(wdev))
11465 11466 11467 11468 11469 11470 11471 11472 11473 11474 11475 11476 11477
		return -EEXIST;

	if (rfkill_blocked(rdev->rfkill))
		return -ERFKILL;

	if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
		return -EINVAL;

	conf.master_pref =
		nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
	if (!conf.master_pref)
		return -EINVAL;

L
Luca Coelho 已提交
11478 11479 11480 11481 11482 11483 11484 11485 11486 11487 11488
	if (info->attrs[NL80211_ATTR_BANDS]) {
		u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);

		if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
			return -EOPNOTSUPP;

		if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
			return -EINVAL;

		conf.bands = bands;
	}
11489 11490 11491 11492 11493

	err = rdev_start_nan(rdev, wdev, &conf);
	if (err)
		return err;

11494
	wdev->is_running = true;
11495 11496 11497 11498 11499 11500 11501 11502 11503 11504 11505 11506 11507 11508 11509 11510 11511 11512
	rdev->opencount++;

	return 0;
}

static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev = info->user_ptr[1];

	if (wdev->iftype != NL80211_IFTYPE_NAN)
		return -EOPNOTSUPP;

	cfg80211_stop_nan(rdev, wdev);

	return 0;
}

11513 11514 11515 11516 11517 11518 11519 11520 11521 11522 11523 11524 11525 11526 11527 11528 11529 11530 11531 11532 11533 11534 11535 11536 11537 11538 11539 11540 11541 11542 11543 11544 11545 11546 11547 11548
static int validate_nan_filter(struct nlattr *filter_attr)
{
	struct nlattr *attr;
	int len = 0, n_entries = 0, rem;

	nla_for_each_nested(attr, filter_attr, rem) {
		len += nla_len(attr);
		n_entries++;
	}

	if (len >= U8_MAX)
		return -EINVAL;

	return n_entries;
}

static int handle_nan_filter(struct nlattr *attr_filter,
			     struct cfg80211_nan_func *func,
			     bool tx)
{
	struct nlattr *attr;
	int n_entries, rem, i;
	struct cfg80211_nan_func_filter *filter;

	n_entries = validate_nan_filter(attr_filter);
	if (n_entries < 0)
		return n_entries;

	BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));

	filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
	if (!filter)
		return -ENOMEM;

	i = 0;
	nla_for_each_nested(attr, attr_filter, rem) {
11549
		filter[i].filter = nla_memdup(attr, GFP_KERNEL);
11550 11551 11552 11553 11554 11555 11556 11557 11558 11559 11560 11561 11562 11563 11564 11565 11566 11567 11568 11569 11570 11571 11572 11573 11574 11575 11576 11577
		filter[i].len = nla_len(attr);
		i++;
	}
	if (tx) {
		func->num_tx_filters = n_entries;
		func->tx_filters = filter;
	} else {
		func->num_rx_filters = n_entries;
		func->rx_filters = filter;
	}

	return 0;
}

static int nl80211_nan_add_func(struct sk_buff *skb,
				struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev = info->user_ptr[1];
	struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
	struct cfg80211_nan_func *func;
	struct sk_buff *msg = NULL;
	void *hdr = NULL;
	int err = 0;

	if (wdev->iftype != NL80211_IFTYPE_NAN)
		return -EOPNOTSUPP;

11578
	if (!wdev_running(wdev))
11579 11580 11581 11582 11583
		return -ENOTCONN;

	if (!info->attrs[NL80211_ATTR_NAN_FUNC])
		return -EINVAL;

11584 11585
	err = nla_parse_nested(tb, NL80211_NAN_FUNC_ATTR_MAX,
			       info->attrs[NL80211_ATTR_NAN_FUNC],
11586
			       nl80211_nan_func_policy, info->extack);
11587 11588 11589 11590 11591 11592 11593 11594 11595 11596 11597 11598 11599 11600 11601 11602 11603 11604 11605 11606 11607 11608 11609 11610 11611 11612 11613 11614 11615 11616 11617 11618 11619 11620 11621 11622 11623 11624 11625 11626 11627 11628 11629 11630 11631 11632 11633 11634 11635 11636 11637 11638 11639 11640 11641 11642 11643 11644 11645 11646 11647 11648 11649 11650 11651 11652 11653 11654 11655
	if (err)
		return err;

	func = kzalloc(sizeof(*func), GFP_KERNEL);
	if (!func)
		return -ENOMEM;

	func->cookie = wdev->wiphy->cookie_counter++;

	if (!tb[NL80211_NAN_FUNC_TYPE] ||
	    nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
		err = -EINVAL;
		goto out;
	}


	func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);

	if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
		err = -EINVAL;
		goto out;
	}

	memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
	       sizeof(func->service_id));

	func->close_range =
		nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);

	if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
		func->serv_spec_info_len =
			nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
		func->serv_spec_info =
			kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
				func->serv_spec_info_len,
				GFP_KERNEL);
		if (!func->serv_spec_info) {
			err = -ENOMEM;
			goto out;
		}
	}

	if (tb[NL80211_NAN_FUNC_TTL])
		func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);

	switch (func->type) {
	case NL80211_NAN_FUNC_PUBLISH:
		if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
			err = -EINVAL;
			goto out;
		}

		func->publish_type =
			nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
		func->publish_bcast =
			nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);

		if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
			func->publish_bcast) {
			err = -EINVAL;
			goto out;
		}
		break;
	case NL80211_NAN_FUNC_SUBSCRIBE:
		func->subscribe_active =
			nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
		break;
	case NL80211_NAN_FUNC_FOLLOW_UP:
		if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
11656 11657
		    !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
		    !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
11658 11659 11660 11661 11662 11663 11664 11665 11666 11667 11668 11669 11670 11671 11672 11673 11674 11675 11676 11677 11678 11679 11680 11681
			err = -EINVAL;
			goto out;
		}

		func->followup_id =
			nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
		func->followup_reqid =
			nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
		memcpy(func->followup_dest.addr,
		       nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
		       sizeof(func->followup_dest.addr));
		if (func->ttl) {
			err = -EINVAL;
			goto out;
		}
		break;
	default:
		err = -EINVAL;
		goto out;
	}

	if (tb[NL80211_NAN_FUNC_SRF]) {
		struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];

11682 11683
		err = nla_parse_nested(srf_tb, NL80211_NAN_SRF_ATTR_MAX,
				       tb[NL80211_NAN_FUNC_SRF],
11684
				       nl80211_nan_srf_policy, info->extack);
11685 11686 11687 11688 11689 11690 11691 11692 11693 11694 11695 11696 11697 11698 11699 11700 11701 11702 11703 11704 11705 11706 11707 11708 11709 11710 11711 11712 11713 11714 11715 11716 11717 11718 11719 11720 11721 11722 11723 11724 11725 11726 11727 11728 11729 11730 11731 11732 11733 11734 11735 11736 11737 11738 11739 11740 11741 11742 11743 11744 11745 11746 11747 11748 11749 11750 11751 11752 11753 11754 11755 11756 11757 11758 11759 11760 11761 11762 11763 11764 11765 11766 11767 11768 11769 11770 11771 11772 11773 11774 11775 11776 11777 11778 11779 11780 11781 11782 11783 11784 11785 11786 11787 11788 11789 11790 11791 11792 11793 11794 11795 11796 11797 11798 11799 11800 11801 11802 11803 11804 11805 11806 11807 11808 11809
		if (err)
			goto out;

		func->srf_include =
			nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);

		if (srf_tb[NL80211_NAN_SRF_BF]) {
			if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
			    !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
				err = -EINVAL;
				goto out;
			}

			func->srf_bf_len =
				nla_len(srf_tb[NL80211_NAN_SRF_BF]);
			func->srf_bf =
				kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
					func->srf_bf_len, GFP_KERNEL);
			if (!func->srf_bf) {
				err = -ENOMEM;
				goto out;
			}

			func->srf_bf_idx =
				nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
		} else {
			struct nlattr *attr, *mac_attr =
				srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
			int n_entries, rem, i = 0;

			if (!mac_attr) {
				err = -EINVAL;
				goto out;
			}

			n_entries = validate_acl_mac_addrs(mac_attr);
			if (n_entries <= 0) {
				err = -EINVAL;
				goto out;
			}

			func->srf_num_macs = n_entries;
			func->srf_macs =
				kzalloc(sizeof(*func->srf_macs) * n_entries,
					GFP_KERNEL);
			if (!func->srf_macs) {
				err = -ENOMEM;
				goto out;
			}

			nla_for_each_nested(attr, mac_attr, rem)
				memcpy(func->srf_macs[i++].addr, nla_data(attr),
				       sizeof(*func->srf_macs));
		}
	}

	if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
		err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
					func, true);
		if (err)
			goto out;
	}

	if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
		err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
					func, false);
		if (err)
			goto out;
	}

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg) {
		err = -ENOMEM;
		goto out;
	}

	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
			     NL80211_CMD_ADD_NAN_FUNCTION);
	/* This can't really happen - we just allocated 4KB */
	if (WARN_ON(!hdr)) {
		err = -ENOMEM;
		goto out;
	}

	err = rdev_add_nan_func(rdev, wdev, func);
out:
	if (err < 0) {
		cfg80211_free_nan_func(func);
		nlmsg_free(msg);
		return err;
	}

	/* propagate the instance id and cookie to userspace  */
	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
			      NL80211_ATTR_PAD))
		goto nla_put_failure;

	func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
	if (!func_attr)
		goto nla_put_failure;

	if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
		       func->instance_id))
		goto nla_put_failure;

	nla_nest_end(msg, func_attr);

	genlmsg_end(msg, hdr);
	return genlmsg_reply(msg, info);

nla_put_failure:
	nlmsg_free(msg);
	return -ENOBUFS;
}

static int nl80211_nan_del_func(struct sk_buff *skb,
			       struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev = info->user_ptr[1];
	u64 cookie;

	if (wdev->iftype != NL80211_IFTYPE_NAN)
		return -EOPNOTSUPP;

11810
	if (!wdev_running(wdev))
11811 11812 11813 11814 11815 11816 11817 11818 11819 11820 11821 11822
		return -ENOTCONN;

	if (!info->attrs[NL80211_ATTR_COOKIE])
		return -EINVAL;

	cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);

	rdev_del_nan_func(rdev, wdev, cookie);

	return 0;
}

11823 11824 11825 11826 11827 11828 11829 11830 11831 11832 11833
static int nl80211_nan_change_config(struct sk_buff *skb,
				     struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev = info->user_ptr[1];
	struct cfg80211_nan_conf conf = {};
	u32 changed = 0;

	if (wdev->iftype != NL80211_IFTYPE_NAN)
		return -EOPNOTSUPP;

11834
	if (!wdev_running(wdev))
11835 11836 11837 11838 11839 11840 11841 11842 11843 11844 11845
		return -ENOTCONN;

	if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
		conf.master_pref =
			nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
		if (conf.master_pref <= 1 || conf.master_pref == 255)
			return -EINVAL;

		changed |= CFG80211_NAN_CONF_CHANGED_PREF;
	}

L
Luca Coelho 已提交
11846 11847 11848 11849 11850 11851 11852 11853 11854 11855 11856
	if (info->attrs[NL80211_ATTR_BANDS]) {
		u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);

		if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
			return -EOPNOTSUPP;

		if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
			return -EINVAL;

		conf.bands = bands;
		changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
11857 11858 11859 11860 11861 11862 11863 11864
	}

	if (!changed)
		return -EINVAL;

	return rdev_nan_change_conf(rdev, wdev, &conf, changed);
}

11865 11866 11867 11868 11869 11870 11871 11872 11873 11874 11875 11876 11877 11878 11879 11880 11881 11882 11883 11884 11885 11886 11887 11888 11889 11890 11891 11892 11893 11894 11895 11896 11897 11898 11899 11900 11901 11902 11903 11904 11905 11906 11907 11908 11909 11910 11911 11912 11913 11914 11915 11916 11917 11918 11919 11920 11921 11922 11923 11924 11925 11926 11927 11928 11929 11930 11931 11932 11933 11934 11935 11936 11937 11938 11939 11940 11941 11942
void cfg80211_nan_match(struct wireless_dev *wdev,
			struct cfg80211_nan_match_params *match, gfp_t gfp)
{
	struct wiphy *wiphy = wdev->wiphy;
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
	struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
	struct sk_buff *msg;
	void *hdr;

	if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
		return;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
					 wdev->netdev->ifindex)) ||
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD))
		goto nla_put_failure;

	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
			      NL80211_ATTR_PAD) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
		goto nla_put_failure;

	match_attr = nla_nest_start(msg, NL80211_ATTR_NAN_MATCH);
	if (!match_attr)
		goto nla_put_failure;

	local_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_LOCAL);
	if (!local_func_attr)
		goto nla_put_failure;

	if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
		goto nla_put_failure;

	nla_nest_end(msg, local_func_attr);

	peer_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_PEER);
	if (!peer_func_attr)
		goto nla_put_failure;

	if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
	    nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
		goto nla_put_failure;

	if (match->info && match->info_len &&
	    nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
		    match->info))
		goto nla_put_failure;

	nla_nest_end(msg, peer_func_attr);
	nla_nest_end(msg, match_attr);
	genlmsg_end(msg, hdr);

	if (!wdev->owner_nlportid)
		genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
					msg, 0, NL80211_MCGRP_NAN, gfp);
	else
		genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
				wdev->owner_nlportid);

	return;

nla_put_failure:
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_nan_match);

11943 11944 11945 11946 11947 11948 11949 11950 11951 11952 11953 11954 11955 11956 11957 11958 11959 11960 11961 11962 11963 11964 11965 11966 11967 11968 11969 11970 11971 11972 11973 11974 11975 11976 11977 11978 11979 11980 11981 11982 11983 11984 11985 11986 11987 11988 11989 11990 11991 11992 11993 11994 11995 11996 11997 11998 11999 12000 12001 12002
void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
				  u8 inst_id,
				  enum nl80211_nan_func_term_reason reason,
				  u64 cookie, gfp_t gfp)
{
	struct wiphy *wiphy = wdev->wiphy;
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
	struct sk_buff *msg;
	struct nlattr *func_attr;
	void *hdr;

	if (WARN_ON(!inst_id))
		return;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
					 wdev->netdev->ifindex)) ||
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD))
		goto nla_put_failure;

	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
			      NL80211_ATTR_PAD))
		goto nla_put_failure;

	func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
	if (!func_attr)
		goto nla_put_failure;

	if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
	    nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
		goto nla_put_failure;

	nla_nest_end(msg, func_attr);
	genlmsg_end(msg, hdr);

	if (!wdev->owner_nlportid)
		genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
					msg, 0, NL80211_MCGRP_NAN, gfp);
	else
		genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
				wdev->owner_nlportid);

	return;

nla_put_failure:
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_nan_func_terminated);

12003 12004 12005 12006 12007 12008 12009 12010 12011 12012 12013 12014 12015 12016 12017 12018 12019 12020 12021 12022 12023 12024 12025 12026 12027 12028 12029
static int nl80211_get_protocol_features(struct sk_buff *skb,
					 struct genl_info *info)
{
	void *hdr;
	struct sk_buff *msg;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg)
		return -ENOMEM;

	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
			     NL80211_CMD_GET_PROTOCOL_FEATURES);
	if (!hdr)
		goto nla_put_failure;

	if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
			NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
		goto nla_put_failure;

	genlmsg_end(msg, hdr);
	return genlmsg_reply(msg, info);

 nla_put_failure:
	kfree_skb(msg);
	return -ENOBUFS;
}

12030 12031 12032 12033 12034 12035 12036 12037 12038 12039 12040 12041 12042 12043 12044 12045 12046 12047 12048 12049 12050
static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct cfg80211_update_ft_ies_params ft_params;
	struct net_device *dev = info->user_ptr[1];

	if (!rdev->ops->update_ft_ies)
		return -EOPNOTSUPP;

	if (!info->attrs[NL80211_ATTR_MDID] ||
	    !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
		return -EINVAL;

	memset(&ft_params, 0, sizeof(ft_params));
	ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
	ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
	ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);

	return rdev_update_ft_ies(rdev, dev, &ft_params);
}

12051 12052 12053 12054 12055 12056 12057 12058 12059 12060 12061 12062 12063 12064 12065 12066 12067 12068 12069 12070 12071 12072 12073 12074 12075 12076 12077 12078 12079 12080 12081 12082 12083 12084 12085 12086 12087 12088 12089 12090 12091 12092 12093 12094 12095 12096 12097 12098 12099 12100 12101 12102 12103 12104 12105 12106 12107 12108
static int nl80211_crit_protocol_start(struct sk_buff *skb,
				       struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev = info->user_ptr[1];
	enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
	u16 duration;
	int ret;

	if (!rdev->ops->crit_proto_start)
		return -EOPNOTSUPP;

	if (WARN_ON(!rdev->ops->crit_proto_stop))
		return -EINVAL;

	if (rdev->crit_proto_nlportid)
		return -EBUSY;

	/* determine protocol if provided */
	if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
		proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);

	if (proto >= NUM_NL80211_CRIT_PROTO)
		return -EINVAL;

	/* timeout must be provided */
	if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
		return -EINVAL;

	duration =
		nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);

	if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
		return -ERANGE;

	ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
	if (!ret)
		rdev->crit_proto_nlportid = info->snd_portid;

	return ret;
}

static int nl80211_crit_protocol_stop(struct sk_buff *skb,
				      struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev = info->user_ptr[1];

	if (!rdev->ops->crit_proto_stop)
		return -EOPNOTSUPP;

	if (rdev->crit_proto_nlportid) {
		rdev->crit_proto_nlportid = 0;
		rdev_crit_proto_stop(rdev, wdev);
	}
	return 0;
}

J
Johannes Berg 已提交
12109 12110 12111 12112 12113 12114 12115 12116 12117 12118 12119 12120 12121 12122 12123 12124 12125 12126 12127 12128 12129 12130 12131 12132 12133 12134 12135 12136 12137 12138 12139 12140 12141 12142 12143 12144 12145 12146 12147 12148 12149 12150 12151 12152 12153
static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct wireless_dev *wdev =
		__cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
	int i, err;
	u32 vid, subcmd;

	if (!rdev->wiphy.vendor_commands)
		return -EOPNOTSUPP;

	if (IS_ERR(wdev)) {
		err = PTR_ERR(wdev);
		if (err != -EINVAL)
			return err;
		wdev = NULL;
	} else if (wdev->wiphy != &rdev->wiphy) {
		return -EINVAL;
	}

	if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
	    !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
		return -EINVAL;

	vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
	subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
	for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
		const struct wiphy_vendor_command *vcmd;
		void *data = NULL;
		int len = 0;

		vcmd = &rdev->wiphy.vendor_commands[i];

		if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
			continue;

		if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
				   WIPHY_VENDOR_CMD_NEED_NETDEV)) {
			if (!wdev)
				return -EINVAL;
			if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
			    !wdev->netdev)
				return -EINVAL;

			if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
12154
				if (!wdev_running(wdev))
J
Johannes Berg 已提交
12155 12156
					return -ENETDOWN;
			}
12157 12158 12159

			if (!vcmd->doit)
				return -EOPNOTSUPP;
J
Johannes Berg 已提交
12160 12161 12162 12163 12164 12165 12166 12167 12168 12169 12170 12171 12172 12173 12174 12175 12176 12177 12178
		} else {
			wdev = NULL;
		}

		if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
			data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
			len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
		}

		rdev->cur_cmd_info = info;
		err = rdev->wiphy.vendor_commands[i].doit(&rdev->wiphy, wdev,
							  data, len);
		rdev->cur_cmd_info = NULL;
		return err;
	}

	return -EOPNOTSUPP;
}

12179 12180 12181 12182 12183
static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
				       struct netlink_callback *cb,
				       struct cfg80211_registered_device **rdev,
				       struct wireless_dev **wdev)
{
12184
	struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
12185 12186 12187 12188 12189 12190 12191 12192 12193 12194 12195 12196
	u32 vid, subcmd;
	unsigned int i;
	int vcmd_idx = -1;
	int err;
	void *data = NULL;
	unsigned int data_len = 0;

	if (cb->args[0]) {
		/* subtract the 1 again here */
		struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
		struct wireless_dev *tmp;

12197 12198
		if (!wiphy)
			return -ENODEV;
12199 12200 12201 12202
		*rdev = wiphy_to_rdev(wiphy);
		*wdev = NULL;

		if (cb->args[1]) {
12203
			list_for_each_entry(tmp, &wiphy->wdev_list, list) {
12204 12205 12206 12207 12208 12209 12210 12211 12212 12213 12214
				if (tmp->identifier == cb->args[1] - 1) {
					*wdev = tmp;
					break;
				}
			}
		}

		/* keep rtnl locked in successful case */
		return 0;
	}

12215 12216
	err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize, attrbuf,
			  nl80211_fam.maxattr, nl80211_policy, NULL);
12217
	if (err)
12218
		return err;
12219

12220
	if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
12221 12222
	    !attrbuf[NL80211_ATTR_VENDOR_SUBCMD])
		return -EINVAL;
12223

12224
	*wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk), attrbuf);
12225 12226 12227
	if (IS_ERR(*wdev))
		*wdev = NULL;

12228
	*rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
12229 12230
	if (IS_ERR(*rdev))
		return PTR_ERR(*rdev);
12231

12232 12233
	vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
	subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
12234 12235 12236 12237 12238 12239 12240 12241 12242

	for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
		const struct wiphy_vendor_command *vcmd;

		vcmd = &(*rdev)->wiphy.vendor_commands[i];

		if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
			continue;

12243 12244
		if (!vcmd->dumpit)
			return -EOPNOTSUPP;
12245 12246 12247 12248 12249

		vcmd_idx = i;
		break;
	}

12250 12251
	if (vcmd_idx < 0)
		return -EOPNOTSUPP;
12252

12253 12254 12255
	if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
		data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
		data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
12256 12257 12258 12259 12260 12261 12262 12263 12264 12265 12266 12267 12268 12269 12270 12271 12272 12273 12274 12275 12276 12277 12278 12279 12280 12281
	}

	/* 0 is the first index - add 1 to parse only once */
	cb->args[0] = (*rdev)->wiphy_idx + 1;
	/* add 1 to know if it was NULL */
	cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
	cb->args[2] = vcmd_idx;
	cb->args[3] = (unsigned long)data;
	cb->args[4] = data_len;

	/* keep rtnl locked in successful case */
	return 0;
}

static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
				   struct netlink_callback *cb)
{
	struct cfg80211_registered_device *rdev;
	struct wireless_dev *wdev;
	unsigned int vcmd_idx;
	const struct wiphy_vendor_command *vcmd;
	void *data;
	int data_len;
	int err;
	struct nlattr *vendor_data;

12282
	rtnl_lock();
12283 12284
	err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
	if (err)
12285
		goto out;
12286 12287 12288 12289 12290 12291 12292 12293

	vcmd_idx = cb->args[2];
	data = (void *)cb->args[3];
	data_len = cb->args[4];
	vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];

	if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
			   WIPHY_VENDOR_CMD_NEED_NETDEV)) {
12294 12295 12296 12297
		if (!wdev) {
			err = -EINVAL;
			goto out;
		}
12298
		if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
12299 12300 12301 12302
		    !wdev->netdev) {
			err = -EINVAL;
			goto out;
		}
12303 12304

		if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
12305 12306 12307 12308
			if (!wdev_running(wdev)) {
				err = -ENETDOWN;
				goto out;
			}
12309 12310 12311 12312 12313 12314 12315 12316 12317 12318 12319
		}
	}

	while (1) {
		void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
					   cb->nlh->nlmsg_seq, NLM_F_MULTI,
					   NL80211_CMD_VENDOR);
		if (!hdr)
			break;

		if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12320 12321 12322
		    (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
					       wdev_id(wdev),
					       NL80211_ATTR_PAD))) {
12323 12324 12325 12326 12327 12328 12329 12330 12331 12332 12333 12334 12335 12336 12337 12338 12339 12340 12341 12342 12343 12344 12345 12346 12347 12348 12349 12350 12351 12352 12353
			genlmsg_cancel(skb, hdr);
			break;
		}

		vendor_data = nla_nest_start(skb, NL80211_ATTR_VENDOR_DATA);
		if (!vendor_data) {
			genlmsg_cancel(skb, hdr);
			break;
		}

		err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
				   (unsigned long *)&cb->args[5]);
		nla_nest_end(skb, vendor_data);

		if (err == -ENOBUFS || err == -ENOENT) {
			genlmsg_cancel(skb, hdr);
			break;
		} else if (err) {
			genlmsg_cancel(skb, hdr);
			goto out;
		}

		genlmsg_end(skb, hdr);
	}

	err = skb->len;
 out:
	rtnl_unlock();
	return err;
}

J
Johannes Berg 已提交
12354 12355 12356 12357 12358
struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
					   enum nl80211_commands cmd,
					   enum nl80211_attrs attr,
					   int approxlen)
{
12359
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
J
Johannes Berg 已提交
12360 12361 12362 12363

	if (WARN_ON(!rdev->cur_cmd_info))
		return NULL;

12364
	return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
J
Johannes Berg 已提交
12365 12366
					   rdev->cur_cmd_info->snd_portid,
					   rdev->cur_cmd_info->snd_seq,
12367
					   cmd, attr, NULL, GFP_KERNEL);
J
Johannes Berg 已提交
12368 12369 12370 12371 12372 12373 12374 12375 12376
}
EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);

int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
{
	struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
	void *hdr = ((void **)skb->cb)[1];
	struct nlattr *data = ((void **)skb->cb)[2];

12377 12378 12379
	/* clear CB data for netlink core to own from now on */
	memset(skb->cb, 0, sizeof(skb->cb));

J
Johannes Berg 已提交
12380 12381 12382 12383 12384 12385 12386 12387 12388 12389 12390
	if (WARN_ON(!rdev->cur_cmd_info)) {
		kfree_skb(skb);
		return -EINVAL;
	}

	nla_nest_end(skb, data);
	genlmsg_end(skb, hdr);
	return genlmsg_reply(skb, rdev->cur_cmd_info);
}
EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);

12391 12392 12393 12394 12395 12396 12397 12398 12399 12400 12401 12402 12403 12404 12405 12406 12407 12408 12409 12410 12411 12412 12413 12414 12415 12416 12417 12418 12419 12420 12421 12422 12423 12424 12425 12426 12427 12428 12429 12430 12431 12432 12433 12434 12435 12436 12437 12438 12439 12440 12441
static int nl80211_set_qos_map(struct sk_buff *skb,
			       struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct cfg80211_qos_map *qos_map = NULL;
	struct net_device *dev = info->user_ptr[1];
	u8 *pos, len, num_des, des_len, des;
	int ret;

	if (!rdev->ops->set_qos_map)
		return -EOPNOTSUPP;

	if (info->attrs[NL80211_ATTR_QOS_MAP]) {
		pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
		len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);

		if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
		    len > IEEE80211_QOS_MAP_LEN_MAX)
			return -EINVAL;

		qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
		if (!qos_map)
			return -ENOMEM;

		num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
		if (num_des) {
			des_len = num_des *
				sizeof(struct cfg80211_dscp_exception);
			memcpy(qos_map->dscp_exception, pos, des_len);
			qos_map->num_des = num_des;
			for (des = 0; des < num_des; des++) {
				if (qos_map->dscp_exception[des].up > 7) {
					kfree(qos_map);
					return -EINVAL;
				}
			}
			pos += des_len;
		}
		memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
	}

	wdev_lock(dev->ieee80211_ptr);
	ret = nl80211_key_allowed(dev->ieee80211_ptr);
	if (!ret)
		ret = rdev_set_qos_map(rdev, dev, qos_map);
	wdev_unlock(dev->ieee80211_ptr);

	kfree(qos_map);
	return ret;
}

12442 12443 12444 12445 12446 12447 12448 12449 12450 12451
static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	const u8 *peer;
	u8 tsid, up;
	u16 admitted_time = 0;
	int err;

12452
	if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
12453 12454 12455 12456 12457 12458 12459 12460 12461 12462 12463 12464 12465 12466 12467
		return -EOPNOTSUPP;

	if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
	    !info->attrs[NL80211_ATTR_USER_PRIO])
		return -EINVAL;

	tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
	if (tsid >= IEEE80211_NUM_TIDS)
		return -EINVAL;

	up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
	if (up >= IEEE80211_NUM_UPS)
		return -EINVAL;

	/* WMM uses TIDs 0-7 even for TSPEC */
12468
	if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
12469
		/* TODO: handle 802.11 TSPEC/admission control
12470 12471
		 * need more attributes for that (e.g. BA session requirement);
		 * change the WMM adminssion test above to allow both then
12472 12473 12474 12475 12476 12477 12478 12479 12480 12481 12482 12483 12484 12485 12486 12487 12488 12489 12490 12491 12492 12493 12494 12495 12496 12497 12498 12499 12500 12501 12502 12503 12504 12505 12506 12507 12508 12509 12510 12511 12512 12513 12514 12515 12516 12517 12518 12519 12520 12521 12522 12523 12524 12525 12526
		 */
		return -EINVAL;
	}

	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);

	if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
		admitted_time =
			nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
		if (!admitted_time)
			return -EINVAL;
	}

	wdev_lock(wdev);
	switch (wdev->iftype) {
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_P2P_CLIENT:
		if (wdev->current_bss)
			break;
		err = -ENOTCONN;
		goto out;
	default:
		err = -EOPNOTSUPP;
		goto out;
	}

	err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);

 out:
	wdev_unlock(wdev);
	return err;
}

static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	const u8 *peer;
	u8 tsid;
	int err;

	if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);

	wdev_lock(wdev);
	err = rdev_del_tx_ts(rdev, dev, tsid, peer);
	wdev_unlock(wdev);

	return err;
}

12527 12528 12529 12530 12531 12532 12533 12534 12535 12536 12537 12538 12539 12540 12541 12542 12543 12544 12545 12546 12547 12548 12549 12550 12551 12552 12553 12554 12555 12556 12557 12558 12559 12560 12561 12562
static int nl80211_tdls_channel_switch(struct sk_buff *skb,
				       struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_chan_def chandef = {};
	const u8 *addr;
	u8 oper_class;
	int err;

	if (!rdev->ops->tdls_channel_switch ||
	    !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
		return -EOPNOTSUPP;

	switch (dev->ieee80211_ptr->iftype) {
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_P2P_CLIENT:
		break;
	default:
		return -EOPNOTSUPP;
	}

	if (!info->attrs[NL80211_ATTR_MAC] ||
	    !info->attrs[NL80211_ATTR_OPER_CLASS])
		return -EINVAL;

	err = nl80211_parse_chandef(rdev, info, &chandef);
	if (err)
		return err;

	/*
	 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
	 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
	 * specification is not defined for them.
	 */
12563
	if (chandef.chan->band == NL80211_BAND_2GHZ &&
12564 12565 12566 12567 12568
	    chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
	    chandef.width != NL80211_CHAN_WIDTH_20)
		return -EINVAL;

	/* we will be active on the TDLS link */
12569 12570
	if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
					   wdev->iftype))
12571 12572 12573 12574 12575 12576 12577 12578 12579 12580 12581 12582 12583 12584 12585 12586 12587 12588 12589 12590 12591 12592 12593 12594 12595 12596 12597 12598 12599 12600 12601 12602 12603 12604 12605 12606 12607 12608 12609 12610 12611 12612 12613 12614 12615 12616 12617 12618 12619
		return -EINVAL;

	/* don't allow switching to DFS channels */
	if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
		return -EINVAL;

	addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
	oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);

	wdev_lock(wdev);
	err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
	wdev_unlock(wdev);

	return err;
}

static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
					      struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	const u8 *addr;

	if (!rdev->ops->tdls_channel_switch ||
	    !rdev->ops->tdls_cancel_channel_switch ||
	    !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
		return -EOPNOTSUPP;

	switch (dev->ieee80211_ptr->iftype) {
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_P2P_CLIENT:
		break;
	default:
		return -EOPNOTSUPP;
	}

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	addr = nla_data(info->attrs[NL80211_ATTR_MAC]);

	wdev_lock(wdev);
	rdev_tdls_cancel_channel_switch(rdev, dev, addr);
	wdev_unlock(wdev);

	return 0;
}

12620 12621 12622 12623 12624 12625 12626 12627 12628 12629 12630 12631 12632 12633 12634 12635 12636 12637 12638 12639 12640 12641
static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
					    struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	const struct nlattr *nla;
	bool enabled;

	if (!rdev->ops->set_multicast_to_unicast)
		return -EOPNOTSUPP;

	if (wdev->iftype != NL80211_IFTYPE_AP &&
	    wdev->iftype != NL80211_IFTYPE_P2P_GO)
		return -EOPNOTSUPP;

	nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
	enabled = nla_get_flag(nla);

	return rdev_set_multicast_to_unicast(rdev, dev, enabled);
}

12642 12643 12644 12645 12646 12647 12648 12649 12650 12651 12652 12653 12654 12655 12656 12657 12658 12659 12660 12661 12662 12663 12664 12665 12666 12667 12668 12669 12670 12671 12672 12673 12674 12675 12676 12677 12678 12679 12680 12681 12682 12683 12684 12685 12686 12687 12688 12689 12690 12691 12692 12693 12694 12695 12696 12697 12698 12699 12700 12701 12702 12703 12704 12705 12706 12707 12708 12709 12710 12711 12712 12713 12714 12715 12716 12717 12718 12719 12720 12721 12722 12723 12724 12725
static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_pmk_conf pmk_conf = {};
	int ret;

	if (wdev->iftype != NL80211_IFTYPE_STATION &&
	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;

	if (!wiphy_ext_feature_isset(&rdev->wiphy,
				     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
		return -EOPNOTSUPP;

	if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK])
		return -EINVAL;

	wdev_lock(wdev);
	if (!wdev->current_bss) {
		ret = -ENOTCONN;
		goto out;
	}

	pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
	if (memcmp(pmk_conf.aa, wdev->current_bss->pub.bssid, ETH_ALEN)) {
		ret = -EINVAL;
		goto out;
	}

	pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
	pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
	if (pmk_conf.pmk_len != WLAN_PMK_LEN &&
	    pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) {
		ret = -EINVAL;
		goto out;
	}

	if (info->attrs[NL80211_ATTR_PMKR0_NAME]) {
		int r0_name_len = nla_len(info->attrs[NL80211_ATTR_PMKR0_NAME]);

		if (r0_name_len != WLAN_PMK_NAME_LEN) {
			ret = -EINVAL;
			goto out;
		}

		pmk_conf.pmk_r0_name =
			nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]);
	}

	ret = rdev_set_pmk(rdev, dev, &pmk_conf);
out:
	wdev_unlock(wdev);
	return ret;
}

static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	const u8 *aa;
	int ret;

	if (wdev->iftype != NL80211_IFTYPE_STATION &&
	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
		return -EOPNOTSUPP;

	if (!wiphy_ext_feature_isset(&rdev->wiphy,
				     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
		return -EOPNOTSUPP;

	if (!info->attrs[NL80211_ATTR_MAC])
		return -EINVAL;

	wdev_lock(wdev);
	aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
	ret = rdev_del_pmk(rdev, dev, aa);
	wdev_unlock(wdev);

	return ret;
}

12726 12727 12728 12729 12730 12731
static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct cfg80211_external_auth_params params;

12732
	if (!rdev->ops->external_auth)
12733 12734 12735 12736 12737 12738 12739 12740 12741 12742 12743 12744 12745 12746 12747 12748 12749 12750 12751 12752 12753 12754 12755 12756 12757 12758 12759 12760
		return -EOPNOTSUPP;

	if (!info->attrs[NL80211_ATTR_SSID])
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_BSSID])
		return -EINVAL;

	if (!info->attrs[NL80211_ATTR_STATUS_CODE])
		return -EINVAL;

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

	params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
	if (params.ssid.ssid_len == 0 ||
	    params.ssid.ssid_len > IEEE80211_MAX_SSID_LEN)
		return -EINVAL;
	memcpy(params.ssid.ssid, nla_data(info->attrs[NL80211_ATTR_SSID]),
	       params.ssid.ssid_len);

	memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]),
	       ETH_ALEN);

	params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);

	return rdev_external_auth(rdev, dev, &params);
}

12761 12762 12763 12764 12765 12766 12767 12768 12769 12770 12771 12772 12773 12774 12775 12776 12777 12778 12779 12780 12781 12782 12783 12784 12785 12786 12787 12788 12789 12790 12791 12792 12793 12794 12795 12796 12797 12798 12799 12800 12801 12802 12803 12804 12805 12806 12807 12808 12809 12810 12811 12812 12813 12814 12815 12816 12817 12818 12819 12820 12821 12822
static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info)
{
	struct cfg80211_registered_device *rdev = info->user_ptr[0];
	struct net_device *dev = info->user_ptr[1];
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	const u8 *buf;
	size_t len;
	u8 *dest;
	u16 proto;
	bool noencrypt;
	int err;

	if (!wiphy_ext_feature_isset(&rdev->wiphy,
				     NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
		return -EOPNOTSUPP;

	if (!rdev->ops->tx_control_port)
		return -EOPNOTSUPP;

	if (!info->attrs[NL80211_ATTR_FRAME] ||
	    !info->attrs[NL80211_ATTR_MAC] ||
	    !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
		GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing");
		return -EINVAL;
	}

	wdev_lock(wdev);

	switch (wdev->iftype) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_P2P_GO:
	case NL80211_IFTYPE_MESH_POINT:
		break;
	case NL80211_IFTYPE_ADHOC:
	case NL80211_IFTYPE_STATION:
	case NL80211_IFTYPE_P2P_CLIENT:
		if (wdev->current_bss)
			break;
		err = -ENOTCONN;
		goto out;
	default:
		err = -EOPNOTSUPP;
		goto out;
	}

	wdev_unlock(wdev);

	buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
	len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
	dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
	proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
	noencrypt =
		nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]);

	return rdev_tx_control_port(rdev, dev, buf, len,
				    dest, cpu_to_be16(proto), noencrypt);

 out:
	wdev_unlock(wdev);
	return err;
}

12823 12824 12825
#define NL80211_FLAG_NEED_WIPHY		0x01
#define NL80211_FLAG_NEED_NETDEV	0x02
#define NL80211_FLAG_NEED_RTNL		0x04
12826 12827 12828
#define NL80211_FLAG_CHECK_NETDEV_UP	0x08
#define NL80211_FLAG_NEED_NETDEV_UP	(NL80211_FLAG_NEED_NETDEV |\
					 NL80211_FLAG_CHECK_NETDEV_UP)
12829
#define NL80211_FLAG_NEED_WDEV		0x10
12830
/* If a netdev is associated, it must be UP, P2P must be started */
12831 12832
#define NL80211_FLAG_NEED_WDEV_UP	(NL80211_FLAG_NEED_WDEV |\
					 NL80211_FLAG_CHECK_NETDEV_UP)
12833
#define NL80211_FLAG_CLEAR_SKB		0x20
12834

J
Johannes Berg 已提交
12835
static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
12836 12837 12838
			    struct genl_info *info)
{
	struct cfg80211_registered_device *rdev;
12839
	struct wireless_dev *wdev;
12840 12841 12842 12843 12844 12845 12846
	struct net_device *dev;
	bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;

	if (rtnl)
		rtnl_lock();

	if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
J
Johannes Berg 已提交
12847
		rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
12848 12849 12850 12851 12852 12853
		if (IS_ERR(rdev)) {
			if (rtnl)
				rtnl_unlock();
			return PTR_ERR(rdev);
		}
		info->user_ptr[0] = rdev;
12854 12855
	} else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
		   ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
12856 12857
		ASSERT_RTNL();

12858 12859 12860
		wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
						  info->attrs);
		if (IS_ERR(wdev)) {
12861 12862
			if (rtnl)
				rtnl_unlock();
12863
			return PTR_ERR(wdev);
12864
		}
12865 12866

		dev = wdev->netdev;
12867
		rdev = wiphy_to_rdev(wdev->wiphy);
12868

12869 12870 12871 12872 12873 12874 12875 12876 12877 12878
		if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
			if (!dev) {
				if (rtnl)
					rtnl_unlock();
				return -EINVAL;
			}

			info->user_ptr[1] = dev;
		} else {
			info->user_ptr[1] = wdev;
12879
		}
12880

12881 12882 12883 12884 12885 12886
		if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
		    !wdev_running(wdev)) {
			if (rtnl)
				rtnl_unlock();
			return -ENETDOWN;
		}
12887

12888
		if (dev)
12889
			dev_hold(dev);
12890

12891 12892 12893 12894 12895 12896
		info->user_ptr[0] = rdev;
	}

	return 0;
}

J
Johannes Berg 已提交
12897
static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
12898 12899
			      struct genl_info *info)
{
12900 12901 12902 12903 12904 12905 12906 12907 12908 12909
	if (info->user_ptr[1]) {
		if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
			struct wireless_dev *wdev = info->user_ptr[1];

			if (wdev->netdev)
				dev_put(wdev->netdev);
		} else {
			dev_put(info->user_ptr[1]);
		}
	}
12910

12911 12912
	if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
		rtnl_unlock();
12913 12914 12915 12916 12917 12918 12919 12920 12921 12922 12923

	/* If needed, clear the netlink message payload from the SKB
	 * as it might contain key data that shouldn't stick around on
	 * the heap after the SKB is freed. The netlink message header
	 * is still needed for further processing, so leave it intact.
	 */
	if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
		struct nlmsghdr *nlh = nlmsg_hdr(skb);

		memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
	}
12924 12925
}

12926
static const struct genl_ops nl80211_ops[] = {
12927 12928 12929 12930
	{
		.cmd = NL80211_CMD_GET_WIPHY,
		.doit = nl80211_get_wiphy,
		.dumpit = nl80211_dump_wiphy,
12931
		.done = nl80211_dump_wiphy_done,
12932 12933
		.policy = nl80211_policy,
		/* can be retrieved by unprivileged users */
12934 12935
		.internal_flags = NL80211_FLAG_NEED_WIPHY |
				  NL80211_FLAG_NEED_RTNL,
12936 12937 12938 12939 12940
	},
	{
		.cmd = NL80211_CMD_SET_WIPHY,
		.doit = nl80211_set_wiphy,
		.policy = nl80211_policy,
12941
		.flags = GENL_UNS_ADMIN_PERM,
12942
		.internal_flags = NL80211_FLAG_NEED_RTNL,
12943 12944 12945 12946 12947 12948 12949
	},
	{
		.cmd = NL80211_CMD_GET_INTERFACE,
		.doit = nl80211_get_interface,
		.dumpit = nl80211_dump_interface,
		.policy = nl80211_policy,
		/* can be retrieved by unprivileged users */
12950 12951
		.internal_flags = NL80211_FLAG_NEED_WDEV |
				  NL80211_FLAG_NEED_RTNL,
12952 12953 12954 12955 12956
	},
	{
		.cmd = NL80211_CMD_SET_INTERFACE,
		.doit = nl80211_set_interface,
		.policy = nl80211_policy,
12957
		.flags = GENL_UNS_ADMIN_PERM,
12958 12959
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
12960 12961 12962 12963 12964
	},
	{
		.cmd = NL80211_CMD_NEW_INTERFACE,
		.doit = nl80211_new_interface,
		.policy = nl80211_policy,
12965
		.flags = GENL_UNS_ADMIN_PERM,
12966 12967
		.internal_flags = NL80211_FLAG_NEED_WIPHY |
				  NL80211_FLAG_NEED_RTNL,
12968 12969 12970 12971 12972
	},
	{
		.cmd = NL80211_CMD_DEL_INTERFACE,
		.doit = nl80211_del_interface,
		.policy = nl80211_policy,
12973
		.flags = GENL_UNS_ADMIN_PERM,
12974
		.internal_flags = NL80211_FLAG_NEED_WDEV |
12975
				  NL80211_FLAG_NEED_RTNL,
12976 12977 12978 12979 12980
	},
	{
		.cmd = NL80211_CMD_GET_KEY,
		.doit = nl80211_get_key,
		.policy = nl80211_policy,
12981
		.flags = GENL_UNS_ADMIN_PERM,
12982
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12983
				  NL80211_FLAG_NEED_RTNL,
12984 12985 12986 12987 12988
	},
	{
		.cmd = NL80211_CMD_SET_KEY,
		.doit = nl80211_set_key,
		.policy = nl80211_policy,
12989
		.flags = GENL_UNS_ADMIN_PERM,
12990
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12991 12992
				  NL80211_FLAG_NEED_RTNL |
				  NL80211_FLAG_CLEAR_SKB,
12993 12994 12995 12996 12997
	},
	{
		.cmd = NL80211_CMD_NEW_KEY,
		.doit = nl80211_new_key,
		.policy = nl80211_policy,
12998
		.flags = GENL_UNS_ADMIN_PERM,
12999
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13000 13001
				  NL80211_FLAG_NEED_RTNL |
				  NL80211_FLAG_CLEAR_SKB,
13002 13003 13004 13005 13006
	},
	{
		.cmd = NL80211_CMD_DEL_KEY,
		.doit = nl80211_del_key,
		.policy = nl80211_policy,
13007
		.flags = GENL_UNS_ADMIN_PERM,
13008
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13009
				  NL80211_FLAG_NEED_RTNL,
13010
	},
13011 13012 13013
	{
		.cmd = NL80211_CMD_SET_BEACON,
		.policy = nl80211_policy,
13014
		.flags = GENL_UNS_ADMIN_PERM,
13015
		.doit = nl80211_set_beacon,
13016
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13017
				  NL80211_FLAG_NEED_RTNL,
13018 13019
	},
	{
13020
		.cmd = NL80211_CMD_START_AP,
13021
		.policy = nl80211_policy,
13022
		.flags = GENL_UNS_ADMIN_PERM,
13023
		.doit = nl80211_start_ap,
13024
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13025
				  NL80211_FLAG_NEED_RTNL,
13026 13027
	},
	{
13028
		.cmd = NL80211_CMD_STOP_AP,
13029
		.policy = nl80211_policy,
13030
		.flags = GENL_UNS_ADMIN_PERM,
13031
		.doit = nl80211_stop_ap,
13032
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13033
				  NL80211_FLAG_NEED_RTNL,
13034
	},
13035 13036 13037
	{
		.cmd = NL80211_CMD_GET_STATION,
		.doit = nl80211_get_station,
13038
		.dumpit = nl80211_dump_station,
13039
		.policy = nl80211_policy,
13040 13041
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
13042 13043 13044 13045 13046
	},
	{
		.cmd = NL80211_CMD_SET_STATION,
		.doit = nl80211_set_station,
		.policy = nl80211_policy,
13047
		.flags = GENL_UNS_ADMIN_PERM,
13048
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13049
				  NL80211_FLAG_NEED_RTNL,
13050 13051 13052 13053 13054
	},
	{
		.cmd = NL80211_CMD_NEW_STATION,
		.doit = nl80211_new_station,
		.policy = nl80211_policy,
13055
		.flags = GENL_UNS_ADMIN_PERM,
13056
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13057
				  NL80211_FLAG_NEED_RTNL,
13058 13059 13060 13061 13062
	},
	{
		.cmd = NL80211_CMD_DEL_STATION,
		.doit = nl80211_del_station,
		.policy = nl80211_policy,
13063
		.flags = GENL_UNS_ADMIN_PERM,
13064
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13065
				  NL80211_FLAG_NEED_RTNL,
13066 13067 13068 13069 13070 13071
	},
	{
		.cmd = NL80211_CMD_GET_MPATH,
		.doit = nl80211_get_mpath,
		.dumpit = nl80211_dump_mpath,
		.policy = nl80211_policy,
13072
		.flags = GENL_UNS_ADMIN_PERM,
13073
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13074
				  NL80211_FLAG_NEED_RTNL,
13075
	},
13076 13077 13078 13079 13080
	{
		.cmd = NL80211_CMD_GET_MPP,
		.doit = nl80211_get_mpp,
		.dumpit = nl80211_dump_mpp,
		.policy = nl80211_policy,
13081
		.flags = GENL_UNS_ADMIN_PERM,
13082 13083 13084
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13085 13086 13087 13088
	{
		.cmd = NL80211_CMD_SET_MPATH,
		.doit = nl80211_set_mpath,
		.policy = nl80211_policy,
13089
		.flags = GENL_UNS_ADMIN_PERM,
13090
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13091
				  NL80211_FLAG_NEED_RTNL,
13092 13093 13094 13095 13096
	},
	{
		.cmd = NL80211_CMD_NEW_MPATH,
		.doit = nl80211_new_mpath,
		.policy = nl80211_policy,
13097
		.flags = GENL_UNS_ADMIN_PERM,
13098
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13099
				  NL80211_FLAG_NEED_RTNL,
13100 13101 13102 13103 13104
	},
	{
		.cmd = NL80211_CMD_DEL_MPATH,
		.doit = nl80211_del_mpath,
		.policy = nl80211_policy,
13105
		.flags = GENL_UNS_ADMIN_PERM,
13106
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13107
				  NL80211_FLAG_NEED_RTNL,
13108 13109 13110 13111 13112
	},
	{
		.cmd = NL80211_CMD_SET_BSS,
		.doit = nl80211_set_bss,
		.policy = nl80211_policy,
13113
		.flags = GENL_UNS_ADMIN_PERM,
13114
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13115
				  NL80211_FLAG_NEED_RTNL,
13116
	},
13117 13118
	{
		.cmd = NL80211_CMD_GET_REG,
13119 13120
		.doit = nl80211_get_reg_do,
		.dumpit = nl80211_get_reg_dump,
13121
		.policy = nl80211_policy,
13122
		.internal_flags = NL80211_FLAG_NEED_RTNL,
13123 13124
		/* can be retrieved by unprivileged users */
	},
13125
#ifdef CONFIG_CFG80211_CRDA_SUPPORT
13126 13127 13128 13129 13130
	{
		.cmd = NL80211_CMD_SET_REG,
		.doit = nl80211_set_reg,
		.policy = nl80211_policy,
		.flags = GENL_ADMIN_PERM,
13131
		.internal_flags = NL80211_FLAG_NEED_RTNL,
13132
	},
13133
#endif
13134 13135 13136 13137
	{
		.cmd = NL80211_CMD_REQ_SET_REG,
		.doit = nl80211_req_set_reg,
		.policy = nl80211_policy,
13138 13139
		.flags = GENL_ADMIN_PERM,
	},
13140 13141 13142 13143 13144 13145
	{
		.cmd = NL80211_CMD_RELOAD_REGDB,
		.doit = nl80211_reload_regdb,
		.policy = nl80211_policy,
		.flags = GENL_ADMIN_PERM,
	},
13146
	{
13147 13148
		.cmd = NL80211_CMD_GET_MESH_CONFIG,
		.doit = nl80211_get_mesh_config,
13149 13150
		.policy = nl80211_policy,
		/* can be retrieved by unprivileged users */
13151
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13152
				  NL80211_FLAG_NEED_RTNL,
13153 13154
	},
	{
13155 13156
		.cmd = NL80211_CMD_SET_MESH_CONFIG,
		.doit = nl80211_update_mesh_config,
13157
		.policy = nl80211_policy,
13158
		.flags = GENL_UNS_ADMIN_PERM,
13159
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13160
				  NL80211_FLAG_NEED_RTNL,
13161
	},
13162 13163 13164 13165
	{
		.cmd = NL80211_CMD_TRIGGER_SCAN,
		.doit = nl80211_trigger_scan,
		.policy = nl80211_policy,
13166
		.flags = GENL_UNS_ADMIN_PERM,
J
Johannes Berg 已提交
13167
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13168
				  NL80211_FLAG_NEED_RTNL,
13169
	},
13170 13171 13172 13173
	{
		.cmd = NL80211_CMD_ABORT_SCAN,
		.doit = nl80211_abort_scan,
		.policy = nl80211_policy,
13174
		.flags = GENL_UNS_ADMIN_PERM,
13175 13176 13177
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13178 13179 13180 13181 13182
	{
		.cmd = NL80211_CMD_GET_SCAN,
		.policy = nl80211_policy,
		.dumpit = nl80211_dump_scan,
	},
13183 13184 13185 13186
	{
		.cmd = NL80211_CMD_START_SCHED_SCAN,
		.doit = nl80211_start_sched_scan,
		.policy = nl80211_policy,
13187
		.flags = GENL_UNS_ADMIN_PERM,
13188 13189 13190 13191 13192 13193 13194
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_STOP_SCHED_SCAN,
		.doit = nl80211_stop_sched_scan,
		.policy = nl80211_policy,
13195
		.flags = GENL_UNS_ADMIN_PERM,
13196 13197 13198
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13199 13200 13201 13202
	{
		.cmd = NL80211_CMD_AUTHENTICATE,
		.doit = nl80211_authenticate,
		.policy = nl80211_policy,
13203
		.flags = GENL_UNS_ADMIN_PERM,
13204
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13205 13206
				  NL80211_FLAG_NEED_RTNL |
				  NL80211_FLAG_CLEAR_SKB,
13207 13208 13209 13210 13211
	},
	{
		.cmd = NL80211_CMD_ASSOCIATE,
		.doit = nl80211_associate,
		.policy = nl80211_policy,
13212
		.flags = GENL_UNS_ADMIN_PERM,
13213
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13214
				  NL80211_FLAG_NEED_RTNL,
13215 13216 13217 13218 13219
	},
	{
		.cmd = NL80211_CMD_DEAUTHENTICATE,
		.doit = nl80211_deauthenticate,
		.policy = nl80211_policy,
13220
		.flags = GENL_UNS_ADMIN_PERM,
13221
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13222
				  NL80211_FLAG_NEED_RTNL,
13223 13224 13225 13226 13227
	},
	{
		.cmd = NL80211_CMD_DISASSOCIATE,
		.doit = nl80211_disassociate,
		.policy = nl80211_policy,
13228
		.flags = GENL_UNS_ADMIN_PERM,
13229
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13230
				  NL80211_FLAG_NEED_RTNL,
13231
	},
J
Johannes Berg 已提交
13232 13233 13234 13235
	{
		.cmd = NL80211_CMD_JOIN_IBSS,
		.doit = nl80211_join_ibss,
		.policy = nl80211_policy,
13236
		.flags = GENL_UNS_ADMIN_PERM,
13237
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13238
				  NL80211_FLAG_NEED_RTNL,
J
Johannes Berg 已提交
13239 13240 13241 13242 13243
	},
	{
		.cmd = NL80211_CMD_LEAVE_IBSS,
		.doit = nl80211_leave_ibss,
		.policy = nl80211_policy,
13244
		.flags = GENL_UNS_ADMIN_PERM,
13245
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13246
				  NL80211_FLAG_NEED_RTNL,
J
Johannes Berg 已提交
13247
	},
13248 13249 13250 13251
#ifdef CONFIG_NL80211_TESTMODE
	{
		.cmd = NL80211_CMD_TESTMODE,
		.doit = nl80211_testmode_do,
W
Wey-Yi Guy 已提交
13252
		.dumpit = nl80211_testmode_dump,
13253
		.policy = nl80211_policy,
13254
		.flags = GENL_UNS_ADMIN_PERM,
13255 13256
		.internal_flags = NL80211_FLAG_NEED_WIPHY |
				  NL80211_FLAG_NEED_RTNL,
13257 13258
	},
#endif
S
Samuel Ortiz 已提交
13259 13260 13261 13262
	{
		.cmd = NL80211_CMD_CONNECT,
		.doit = nl80211_connect,
		.policy = nl80211_policy,
13263
		.flags = GENL_UNS_ADMIN_PERM,
13264
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13265
				  NL80211_FLAG_NEED_RTNL,
S
Samuel Ortiz 已提交
13266
	},
13267 13268 13269 13270 13271 13272 13273 13274
	{
		.cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
		.doit = nl80211_update_connect_params,
		.policy = nl80211_policy,
		.flags = GENL_ADMIN_PERM,
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
S
Samuel Ortiz 已提交
13275 13276 13277 13278
	{
		.cmd = NL80211_CMD_DISCONNECT,
		.doit = nl80211_disconnect,
		.policy = nl80211_policy,
13279
		.flags = GENL_UNS_ADMIN_PERM,
13280
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13281
				  NL80211_FLAG_NEED_RTNL,
S
Samuel Ortiz 已提交
13282
	},
13283 13284 13285 13286
	{
		.cmd = NL80211_CMD_SET_WIPHY_NETNS,
		.doit = nl80211_wiphy_netns,
		.policy = nl80211_policy,
13287
		.flags = GENL_UNS_ADMIN_PERM,
13288 13289
		.internal_flags = NL80211_FLAG_NEED_WIPHY |
				  NL80211_FLAG_NEED_RTNL,
13290
	},
13291 13292 13293 13294 13295
	{
		.cmd = NL80211_CMD_GET_SURVEY,
		.policy = nl80211_policy,
		.dumpit = nl80211_dump_survey,
	},
S
Samuel Ortiz 已提交
13296 13297 13298 13299
	{
		.cmd = NL80211_CMD_SET_PMKSA,
		.doit = nl80211_setdel_pmksa,
		.policy = nl80211_policy,
13300
		.flags = GENL_UNS_ADMIN_PERM,
13301
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13302
				  NL80211_FLAG_NEED_RTNL,
S
Samuel Ortiz 已提交
13303 13304 13305 13306 13307
	},
	{
		.cmd = NL80211_CMD_DEL_PMKSA,
		.doit = nl80211_setdel_pmksa,
		.policy = nl80211_policy,
13308
		.flags = GENL_UNS_ADMIN_PERM,
13309
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13310
				  NL80211_FLAG_NEED_RTNL,
S
Samuel Ortiz 已提交
13311 13312 13313 13314 13315
	},
	{
		.cmd = NL80211_CMD_FLUSH_PMKSA,
		.doit = nl80211_flush_pmksa,
		.policy = nl80211_policy,
13316
		.flags = GENL_UNS_ADMIN_PERM,
13317
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13318
				  NL80211_FLAG_NEED_RTNL,
S
Samuel Ortiz 已提交
13319
	},
13320 13321 13322 13323
	{
		.cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
		.doit = nl80211_remain_on_channel,
		.policy = nl80211_policy,
13324
		.flags = GENL_UNS_ADMIN_PERM,
13325
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13326
				  NL80211_FLAG_NEED_RTNL,
13327 13328 13329 13330 13331
	},
	{
		.cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
		.doit = nl80211_cancel_remain_on_channel,
		.policy = nl80211_policy,
13332
		.flags = GENL_UNS_ADMIN_PERM,
13333
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13334
				  NL80211_FLAG_NEED_RTNL,
13335
	},
13336 13337 13338 13339
	{
		.cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
		.doit = nl80211_set_tx_bitrate_mask,
		.policy = nl80211_policy,
13340
		.flags = GENL_UNS_ADMIN_PERM,
13341 13342
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
13343
	},
13344
	{
13345 13346
		.cmd = NL80211_CMD_REGISTER_FRAME,
		.doit = nl80211_register_mgmt,
13347
		.policy = nl80211_policy,
13348
		.flags = GENL_UNS_ADMIN_PERM,
13349
		.internal_flags = NL80211_FLAG_NEED_WDEV |
13350
				  NL80211_FLAG_NEED_RTNL,
13351 13352
	},
	{
13353 13354
		.cmd = NL80211_CMD_FRAME,
		.doit = nl80211_tx_mgmt,
13355
		.policy = nl80211_policy,
13356
		.flags = GENL_UNS_ADMIN_PERM,
13357
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13358 13359 13360 13361 13362 13363
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
		.doit = nl80211_tx_mgmt_cancel_wait,
		.policy = nl80211_policy,
13364
		.flags = GENL_UNS_ADMIN_PERM,
13365
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13366
				  NL80211_FLAG_NEED_RTNL,
13367
	},
K
Kalle Valo 已提交
13368 13369 13370 13371
	{
		.cmd = NL80211_CMD_SET_POWER_SAVE,
		.doit = nl80211_set_power_save,
		.policy = nl80211_policy,
13372
		.flags = GENL_UNS_ADMIN_PERM,
13373 13374
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
K
Kalle Valo 已提交
13375 13376 13377 13378 13379 13380
	},
	{
		.cmd = NL80211_CMD_GET_POWER_SAVE,
		.doit = nl80211_get_power_save,
		.policy = nl80211_policy,
		/* can be retrieved by unprivileged users */
13381 13382
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
K
Kalle Valo 已提交
13383
	},
13384 13385 13386 13387
	{
		.cmd = NL80211_CMD_SET_CQM,
		.doit = nl80211_set_cqm,
		.policy = nl80211_policy,
13388
		.flags = GENL_UNS_ADMIN_PERM,
13389 13390
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
13391
	},
13392 13393 13394 13395
	{
		.cmd = NL80211_CMD_SET_CHANNEL,
		.doit = nl80211_set_channel,
		.policy = nl80211_policy,
13396
		.flags = GENL_UNS_ADMIN_PERM,
13397 13398
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
13399
	},
13400 13401 13402 13403
	{
		.cmd = NL80211_CMD_SET_WDS_PEER,
		.doit = nl80211_set_wds_peer,
		.policy = nl80211_policy,
13404
		.flags = GENL_UNS_ADMIN_PERM,
13405 13406
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
13407
	},
13408 13409 13410 13411
	{
		.cmd = NL80211_CMD_JOIN_MESH,
		.doit = nl80211_join_mesh,
		.policy = nl80211_policy,
13412
		.flags = GENL_UNS_ADMIN_PERM,
13413 13414 13415 13416 13417 13418 13419
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_LEAVE_MESH,
		.doit = nl80211_leave_mesh,
		.policy = nl80211_policy,
13420
		.flags = GENL_UNS_ADMIN_PERM,
13421 13422 13423
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13424 13425 13426 13427
	{
		.cmd = NL80211_CMD_JOIN_OCB,
		.doit = nl80211_join_ocb,
		.policy = nl80211_policy,
13428
		.flags = GENL_UNS_ADMIN_PERM,
13429 13430 13431 13432 13433 13434 13435
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_LEAVE_OCB,
		.doit = nl80211_leave_ocb,
		.policy = nl80211_policy,
13436
		.flags = GENL_UNS_ADMIN_PERM,
13437 13438 13439
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13440
#ifdef CONFIG_PM
J
Johannes Berg 已提交
13441 13442 13443 13444 13445 13446 13447 13448 13449 13450 13451 13452
	{
		.cmd = NL80211_CMD_GET_WOWLAN,
		.doit = nl80211_get_wowlan,
		.policy = nl80211_policy,
		/* can be retrieved by unprivileged users */
		.internal_flags = NL80211_FLAG_NEED_WIPHY |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_SET_WOWLAN,
		.doit = nl80211_set_wowlan,
		.policy = nl80211_policy,
13453
		.flags = GENL_UNS_ADMIN_PERM,
J
Johannes Berg 已提交
13454 13455 13456
		.internal_flags = NL80211_FLAG_NEED_WIPHY |
				  NL80211_FLAG_NEED_RTNL,
	},
13457
#endif
13458 13459 13460 13461
	{
		.cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
		.doit = nl80211_set_rekey_data,
		.policy = nl80211_policy,
13462
		.flags = GENL_UNS_ADMIN_PERM,
13463
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13464 13465
				  NL80211_FLAG_NEED_RTNL |
				  NL80211_FLAG_CLEAR_SKB,
13466
	},
13467 13468 13469 13470
	{
		.cmd = NL80211_CMD_TDLS_MGMT,
		.doit = nl80211_tdls_mgmt,
		.policy = nl80211_policy,
13471
		.flags = GENL_UNS_ADMIN_PERM,
13472 13473 13474 13475 13476 13477 13478
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_TDLS_OPER,
		.doit = nl80211_tdls_oper,
		.policy = nl80211_policy,
13479
		.flags = GENL_UNS_ADMIN_PERM,
13480 13481 13482
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13483 13484 13485 13486
	{
		.cmd = NL80211_CMD_UNEXPECTED_FRAME,
		.doit = nl80211_register_unexpected_frame,
		.policy = nl80211_policy,
13487
		.flags = GENL_UNS_ADMIN_PERM,
13488 13489 13490
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
	},
J
Johannes Berg 已提交
13491 13492 13493 13494
	{
		.cmd = NL80211_CMD_PROBE_CLIENT,
		.doit = nl80211_probe_client,
		.policy = nl80211_policy,
13495
		.flags = GENL_UNS_ADMIN_PERM,
13496
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
J
Johannes Berg 已提交
13497 13498
				  NL80211_FLAG_NEED_RTNL,
	},
13499 13500 13501 13502
	{
		.cmd = NL80211_CMD_REGISTER_BEACONS,
		.doit = nl80211_register_beacons,
		.policy = nl80211_policy,
13503
		.flags = GENL_UNS_ADMIN_PERM,
13504 13505 13506
		.internal_flags = NL80211_FLAG_NEED_WIPHY |
				  NL80211_FLAG_NEED_RTNL,
	},
13507 13508 13509 13510
	{
		.cmd = NL80211_CMD_SET_NOACK_MAP,
		.doit = nl80211_set_noack_map,
		.policy = nl80211_policy,
13511
		.flags = GENL_UNS_ADMIN_PERM,
13512 13513 13514
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
	},
13515 13516 13517 13518
	{
		.cmd = NL80211_CMD_START_P2P_DEVICE,
		.doit = nl80211_start_p2p_device,
		.policy = nl80211_policy,
13519
		.flags = GENL_UNS_ADMIN_PERM,
13520 13521 13522 13523 13524 13525 13526
		.internal_flags = NL80211_FLAG_NEED_WDEV |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_STOP_P2P_DEVICE,
		.doit = nl80211_stop_p2p_device,
		.policy = nl80211_policy,
13527
		.flags = GENL_UNS_ADMIN_PERM,
13528 13529
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
13530 13531 13532 13533 13534 13535 13536 13537 13538 13539 13540 13541 13542 13543 13544 13545
	},
	{
		.cmd = NL80211_CMD_START_NAN,
		.doit = nl80211_start_nan,
		.policy = nl80211_policy,
		.flags = GENL_ADMIN_PERM,
		.internal_flags = NL80211_FLAG_NEED_WDEV |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_STOP_NAN,
		.doit = nl80211_stop_nan,
		.policy = nl80211_policy,
		.flags = GENL_ADMIN_PERM,
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
13546 13547 13548 13549 13550 13551 13552 13553 13554 13555 13556 13557 13558 13559 13560 13561
	},
	{
		.cmd = NL80211_CMD_ADD_NAN_FUNCTION,
		.doit = nl80211_nan_add_func,
		.policy = nl80211_policy,
		.flags = GENL_ADMIN_PERM,
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_DEL_NAN_FUNCTION,
		.doit = nl80211_nan_del_func,
		.policy = nl80211_policy,
		.flags = GENL_ADMIN_PERM,
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
13562 13563 13564 13565 13566 13567 13568 13569
	},
	{
		.cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
		.doit = nl80211_nan_change_config,
		.policy = nl80211_policy,
		.flags = GENL_ADMIN_PERM,
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
13570
	},
13571 13572 13573
	{
		.cmd = NL80211_CMD_SET_MCAST_RATE,
		.doit = nl80211_set_mcast_rate,
13574
		.policy = nl80211_policy,
13575
		.flags = GENL_UNS_ADMIN_PERM,
13576 13577 13578 13579 13580 13581
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_SET_MAC_ACL,
		.doit = nl80211_set_mac_acl,
13582
		.policy = nl80211_policy,
13583
		.flags = GENL_UNS_ADMIN_PERM,
13584 13585 13586
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
	},
13587 13588 13589 13590
	{
		.cmd = NL80211_CMD_RADAR_DETECT,
		.doit = nl80211_start_radar_detection,
		.policy = nl80211_policy,
13591
		.flags = GENL_UNS_ADMIN_PERM,
13592 13593 13594
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13595 13596 13597 13598 13599
	{
		.cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
		.doit = nl80211_get_protocol_features,
		.policy = nl80211_policy,
	},
13600 13601 13602 13603
	{
		.cmd = NL80211_CMD_UPDATE_FT_IES,
		.doit = nl80211_update_ft_ies,
		.policy = nl80211_policy,
13604
		.flags = GENL_UNS_ADMIN_PERM,
13605 13606 13607
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13608 13609 13610 13611
	{
		.cmd = NL80211_CMD_CRIT_PROTOCOL_START,
		.doit = nl80211_crit_protocol_start,
		.policy = nl80211_policy,
13612
		.flags = GENL_UNS_ADMIN_PERM,
13613 13614 13615 13616 13617 13618 13619
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
		.doit = nl80211_crit_protocol_stop,
		.policy = nl80211_policy,
13620
		.flags = GENL_UNS_ADMIN_PERM,
13621 13622
		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
13623 13624 13625 13626 13627 13628 13629 13630 13631 13632 13633 13634
	},
	{
		.cmd = NL80211_CMD_GET_COALESCE,
		.doit = nl80211_get_coalesce,
		.policy = nl80211_policy,
		.internal_flags = NL80211_FLAG_NEED_WIPHY |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_SET_COALESCE,
		.doit = nl80211_set_coalesce,
		.policy = nl80211_policy,
13635
		.flags = GENL_UNS_ADMIN_PERM,
13636 13637
		.internal_flags = NL80211_FLAG_NEED_WIPHY |
				  NL80211_FLAG_NEED_RTNL,
13638 13639 13640 13641 13642
	},
	{
		.cmd = NL80211_CMD_CHANNEL_SWITCH,
		.doit = nl80211_channel_switch,
		.policy = nl80211_policy,
13643
		.flags = GENL_UNS_ADMIN_PERM,
13644 13645 13646
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
J
Johannes Berg 已提交
13647 13648 13649
	{
		.cmd = NL80211_CMD_VENDOR,
		.doit = nl80211_vendor_cmd,
13650
		.dumpit = nl80211_vendor_cmd_dump,
J
Johannes Berg 已提交
13651
		.policy = nl80211_policy,
13652
		.flags = GENL_UNS_ADMIN_PERM,
J
Johannes Berg 已提交
13653 13654 13655
		.internal_flags = NL80211_FLAG_NEED_WIPHY |
				  NL80211_FLAG_NEED_RTNL,
	},
13656 13657 13658 13659
	{
		.cmd = NL80211_CMD_SET_QOS_MAP,
		.doit = nl80211_set_qos_map,
		.policy = nl80211_policy,
13660
		.flags = GENL_UNS_ADMIN_PERM,
13661 13662 13663
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13664 13665 13666 13667
	{
		.cmd = NL80211_CMD_ADD_TX_TS,
		.doit = nl80211_add_tx_ts,
		.policy = nl80211_policy,
13668
		.flags = GENL_UNS_ADMIN_PERM,
13669 13670 13671 13672 13673 13674 13675
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_DEL_TX_TS,
		.doit = nl80211_del_tx_ts,
		.policy = nl80211_policy,
13676
		.flags = GENL_UNS_ADMIN_PERM,
13677 13678 13679
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13680 13681 13682 13683
	{
		.cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
		.doit = nl80211_tdls_channel_switch,
		.policy = nl80211_policy,
13684
		.flags = GENL_UNS_ADMIN_PERM,
13685 13686 13687 13688 13689 13690 13691
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
		.doit = nl80211_tdls_cancel_channel_switch,
		.policy = nl80211_policy,
13692
		.flags = GENL_UNS_ADMIN_PERM,
13693 13694 13695
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13696 13697 13698 13699 13700 13701 13702 13703
	{
		.cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
		.doit = nl80211_set_multicast_to_unicast,
		.policy = nl80211_policy,
		.flags = GENL_UNS_ADMIN_PERM,
		.internal_flags = NL80211_FLAG_NEED_NETDEV |
				  NL80211_FLAG_NEED_RTNL,
	},
13704 13705 13706 13707 13708 13709 13710 13711 13712 13713 13714 13715 13716 13717
	{
		.cmd = NL80211_CMD_SET_PMK,
		.doit = nl80211_set_pmk,
		.policy = nl80211_policy,
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
	{
		.cmd = NL80211_CMD_DEL_PMK,
		.doit = nl80211_del_pmk,
		.policy = nl80211_policy,
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13718 13719 13720 13721 13722 13723 13724 13725
	{
		.cmd = NL80211_CMD_EXTERNAL_AUTH,
		.doit = nl80211_external_auth,
		.policy = nl80211_policy,
		.flags = GENL_ADMIN_PERM,
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13726 13727 13728 13729 13730 13731 13732 13733
	{
		.cmd = NL80211_CMD_CONTROL_PORT_FRAME,
		.doit = nl80211_tx_control_port,
		.policy = nl80211_policy,
		.flags = GENL_UNS_ADMIN_PERM,
		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
				  NL80211_FLAG_NEED_RTNL,
	},
13734
};
13735

13736
static struct genl_family nl80211_fam __ro_after_init = {
13737 13738 13739 13740 13741 13742 13743 13744 13745 13746 13747 13748 13749 13750
	.name = NL80211_GENL_NAME,	/* have users key off the name instead */
	.hdrsize = 0,			/* no private header */
	.version = 1,			/* no particular meaning now */
	.maxattr = NL80211_ATTR_MAX,
	.netnsok = true,
	.pre_doit = nl80211_pre_doit,
	.post_doit = nl80211_post_doit,
	.module = THIS_MODULE,
	.ops = nl80211_ops,
	.n_ops = ARRAY_SIZE(nl80211_ops),
	.mcgrps = nl80211_mcgrps,
	.n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
};

13751 13752
/* notification functions */

13753 13754
void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
			  enum nl80211_commands cmd)
13755 13756
{
	struct sk_buff *msg;
13757
	struct nl80211_dump_wiphy_state state = {};
13758

13759 13760 13761
	WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
		cmd != NL80211_CMD_DEL_WIPHY);

13762
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13763 13764 13765
	if (!msg)
		return;

13766
	if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
13767 13768 13769 13770
		nlmsg_free(msg);
		return;
	}

13771
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13772
				NL80211_MCGRP_CONFIG, GFP_KERNEL);
13773 13774
}

13775 13776 13777 13778 13779 13780 13781 13782 13783 13784 13785 13786 13787 13788 13789 13790 13791 13792 13793 13794 13795 13796 13797
void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
				struct wireless_dev *wdev,
				enum nl80211_commands cmd)
{
	struct sk_buff *msg;

	WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
		cmd != NL80211_CMD_DEL_INTERFACE);

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg)
		return;

	if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev,
			       cmd == NL80211_CMD_DEL_INTERFACE) < 0) {
		nlmsg_free(msg);
		return;
	}

	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
				NL80211_MCGRP_CONFIG, GFP_KERNEL);
}

13798 13799 13800 13801 13802 13803 13804 13805 13806 13807 13808 13809 13810
static int nl80211_add_scan_req(struct sk_buff *msg,
				struct cfg80211_registered_device *rdev)
{
	struct cfg80211_scan_request *req = rdev->scan_req;
	struct nlattr *nest;
	int i;

	if (WARN_ON(!req))
		return 0;

	nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
	if (!nest)
		goto nla_put_failure;
13811 13812 13813 13814
	for (i = 0; i < req->n_ssids; i++) {
		if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
			goto nla_put_failure;
	}
13815 13816 13817 13818 13819
	nla_nest_end(msg, nest);

	nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
	if (!nest)
		goto nla_put_failure;
13820 13821 13822 13823
	for (i = 0; i < req->n_channels; i++) {
		if (nla_put_u32(msg, i, req->channels[i]->center_freq))
			goto nla_put_failure;
	}
13824 13825
	nla_nest_end(msg, nest);

13826 13827 13828
	if (req->ie &&
	    nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
		goto nla_put_failure;
13829

13830 13831 13832
	if (req->flags &&
	    nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
		goto nla_put_failure;
13833

13834 13835 13836 13837 13838 13839 13840
	if (req->info.scan_start_tsf &&
	    (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
			       req->info.scan_start_tsf, NL80211_BSS_PAD) ||
	     nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
		     req->info.tsf_bssid)))
		goto nla_put_failure;

13841 13842 13843 13844 13845
	return 0;
 nla_put_failure:
	return -ENOBUFS;
}

13846
static int nl80211_prep_scan_msg(struct sk_buff *msg,
13847
				 struct cfg80211_registered_device *rdev,
J
Johannes Berg 已提交
13848
				 struct wireless_dev *wdev,
13849
				 u32 portid, u32 seq, int flags,
13850
				 u32 cmd)
13851 13852 13853
{
	void *hdr;

13854
	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
13855 13856 13857
	if (!hdr)
		return -1;

13858
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
J
Johannes Berg 已提交
13859 13860
	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
					 wdev->netdev->ifindex)) ||
13861 13862
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD))
13863
		goto nla_put_failure;
13864

13865 13866
	/* ignore errors and send incomplete event anyway */
	nl80211_add_scan_req(msg, rdev);
13867

13868 13869
	genlmsg_end(msg, hdr);
	return 0;
13870 13871 13872 13873 13874 13875

 nla_put_failure:
	genlmsg_cancel(msg, hdr);
	return -EMSGSIZE;
}

13876
static int
13877
nl80211_prep_sched_scan_msg(struct sk_buff *msg,
13878
			    struct cfg80211_sched_scan_request *req, u32 cmd)
13879 13880 13881
{
	void *hdr;

13882
	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13883 13884 13885
	if (!hdr)
		return -1;

13886 13887 13888 13889 13890
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
			wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
			      NL80211_ATTR_PAD))
13891
		goto nla_put_failure;
13892

13893 13894
	genlmsg_end(msg, hdr);
	return 0;
13895 13896 13897 13898 13899 13900

 nla_put_failure:
	genlmsg_cancel(msg, hdr);
	return -EMSGSIZE;
}

13901
void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
J
Johannes Berg 已提交
13902
			     struct wireless_dev *wdev)
13903 13904 13905
{
	struct sk_buff *msg;

13906
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13907 13908 13909
	if (!msg)
		return;

13910
	if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
13911 13912 13913 13914 13915
				  NL80211_CMD_TRIGGER_SCAN) < 0) {
		nlmsg_free(msg);
		return;
	}

13916
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13917
				NL80211_MCGRP_SCAN, GFP_KERNEL);
13918 13919
}

13920 13921
struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
				       struct wireless_dev *wdev, bool aborted)
13922 13923 13924
{
	struct sk_buff *msg;

13925
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13926
	if (!msg)
13927
		return NULL;
13928

13929
	if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
13930 13931
				  aborted ? NL80211_CMD_SCAN_ABORTED :
					    NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
13932
		nlmsg_free(msg);
13933
		return NULL;
13934 13935
	}

13936
	return msg;
13937 13938
}

13939 13940 13941
/* send message created by nl80211_build_scan_msg() */
void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
			   struct sk_buff *msg)
13942 13943 13944 13945
{
	if (!msg)
		return;

13946
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13947
				NL80211_MCGRP_SCAN, GFP_KERNEL);
13948 13949
}

13950
void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
13951 13952 13953
{
	struct sk_buff *msg;

13954
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13955 13956 13957
	if (!msg)
		return;

13958
	if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
13959 13960 13961 13962
		nlmsg_free(msg);
		return;
	}

13963
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
13964
				NL80211_MCGRP_SCAN, GFP_KERNEL);
13965 13966
}

13967 13968
static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
					  struct regulatory_request *request)
13969 13970
{
	/* Userspace can always count this one always being set */
13971 13972 13973 13974 13975 13976 13977 13978 13979 13980 13981 13982 13983 13984 13985 13986 13987 13988 13989 13990 13991 13992 13993 13994
	if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
		goto nla_put_failure;

	if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
			       NL80211_REGDOM_TYPE_WORLD))
			goto nla_put_failure;
	} else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
			       NL80211_REGDOM_TYPE_CUSTOM_WORLD))
			goto nla_put_failure;
	} else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
		   request->intersect) {
		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
			       NL80211_REGDOM_TYPE_INTERSECTION))
			goto nla_put_failure;
	} else {
		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
			       NL80211_REGDOM_TYPE_COUNTRY) ||
		    nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
				   request->alpha2))
			goto nla_put_failure;
	}

13995 13996 13997 13998 13999 14000
	if (request->wiphy_idx != WIPHY_IDX_INVALID) {
		struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);

		if (wiphy &&
		    nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
			goto nla_put_failure;
14001 14002 14003 14004 14005

		if (wiphy &&
		    wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
		    nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
			goto nla_put_failure;
14006
	}
14007

14008 14009 14010 14011 14012 14013 14014 14015 14016 14017 14018 14019 14020 14021 14022 14023 14024 14025 14026 14027 14028 14029 14030 14031 14032 14033 14034 14035 14036
	return true;

nla_put_failure:
	return false;
}

/*
 * This can happen on global regulatory changes or device specific settings
 * based on custom regulatory domains.
 */
void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
				     struct regulatory_request *request)
{
	struct sk_buff *msg;
	void *hdr;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

	if (nl80211_reg_change_event_fill(msg, request) == false)
		goto nla_put_failure;

J
Johannes Berg 已提交
14037
	genlmsg_end(msg, hdr);
14038

14039
	rcu_read_lock();
14040
	genlmsg_multicast_allns(&nl80211_fam, msg, 0,
14041
				NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
14042
	rcu_read_unlock();
14043 14044 14045 14046 14047 14048 14049

	return;

nla_put_failure:
	nlmsg_free(msg);
}

14050 14051 14052
static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
				    struct net_device *netdev,
				    const u8 *buf, size_t len,
14053 14054
				    enum nl80211_commands cmd, gfp_t gfp,
				    int uapsd_queues)
14055 14056 14057 14058
{
	struct sk_buff *msg;
	void *hdr;

14059
	msg = nlmsg_new(100 + len, gfp);
14060 14061 14062 14063 14064 14065 14066 14067 14068
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

14069 14070 14071 14072
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_FRAME, len, buf))
		goto nla_put_failure;
14073

14074 14075 14076 14077 14078 14079 14080 14081 14082 14083 14084 14085 14086
	if (uapsd_queues >= 0) {
		struct nlattr *nla_wmm =
			nla_nest_start(msg, NL80211_ATTR_STA_WME);
		if (!nla_wmm)
			goto nla_put_failure;

		if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
			       uapsd_queues))
			goto nla_put_failure;

		nla_nest_end(msg, nla_wmm);
	}

J
Johannes Berg 已提交
14087
	genlmsg_end(msg, hdr);
14088

14089
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14090
				NL80211_MCGRP_MLME, gfp);
14091 14092 14093 14094 14095 14096 14097
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
14098 14099
			  struct net_device *netdev, const u8 *buf,
			  size_t len, gfp_t gfp)
14100 14101
{
	nl80211_send_mlme_event(rdev, netdev, buf, len,
14102
				NL80211_CMD_AUTHENTICATE, gfp, -1);
14103 14104 14105 14106
}

void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
			   struct net_device *netdev, const u8 *buf,
14107
			   size_t len, gfp_t gfp, int uapsd_queues)
14108
{
14109
	nl80211_send_mlme_event(rdev, netdev, buf, len,
14110
				NL80211_CMD_ASSOCIATE, gfp, uapsd_queues);
14111 14112
}

14113
void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
14114 14115
			 struct net_device *netdev, const u8 *buf,
			 size_t len, gfp_t gfp)
14116 14117
{
	nl80211_send_mlme_event(rdev, netdev, buf, len,
14118
				NL80211_CMD_DEAUTHENTICATE, gfp, -1);
14119 14120
}

14121 14122
void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
			   struct net_device *netdev, const u8 *buf,
14123
			   size_t len, gfp_t gfp)
14124 14125
{
	nl80211_send_mlme_event(rdev, netdev, buf, len,
14126
				NL80211_CMD_DISASSOCIATE, gfp, -1);
14127 14128
}

14129 14130
void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
				  size_t len)
14131
{
14132 14133
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
14134
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14135 14136
	const struct ieee80211_mgmt *mgmt = (void *)buf;
	u32 cmd;
14137

14138 14139
	if (WARN_ON(len < 2))
		return;
14140

14141 14142 14143 14144
	if (ieee80211_is_deauth(mgmt->frame_control))
		cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
	else
		cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
14145

14146
	trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
14147
	nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1);
14148
}
14149
EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
14150

14151 14152
static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
				      struct net_device *netdev, int cmd,
14153
				      const u8 *addr, gfp_t gfp)
14154 14155 14156 14157
{
	struct sk_buff *msg;
	void *hdr;

14158
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14159 14160 14161 14162 14163 14164 14165 14166 14167
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

14168 14169 14170 14171 14172
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
	    nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
		goto nla_put_failure;
14173

J
Johannes Berg 已提交
14174
	genlmsg_end(msg, hdr);
14175

14176
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14177
				NL80211_MCGRP_MLME, gfp);
14178 14179 14180 14181 14182 14183 14184
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
14185 14186
			       struct net_device *netdev, const u8 *addr,
			       gfp_t gfp)
14187 14188
{
	nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
14189
				  addr, gfp);
14190 14191 14192
}

void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
14193 14194
				struct net_device *netdev, const u8 *addr,
				gfp_t gfp)
14195
{
14196 14197
	nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
				  addr, gfp);
14198 14199
}

S
Samuel Ortiz 已提交
14200
void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
14201 14202
				 struct net_device *netdev,
				 struct cfg80211_connect_resp_params *cr,
14203
				 gfp_t gfp)
S
Samuel Ortiz 已提交
14204 14205 14206 14207
{
	struct sk_buff *msg;
	void *hdr;

14208
	msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
14209 14210
			cr->fils.kek_len + cr->fils.pmk_len +
			(cr->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp);
S
Samuel Ortiz 已提交
14211 14212 14213 14214 14215 14216 14217 14218 14219
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

14220 14221
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14222 14223
	    (cr->bssid &&
	     nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cr->bssid)) ||
14224
	    nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
14225 14226 14227
			cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
			cr->status) ||
	    (cr->status < 0 &&
14228
	     (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
14229 14230 14231 14232 14233 14234
	      nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
			  cr->timeout_reason))) ||
	    (cr->req_ie &&
	     nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
	    (cr->resp_ie &&
	     nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
14235
		     cr->resp_ie)) ||
14236
	    (cr->fils.update_erp_next_seq_num &&
14237
	     nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
14238
			 cr->fils.erp_next_seq_num)) ||
14239
	    (cr->status == WLAN_STATUS_SUCCESS &&
14240 14241 14242 14243 14244 14245 14246
	     ((cr->fils.kek &&
	       nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len,
		       cr->fils.kek)) ||
	      (cr->fils.pmk &&
	       nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) ||
	      (cr->fils.pmkid &&
	       nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid)))))
14247
		goto nla_put_failure;
S
Samuel Ortiz 已提交
14248

J
Johannes Berg 已提交
14249
	genlmsg_end(msg, hdr);
S
Samuel Ortiz 已提交
14250

14251
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14252
				NL80211_MCGRP_MLME, gfp);
S
Samuel Ortiz 已提交
14253 14254 14255 14256 14257 14258 14259
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
14260 14261
			 struct net_device *netdev,
			 struct cfg80211_roam_info *info, gfp_t gfp)
S
Samuel Ortiz 已提交
14262 14263 14264
{
	struct sk_buff *msg;
	void *hdr;
14265
	const u8 *bssid = info->bss ? info->bss->bssid : info->bssid;
S
Samuel Ortiz 已提交
14266

14267 14268 14269
	msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len +
			info->fils.kek_len + info->fils.pmk_len +
			(info->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp);
S
Samuel Ortiz 已提交
14270 14271 14272 14273 14274 14275 14276 14277 14278
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

14279 14280 14281
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
14282 14283 14284 14285 14286
	    (info->req_ie &&
	     nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
		     info->req_ie)) ||
	    (info->resp_ie &&
	     nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
14287 14288 14289 14290 14291 14292 14293 14294 14295 14296 14297
		     info->resp_ie)) ||
	    (info->fils.update_erp_next_seq_num &&
	     nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
			 info->fils.erp_next_seq_num)) ||
	    (info->fils.kek &&
	     nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len,
		     info->fils.kek)) ||
	    (info->fils.pmk &&
	     nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) ||
	    (info->fils.pmkid &&
	     nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid)))
14298
		goto nla_put_failure;
S
Samuel Ortiz 已提交
14299

J
Johannes Berg 已提交
14300
	genlmsg_end(msg, hdr);
S
Samuel Ortiz 已提交
14301

14302
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14303
				NL80211_MCGRP_MLME, gfp);
S
Samuel Ortiz 已提交
14304 14305
	return;

14306 14307 14308 14309 14310 14311 14312 14313 14314 14315 14316 14317 14318 14319 14320 14321 14322 14323 14324 14325 14326 14327 14328 14329 14330 14331 14332 14333 14334
 nla_put_failure:
	nlmsg_free(msg);
}

void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev,
				  struct net_device *netdev, const u8 *bssid)
{
	struct sk_buff *msg;
	void *hdr;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

	if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
		goto nla_put_failure;

	genlmsg_end(msg, hdr);

	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
				NL80211_MCGRP_MLME, GFP_KERNEL);
	return;

S
Samuel Ortiz 已提交
14335 14336 14337 14338 14339 14340
 nla_put_failure:
	nlmsg_free(msg);
}

void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
			       struct net_device *netdev, u16 reason,
J
Johannes Berg 已提交
14341
			       const u8 *ie, size_t ie_len, bool from_ap)
S
Samuel Ortiz 已提交
14342 14343 14344 14345
{
	struct sk_buff *msg;
	void *hdr;

14346
	msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
S
Samuel Ortiz 已提交
14347 14348 14349 14350 14351 14352 14353 14354 14355
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

14356 14357
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14358
	    (reason &&
14359 14360 14361 14362 14363
	     nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
	    (from_ap &&
	     nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
	    (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
		goto nla_put_failure;
S
Samuel Ortiz 已提交
14364

J
Johannes Berg 已提交
14365
	genlmsg_end(msg, hdr);
S
Samuel Ortiz 已提交
14366

14367
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14368
				NL80211_MCGRP_MLME, GFP_KERNEL);
S
Samuel Ortiz 已提交
14369 14370 14371 14372 14373 14374
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

J
Johannes Berg 已提交
14375 14376 14377 14378 14379 14380 14381
void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
			     struct net_device *netdev, const u8 *bssid,
			     gfp_t gfp)
{
	struct sk_buff *msg;
	void *hdr;

14382
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
J
Johannes Berg 已提交
14383 14384 14385 14386 14387 14388 14389 14390 14391
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

14392 14393 14394 14395
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
		goto nla_put_failure;
J
Johannes Berg 已提交
14396

J
Johannes Berg 已提交
14397
	genlmsg_end(msg, hdr);
J
Johannes Berg 已提交
14398

14399
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14400
				NL80211_MCGRP_MLME, gfp);
J
Johannes Berg 已提交
14401 14402 14403 14404 14405 14406
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

14407 14408
void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
					const u8* ie, u8 ie_len, gfp_t gfp)
14409
{
14410
	struct wireless_dev *wdev = dev->ieee80211_ptr;
14411
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14412 14413 14414
	struct sk_buff *msg;
	void *hdr;

14415 14416 14417 14418 14419
	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
		return;

	trace_cfg80211_notify_new_peer_candidate(dev, addr);

14420
	msg = nlmsg_new(100 + ie_len, gfp);
14421 14422 14423 14424 14425 14426 14427 14428 14429
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

14430
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14431 14432
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
14433 14434 14435
	    (ie_len && ie &&
	     nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
		goto nla_put_failure;
14436

J
Johannes Berg 已提交
14437
	genlmsg_end(msg, hdr);
14438

14439
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14440
				NL80211_MCGRP_MLME, gfp);
14441 14442 14443 14444 14445
	return;

 nla_put_failure:
	nlmsg_free(msg);
}
14446
EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
14447

14448 14449 14450
void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
				 struct net_device *netdev, const u8 *addr,
				 enum nl80211_key_type key_type, int key_id,
14451
				 const u8 *tsc, gfp_t gfp)
14452 14453 14454 14455
{
	struct sk_buff *msg;
	void *hdr;

14456
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14457 14458 14459 14460 14461 14462 14463 14464 14465
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

14466 14467 14468 14469 14470 14471 14472 14473
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
	    (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
	    nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
	    (key_id != -1 &&
	     nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
	    (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
		goto nla_put_failure;
14474

J
Johannes Berg 已提交
14475
	genlmsg_end(msg, hdr);
14476

14477
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14478
				NL80211_MCGRP_MLME, gfp);
14479 14480 14481 14482 14483 14484
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

14485 14486 14487 14488 14489 14490 14491 14492
void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
				    struct ieee80211_channel *channel_before,
				    struct ieee80211_channel *channel_after)
{
	struct sk_buff *msg;
	void *hdr;
	struct nlattr *nl_freq;

14493
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
14494 14495 14496 14497 14498 14499 14500 14501 14502 14503 14504 14505 14506
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

	/*
	 * Since we are applying the beacon hint to a wiphy we know its
	 * wiphy_idx is valid
	 */
14507 14508
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
		goto nla_put_failure;
14509 14510 14511 14512 14513

	/* Before */
	nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
	if (!nl_freq)
		goto nla_put_failure;
14514 14515

	if (nl80211_msg_put_channel(msg, wiphy, channel_before, false))
14516 14517 14518 14519 14520 14521 14522
		goto nla_put_failure;
	nla_nest_end(msg, nl_freq);

	/* After */
	nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
	if (!nl_freq)
		goto nla_put_failure;
14523 14524

	if (nl80211_msg_put_channel(msg, wiphy, channel_after, false))
14525 14526 14527
		goto nla_put_failure;
	nla_nest_end(msg, nl_freq);

J
Johannes Berg 已提交
14528
	genlmsg_end(msg, hdr);
14529

14530
	rcu_read_lock();
14531
	genlmsg_multicast_allns(&nl80211_fam, msg, 0,
14532
				NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
14533
	rcu_read_unlock();
14534 14535 14536 14537 14538 14539 14540

	return;

nla_put_failure:
	nlmsg_free(msg);
}

14541 14542
static void nl80211_send_remain_on_chan_event(
	int cmd, struct cfg80211_registered_device *rdev,
14543
	struct wireless_dev *wdev, u64 cookie,
14544 14545 14546 14547 14548 14549 14550 14551 14552 14553 14554 14555 14556 14557 14558 14559
	struct ieee80211_channel *chan,
	unsigned int duration, gfp_t gfp)
{
	struct sk_buff *msg;
	void *hdr;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

14560
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14561 14562
	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
					 wdev->netdev->ifindex)) ||
14563 14564
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD) ||
14565
	    nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
14566 14567
	    nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
			NL80211_CHAN_NO_HT) ||
14568 14569
	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
			      NL80211_ATTR_PAD))
14570
		goto nla_put_failure;
14571

14572 14573 14574
	if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
	    nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
		goto nla_put_failure;
14575

J
Johannes Berg 已提交
14576
	genlmsg_end(msg, hdr);
14577

14578
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14579
				NL80211_MCGRP_MLME, gfp);
14580 14581 14582 14583 14584 14585
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

14586 14587 14588
void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
			       struct ieee80211_channel *chan,
			       unsigned int duration, gfp_t gfp)
14589
{
14590
	struct wiphy *wiphy = wdev->wiphy;
14591
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14592 14593

	trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
14594
	nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
14595
					  rdev, wdev, cookie, chan,
14596
					  duration, gfp);
14597
}
14598
EXPORT_SYMBOL(cfg80211_ready_on_channel);
14599

14600 14601 14602
void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
					struct ieee80211_channel *chan,
					gfp_t gfp)
14603
{
14604
	struct wiphy *wiphy = wdev->wiphy;
14605
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14606 14607

	trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
14608
	nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
14609
					  rdev, wdev, cookie, chan, 0, gfp);
14610
}
14611
EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
14612

14613 14614
void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
		      struct station_info *sinfo, gfp_t gfp)
14615
{
14616
	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
14617
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14618 14619
	struct sk_buff *msg;

14620 14621
	trace_cfg80211_new_sta(dev, mac_addr, sinfo);

14622
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14623 14624 14625
	if (!msg)
		return;

14626
	if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
14627
				 rdev, dev, mac_addr, sinfo) < 0) {
14628 14629 14630 14631
		nlmsg_free(msg);
		return;
	}

14632
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14633
				NL80211_MCGRP_MLME, gfp);
14634
}
14635
EXPORT_SYMBOL(cfg80211_new_sta);
14636

14637 14638
void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
			    struct station_info *sinfo, gfp_t gfp)
14639
{
14640
	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
14641
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14642
	struct sk_buff *msg;
14643
	struct station_info empty_sinfo = {};
14644

14645 14646
	if (!sinfo)
		sinfo = &empty_sinfo;
14647

14648 14649
	trace_cfg80211_del_sta(dev, mac_addr);

14650
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14651 14652
	if (!msg) {
		cfg80211_sinfo_release_content(sinfo);
14653
		return;
14654
	}
14655

14656
	if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
14657
				 rdev, dev, mac_addr, sinfo) < 0) {
14658
		nlmsg_free(msg);
14659
		return;
14660 14661
	}

14662
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14663
				NL80211_MCGRP_MLME, gfp);
14664
}
14665
EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
14666

14667 14668 14669
void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
			  enum nl80211_connect_failed_reason reason,
			  gfp_t gfp)
14670
{
14671
	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
14672
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14673 14674 14675 14676 14677 14678 14679 14680 14681 14682 14683 14684 14685 14686 14687 14688 14689 14690 14691 14692
	struct sk_buff *msg;
	void *hdr;

	msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
	    nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
		goto nla_put_failure;

	genlmsg_end(msg, hdr);

14693
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14694
				NL80211_MCGRP_MLME, gfp);
14695 14696 14697 14698 14699
	return;

 nla_put_failure:
	nlmsg_free(msg);
}
14700
EXPORT_SYMBOL(cfg80211_conn_failed);
14701

14702 14703
static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
				       const u8 *addr, gfp_t gfp)
14704 14705
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
14706
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14707 14708
	struct sk_buff *msg;
	void *hdr;
14709
	u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid);
14710

14711
	if (!nlportid)
14712 14713 14714 14715 14716 14717
		return false;

	msg = nlmsg_new(100, gfp);
	if (!msg)
		return true;

14718
	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
14719 14720 14721 14722 14723
	if (!hdr) {
		nlmsg_free(msg);
		return true;
	}

14724 14725 14726 14727
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
		goto nla_put_failure;
14728

14729
	genlmsg_end(msg, hdr);
14730
	genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
14731 14732 14733 14734 14735 14736 14737
	return true;

 nla_put_failure:
	nlmsg_free(msg);
	return true;
}

14738 14739
bool cfg80211_rx_spurious_frame(struct net_device *dev,
				const u8 *addr, gfp_t gfp)
14740
{
14741 14742 14743 14744 14745 14746 14747 14748 14749 14750 14751 14752 14753 14754
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	bool ret;

	trace_cfg80211_rx_spurious_frame(dev, addr);

	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
		    wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
		trace_cfg80211_return_bool(false);
		return false;
	}
	ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
					 addr, gfp);
	trace_cfg80211_return_bool(ret);
	return ret;
14755
}
14756
EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
14757

14758 14759
bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
					const u8 *addr, gfp_t gfp)
14760
{
14761 14762 14763 14764 14765 14766 14767 14768 14769 14770 14771 14772 14773 14774 14775 14776
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	bool ret;

	trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);

	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
		    wdev->iftype != NL80211_IFTYPE_P2P_GO &&
		    wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
		trace_cfg80211_return_bool(false);
		return false;
	}
	ret = __nl80211_unexpected_frame(dev,
					 NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
					 addr, gfp);
	trace_cfg80211_return_bool(ret);
	return ret;
14777
}
14778
EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
14779

14780
int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
14781
		      struct wireless_dev *wdev, u32 nlportid,
14782
		      int freq, int sig_dbm,
14783
		      const u8 *buf, size_t len, u32 flags, gfp_t gfp)
14784
{
14785
	struct net_device *netdev = wdev->netdev;
14786 14787 14788
	struct sk_buff *msg;
	void *hdr;

14789
	msg = nlmsg_new(100 + len, gfp);
14790 14791 14792
	if (!msg)
		return -ENOMEM;

14793
	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
14794 14795 14796 14797 14798
	if (!hdr) {
		nlmsg_free(msg);
		return -ENOMEM;
	}

14799
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14800 14801
	    (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
					netdev->ifindex)) ||
14802 14803
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD) ||
14804 14805 14806
	    nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
	    (sig_dbm &&
	     nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
14807 14808 14809
	    nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
	    (flags &&
	     nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
14810
		goto nla_put_failure;
14811

J
Johannes Berg 已提交
14812
	genlmsg_end(msg, hdr);
14813

14814
	return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
14815 14816 14817 14818 14819 14820

 nla_put_failure:
	nlmsg_free(msg);
	return -ENOBUFS;
}

14821 14822
void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
			     const u8 *buf, size_t len, bool ack, gfp_t gfp)
14823
{
14824
	struct wiphy *wiphy = wdev->wiphy;
14825
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14826
	struct net_device *netdev = wdev->netdev;
14827 14828 14829
	struct sk_buff *msg;
	void *hdr;

14830 14831
	trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);

14832
	msg = nlmsg_new(100 + len, gfp);
14833 14834 14835
	if (!msg)
		return;

14836
	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
14837 14838 14839 14840 14841
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

14842
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14843 14844
	    (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
				   netdev->ifindex)) ||
14845 14846
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD) ||
14847
	    nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
14848 14849
	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
			      NL80211_ATTR_PAD) ||
14850 14851
	    (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
		goto nla_put_failure;
14852

J
Johannes Berg 已提交
14853
	genlmsg_end(msg, hdr);
14854

14855
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14856
				NL80211_MCGRP_MLME, gfp);
14857 14858 14859 14860 14861
	return;

 nla_put_failure:
	nlmsg_free(msg);
}
14862
EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
14863

14864 14865 14866 14867 14868 14869 14870 14871 14872 14873 14874 14875 14876 14877 14878 14879 14880 14881 14882 14883 14884 14885 14886 14887 14888 14889 14890 14891 14892 14893 14894 14895 14896 14897 14898 14899 14900 14901 14902 14903 14904 14905 14906 14907 14908 14909 14910 14911 14912 14913 14914 14915 14916 14917 14918 14919 14920 14921
static int __nl80211_rx_control_port(struct net_device *dev,
				     const u8 *buf, size_t len,
				     const u8 *addr, u16 proto,
				     bool unencrypted, gfp_t gfp)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
	struct sk_buff *msg;
	void *hdr;
	u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid);

	if (!nlportid)
		return -ENOENT;

	msg = nlmsg_new(100 + len, gfp);
	if (!msg)
		return -ENOMEM;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME);
	if (!hdr) {
		nlmsg_free(msg);
		return -ENOBUFS;
	}

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD) ||
	    nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
	    nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) ||
	    (unencrypted && nla_put_flag(msg,
					 NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT)))
		goto nla_put_failure;

	genlmsg_end(msg, hdr);

	return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);

 nla_put_failure:
	nlmsg_free(msg);
	return -ENOBUFS;
}

bool cfg80211_rx_control_port(struct net_device *dev,
			      const u8 *buf, size_t len,
			      const u8 *addr, u16 proto, bool unencrypted)
{
	int ret;

	trace_cfg80211_rx_control_port(dev, buf, len, addr, proto, unencrypted);
	ret = __nl80211_rx_control_port(dev, buf, len, addr, proto,
					unencrypted, GFP_ATOMIC);
	trace_cfg80211_return_bool(ret == 0);
	return ret == 0;
}
EXPORT_SYMBOL(cfg80211_rx_control_port);

14922 14923
static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
					    const char *mac, gfp_t gfp)
14924
{
14925
	struct wireless_dev *wdev = dev->ieee80211_ptr;
14926 14927 14928
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
	struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
	void **cb;
14929

14930
	if (!msg)
14931
		return NULL;
14932

14933 14934 14935 14936
	cb = (void **)msg->cb;

	cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
	if (!cb[0]) {
14937
		nlmsg_free(msg);
14938
		return NULL;
14939 14940
	}

14941
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14942
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
14943
		goto nla_put_failure;
14944

14945
	if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
14946 14947
		goto nla_put_failure;

14948 14949
	cb[1] = nla_nest_start(msg, NL80211_ATTR_CQM);
	if (!cb[1])
14950
		goto nla_put_failure;
14951

14952
	cb[2] = rdev;
14953

14954 14955 14956 14957 14958 14959 14960 14961 14962 14963 14964 14965 14966 14967 14968
	return msg;
 nla_put_failure:
	nlmsg_free(msg);
	return NULL;
}

static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
{
	void **cb = (void **)msg->cb;
	struct cfg80211_registered_device *rdev = cb[2];

	nla_nest_end(msg, cb[1]);
	genlmsg_end(msg, cb[0]);

	memset(msg->cb, 0, sizeof(msg->cb));
14969

14970
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14971
				NL80211_MCGRP_MLME, gfp);
14972 14973 14974 14975
}

void cfg80211_cqm_rssi_notify(struct net_device *dev,
			      enum nl80211_cqm_rssi_threshold_event rssi_event,
14976
			      s32 rssi_level, gfp_t gfp)
14977 14978
{
	struct sk_buff *msg;
14979 14980
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14981

14982
	trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
14983

14984 14985 14986 14987
	if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
		    rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
		return;

14988 14989 14990 14991 14992 14993 14994 14995 14996
	if (wdev->cqm_config) {
		wdev->cqm_config->last_rssi_event_value = rssi_level;

		cfg80211_cqm_rssi_update(rdev, dev);

		if (rssi_level == 0)
			rssi_level = wdev->cqm_config->last_rssi_event_value;
	}

14997 14998 14999 15000 15001 15002 15003 15004
	msg = cfg80211_prepare_cqm(dev, NULL, gfp);
	if (!msg)
		return;

	if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
			rssi_event))
		goto nla_put_failure;

15005 15006 15007 15008
	if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
				      rssi_level))
		goto nla_put_failure;

15009 15010
	cfg80211_send_cqm(msg, gfp);

15011 15012 15013 15014 15015
	return;

 nla_put_failure:
	nlmsg_free(msg);
}
15016
EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
15017

15018 15019 15020 15021 15022 15023 15024 15025 15026 15027 15028 15029 15030 15031 15032 15033 15034 15035 15036 15037 15038 15039 15040 15041 15042 15043 15044 15045 15046 15047 15048 15049 15050 15051 15052 15053 15054 15055 15056 15057 15058 15059 15060 15061 15062 15063 15064 15065 15066
void cfg80211_cqm_txe_notify(struct net_device *dev,
			     const u8 *peer, u32 num_packets,
			     u32 rate, u32 intvl, gfp_t gfp)
{
	struct sk_buff *msg;

	msg = cfg80211_prepare_cqm(dev, peer, gfp);
	if (!msg)
		return;

	if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
		goto nla_put_failure;

	if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
		goto nla_put_failure;

	if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
		goto nla_put_failure;

	cfg80211_send_cqm(msg, gfp);
	return;

 nla_put_failure:
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_cqm_txe_notify);

void cfg80211_cqm_pktloss_notify(struct net_device *dev,
				 const u8 *peer, u32 num_packets, gfp_t gfp)
{
	struct sk_buff *msg;

	trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);

	msg = cfg80211_prepare_cqm(dev, peer, gfp);
	if (!msg)
		return;

	if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
		goto nla_put_failure;

	cfg80211_send_cqm(msg, gfp);
	return;

 nla_put_failure:
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);

15067 15068 15069 15070 15071 15072 15073 15074 15075 15076 15077 15078 15079 15080 15081 15082 15083 15084 15085
void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
{
	struct sk_buff *msg;

	msg = cfg80211_prepare_cqm(dev, NULL, gfp);
	if (!msg)
		return;

	if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
		goto nla_put_failure;

	cfg80211_send_cqm(msg, gfp);
	return;

 nla_put_failure:
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);

15086 15087 15088
static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
				     struct net_device *netdev, const u8 *bssid,
				     const u8 *replay_ctr, gfp_t gfp)
15089 15090 15091 15092 15093
{
	struct sk_buff *msg;
	struct nlattr *rekey_attr;
	void *hdr;

15094
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15095 15096 15097 15098 15099 15100 15101 15102 15103
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

15104 15105 15106 15107
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
		goto nla_put_failure;
15108 15109 15110 15111 15112

	rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
	if (!rekey_attr)
		goto nla_put_failure;

15113 15114 15115
	if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
		    NL80211_REPLAY_CTR_LEN, replay_ctr))
		goto nla_put_failure;
15116 15117 15118

	nla_nest_end(msg, rekey_attr);

J
Johannes Berg 已提交
15119
	genlmsg_end(msg, hdr);
15120

15121
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15122
				NL80211_MCGRP_MLME, gfp);
15123 15124 15125 15126 15127 15128
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

15129 15130 15131 15132 15133
void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
			       const u8 *replay_ctr, gfp_t gfp)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
15134
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15135 15136 15137 15138 15139 15140 15141 15142 15143 15144

	trace_cfg80211_gtk_rekey_notify(dev, bssid);
	nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
}
EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);

static void
nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
			       struct net_device *netdev, int index,
			       const u8 *bssid, bool preauth, gfp_t gfp)
15145 15146 15147 15148 15149
{
	struct sk_buff *msg;
	struct nlattr *attr;
	void *hdr;

15150
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15151 15152 15153 15154 15155 15156 15157 15158 15159
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

15160 15161 15162
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
		goto nla_put_failure;
15163 15164 15165 15166 15167

	attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
	if (!attr)
		goto nla_put_failure;

15168 15169 15170 15171 15172
	if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
	    nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
	    (preauth &&
	     nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
		goto nla_put_failure;
15173 15174 15175

	nla_nest_end(msg, attr);

J
Johannes Berg 已提交
15176
	genlmsg_end(msg, hdr);
15177

15178
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15179
				NL80211_MCGRP_MLME, gfp);
15180 15181 15182 15183 15184 15185
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

15186 15187 15188 15189 15190
void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
				     const u8 *bssid, bool preauth, gfp_t gfp)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
15191
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15192 15193 15194 15195 15196 15197 15198 15199 15200

	trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
	nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
}
EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);

static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
				     struct net_device *netdev,
				     struct cfg80211_chan_def *chandef,
15201 15202 15203
				     gfp_t gfp,
				     enum nl80211_commands notif,
				     u8 count)
15204 15205 15206 15207
{
	struct sk_buff *msg;
	void *hdr;

15208
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15209 15210 15211
	if (!msg)
		return;

15212
	hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
15213 15214 15215 15216 15217
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

15218 15219 15220 15221
	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
		goto nla_put_failure;

	if (nl80211_send_chandef(msg, chandef))
15222
		goto nla_put_failure;
15223

15224 15225 15226 15227
	if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
	    (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
			goto nla_put_failure;

15228 15229
	genlmsg_end(msg, hdr);

15230
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15231
				NL80211_MCGRP_MLME, gfp);
15232 15233 15234 15235 15236 15237
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

15238 15239
void cfg80211_ch_switch_notify(struct net_device *dev,
			       struct cfg80211_chan_def *chandef)
15240
{
15241 15242
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
15243
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15244

15245
	ASSERT_WDEV_LOCK(wdev);
15246

15247
	trace_cfg80211_ch_switch_notify(dev, chandef);
15248

15249
	wdev->chandef = *chandef;
15250
	wdev->preset_chandef = *chandef;
15251 15252
	nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
				 NL80211_CMD_CH_SWITCH_NOTIFY, 0);
15253 15254 15255
}
EXPORT_SYMBOL(cfg80211_ch_switch_notify);

15256 15257 15258 15259 15260 15261 15262 15263 15264 15265 15266 15267 15268 15269 15270
void cfg80211_ch_switch_started_notify(struct net_device *dev,
				       struct cfg80211_chan_def *chandef,
				       u8 count)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct wiphy *wiphy = wdev->wiphy;
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);

	trace_cfg80211_ch_switch_started_notify(dev, chandef);

	nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
				 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
}
EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);

15271 15272
void
nl80211_radar_notify(struct cfg80211_registered_device *rdev,
15273
		     const struct cfg80211_chan_def *chandef,
15274 15275 15276 15277 15278 15279 15280 15281 15282 15283 15284 15285 15286 15287 15288 15289 15290 15291 15292 15293 15294 15295 15296 15297
		     enum nl80211_radar_event event,
		     struct net_device *netdev, gfp_t gfp)
{
	struct sk_buff *msg;
	void *hdr;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
		goto nla_put_failure;

	/* NOP and radar events don't need a netdev parameter */
	if (netdev) {
		struct wireless_dev *wdev = netdev->ieee80211_ptr;

		if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15298 15299
		    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
				      NL80211_ATTR_PAD))
15300 15301 15302 15303 15304 15305 15306 15307 15308
			goto nla_put_failure;
	}

	if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
		goto nla_put_failure;

	if (nl80211_send_chandef(msg, chandef))
		goto nla_put_failure;

15309
	genlmsg_end(msg, hdr);
15310

15311
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15312
				NL80211_MCGRP_MLME, gfp);
15313 15314 15315 15316 15317 15318
	return;

 nla_put_failure:
	nlmsg_free(msg);
}

15319 15320 15321 15322 15323 15324 15325 15326 15327 15328 15329 15330 15331 15332 15333 15334 15335 15336 15337 15338 15339 15340 15341 15342 15343 15344 15345 15346 15347 15348 15349 15350 15351 15352 15353 15354 15355 15356 15357 15358 15359 15360 15361 15362 15363 15364 15365 15366 15367 15368 15369 15370 15371 15372 15373
void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac,
				       struct sta_opmode_info *sta_opmode,
				       gfp_t gfp)
{
	struct sk_buff *msg;
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
	void *hdr;

	if (WARN_ON(!mac))
		return;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
		goto nla_put_failure;

	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
		goto nla_put_failure;

	if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
		goto nla_put_failure;

	if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) &&
	    nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode))
		goto nla_put_failure;

	if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) &&
	    nla_put_u8(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw))
		goto nla_put_failure;

	if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) &&
	    nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss))
		goto nla_put_failure;

	genlmsg_end(msg, hdr);

	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
				NL80211_MCGRP_MLME, gfp);

	return;

nla_put_failure:
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify);

J
Johannes Berg 已提交
15374
void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
15375 15376
			   u64 cookie, bool acked, s32 ack_signal,
			   bool is_valid_ack_signal, gfp_t gfp)
J
Johannes Berg 已提交
15377 15378
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
15379
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
J
Johannes Berg 已提交
15380 15381 15382
	struct sk_buff *msg;
	void *hdr;

15383 15384
	trace_cfg80211_probe_status(dev, addr, cookie, acked);

15385
	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15386

J
Johannes Berg 已提交
15387 15388 15389 15390 15391 15392 15393 15394 15395
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

15396 15397 15398
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
15399 15400
	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
			      NL80211_ATTR_PAD) ||
15401 15402 15403
	    (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
	    (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL,
						ack_signal)))
15404
		goto nla_put_failure;
J
Johannes Berg 已提交
15405

15406
	genlmsg_end(msg, hdr);
J
Johannes Berg 已提交
15407

15408
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15409
				NL80211_MCGRP_MLME, gfp);
J
Johannes Berg 已提交
15410 15411 15412 15413 15414 15415 15416
	return;

 nla_put_failure:
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_probe_status);

15417 15418
void cfg80211_report_obss_beacon(struct wiphy *wiphy,
				 const u8 *frame, size_t len,
15419
				 int freq, int sig_dbm)
15420
{
15421
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15422 15423
	struct sk_buff *msg;
	void *hdr;
15424
	struct cfg80211_beacon_registration *reg;
15425

15426 15427
	trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);

15428 15429 15430 15431 15432 15433 15434
	spin_lock_bh(&rdev->beacon_registrations_lock);
	list_for_each_entry(reg, &rdev->beacon_registrations, list) {
		msg = nlmsg_new(len + 100, GFP_ATOMIC);
		if (!msg) {
			spin_unlock_bh(&rdev->beacon_registrations_lock);
			return;
		}
15435

15436 15437 15438
		hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
		if (!hdr)
			goto nla_put_failure;
15439

15440 15441 15442 15443 15444 15445 15446
		if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
		    (freq &&
		     nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
		    (sig_dbm &&
		     nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
		    nla_put(msg, NL80211_ATTR_FRAME, len, frame))
			goto nla_put_failure;
15447

15448
		genlmsg_end(msg, hdr);
15449

15450 15451 15452
		genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
	}
	spin_unlock_bh(&rdev->beacon_registrations_lock);
15453 15454 15455
	return;

 nla_put_failure:
15456
	spin_unlock_bh(&rdev->beacon_registrations_lock);
15457 15458 15459 15460
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_report_obss_beacon);

15461
#ifdef CONFIG_PM
15462 15463 15464 15465 15466 15467 15468 15469 15470 15471 15472 15473 15474 15475 15476 15477 15478 15479 15480 15481 15482 15483 15484 15485 15486 15487 15488 15489 15490 15491 15492 15493 15494 15495 15496 15497 15498 15499 15500 15501 15502
static int cfg80211_net_detect_results(struct sk_buff *msg,
				       struct cfg80211_wowlan_wakeup *wakeup)
{
	struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
	struct nlattr *nl_results, *nl_match, *nl_freqs;
	int i, j;

	nl_results = nla_nest_start(
		msg, NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
	if (!nl_results)
		return -EMSGSIZE;

	for (i = 0; i < nd->n_matches; i++) {
		struct cfg80211_wowlan_nd_match *match = nd->matches[i];

		nl_match = nla_nest_start(msg, i);
		if (!nl_match)
			break;

		/* The SSID attribute is optional in nl80211, but for
		 * simplicity reasons it's always present in the
		 * cfg80211 structure.  If a driver can't pass the
		 * SSID, that needs to be changed.  A zero length SSID
		 * is still a valid SSID (wildcard), so it cannot be
		 * used for this purpose.
		 */
		if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
			    match->ssid.ssid)) {
			nla_nest_cancel(msg, nl_match);
			goto out;
		}

		if (match->n_channels) {
			nl_freqs = nla_nest_start(
				msg, NL80211_ATTR_SCAN_FREQUENCIES);
			if (!nl_freqs) {
				nla_nest_cancel(msg, nl_match);
				goto out;
			}

			for (j = 0; j < match->n_channels; j++) {
15503
				if (nla_put_u32(msg, j, match->channels[j])) {
15504 15505 15506 15507 15508 15509 15510 15511 15512 15513 15514 15515 15516 15517 15518 15519 15520
					nla_nest_cancel(msg, nl_freqs);
					nla_nest_cancel(msg, nl_match);
					goto out;
				}
			}

			nla_nest_end(msg, nl_freqs);
		}

		nla_nest_end(msg, nl_match);
	}

out:
	nla_nest_end(msg, nl_results);
	return 0;
}

15521 15522 15523 15524
void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
				   struct cfg80211_wowlan_wakeup *wakeup,
				   gfp_t gfp)
{
15525
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15526 15527
	struct sk_buff *msg;
	void *hdr;
15528
	int size = 200;
15529 15530 15531 15532 15533 15534 15535 15536 15537 15538 15539 15540 15541 15542 15543

	trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);

	if (wakeup)
		size += wakeup->packet_present_len;

	msg = nlmsg_new(size, gfp);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
	if (!hdr)
		goto free_msg;

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15544 15545
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD))
15546 15547 15548 15549 15550 15551 15552 15553 15554 15555
		goto free_msg;

	if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
					wdev->netdev->ifindex))
		goto free_msg;

	if (wakeup) {
		struct nlattr *reasons;

		reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
15556 15557
		if (!reasons)
			goto free_msg;
15558 15559 15560 15561 15562 15563 15564 15565 15566 15567 15568 15569 15570 15571 15572 15573 15574 15575 15576 15577 15578 15579 15580 15581 15582

		if (wakeup->disconnect &&
		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
			goto free_msg;
		if (wakeup->magic_pkt &&
		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
			goto free_msg;
		if (wakeup->gtk_rekey_failure &&
		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
			goto free_msg;
		if (wakeup->eap_identity_req &&
		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
			goto free_msg;
		if (wakeup->four_way_handshake &&
		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
			goto free_msg;
		if (wakeup->rfkill_release &&
		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
			goto free_msg;

		if (wakeup->pattern_idx >= 0 &&
		    nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
				wakeup->pattern_idx))
			goto free_msg;

15583 15584 15585
		if (wakeup->tcp_match &&
		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
			goto free_msg;
15586

15587 15588 15589
		if (wakeup->tcp_connlost &&
		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
			goto free_msg;
15590

15591 15592 15593 15594
		if (wakeup->tcp_nomoretokens &&
		    nla_put_flag(msg,
				 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
			goto free_msg;
15595

15596 15597 15598 15599 15600 15601 15602 15603 15604 15605 15606 15607 15608 15609 15610 15611 15612 15613 15614 15615
		if (wakeup->packet) {
			u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
			u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;

			if (!wakeup->packet_80211) {
				pkt_attr =
					NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
				len_attr =
					NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
			}

			if (wakeup->packet_len &&
			    nla_put_u32(msg, len_attr, wakeup->packet_len))
				goto free_msg;

			if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
				    wakeup->packet))
				goto free_msg;
		}

15616 15617 15618 15619
		if (wakeup->net_detect &&
		    cfg80211_net_detect_results(msg, wakeup))
				goto free_msg;

15620 15621 15622
		nla_nest_end(msg, reasons);
	}

15623
	genlmsg_end(msg, hdr);
15624

15625
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15626
				NL80211_MCGRP_MLME, gfp);
15627 15628 15629 15630 15631 15632 15633 15634
	return;

 free_msg:
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
#endif

15635 15636 15637 15638 15639
void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
				enum nl80211_tdls_operation oper,
				u16 reason_code, gfp_t gfp)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
15640
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15641 15642 15643 15644 15645 15646 15647 15648 15649 15650 15651 15652 15653 15654 15655 15656 15657 15658 15659 15660 15661 15662 15663 15664
	struct sk_buff *msg;
	void *hdr;

	trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
					 reason_code);

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
	if (!hdr) {
		nlmsg_free(msg);
		return;
	}

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
	    (reason_code > 0 &&
	     nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
		goto nla_put_failure;

15665
	genlmsg_end(msg, hdr);
15666

15667
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15668
				NL80211_MCGRP_MLME, gfp);
15669 15670 15671 15672 15673 15674 15675
	return;

 nla_put_failure:
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_tdls_oper_request);

15676 15677 15678 15679 15680 15681 15682
static int nl80211_netlink_notify(struct notifier_block * nb,
				  unsigned long state,
				  void *_notify)
{
	struct netlink_notify *notify = _notify;
	struct cfg80211_registered_device *rdev;
	struct wireless_dev *wdev;
15683
	struct cfg80211_beacon_registration *reg, *tmp;
15684

15685
	if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
15686 15687 15688 15689
		return NOTIFY_DONE;

	rcu_read_lock();

15690
	list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
15691
		struct cfg80211_sched_scan_request *sched_scan_req;
15692

15693 15694 15695 15696 15697
		list_for_each_entry_rcu(sched_scan_req,
					&rdev->sched_scan_req_list,
					list) {
			if (sched_scan_req->owner_nlportid == notify->portid) {
				sched_scan_req->nl_owner_dead = true;
15698
				schedule_work(&rdev->sched_scan_stop_wk);
15699
			}
15700
		}
15701

15702
		list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
15703
			cfg80211_mlme_unregister_socket(wdev, notify->portid);
15704

15705 15706 15707 15708
			if (wdev->owner_nlportid == notify->portid) {
				wdev->nl_owner_dead = true;
				schedule_work(&rdev->destroy_work);
			} else if (wdev->conn_owner_nlportid == notify->portid) {
15709
				schedule_work(&wdev->disconnect_wk);
15710
			}
15711 15712
		}

15713 15714 15715 15716 15717 15718 15719 15720 15721 15722
		spin_lock_bh(&rdev->beacon_registrations_lock);
		list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
					 list) {
			if (reg->nlportid == notify->portid) {
				list_del(&reg->list);
				kfree(reg);
				break;
			}
		}
		spin_unlock_bh(&rdev->beacon_registrations_lock);
15723
	}
15724 15725 15726

	rcu_read_unlock();

15727 15728 15729 15730 15731
	/*
	 * It is possible that the user space process that is controlling the
	 * indoor setting disappeared, so notify the regulatory core.
	 */
	regulatory_netlink_notify(notify->portid);
15732
	return NOTIFY_OK;
15733 15734 15735 15736 15737 15738
}

static struct notifier_block nl80211_netlink_notifier = {
	.notifier_call = nl80211_netlink_notify,
};

15739 15740 15741 15742
void cfg80211_ft_event(struct net_device *netdev,
		       struct cfg80211_ft_event_params *ft_event)
{
	struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
15743
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15744 15745 15746 15747 15748 15749 15750 15751
	struct sk_buff *msg;
	void *hdr;

	trace_cfg80211_ft_event(wiphy, netdev, ft_event);

	if (!ft_event->target_ap)
		return;

15752
	msg = nlmsg_new(100 + ft_event->ric_ies_len, GFP_KERNEL);
15753 15754 15755 15756
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
15757 15758
	if (!hdr)
		goto out;
15759

15760 15761 15762 15763
	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
		goto out;
15764

15765 15766 15767 15768 15769 15770 15771
	if (ft_event->ies &&
	    nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
		goto out;
	if (ft_event->ric_ies &&
	    nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
		    ft_event->ric_ies))
		goto out;
15772

15773
	genlmsg_end(msg, hdr);
15774

15775
	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15776
				NL80211_MCGRP_MLME, GFP_KERNEL);
15777 15778 15779
	return;
 out:
	nlmsg_free(msg);
15780 15781 15782
}
EXPORT_SYMBOL(cfg80211_ft_event);

15783 15784 15785 15786 15787 15788 15789
void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
{
	struct cfg80211_registered_device *rdev;
	struct sk_buff *msg;
	void *hdr;
	u32 nlportid;

15790
	rdev = wiphy_to_rdev(wdev->wiphy);
15791 15792 15793 15794 15795 15796 15797 15798 15799 15800 15801 15802 15803 15804 15805
	if (!rdev->crit_proto_nlportid)
		return;

	nlportid = rdev->crit_proto_nlportid;
	rdev->crit_proto_nlportid = 0;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
	if (!hdr)
		goto nla_put_failure;

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15806 15807
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD))
15808 15809 15810 15811 15812 15813 15814 15815 15816 15817 15818 15819
		goto nla_put_failure;

	genlmsg_end(msg, hdr);

	genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
	return;

 nla_put_failure:
	nlmsg_free(msg);
}
EXPORT_SYMBOL(cfg80211_crit_proto_stopped);

15820 15821 15822
void nl80211_send_ap_stopped(struct wireless_dev *wdev)
{
	struct wiphy *wiphy = wdev->wiphy;
15823
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15824 15825 15826 15827 15828 15829 15830 15831 15832 15833 15834 15835 15836
	struct sk_buff *msg;
	void *hdr;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
	if (!msg)
		return;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
	if (!hdr)
		goto out;

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
15837 15838
	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
			      NL80211_ATTR_PAD))
15839 15840 15841 15842 15843 15844 15845 15846 15847 15848 15849
		goto out;

	genlmsg_end(msg, hdr);

	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
				NL80211_MCGRP_MLME, GFP_KERNEL);
	return;
 out:
	nlmsg_free(msg);
}

15850 15851 15852 15853 15854 15855 15856 15857 15858 15859 15860 15861 15862 15863 15864 15865 15866 15867 15868 15869 15870 15871 15872 15873 15874 15875 15876 15877 15878 15879 15880 15881 15882 15883 15884 15885 15886 15887 15888 15889 15890
int cfg80211_external_auth_request(struct net_device *dev,
				   struct cfg80211_external_auth_params *params,
				   gfp_t gfp)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
	struct sk_buff *msg;
	void *hdr;

	if (!wdev->conn_owner_nlportid)
		return -EINVAL;

	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
	if (!msg)
		return -ENOMEM;

	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH);
	if (!hdr)
		goto nla_put_failure;

	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
	    nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) ||
	    nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION,
			params->action) ||
	    nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) ||
	    nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len,
		    params->ssid.ssid))
		goto nla_put_failure;

	genlmsg_end(msg, hdr);
	genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
			wdev->conn_owner_nlportid);
	return 0;

 nla_put_failure:
	nlmsg_free(msg);
	return -ENOBUFS;
}
EXPORT_SYMBOL(cfg80211_external_auth_request);

15891 15892
/* initialisation/exit functions */

15893
int __init nl80211_init(void)
15894
{
15895
	int err;
15896

15897
	err = genl_register_family(&nl80211_fam);
15898 15899 15900
	if (err)
		return err;

15901 15902 15903 15904
	err = netlink_register_notifier(&nl80211_netlink_notifier);
	if (err)
		goto err_out;

15905 15906 15907 15908 15909 15910 15911 15912
	return 0;
 err_out:
	genl_unregister_family(&nl80211_fam);
	return err;
}

void nl80211_exit(void)
{
15913
	netlink_unregister_notifier(&nl80211_netlink_notifier);
15914 15915
	genl_unregister_family(&nl80211_fam);
}