xref: /linux/net/wireless/nl80211.c (revision 3494bec0f6ac8ac06e0ad7c35933db345b2c5a83)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * This is the new netlink-based wireless configuration interface.
4  *
5  * Copyright 2006-2010	Johannes Berg <johannes@sipsolutions.net>
6  * Copyright 2013-2014  Intel Mobile Communications GmbH
7  * Copyright 2015-2017	Intel Deutschland GmbH
8  * Copyright (C) 2018-2019 Intel Corporation
9  */
10 
11 #include <linux/if.h>
12 #include <linux/module.h>
13 #include <linux/err.h>
14 #include <linux/slab.h>
15 #include <linux/list.h>
16 #include <linux/if_ether.h>
17 #include <linux/ieee80211.h>
18 #include <linux/nl80211.h>
19 #include <linux/rtnetlink.h>
20 #include <linux/netlink.h>
21 #include <linux/nospec.h>
22 #include <linux/etherdevice.h>
23 #include <net/net_namespace.h>
24 #include <net/genetlink.h>
25 #include <net/cfg80211.h>
26 #include <net/sock.h>
27 #include <net/inet_connection_sock.h>
28 #include "core.h"
29 #include "nl80211.h"
30 #include "reg.h"
31 #include "rdev-ops.h"
32 
33 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
34 				   struct genl_info *info,
35 				   struct cfg80211_crypto_settings *settings,
36 				   int cipher_limit);
37 
38 /* the netlink family */
39 static struct genl_family nl80211_fam;
40 
41 /* multicast groups */
42 enum nl80211_multicast_groups {
43 	NL80211_MCGRP_CONFIG,
44 	NL80211_MCGRP_SCAN,
45 	NL80211_MCGRP_REGULATORY,
46 	NL80211_MCGRP_MLME,
47 	NL80211_MCGRP_VENDOR,
48 	NL80211_MCGRP_NAN,
49 	NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
50 };
51 
52 static const struct genl_multicast_group nl80211_mcgrps[] = {
53 	[NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
54 	[NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
55 	[NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
56 	[NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
57 	[NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
58 	[NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
59 #ifdef CONFIG_NL80211_TESTMODE
60 	[NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
61 #endif
62 };
63 
64 /* returns ERR_PTR values */
65 static struct wireless_dev *
66 __cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
67 {
68 	struct cfg80211_registered_device *rdev;
69 	struct wireless_dev *result = NULL;
70 	bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
71 	bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
72 	u64 wdev_id;
73 	int wiphy_idx = -1;
74 	int ifidx = -1;
75 
76 	ASSERT_RTNL();
77 
78 	if (!have_ifidx && !have_wdev_id)
79 		return ERR_PTR(-EINVAL);
80 
81 	if (have_ifidx)
82 		ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
83 	if (have_wdev_id) {
84 		wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
85 		wiphy_idx = wdev_id >> 32;
86 	}
87 
88 	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
89 		struct wireless_dev *wdev;
90 
91 		if (wiphy_net(&rdev->wiphy) != netns)
92 			continue;
93 
94 		if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
95 			continue;
96 
97 		list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
98 			if (have_ifidx && wdev->netdev &&
99 			    wdev->netdev->ifindex == ifidx) {
100 				result = wdev;
101 				break;
102 			}
103 			if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
104 				result = wdev;
105 				break;
106 			}
107 		}
108 
109 		if (result)
110 			break;
111 	}
112 
113 	if (result)
114 		return result;
115 	return ERR_PTR(-ENODEV);
116 }
117 
118 static struct cfg80211_registered_device *
119 __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
120 {
121 	struct cfg80211_registered_device *rdev = NULL, *tmp;
122 	struct net_device *netdev;
123 
124 	ASSERT_RTNL();
125 
126 	if (!attrs[NL80211_ATTR_WIPHY] &&
127 	    !attrs[NL80211_ATTR_IFINDEX] &&
128 	    !attrs[NL80211_ATTR_WDEV])
129 		return ERR_PTR(-EINVAL);
130 
131 	if (attrs[NL80211_ATTR_WIPHY])
132 		rdev = cfg80211_rdev_by_wiphy_idx(
133 				nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
134 
135 	if (attrs[NL80211_ATTR_WDEV]) {
136 		u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
137 		struct wireless_dev *wdev;
138 		bool found = false;
139 
140 		tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
141 		if (tmp) {
142 			/* make sure wdev exists */
143 			list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
144 				if (wdev->identifier != (u32)wdev_id)
145 					continue;
146 				found = true;
147 				break;
148 			}
149 
150 			if (!found)
151 				tmp = NULL;
152 
153 			if (rdev && tmp != rdev)
154 				return ERR_PTR(-EINVAL);
155 			rdev = tmp;
156 		}
157 	}
158 
159 	if (attrs[NL80211_ATTR_IFINDEX]) {
160 		int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
161 
162 		netdev = __dev_get_by_index(netns, ifindex);
163 		if (netdev) {
164 			if (netdev->ieee80211_ptr)
165 				tmp = wiphy_to_rdev(
166 					netdev->ieee80211_ptr->wiphy);
167 			else
168 				tmp = NULL;
169 
170 			/* not wireless device -- return error */
171 			if (!tmp)
172 				return ERR_PTR(-EINVAL);
173 
174 			/* mismatch -- return error */
175 			if (rdev && tmp != rdev)
176 				return ERR_PTR(-EINVAL);
177 
178 			rdev = tmp;
179 		}
180 	}
181 
182 	if (!rdev)
183 		return ERR_PTR(-ENODEV);
184 
185 	if (netns != wiphy_net(&rdev->wiphy))
186 		return ERR_PTR(-ENODEV);
187 
188 	return rdev;
189 }
190 
191 /*
192  * This function returns a pointer to the driver
193  * that the genl_info item that is passed refers to.
194  *
195  * The result of this can be a PTR_ERR and hence must
196  * be checked with IS_ERR() for errors.
197  */
198 static struct cfg80211_registered_device *
199 cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
200 {
201 	return __cfg80211_rdev_from_attrs(netns, info->attrs);
202 }
203 
204 static int validate_beacon_head(const struct nlattr *attr,
205 				struct netlink_ext_ack *extack)
206 {
207 	const u8 *data = nla_data(attr);
208 	unsigned int len = nla_len(attr);
209 	const struct element *elem;
210 	const struct ieee80211_mgmt *mgmt = (void *)data;
211 	unsigned int fixedlen = offsetof(struct ieee80211_mgmt,
212 					 u.beacon.variable);
213 
214 	if (len < fixedlen)
215 		goto err;
216 
217 	if (ieee80211_hdrlen(mgmt->frame_control) !=
218 	    offsetof(struct ieee80211_mgmt, u.beacon))
219 		goto err;
220 
221 	data += fixedlen;
222 	len -= fixedlen;
223 
224 	for_each_element(elem, data, len) {
225 		/* nothing */
226 	}
227 
228 	if (for_each_element_completed(elem, data, len))
229 		return 0;
230 
231 err:
232 	NL_SET_ERR_MSG_ATTR(extack, attr, "malformed beacon head");
233 	return -EINVAL;
234 }
235 
236 static int validate_ie_attr(const struct nlattr *attr,
237 			    struct netlink_ext_ack *extack)
238 {
239 	const u8 *data = nla_data(attr);
240 	unsigned int len = nla_len(attr);
241 	const struct element *elem;
242 
243 	for_each_element(elem, data, len) {
244 		/* nothing */
245 	}
246 
247 	if (for_each_element_completed(elem, data, len))
248 		return 0;
249 
250 	NL_SET_ERR_MSG_ATTR(extack, attr, "malformed information elements");
251 	return -EINVAL;
252 }
253 
254 /* policy for the attributes */
255 static const struct nla_policy
256 nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = {
257 	[NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, },
258 	[NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY,
259 					.len = U8_MAX },
260 	[NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY,
261 					     .len = U8_MAX },
262 };
263 
264 static const struct nla_policy
265 nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = {
266 	[NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG },
267 	[NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 },
268 	[NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] =
269 		NLA_POLICY_MAX(NLA_U8, 15),
270 	[NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 },
271 	[NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] =
272 		NLA_POLICY_MAX(NLA_U8, 15),
273 	[NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] =
274 		NLA_POLICY_MAX(NLA_U8, 31),
275 	[NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 },
276 	[NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG },
277 	[NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG },
278 };
279 
280 static const struct nla_policy
281 nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = {
282 	[NL80211_PMSR_TYPE_FTM] =
283 		NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy),
284 };
285 
286 static const struct nla_policy
287 nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = {
288 	[NL80211_PMSR_REQ_ATTR_DATA] =
289 		NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy),
290 	[NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG },
291 };
292 
293 static const struct nla_policy
294 nl80211_psmr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = {
295 	[NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR,
296 	/*
297 	 * we could specify this again to be the top-level policy,
298 	 * but that would open us up to recursion problems ...
299 	 */
300 	[NL80211_PMSR_PEER_ATTR_CHAN] = { .type = NLA_NESTED },
301 	[NL80211_PMSR_PEER_ATTR_REQ] =
302 		NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy),
303 	[NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT },
304 };
305 
306 static const struct nla_policy
307 nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = {
308 	[NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT },
309 	[NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT },
310 	[NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT },
311 	[NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT },
312 	[NL80211_PMSR_ATTR_PEERS] =
313 		NLA_POLICY_NESTED_ARRAY(nl80211_psmr_peer_attr_policy),
314 };
315 
316 static const struct nla_policy
317 he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = {
318 	[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] =
319 		NLA_POLICY_RANGE(NLA_U8, 1, 20),
320 	[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] =
321 		NLA_POLICY_RANGE(NLA_U8, 1, 20),
322 };
323 
324 static const struct nla_policy
325 he_bss_color_policy[NL80211_HE_BSS_COLOR_ATTR_MAX + 1] = {
326 	[NL80211_HE_BSS_COLOR_ATTR_COLOR] = NLA_POLICY_RANGE(NLA_U8, 1, 63),
327 	[NL80211_HE_BSS_COLOR_ATTR_DISABLED] = { .type = NLA_FLAG },
328 	[NL80211_HE_BSS_COLOR_ATTR_PARTIAL] = { .type = NLA_FLAG },
329 };
330 
331 const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
332 	[0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD },
333 	[NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
334 	[NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
335 				      .len = 20-1 },
336 	[NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
337 
338 	[NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
339 	[NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
340 	[NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8,
341 						NL80211_EDMG_CHANNELS_MIN,
342 						NL80211_EDMG_CHANNELS_MAX),
343 	[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8,
344 						NL80211_EDMG_BW_CONFIG_MIN,
345 						NL80211_EDMG_BW_CONFIG_MAX),
346 
347 	[NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
348 	[NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
349 	[NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
350 
351 	[NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1),
352 	[NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1),
353 	[NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
354 	[NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
355 	[NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
356 	[NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
357 
358 	[NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX),
359 	[NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
360 	[NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
361 
362 	[NL80211_ATTR_MAC] = { .type = NLA_EXACT_LEN_WARN, .len = ETH_ALEN },
363 	[NL80211_ATTR_PREV_BSSID] = {
364 		.type = NLA_EXACT_LEN_WARN,
365 		.len = ETH_ALEN
366 	},
367 
368 	[NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
369 	[NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
370 				    .len = WLAN_MAX_KEY_LEN },
371 	[NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 5),
372 	[NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
373 	[NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
374 	[NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
375 	[NL80211_ATTR_KEY_TYPE] =
376 		NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES),
377 
378 	[NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
379 	[NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
380 	[NL80211_ATTR_BEACON_HEAD] =
381 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head,
382 				       IEEE80211_MAX_DATA_LEN),
383 	[NL80211_ATTR_BEACON_TAIL] =
384 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
385 				       IEEE80211_MAX_DATA_LEN),
386 	[NL80211_ATTR_STA_AID] =
387 		NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
388 	[NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
389 	[NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
390 	[NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
391 					       .len = NL80211_MAX_SUPP_RATES },
392 	[NL80211_ATTR_STA_PLINK_ACTION] =
393 		NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1),
394 	[NL80211_ATTR_STA_TX_POWER_SETTING] =
395 		NLA_POLICY_RANGE(NLA_U8,
396 				 NL80211_TX_POWER_AUTOMATIC,
397 				 NL80211_TX_POWER_FIXED),
398 	[NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 },
399 	[NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
400 	[NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
401 	[NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
402 				   .len = IEEE80211_MAX_MESH_ID_LEN },
403 	[NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT,
404 
405 	[NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
406 	[NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
407 
408 	[NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
409 	[NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
410 	[NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
411 	[NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
412 					   .len = NL80211_MAX_SUPP_RATES },
413 	[NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
414 
415 	[NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
416 	[NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
417 
418 	[NL80211_ATTR_HT_CAPABILITY] = {
419 		.type = NLA_EXACT_LEN_WARN,
420 		.len = NL80211_HT_CAPABILITY_LEN
421 	},
422 
423 	[NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
424 	[NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY,
425 						   validate_ie_attr,
426 						   IEEE80211_MAX_DATA_LEN),
427 	[NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
428 	[NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
429 
430 	[NL80211_ATTR_SSID] = { .type = NLA_BINARY,
431 				.len = IEEE80211_MAX_SSID_LEN },
432 	[NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
433 	[NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
434 	[NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
435 	[NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
436 	[NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32,
437 						  NL80211_MFP_NO,
438 						  NL80211_MFP_OPTIONAL),
439 	[NL80211_ATTR_STA_FLAGS2] = {
440 		.len = sizeof(struct nl80211_sta_flag_update),
441 	},
442 	[NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
443 	[NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
444 	[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
445 	[NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG },
446 	[NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
447 	[NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 },
448 	[NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
449 	[NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
450 	[NL80211_ATTR_PID] = { .type = NLA_U32 },
451 	[NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
452 	[NL80211_ATTR_PMKID] = {
453 		.type = NLA_EXACT_LEN_WARN,
454 		.len = WLAN_PMKID_LEN
455 	},
456 	[NL80211_ATTR_DURATION] = { .type = NLA_U32 },
457 	[NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
458 	[NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
459 	[NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
460 				 .len = IEEE80211_MAX_DATA_LEN },
461 	[NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
462 	[NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32,
463 						   NL80211_PS_DISABLED,
464 						   NL80211_PS_ENABLED),
465 	[NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
466 	[NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
467 	[NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
468 	[NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
469 	[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
470 	[NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
471 	[NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
472 	[NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
473 	[NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
474 	[NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
475 	[NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
476 	[NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
477 	[NL80211_ATTR_STA_PLINK_STATE] =
478 		NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1),
479 	[NL80211_ATTR_MESH_PEER_AID] =
480 		NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
481 	[NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
482 	[NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
483 	[NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
484 	[NL80211_ATTR_HIDDEN_SSID] =
485 		NLA_POLICY_RANGE(NLA_U32,
486 				 NL80211_HIDDEN_SSID_NOT_IN_USE,
487 				 NL80211_HIDDEN_SSID_ZERO_CONTENTS),
488 	[NL80211_ATTR_IE_PROBE_RESP] =
489 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
490 				       IEEE80211_MAX_DATA_LEN),
491 	[NL80211_ATTR_IE_ASSOC_RESP] =
492 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
493 				       IEEE80211_MAX_DATA_LEN),
494 	[NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
495 	[NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
496 	[NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
497 	[NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
498 	[NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
499 	[NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
500 	[NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
501 	[NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
502 	[NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
503 	[NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
504 	[NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
505 				      .len = IEEE80211_MAX_DATA_LEN },
506 	[NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
507 	[NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
508 	[NL80211_ATTR_HT_CAPABILITY_MASK] = {
509 		.len = NL80211_HT_CAPABILITY_LEN
510 	},
511 	[NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
512 	[NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
513 	[NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
514 	[NL80211_ATTR_WDEV] = { .type = NLA_U64 },
515 	[NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
516 	[NL80211_ATTR_AUTH_DATA] = { .type = NLA_BINARY, },
517 	[NL80211_ATTR_VHT_CAPABILITY] = {
518 		.type = NLA_EXACT_LEN_WARN,
519 		.len = NL80211_VHT_CAPABILITY_LEN
520 	},
521 	[NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
522 	[NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127),
523 	[NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1),
524 	[NL80211_ATTR_LOCAL_MESH_POWER_MODE] =
525 		NLA_POLICY_RANGE(NLA_U32,
526 				 NL80211_MESH_POWER_UNKNOWN + 1,
527 				 NL80211_MESH_POWER_MAX),
528 	[NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
529 	[NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
530 	[NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
531 	[NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
532 	[NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
533 	[NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
534 	[NL80211_ATTR_VHT_CAPABILITY_MASK] = {
535 		.len = NL80211_VHT_CAPABILITY_LEN,
536 	},
537 	[NL80211_ATTR_MDID] = { .type = NLA_U16 },
538 	[NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
539 				  .len = IEEE80211_MAX_DATA_LEN },
540 	[NL80211_ATTR_PEER_AID] =
541 		NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
542 	[NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
543 	[NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
544 	[NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
545 	[NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
546 	[NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
547 	[NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
548 	[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
549 	[NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
550 	[NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
551 	[NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
552 	[NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
553 	[NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
554 	[NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
555 				   .len = IEEE80211_QOS_MAP_LEN_MAX },
556 	[NL80211_ATTR_MAC_HINT] = {
557 		.type = NLA_EXACT_LEN_WARN,
558 		.len = ETH_ALEN
559 	},
560 	[NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
561 	[NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
562 	[NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
563 	[NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
564 	[NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
565 	[NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1),
566 	[NL80211_ATTR_USER_PRIO] =
567 		NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1),
568 	[NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
569 	[NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
570 	[NL80211_ATTR_MAC_MASK] = {
571 		.type = NLA_EXACT_LEN_WARN,
572 		.len = ETH_ALEN
573 	},
574 	[NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
575 	[NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
576 	[NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
577 	[NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
578 	[NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
579 	[NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
580 	[NL80211_ATTR_STA_SUPPORT_P2P_PS] =
581 		NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1),
582 	[NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
583 		.len = VHT_MUMIMO_GROUPS_DATA_LEN
584 	},
585 	[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = {
586 		.type = NLA_EXACT_LEN_WARN,
587 		.len = ETH_ALEN
588 	},
589 	[NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1),
590 	[NL80211_ATTR_BANDS] = { .type = NLA_U32 },
591 	[NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
592 	[NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
593 				    .len = FILS_MAX_KEK_LEN },
594 	[NL80211_ATTR_FILS_NONCES] = {
595 		.type = NLA_EXACT_LEN_WARN,
596 		.len = 2 * FILS_NONCE_LEN
597 	},
598 	[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
599 	[NL80211_ATTR_BSSID] = { .type = NLA_EXACT_LEN_WARN, .len = ETH_ALEN },
600 	[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
601 	[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
602 		.len = sizeof(struct nl80211_bss_select_rssi_adjust)
603 	},
604 	[NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
605 	[NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
606 					     .len = FILS_ERP_MAX_USERNAME_LEN },
607 	[NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
608 					  .len = FILS_ERP_MAX_REALM_LEN },
609 	[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
610 	[NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
611 					.len = FILS_ERP_MAX_RRK_LEN },
612 	[NL80211_ATTR_FILS_CACHE_ID] = { .type = NLA_EXACT_LEN_WARN, .len = 2 },
613 	[NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
614 	[NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
615 	[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG },
616 
617 	[NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 },
618 	[NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 },
619 	[NL80211_ATTR_TXQ_QUANTUM] = { .type = NLA_U32 },
620 	[NL80211_ATTR_HE_CAPABILITY] = { .type = NLA_BINARY,
621 					 .len = NL80211_HE_MAX_CAPABILITY_LEN },
622 
623 	[NL80211_ATTR_FTM_RESPONDER] = {
624 		.type = NLA_NESTED,
625 		.validation_data = nl80211_ftm_responder_policy,
626 	},
627 	[NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1),
628 	[NL80211_ATTR_PEER_MEASUREMENTS] =
629 		NLA_POLICY_NESTED(nl80211_pmsr_attr_policy),
630 	[NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1),
631 	[NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY,
632 					.len = SAE_PASSWORD_MAX_LEN },
633 	[NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG },
634 	[NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy),
635 	[NL80211_ATTR_VLAN_ID] = NLA_POLICY_RANGE(NLA_U16, 1, VLAN_N_VID - 2),
636 	[NL80211_ATTR_HE_BSS_COLOR] = NLA_POLICY_NESTED(he_bss_color_policy),
637 	[NL80211_ATTR_SRC_MAC] = NLA_POLICY_ETH_ADDR,
638 	[NL80211_ATTR_DST_MAC] = NLA_POLICY_ETH_ADDR,
639 };
640 
641 /* policy for the key attributes */
642 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
643 	[NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
644 	[NL80211_KEY_IDX] = { .type = NLA_U8 },
645 	[NL80211_KEY_CIPHER] = { .type = NLA_U32 },
646 	[NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
647 	[NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
648 	[NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
649 	[NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1),
650 	[NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
651 	[NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX),
652 };
653 
654 /* policy for the key default flags */
655 static const struct nla_policy
656 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
657 	[NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
658 	[NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
659 };
660 
661 #ifdef CONFIG_PM
662 /* policy for WoWLAN attributes */
663 static const struct nla_policy
664 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
665 	[NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
666 	[NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
667 	[NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
668 	[NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
669 	[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
670 	[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
671 	[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
672 	[NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
673 	[NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
674 	[NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
675 };
676 
677 static const struct nla_policy
678 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
679 	[NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
680 	[NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
681 	[NL80211_WOWLAN_TCP_DST_MAC] = {
682 		.type = NLA_EXACT_LEN_WARN,
683 		.len = ETH_ALEN
684 	},
685 	[NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
686 	[NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
687 	[NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .type = NLA_MIN_LEN, .len = 1 },
688 	[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
689 		.len = sizeof(struct nl80211_wowlan_tcp_data_seq)
690 	},
691 	[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
692 		.len = sizeof(struct nl80211_wowlan_tcp_data_token)
693 	},
694 	[NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
695 	[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .type = NLA_MIN_LEN, .len = 1 },
696 	[NL80211_WOWLAN_TCP_WAKE_MASK] = { .type = NLA_MIN_LEN, .len = 1 },
697 };
698 #endif /* CONFIG_PM */
699 
700 /* policy for coalesce rule attributes */
701 static const struct nla_policy
702 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
703 	[NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
704 	[NL80211_ATTR_COALESCE_RULE_CONDITION] =
705 		NLA_POLICY_RANGE(NLA_U32,
706 				 NL80211_COALESCE_CONDITION_MATCH,
707 				 NL80211_COALESCE_CONDITION_NO_MATCH),
708 	[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
709 };
710 
711 /* policy for GTK rekey offload attributes */
712 static const struct nla_policy
713 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
714 	[NL80211_REKEY_DATA_KEK] = {
715 		.type = NLA_EXACT_LEN_WARN,
716 		.len = NL80211_KEK_LEN,
717 	},
718 	[NL80211_REKEY_DATA_KCK] = {
719 		.type = NLA_EXACT_LEN_WARN,
720 		.len = NL80211_KCK_LEN,
721 	},
722 	[NL80211_REKEY_DATA_REPLAY_CTR] = {
723 		.type = NLA_EXACT_LEN_WARN,
724 		.len = NL80211_REPLAY_CTR_LEN
725 	},
726 };
727 
728 static const struct nla_policy
729 nl80211_match_band_rssi_policy[NUM_NL80211_BANDS] = {
730 	[NL80211_BAND_2GHZ] = { .type = NLA_S32 },
731 	[NL80211_BAND_5GHZ] = { .type = NLA_S32 },
732 	[NL80211_BAND_6GHZ] = { .type = NLA_S32 },
733 	[NL80211_BAND_60GHZ] = { .type = NLA_S32 },
734 };
735 
736 static const struct nla_policy
737 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
738 	[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
739 						 .len = IEEE80211_MAX_SSID_LEN },
740 	[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = {
741 		.type = NLA_EXACT_LEN_WARN,
742 		.len = ETH_ALEN
743 	},
744 	[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
745 	[NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI] =
746 		NLA_POLICY_NESTED(nl80211_match_band_rssi_policy),
747 };
748 
749 static const struct nla_policy
750 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
751 	[NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
752 	[NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
753 };
754 
755 static const struct nla_policy
756 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
757 	[NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
758 	[NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
759 	[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
760 		.len = sizeof(struct nl80211_bss_select_rssi_adjust)
761 	},
762 };
763 
764 /* policy for NAN function attributes */
765 static const struct nla_policy
766 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
767 	[NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
768 	[NL80211_NAN_FUNC_SERVICE_ID] = {
769 				    .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
770 	[NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
771 	[NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
772 	[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
773 	[NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
774 	[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
775 	[NL80211_NAN_FUNC_FOLLOW_UP_DEST] = {
776 		.type = NLA_EXACT_LEN_WARN,
777 		.len = ETH_ALEN
778 	},
779 	[NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
780 	[NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
781 	[NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
782 			.len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
783 	[NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
784 	[NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
785 	[NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
786 	[NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
787 	[NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
788 };
789 
790 /* policy for Service Response Filter attributes */
791 static const struct nla_policy
792 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
793 	[NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
794 	[NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
795 				 .len =  NL80211_NAN_FUNC_SRF_MAX_LEN },
796 	[NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
797 	[NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
798 };
799 
800 /* policy for packet pattern attributes */
801 static const struct nla_policy
802 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
803 	[NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
804 	[NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
805 	[NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
806 };
807 
808 int nl80211_prepare_wdev_dump(struct netlink_callback *cb,
809 			      struct cfg80211_registered_device **rdev,
810 			      struct wireless_dev **wdev)
811 {
812 	int err;
813 
814 	if (!cb->args[0]) {
815 		struct nlattr **attrbuf;
816 
817 		attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf),
818 				  GFP_KERNEL);
819 		if (!attrbuf)
820 			return -ENOMEM;
821 
822 		err = nlmsg_parse_deprecated(cb->nlh,
823 					     GENL_HDRLEN + nl80211_fam.hdrsize,
824 					     attrbuf, nl80211_fam.maxattr,
825 					     nl80211_policy, NULL);
826 		if (err) {
827 			kfree(attrbuf);
828 			return err;
829 		}
830 
831 		*wdev = __cfg80211_wdev_from_attrs(sock_net(cb->skb->sk),
832 						   attrbuf);
833 		kfree(attrbuf);
834 		if (IS_ERR(*wdev))
835 			return PTR_ERR(*wdev);
836 		*rdev = wiphy_to_rdev((*wdev)->wiphy);
837 		/* 0 is the first index - add 1 to parse only once */
838 		cb->args[0] = (*rdev)->wiphy_idx + 1;
839 		cb->args[1] = (*wdev)->identifier;
840 	} else {
841 		/* subtract the 1 again here */
842 		struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
843 		struct wireless_dev *tmp;
844 
845 		if (!wiphy)
846 			return -ENODEV;
847 		*rdev = wiphy_to_rdev(wiphy);
848 		*wdev = NULL;
849 
850 		list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
851 			if (tmp->identifier == cb->args[1]) {
852 				*wdev = tmp;
853 				break;
854 			}
855 		}
856 
857 		if (!*wdev)
858 			return -ENODEV;
859 	}
860 
861 	return 0;
862 }
863 
864 /* message building helper */
865 void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
866 		     int flags, u8 cmd)
867 {
868 	/* since there is no private header just add the generic one */
869 	return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
870 }
871 
872 static int nl80211_msg_put_wmm_rules(struct sk_buff *msg,
873 				     const struct ieee80211_reg_rule *rule)
874 {
875 	int j;
876 	struct nlattr *nl_wmm_rules =
877 		nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM);
878 
879 	if (!nl_wmm_rules)
880 		goto nla_put_failure;
881 
882 	for (j = 0; j < IEEE80211_NUM_ACS; j++) {
883 		struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j);
884 
885 		if (!nl_wmm_rule)
886 			goto nla_put_failure;
887 
888 		if (nla_put_u16(msg, NL80211_WMMR_CW_MIN,
889 				rule->wmm_rule.client[j].cw_min) ||
890 		    nla_put_u16(msg, NL80211_WMMR_CW_MAX,
891 				rule->wmm_rule.client[j].cw_max) ||
892 		    nla_put_u8(msg, NL80211_WMMR_AIFSN,
893 			       rule->wmm_rule.client[j].aifsn) ||
894 		    nla_put_u16(msg, NL80211_WMMR_TXOP,
895 			        rule->wmm_rule.client[j].cot))
896 			goto nla_put_failure;
897 
898 		nla_nest_end(msg, nl_wmm_rule);
899 	}
900 	nla_nest_end(msg, nl_wmm_rules);
901 
902 	return 0;
903 
904 nla_put_failure:
905 	return -ENOBUFS;
906 }
907 
908 static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy,
909 				   struct ieee80211_channel *chan,
910 				   bool large)
911 {
912 	/* Some channels must be completely excluded from the
913 	 * list to protect old user-space tools from breaking
914 	 */
915 	if (!large && chan->flags &
916 	    (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
917 		return 0;
918 
919 	if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
920 			chan->center_freq))
921 		goto nla_put_failure;
922 
923 	if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
924 	    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
925 		goto nla_put_failure;
926 	if (chan->flags & IEEE80211_CHAN_NO_IR) {
927 		if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
928 			goto nla_put_failure;
929 		if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
930 			goto nla_put_failure;
931 	}
932 	if (chan->flags & IEEE80211_CHAN_RADAR) {
933 		if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
934 			goto nla_put_failure;
935 		if (large) {
936 			u32 time;
937 
938 			time = elapsed_jiffies_msecs(chan->dfs_state_entered);
939 
940 			if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
941 					chan->dfs_state))
942 				goto nla_put_failure;
943 			if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
944 					time))
945 				goto nla_put_failure;
946 			if (nla_put_u32(msg,
947 					NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
948 					chan->dfs_cac_ms))
949 				goto nla_put_failure;
950 		}
951 	}
952 
953 	if (large) {
954 		if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
955 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
956 			goto nla_put_failure;
957 		if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
958 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
959 			goto nla_put_failure;
960 		if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
961 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
962 			goto nla_put_failure;
963 		if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
964 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
965 			goto nla_put_failure;
966 		if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
967 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
968 			goto nla_put_failure;
969 		if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
970 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
971 			goto nla_put_failure;
972 		if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
973 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
974 			goto nla_put_failure;
975 		if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
976 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
977 			goto nla_put_failure;
978 		if ((chan->flags & IEEE80211_CHAN_NO_HE) &&
979 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HE))
980 			goto nla_put_failure;
981 	}
982 
983 	if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
984 			DBM_TO_MBM(chan->max_power)))
985 		goto nla_put_failure;
986 
987 	if (large) {
988 		const struct ieee80211_reg_rule *rule =
989 			freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq));
990 
991 		if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) {
992 			if (nl80211_msg_put_wmm_rules(msg, rule))
993 				goto nla_put_failure;
994 		}
995 	}
996 
997 	return 0;
998 
999  nla_put_failure:
1000 	return -ENOBUFS;
1001 }
1002 
1003 static bool nl80211_put_txq_stats(struct sk_buff *msg,
1004 				  struct cfg80211_txq_stats *txqstats,
1005 				  int attrtype)
1006 {
1007 	struct nlattr *txqattr;
1008 
1009 #define PUT_TXQVAL_U32(attr, memb) do {					  \
1010 	if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) &&	  \
1011 	    nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \
1012 		return false;						  \
1013 	} while (0)
1014 
1015 	txqattr = nla_nest_start_noflag(msg, attrtype);
1016 	if (!txqattr)
1017 		return false;
1018 
1019 	PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes);
1020 	PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets);
1021 	PUT_TXQVAL_U32(FLOWS, flows);
1022 	PUT_TXQVAL_U32(DROPS, drops);
1023 	PUT_TXQVAL_U32(ECN_MARKS, ecn_marks);
1024 	PUT_TXQVAL_U32(OVERLIMIT, overlimit);
1025 	PUT_TXQVAL_U32(OVERMEMORY, overmemory);
1026 	PUT_TXQVAL_U32(COLLISIONS, collisions);
1027 	PUT_TXQVAL_U32(TX_BYTES, tx_bytes);
1028 	PUT_TXQVAL_U32(TX_PACKETS, tx_packets);
1029 	PUT_TXQVAL_U32(MAX_FLOWS, max_flows);
1030 	nla_nest_end(msg, txqattr);
1031 
1032 #undef PUT_TXQVAL_U32
1033 	return true;
1034 }
1035 
1036 /* netlink command implementations */
1037 
1038 struct key_parse {
1039 	struct key_params p;
1040 	int idx;
1041 	int type;
1042 	bool def, defmgmt;
1043 	bool def_uni, def_multi;
1044 };
1045 
1046 static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key,
1047 				 struct key_parse *k)
1048 {
1049 	struct nlattr *tb[NL80211_KEY_MAX + 1];
1050 	int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key,
1051 					      nl80211_key_policy,
1052 					      info->extack);
1053 	if (err)
1054 		return err;
1055 
1056 	k->def = !!tb[NL80211_KEY_DEFAULT];
1057 	k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
1058 
1059 	if (k->def) {
1060 		k->def_uni = true;
1061 		k->def_multi = true;
1062 	}
1063 	if (k->defmgmt)
1064 		k->def_multi = true;
1065 
1066 	if (tb[NL80211_KEY_IDX])
1067 		k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
1068 
1069 	if (tb[NL80211_KEY_DATA]) {
1070 		k->p.key = nla_data(tb[NL80211_KEY_DATA]);
1071 		k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
1072 	}
1073 
1074 	if (tb[NL80211_KEY_SEQ]) {
1075 		k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
1076 		k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
1077 	}
1078 
1079 	if (tb[NL80211_KEY_CIPHER])
1080 		k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
1081 
1082 	if (tb[NL80211_KEY_TYPE])
1083 		k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
1084 
1085 	if (tb[NL80211_KEY_DEFAULT_TYPES]) {
1086 		struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
1087 
1088 		err = nla_parse_nested_deprecated(kdt,
1089 						  NUM_NL80211_KEY_DEFAULT_TYPES - 1,
1090 						  tb[NL80211_KEY_DEFAULT_TYPES],
1091 						  nl80211_key_default_policy,
1092 						  info->extack);
1093 		if (err)
1094 			return err;
1095 
1096 		k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
1097 		k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
1098 	}
1099 
1100 	if (tb[NL80211_KEY_MODE])
1101 		k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]);
1102 
1103 	return 0;
1104 }
1105 
1106 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
1107 {
1108 	if (info->attrs[NL80211_ATTR_KEY_DATA]) {
1109 		k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
1110 		k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
1111 	}
1112 
1113 	if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
1114 		k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
1115 		k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
1116 	}
1117 
1118 	if (info->attrs[NL80211_ATTR_KEY_IDX])
1119 		k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
1120 
1121 	if (info->attrs[NL80211_ATTR_KEY_CIPHER])
1122 		k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
1123 
1124 	k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
1125 	k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
1126 
1127 	if (k->def) {
1128 		k->def_uni = true;
1129 		k->def_multi = true;
1130 	}
1131 	if (k->defmgmt)
1132 		k->def_multi = true;
1133 
1134 	if (info->attrs[NL80211_ATTR_KEY_TYPE])
1135 		k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
1136 
1137 	if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
1138 		struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
1139 		int err = nla_parse_nested_deprecated(kdt,
1140 						      NUM_NL80211_KEY_DEFAULT_TYPES - 1,
1141 						      info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
1142 						      nl80211_key_default_policy,
1143 						      info->extack);
1144 		if (err)
1145 			return err;
1146 
1147 		k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
1148 		k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
1149 	}
1150 
1151 	return 0;
1152 }
1153 
1154 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
1155 {
1156 	int err;
1157 
1158 	memset(k, 0, sizeof(*k));
1159 	k->idx = -1;
1160 	k->type = -1;
1161 
1162 	if (info->attrs[NL80211_ATTR_KEY])
1163 		err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k);
1164 	else
1165 		err = nl80211_parse_key_old(info, k);
1166 
1167 	if (err)
1168 		return err;
1169 
1170 	if (k->def && k->defmgmt) {
1171 		GENL_SET_ERR_MSG(info, "key with def && defmgmt is invalid");
1172 		return -EINVAL;
1173 	}
1174 
1175 	if (k->defmgmt) {
1176 		if (k->def_uni || !k->def_multi) {
1177 			GENL_SET_ERR_MSG(info, "defmgmt key must be mcast");
1178 			return -EINVAL;
1179 		}
1180 	}
1181 
1182 	if (k->idx != -1) {
1183 		if (k->defmgmt) {
1184 			if (k->idx < 4 || k->idx > 5) {
1185 				GENL_SET_ERR_MSG(info,
1186 						 "defmgmt key idx not 4 or 5");
1187 				return -EINVAL;
1188 			}
1189 		} else if (k->def) {
1190 			if (k->idx < 0 || k->idx > 3) {
1191 				GENL_SET_ERR_MSG(info, "def key idx not 0-3");
1192 				return -EINVAL;
1193 			}
1194 		} else {
1195 			if (k->idx < 0 || k->idx > 5) {
1196 				GENL_SET_ERR_MSG(info, "key idx not 0-5");
1197 				return -EINVAL;
1198 			}
1199 		}
1200 	}
1201 
1202 	return 0;
1203 }
1204 
1205 static struct cfg80211_cached_keys *
1206 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
1207 		       struct genl_info *info, bool *no_ht)
1208 {
1209 	struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS];
1210 	struct key_parse parse;
1211 	struct nlattr *key;
1212 	struct cfg80211_cached_keys *result;
1213 	int rem, err, def = 0;
1214 	bool have_key = false;
1215 
1216 	nla_for_each_nested(key, keys, rem) {
1217 		have_key = true;
1218 		break;
1219 	}
1220 
1221 	if (!have_key)
1222 		return NULL;
1223 
1224 	result = kzalloc(sizeof(*result), GFP_KERNEL);
1225 	if (!result)
1226 		return ERR_PTR(-ENOMEM);
1227 
1228 	result->def = -1;
1229 
1230 	nla_for_each_nested(key, keys, rem) {
1231 		memset(&parse, 0, sizeof(parse));
1232 		parse.idx = -1;
1233 
1234 		err = nl80211_parse_key_new(info, key, &parse);
1235 		if (err)
1236 			goto error;
1237 		err = -EINVAL;
1238 		if (!parse.p.key)
1239 			goto error;
1240 		if (parse.idx < 0 || parse.idx > 3) {
1241 			GENL_SET_ERR_MSG(info, "key index out of range [0-3]");
1242 			goto error;
1243 		}
1244 		if (parse.def) {
1245 			if (def) {
1246 				GENL_SET_ERR_MSG(info,
1247 						 "only one key can be default");
1248 				goto error;
1249 			}
1250 			def = 1;
1251 			result->def = parse.idx;
1252 			if (!parse.def_uni || !parse.def_multi)
1253 				goto error;
1254 		} else if (parse.defmgmt)
1255 			goto error;
1256 		err = cfg80211_validate_key_settings(rdev, &parse.p,
1257 						     parse.idx, false, NULL);
1258 		if (err)
1259 			goto error;
1260 		if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
1261 		    parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
1262 			GENL_SET_ERR_MSG(info, "connect key must be WEP");
1263 			err = -EINVAL;
1264 			goto error;
1265 		}
1266 		result->params[parse.idx].cipher = parse.p.cipher;
1267 		result->params[parse.idx].key_len = parse.p.key_len;
1268 		result->params[parse.idx].key = result->data[parse.idx];
1269 		memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
1270 
1271 		/* must be WEP key if we got here */
1272 		if (no_ht)
1273 			*no_ht = true;
1274 	}
1275 
1276 	if (result->def < 0) {
1277 		err = -EINVAL;
1278 		GENL_SET_ERR_MSG(info, "need a default/TX key");
1279 		goto error;
1280 	}
1281 
1282 	return result;
1283  error:
1284 	kfree(result);
1285 	return ERR_PTR(err);
1286 }
1287 
1288 static int nl80211_key_allowed(struct wireless_dev *wdev)
1289 {
1290 	ASSERT_WDEV_LOCK(wdev);
1291 
1292 	switch (wdev->iftype) {
1293 	case NL80211_IFTYPE_AP:
1294 	case NL80211_IFTYPE_AP_VLAN:
1295 	case NL80211_IFTYPE_P2P_GO:
1296 	case NL80211_IFTYPE_MESH_POINT:
1297 		break;
1298 	case NL80211_IFTYPE_ADHOC:
1299 	case NL80211_IFTYPE_STATION:
1300 	case NL80211_IFTYPE_P2P_CLIENT:
1301 		if (!wdev->current_bss)
1302 			return -ENOLINK;
1303 		break;
1304 	case NL80211_IFTYPE_UNSPECIFIED:
1305 	case NL80211_IFTYPE_OCB:
1306 	case NL80211_IFTYPE_MONITOR:
1307 	case NL80211_IFTYPE_NAN:
1308 	case NL80211_IFTYPE_P2P_DEVICE:
1309 	case NL80211_IFTYPE_WDS:
1310 	case NUM_NL80211_IFTYPES:
1311 		return -EINVAL;
1312 	}
1313 
1314 	return 0;
1315 }
1316 
1317 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
1318 							struct nlattr *tb)
1319 {
1320 	struct ieee80211_channel *chan;
1321 
1322 	if (tb == NULL)
1323 		return NULL;
1324 	chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
1325 	if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
1326 		return NULL;
1327 	return chan;
1328 }
1329 
1330 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
1331 {
1332 	struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr);
1333 	int i;
1334 
1335 	if (!nl_modes)
1336 		goto nla_put_failure;
1337 
1338 	i = 0;
1339 	while (ifmodes) {
1340 		if ((ifmodes & 1) && nla_put_flag(msg, i))
1341 			goto nla_put_failure;
1342 		ifmodes >>= 1;
1343 		i++;
1344 	}
1345 
1346 	nla_nest_end(msg, nl_modes);
1347 	return 0;
1348 
1349 nla_put_failure:
1350 	return -ENOBUFS;
1351 }
1352 
1353 static int nl80211_put_iface_combinations(struct wiphy *wiphy,
1354 					  struct sk_buff *msg,
1355 					  bool large)
1356 {
1357 	struct nlattr *nl_combis;
1358 	int i, j;
1359 
1360 	nl_combis = nla_nest_start_noflag(msg,
1361 					  NL80211_ATTR_INTERFACE_COMBINATIONS);
1362 	if (!nl_combis)
1363 		goto nla_put_failure;
1364 
1365 	for (i = 0; i < wiphy->n_iface_combinations; i++) {
1366 		const struct ieee80211_iface_combination *c;
1367 		struct nlattr *nl_combi, *nl_limits;
1368 
1369 		c = &wiphy->iface_combinations[i];
1370 
1371 		nl_combi = nla_nest_start_noflag(msg, i + 1);
1372 		if (!nl_combi)
1373 			goto nla_put_failure;
1374 
1375 		nl_limits = nla_nest_start_noflag(msg,
1376 						  NL80211_IFACE_COMB_LIMITS);
1377 		if (!nl_limits)
1378 			goto nla_put_failure;
1379 
1380 		for (j = 0; j < c->n_limits; j++) {
1381 			struct nlattr *nl_limit;
1382 
1383 			nl_limit = nla_nest_start_noflag(msg, j + 1);
1384 			if (!nl_limit)
1385 				goto nla_put_failure;
1386 			if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
1387 					c->limits[j].max))
1388 				goto nla_put_failure;
1389 			if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
1390 						c->limits[j].types))
1391 				goto nla_put_failure;
1392 			nla_nest_end(msg, nl_limit);
1393 		}
1394 
1395 		nla_nest_end(msg, nl_limits);
1396 
1397 		if (c->beacon_int_infra_match &&
1398 		    nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
1399 			goto nla_put_failure;
1400 		if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
1401 				c->num_different_channels) ||
1402 		    nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
1403 				c->max_interfaces))
1404 			goto nla_put_failure;
1405 		if (large &&
1406 		    (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
1407 				c->radar_detect_widths) ||
1408 		     nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
1409 				c->radar_detect_regions)))
1410 			goto nla_put_failure;
1411 		if (c->beacon_int_min_gcd &&
1412 		    nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
1413 				c->beacon_int_min_gcd))
1414 			goto nla_put_failure;
1415 
1416 		nla_nest_end(msg, nl_combi);
1417 	}
1418 
1419 	nla_nest_end(msg, nl_combis);
1420 
1421 	return 0;
1422 nla_put_failure:
1423 	return -ENOBUFS;
1424 }
1425 
1426 #ifdef CONFIG_PM
1427 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
1428 					struct sk_buff *msg)
1429 {
1430 	const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
1431 	struct nlattr *nl_tcp;
1432 
1433 	if (!tcp)
1434 		return 0;
1435 
1436 	nl_tcp = nla_nest_start_noflag(msg,
1437 				       NL80211_WOWLAN_TRIG_TCP_CONNECTION);
1438 	if (!nl_tcp)
1439 		return -ENOBUFS;
1440 
1441 	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1442 			tcp->data_payload_max))
1443 		return -ENOBUFS;
1444 
1445 	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1446 			tcp->data_payload_max))
1447 		return -ENOBUFS;
1448 
1449 	if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
1450 		return -ENOBUFS;
1451 
1452 	if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
1453 				sizeof(*tcp->tok), tcp->tok))
1454 		return -ENOBUFS;
1455 
1456 	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
1457 			tcp->data_interval_max))
1458 		return -ENOBUFS;
1459 
1460 	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
1461 			tcp->wake_payload_max))
1462 		return -ENOBUFS;
1463 
1464 	nla_nest_end(msg, nl_tcp);
1465 	return 0;
1466 }
1467 
1468 static int nl80211_send_wowlan(struct sk_buff *msg,
1469 			       struct cfg80211_registered_device *rdev,
1470 			       bool large)
1471 {
1472 	struct nlattr *nl_wowlan;
1473 
1474 	if (!rdev->wiphy.wowlan)
1475 		return 0;
1476 
1477 	nl_wowlan = nla_nest_start_noflag(msg,
1478 					  NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1479 	if (!nl_wowlan)
1480 		return -ENOBUFS;
1481 
1482 	if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
1483 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1484 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
1485 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1486 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
1487 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1488 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
1489 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1490 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
1491 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1492 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
1493 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1494 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
1495 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1496 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
1497 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1498 		return -ENOBUFS;
1499 
1500 	if (rdev->wiphy.wowlan->n_patterns) {
1501 		struct nl80211_pattern_support pat = {
1502 			.max_patterns = rdev->wiphy.wowlan->n_patterns,
1503 			.min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
1504 			.max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
1505 			.max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
1506 		};
1507 
1508 		if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1509 			    sizeof(pat), &pat))
1510 			return -ENOBUFS;
1511 	}
1512 
1513 	if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
1514 	    nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
1515 			rdev->wiphy.wowlan->max_nd_match_sets))
1516 		return -ENOBUFS;
1517 
1518 	if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
1519 		return -ENOBUFS;
1520 
1521 	nla_nest_end(msg, nl_wowlan);
1522 
1523 	return 0;
1524 }
1525 #endif
1526 
1527 static int nl80211_send_coalesce(struct sk_buff *msg,
1528 				 struct cfg80211_registered_device *rdev)
1529 {
1530 	struct nl80211_coalesce_rule_support rule;
1531 
1532 	if (!rdev->wiphy.coalesce)
1533 		return 0;
1534 
1535 	rule.max_rules = rdev->wiphy.coalesce->n_rules;
1536 	rule.max_delay = rdev->wiphy.coalesce->max_delay;
1537 	rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
1538 	rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
1539 	rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
1540 	rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
1541 
1542 	if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
1543 		return -ENOBUFS;
1544 
1545 	return 0;
1546 }
1547 
1548 static int
1549 nl80211_send_iftype_data(struct sk_buff *msg,
1550 			 const struct ieee80211_sband_iftype_data *iftdata)
1551 {
1552 	const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap;
1553 
1554 	if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES,
1555 				iftdata->types_mask))
1556 		return -ENOBUFS;
1557 
1558 	if (he_cap->has_he) {
1559 		if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC,
1560 			    sizeof(he_cap->he_cap_elem.mac_cap_info),
1561 			    he_cap->he_cap_elem.mac_cap_info) ||
1562 		    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY,
1563 			    sizeof(he_cap->he_cap_elem.phy_cap_info),
1564 			    he_cap->he_cap_elem.phy_cap_info) ||
1565 		    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET,
1566 			    sizeof(he_cap->he_mcs_nss_supp),
1567 			    &he_cap->he_mcs_nss_supp) ||
1568 		    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE,
1569 			    sizeof(he_cap->ppe_thres), he_cap->ppe_thres))
1570 			return -ENOBUFS;
1571 	}
1572 
1573 	return 0;
1574 }
1575 
1576 static int nl80211_send_band_rateinfo(struct sk_buff *msg,
1577 				      struct ieee80211_supported_band *sband)
1578 {
1579 	struct nlattr *nl_rates, *nl_rate;
1580 	struct ieee80211_rate *rate;
1581 	int i;
1582 
1583 	/* add HT info */
1584 	if (sband->ht_cap.ht_supported &&
1585 	    (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
1586 		     sizeof(sband->ht_cap.mcs),
1587 		     &sband->ht_cap.mcs) ||
1588 	     nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
1589 			 sband->ht_cap.cap) ||
1590 	     nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1591 			sband->ht_cap.ampdu_factor) ||
1592 	     nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1593 			sband->ht_cap.ampdu_density)))
1594 		return -ENOBUFS;
1595 
1596 	/* add VHT info */
1597 	if (sband->vht_cap.vht_supported &&
1598 	    (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1599 		     sizeof(sband->vht_cap.vht_mcs),
1600 		     &sband->vht_cap.vht_mcs) ||
1601 	     nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1602 			 sband->vht_cap.cap)))
1603 		return -ENOBUFS;
1604 
1605 	if (sband->n_iftype_data) {
1606 		struct nlattr *nl_iftype_data =
1607 			nla_nest_start_noflag(msg,
1608 					      NL80211_BAND_ATTR_IFTYPE_DATA);
1609 		int err;
1610 
1611 		if (!nl_iftype_data)
1612 			return -ENOBUFS;
1613 
1614 		for (i = 0; i < sband->n_iftype_data; i++) {
1615 			struct nlattr *iftdata;
1616 
1617 			iftdata = nla_nest_start_noflag(msg, i + 1);
1618 			if (!iftdata)
1619 				return -ENOBUFS;
1620 
1621 			err = nl80211_send_iftype_data(msg,
1622 						       &sband->iftype_data[i]);
1623 			if (err)
1624 				return err;
1625 
1626 			nla_nest_end(msg, iftdata);
1627 		}
1628 
1629 		nla_nest_end(msg, nl_iftype_data);
1630 	}
1631 
1632 	/* add EDMG info */
1633 	if (sband->edmg_cap.channels &&
1634 	    (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS,
1635 		       sband->edmg_cap.channels) ||
1636 	    nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG,
1637 		       sband->edmg_cap.bw_config)))
1638 
1639 		return -ENOBUFS;
1640 
1641 	/* add bitrates */
1642 	nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES);
1643 	if (!nl_rates)
1644 		return -ENOBUFS;
1645 
1646 	for (i = 0; i < sband->n_bitrates; i++) {
1647 		nl_rate = nla_nest_start_noflag(msg, i);
1648 		if (!nl_rate)
1649 			return -ENOBUFS;
1650 
1651 		rate = &sband->bitrates[i];
1652 		if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1653 				rate->bitrate))
1654 			return -ENOBUFS;
1655 		if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1656 		    nla_put_flag(msg,
1657 				 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1658 			return -ENOBUFS;
1659 
1660 		nla_nest_end(msg, nl_rate);
1661 	}
1662 
1663 	nla_nest_end(msg, nl_rates);
1664 
1665 	return 0;
1666 }
1667 
1668 static int
1669 nl80211_send_mgmt_stypes(struct sk_buff *msg,
1670 			 const struct ieee80211_txrx_stypes *mgmt_stypes)
1671 {
1672 	u16 stypes;
1673 	struct nlattr *nl_ftypes, *nl_ifs;
1674 	enum nl80211_iftype ift;
1675 	int i;
1676 
1677 	if (!mgmt_stypes)
1678 		return 0;
1679 
1680 	nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES);
1681 	if (!nl_ifs)
1682 		return -ENOBUFS;
1683 
1684 	for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1685 		nl_ftypes = nla_nest_start_noflag(msg, ift);
1686 		if (!nl_ftypes)
1687 			return -ENOBUFS;
1688 		i = 0;
1689 		stypes = mgmt_stypes[ift].tx;
1690 		while (stypes) {
1691 			if ((stypes & 1) &&
1692 			    nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1693 					(i << 4) | IEEE80211_FTYPE_MGMT))
1694 				return -ENOBUFS;
1695 			stypes >>= 1;
1696 			i++;
1697 		}
1698 		nla_nest_end(msg, nl_ftypes);
1699 	}
1700 
1701 	nla_nest_end(msg, nl_ifs);
1702 
1703 	nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES);
1704 	if (!nl_ifs)
1705 		return -ENOBUFS;
1706 
1707 	for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1708 		nl_ftypes = nla_nest_start_noflag(msg, ift);
1709 		if (!nl_ftypes)
1710 			return -ENOBUFS;
1711 		i = 0;
1712 		stypes = mgmt_stypes[ift].rx;
1713 		while (stypes) {
1714 			if ((stypes & 1) &&
1715 			    nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1716 					(i << 4) | IEEE80211_FTYPE_MGMT))
1717 				return -ENOBUFS;
1718 			stypes >>= 1;
1719 			i++;
1720 		}
1721 		nla_nest_end(msg, nl_ftypes);
1722 	}
1723 	nla_nest_end(msg, nl_ifs);
1724 
1725 	return 0;
1726 }
1727 
1728 #define CMD(op, n)							\
1729 	 do {								\
1730 		if (rdev->ops->op) {					\
1731 			i++;						\
1732 			if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) 	\
1733 				goto nla_put_failure;			\
1734 		}							\
1735 	} while (0)
1736 
1737 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
1738 					struct sk_buff *msg)
1739 {
1740 	int i = 0;
1741 
1742 	/*
1743 	 * do *NOT* add anything into this function, new things need to be
1744 	 * advertised only to new versions of userspace that can deal with
1745 	 * the split (and they can't possibly care about new features...
1746 	 */
1747 	CMD(add_virtual_intf, NEW_INTERFACE);
1748 	CMD(change_virtual_intf, SET_INTERFACE);
1749 	CMD(add_key, NEW_KEY);
1750 	CMD(start_ap, START_AP);
1751 	CMD(add_station, NEW_STATION);
1752 	CMD(add_mpath, NEW_MPATH);
1753 	CMD(update_mesh_config, SET_MESH_CONFIG);
1754 	CMD(change_bss, SET_BSS);
1755 	CMD(auth, AUTHENTICATE);
1756 	CMD(assoc, ASSOCIATE);
1757 	CMD(deauth, DEAUTHENTICATE);
1758 	CMD(disassoc, DISASSOCIATE);
1759 	CMD(join_ibss, JOIN_IBSS);
1760 	CMD(join_mesh, JOIN_MESH);
1761 	CMD(set_pmksa, SET_PMKSA);
1762 	CMD(del_pmksa, DEL_PMKSA);
1763 	CMD(flush_pmksa, FLUSH_PMKSA);
1764 	if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
1765 		CMD(remain_on_channel, REMAIN_ON_CHANNEL);
1766 	CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
1767 	CMD(mgmt_tx, FRAME);
1768 	CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
1769 	if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
1770 		i++;
1771 		if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
1772 			goto nla_put_failure;
1773 	}
1774 	if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
1775 	    rdev->ops->join_mesh) {
1776 		i++;
1777 		if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1778 			goto nla_put_failure;
1779 	}
1780 	CMD(set_wds_peer, SET_WDS_PEER);
1781 	if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
1782 		CMD(tdls_mgmt, TDLS_MGMT);
1783 		CMD(tdls_oper, TDLS_OPER);
1784 	}
1785 	if (rdev->wiphy.max_sched_scan_reqs)
1786 		CMD(sched_scan_start, START_SCHED_SCAN);
1787 	CMD(probe_client, PROBE_CLIENT);
1788 	CMD(set_noack_map, SET_NOACK_MAP);
1789 	if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
1790 		i++;
1791 		if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1792 			goto nla_put_failure;
1793 	}
1794 	CMD(start_p2p_device, START_P2P_DEVICE);
1795 	CMD(set_mcast_rate, SET_MCAST_RATE);
1796 #ifdef CONFIG_NL80211_TESTMODE
1797 	CMD(testmode_cmd, TESTMODE);
1798 #endif
1799 
1800 	if (rdev->ops->connect || rdev->ops->auth) {
1801 		i++;
1802 		if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
1803 			goto nla_put_failure;
1804 	}
1805 
1806 	if (rdev->ops->disconnect || rdev->ops->deauth) {
1807 		i++;
1808 		if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1809 			goto nla_put_failure;
1810 	}
1811 
1812 	return i;
1813  nla_put_failure:
1814 	return -ENOBUFS;
1815 }
1816 
1817 static int
1818 nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap,
1819 			   struct sk_buff *msg)
1820 {
1821 	struct nlattr *ftm;
1822 
1823 	if (!cap->ftm.supported)
1824 		return 0;
1825 
1826 	ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM);
1827 	if (!ftm)
1828 		return -ENOBUFS;
1829 
1830 	if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP))
1831 		return -ENOBUFS;
1832 	if (cap->ftm.non_asap &&
1833 	    nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP))
1834 		return -ENOBUFS;
1835 	if (cap->ftm.request_lci &&
1836 	    nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI))
1837 		return -ENOBUFS;
1838 	if (cap->ftm.request_civicloc &&
1839 	    nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC))
1840 		return -ENOBUFS;
1841 	if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES,
1842 			cap->ftm.preambles))
1843 		return -ENOBUFS;
1844 	if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS,
1845 			cap->ftm.bandwidths))
1846 		return -ENOBUFS;
1847 	if (cap->ftm.max_bursts_exponent >= 0 &&
1848 	    nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT,
1849 			cap->ftm.max_bursts_exponent))
1850 		return -ENOBUFS;
1851 	if (cap->ftm.max_ftms_per_burst &&
1852 	    nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST,
1853 			cap->ftm.max_ftms_per_burst))
1854 		return -ENOBUFS;
1855 
1856 	nla_nest_end(msg, ftm);
1857 	return 0;
1858 }
1859 
1860 static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev,
1861 				  struct sk_buff *msg)
1862 {
1863 	const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa;
1864 	struct nlattr *pmsr, *caps;
1865 
1866 	if (!cap)
1867 		return 0;
1868 
1869 	/*
1870 	 * we don't need to clean up anything here since the caller
1871 	 * will genlmsg_cancel() if we fail
1872 	 */
1873 
1874 	pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS);
1875 	if (!pmsr)
1876 		return -ENOBUFS;
1877 
1878 	if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers))
1879 		return -ENOBUFS;
1880 
1881 	if (cap->report_ap_tsf &&
1882 	    nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF))
1883 		return -ENOBUFS;
1884 
1885 	if (cap->randomize_mac_addr &&
1886 	    nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR))
1887 		return -ENOBUFS;
1888 
1889 	caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA);
1890 	if (!caps)
1891 		return -ENOBUFS;
1892 
1893 	if (nl80211_send_pmsr_ftm_capa(cap, msg))
1894 		return -ENOBUFS;
1895 
1896 	nla_nest_end(msg, caps);
1897 	nla_nest_end(msg, pmsr);
1898 
1899 	return 0;
1900 }
1901 
1902 static int
1903 nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev,
1904 			      struct sk_buff *msg)
1905 {
1906 	int i;
1907 	struct nlattr *nested, *nested_akms;
1908 	const struct wiphy_iftype_akm_suites *iftype_akms;
1909 
1910 	if (!rdev->wiphy.num_iftype_akm_suites ||
1911 	    !rdev->wiphy.iftype_akm_suites)
1912 		return 0;
1913 
1914 	nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES);
1915 	if (!nested)
1916 		return -ENOBUFS;
1917 
1918 	for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) {
1919 		nested_akms = nla_nest_start(msg, i + 1);
1920 		if (!nested_akms)
1921 			return -ENOBUFS;
1922 
1923 		iftype_akms = &rdev->wiphy.iftype_akm_suites[i];
1924 
1925 		if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES,
1926 					iftype_akms->iftypes_mask))
1927 			return -ENOBUFS;
1928 
1929 		if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES,
1930 			    sizeof(u32) * iftype_akms->n_akm_suites,
1931 			    iftype_akms->akm_suites)) {
1932 			return -ENOBUFS;
1933 		}
1934 		nla_nest_end(msg, nested_akms);
1935 	}
1936 
1937 	nla_nest_end(msg, nested);
1938 
1939 	return 0;
1940 }
1941 
1942 struct nl80211_dump_wiphy_state {
1943 	s64 filter_wiphy;
1944 	long start;
1945 	long split_start, band_start, chan_start, capa_start;
1946 	bool split;
1947 };
1948 
1949 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
1950 			      enum nl80211_commands cmd,
1951 			      struct sk_buff *msg, u32 portid, u32 seq,
1952 			      int flags, struct nl80211_dump_wiphy_state *state)
1953 {
1954 	void *hdr;
1955 	struct nlattr *nl_bands, *nl_band;
1956 	struct nlattr *nl_freqs, *nl_freq;
1957 	struct nlattr *nl_cmds;
1958 	enum nl80211_band band;
1959 	struct ieee80211_channel *chan;
1960 	int i;
1961 	const struct ieee80211_txrx_stypes *mgmt_stypes =
1962 				rdev->wiphy.mgmt_stypes;
1963 	u32 features;
1964 
1965 	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
1966 	if (!hdr)
1967 		return -ENOBUFS;
1968 
1969 	if (WARN_ON(!state))
1970 		return -EINVAL;
1971 
1972 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
1973 	    nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
1974 			   wiphy_name(&rdev->wiphy)) ||
1975 	    nla_put_u32(msg, NL80211_ATTR_GENERATION,
1976 			cfg80211_rdev_list_generation))
1977 		goto nla_put_failure;
1978 
1979 	if (cmd != NL80211_CMD_NEW_WIPHY)
1980 		goto finish;
1981 
1982 	switch (state->split_start) {
1983 	case 0:
1984 		if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
1985 			       rdev->wiphy.retry_short) ||
1986 		    nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
1987 			       rdev->wiphy.retry_long) ||
1988 		    nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
1989 				rdev->wiphy.frag_threshold) ||
1990 		    nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
1991 				rdev->wiphy.rts_threshold) ||
1992 		    nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
1993 			       rdev->wiphy.coverage_class) ||
1994 		    nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
1995 			       rdev->wiphy.max_scan_ssids) ||
1996 		    nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
1997 			       rdev->wiphy.max_sched_scan_ssids) ||
1998 		    nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
1999 				rdev->wiphy.max_scan_ie_len) ||
2000 		    nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
2001 				rdev->wiphy.max_sched_scan_ie_len) ||
2002 		    nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
2003 			       rdev->wiphy.max_match_sets) ||
2004 		    nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
2005 				rdev->wiphy.max_sched_scan_plans) ||
2006 		    nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
2007 				rdev->wiphy.max_sched_scan_plan_interval) ||
2008 		    nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
2009 				rdev->wiphy.max_sched_scan_plan_iterations))
2010 			goto nla_put_failure;
2011 
2012 		if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
2013 		    nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
2014 			goto nla_put_failure;
2015 		if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
2016 		    nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
2017 			goto nla_put_failure;
2018 		if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
2019 		    nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
2020 			goto nla_put_failure;
2021 		if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
2022 		    nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
2023 			goto nla_put_failure;
2024 		if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
2025 		    nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
2026 			goto nla_put_failure;
2027 		if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
2028 		    nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
2029 			goto nla_put_failure;
2030 		state->split_start++;
2031 		if (state->split)
2032 			break;
2033 		/* fall through */
2034 	case 1:
2035 		if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
2036 			    sizeof(u32) * rdev->wiphy.n_cipher_suites,
2037 			    rdev->wiphy.cipher_suites))
2038 			goto nla_put_failure;
2039 
2040 		if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
2041 			       rdev->wiphy.max_num_pmkids))
2042 			goto nla_put_failure;
2043 
2044 		if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
2045 		    nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
2046 			goto nla_put_failure;
2047 
2048 		if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
2049 				rdev->wiphy.available_antennas_tx) ||
2050 		    nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
2051 				rdev->wiphy.available_antennas_rx))
2052 			goto nla_put_failure;
2053 
2054 		if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
2055 		    nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
2056 				rdev->wiphy.probe_resp_offload))
2057 			goto nla_put_failure;
2058 
2059 		if ((rdev->wiphy.available_antennas_tx ||
2060 		     rdev->wiphy.available_antennas_rx) &&
2061 		    rdev->ops->get_antenna) {
2062 			u32 tx_ant = 0, rx_ant = 0;
2063 			int res;
2064 
2065 			res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
2066 			if (!res) {
2067 				if (nla_put_u32(msg,
2068 						NL80211_ATTR_WIPHY_ANTENNA_TX,
2069 						tx_ant) ||
2070 				    nla_put_u32(msg,
2071 						NL80211_ATTR_WIPHY_ANTENNA_RX,
2072 						rx_ant))
2073 					goto nla_put_failure;
2074 			}
2075 		}
2076 
2077 		state->split_start++;
2078 		if (state->split)
2079 			break;
2080 		/* fall through */
2081 	case 2:
2082 		if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
2083 					rdev->wiphy.interface_modes))
2084 				goto nla_put_failure;
2085 		state->split_start++;
2086 		if (state->split)
2087 			break;
2088 		/* fall through */
2089 	case 3:
2090 		nl_bands = nla_nest_start_noflag(msg,
2091 						 NL80211_ATTR_WIPHY_BANDS);
2092 		if (!nl_bands)
2093 			goto nla_put_failure;
2094 
2095 		for (band = state->band_start;
2096 		     band < NUM_NL80211_BANDS; band++) {
2097 			struct ieee80211_supported_band *sband;
2098 
2099 			sband = rdev->wiphy.bands[band];
2100 
2101 			if (!sband)
2102 				continue;
2103 
2104 			nl_band = nla_nest_start_noflag(msg, band);
2105 			if (!nl_band)
2106 				goto nla_put_failure;
2107 
2108 			switch (state->chan_start) {
2109 			case 0:
2110 				if (nl80211_send_band_rateinfo(msg, sband))
2111 					goto nla_put_failure;
2112 				state->chan_start++;
2113 				if (state->split)
2114 					break;
2115 				/* fall through */
2116 			default:
2117 				/* add frequencies */
2118 				nl_freqs = nla_nest_start_noflag(msg,
2119 								 NL80211_BAND_ATTR_FREQS);
2120 				if (!nl_freqs)
2121 					goto nla_put_failure;
2122 
2123 				for (i = state->chan_start - 1;
2124 				     i < sband->n_channels;
2125 				     i++) {
2126 					nl_freq = nla_nest_start_noflag(msg,
2127 									i);
2128 					if (!nl_freq)
2129 						goto nla_put_failure;
2130 
2131 					chan = &sband->channels[i];
2132 
2133 					if (nl80211_msg_put_channel(
2134 							msg, &rdev->wiphy, chan,
2135 							state->split))
2136 						goto nla_put_failure;
2137 
2138 					nla_nest_end(msg, nl_freq);
2139 					if (state->split)
2140 						break;
2141 				}
2142 				if (i < sband->n_channels)
2143 					state->chan_start = i + 2;
2144 				else
2145 					state->chan_start = 0;
2146 				nla_nest_end(msg, nl_freqs);
2147 			}
2148 
2149 			nla_nest_end(msg, nl_band);
2150 
2151 			if (state->split) {
2152 				/* start again here */
2153 				if (state->chan_start)
2154 					band--;
2155 				break;
2156 			}
2157 		}
2158 		nla_nest_end(msg, nl_bands);
2159 
2160 		if (band < NUM_NL80211_BANDS)
2161 			state->band_start = band + 1;
2162 		else
2163 			state->band_start = 0;
2164 
2165 		/* if bands & channels are done, continue outside */
2166 		if (state->band_start == 0 && state->chan_start == 0)
2167 			state->split_start++;
2168 		if (state->split)
2169 			break;
2170 		/* fall through */
2171 	case 4:
2172 		nl_cmds = nla_nest_start_noflag(msg,
2173 						NL80211_ATTR_SUPPORTED_COMMANDS);
2174 		if (!nl_cmds)
2175 			goto nla_put_failure;
2176 
2177 		i = nl80211_add_commands_unsplit(rdev, msg);
2178 		if (i < 0)
2179 			goto nla_put_failure;
2180 		if (state->split) {
2181 			CMD(crit_proto_start, CRIT_PROTOCOL_START);
2182 			CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
2183 			if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
2184 				CMD(channel_switch, CHANNEL_SWITCH);
2185 			CMD(set_qos_map, SET_QOS_MAP);
2186 			if (rdev->wiphy.features &
2187 					NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
2188 				CMD(add_tx_ts, ADD_TX_TS);
2189 			CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
2190 			CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
2191 			CMD(update_ft_ies, UPDATE_FT_IES);
2192 		}
2193 #undef CMD
2194 
2195 		nla_nest_end(msg, nl_cmds);
2196 		state->split_start++;
2197 		if (state->split)
2198 			break;
2199 		/* fall through */
2200 	case 5:
2201 		if (rdev->ops->remain_on_channel &&
2202 		    (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
2203 		    nla_put_u32(msg,
2204 				NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
2205 				rdev->wiphy.max_remain_on_channel_duration))
2206 			goto nla_put_failure;
2207 
2208 		if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
2209 		    nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
2210 			goto nla_put_failure;
2211 
2212 		if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
2213 			goto nla_put_failure;
2214 		state->split_start++;
2215 		if (state->split)
2216 			break;
2217 		/* fall through */
2218 	case 6:
2219 #ifdef CONFIG_PM
2220 		if (nl80211_send_wowlan(msg, rdev, state->split))
2221 			goto nla_put_failure;
2222 		state->split_start++;
2223 		if (state->split)
2224 			break;
2225 #else
2226 		state->split_start++;
2227 #endif
2228 		/* fall through */
2229 	case 7:
2230 		if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
2231 					rdev->wiphy.software_iftypes))
2232 			goto nla_put_failure;
2233 
2234 		if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
2235 						   state->split))
2236 			goto nla_put_failure;
2237 
2238 		state->split_start++;
2239 		if (state->split)
2240 			break;
2241 		/* fall through */
2242 	case 8:
2243 		if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
2244 		    nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
2245 				rdev->wiphy.ap_sme_capa))
2246 			goto nla_put_failure;
2247 
2248 		features = rdev->wiphy.features;
2249 		/*
2250 		 * We can only add the per-channel limit information if the
2251 		 * dump is split, otherwise it makes it too big. Therefore
2252 		 * only advertise it in that case.
2253 		 */
2254 		if (state->split)
2255 			features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
2256 		if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
2257 			goto nla_put_failure;
2258 
2259 		if (rdev->wiphy.ht_capa_mod_mask &&
2260 		    nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
2261 			    sizeof(*rdev->wiphy.ht_capa_mod_mask),
2262 			    rdev->wiphy.ht_capa_mod_mask))
2263 			goto nla_put_failure;
2264 
2265 		if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
2266 		    rdev->wiphy.max_acl_mac_addrs &&
2267 		    nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
2268 				rdev->wiphy.max_acl_mac_addrs))
2269 			goto nla_put_failure;
2270 
2271 		/*
2272 		 * Any information below this point is only available to
2273 		 * applications that can deal with it being split. This
2274 		 * helps ensure that newly added capabilities don't break
2275 		 * older tools by overrunning their buffers.
2276 		 *
2277 		 * We still increment split_start so that in the split
2278 		 * case we'll continue with more data in the next round,
2279 		 * but break unconditionally so unsplit data stops here.
2280 		 */
2281 		state->split_start++;
2282 		break;
2283 	case 9:
2284 		if (rdev->wiphy.extended_capabilities &&
2285 		    (nla_put(msg, NL80211_ATTR_EXT_CAPA,
2286 			     rdev->wiphy.extended_capabilities_len,
2287 			     rdev->wiphy.extended_capabilities) ||
2288 		     nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
2289 			     rdev->wiphy.extended_capabilities_len,
2290 			     rdev->wiphy.extended_capabilities_mask)))
2291 			goto nla_put_failure;
2292 
2293 		if (rdev->wiphy.vht_capa_mod_mask &&
2294 		    nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
2295 			    sizeof(*rdev->wiphy.vht_capa_mod_mask),
2296 			    rdev->wiphy.vht_capa_mod_mask))
2297 			goto nla_put_failure;
2298 
2299 		if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
2300 			    rdev->wiphy.perm_addr))
2301 			goto nla_put_failure;
2302 
2303 		if (!is_zero_ether_addr(rdev->wiphy.addr_mask) &&
2304 		    nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN,
2305 			    rdev->wiphy.addr_mask))
2306 			goto nla_put_failure;
2307 
2308 		if (rdev->wiphy.n_addresses > 1) {
2309 			void *attr;
2310 
2311 			attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS);
2312 			if (!attr)
2313 				goto nla_put_failure;
2314 
2315 			for (i = 0; i < rdev->wiphy.n_addresses; i++)
2316 				if (nla_put(msg, i + 1, ETH_ALEN,
2317 					    rdev->wiphy.addresses[i].addr))
2318 					goto nla_put_failure;
2319 
2320 			nla_nest_end(msg, attr);
2321 		}
2322 
2323 		state->split_start++;
2324 		break;
2325 	case 10:
2326 		if (nl80211_send_coalesce(msg, rdev))
2327 			goto nla_put_failure;
2328 
2329 		if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
2330 		    (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
2331 		     nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
2332 			goto nla_put_failure;
2333 
2334 		if (rdev->wiphy.max_ap_assoc_sta &&
2335 		    nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
2336 				rdev->wiphy.max_ap_assoc_sta))
2337 			goto nla_put_failure;
2338 
2339 		state->split_start++;
2340 		break;
2341 	case 11:
2342 		if (rdev->wiphy.n_vendor_commands) {
2343 			const struct nl80211_vendor_cmd_info *info;
2344 			struct nlattr *nested;
2345 
2346 			nested = nla_nest_start_noflag(msg,
2347 						       NL80211_ATTR_VENDOR_DATA);
2348 			if (!nested)
2349 				goto nla_put_failure;
2350 
2351 			for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
2352 				info = &rdev->wiphy.vendor_commands[i].info;
2353 				if (nla_put(msg, i + 1, sizeof(*info), info))
2354 					goto nla_put_failure;
2355 			}
2356 			nla_nest_end(msg, nested);
2357 		}
2358 
2359 		if (rdev->wiphy.n_vendor_events) {
2360 			const struct nl80211_vendor_cmd_info *info;
2361 			struct nlattr *nested;
2362 
2363 			nested = nla_nest_start_noflag(msg,
2364 						       NL80211_ATTR_VENDOR_EVENTS);
2365 			if (!nested)
2366 				goto nla_put_failure;
2367 
2368 			for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
2369 				info = &rdev->wiphy.vendor_events[i];
2370 				if (nla_put(msg, i + 1, sizeof(*info), info))
2371 					goto nla_put_failure;
2372 			}
2373 			nla_nest_end(msg, nested);
2374 		}
2375 		state->split_start++;
2376 		break;
2377 	case 12:
2378 		if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
2379 		    nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
2380 			       rdev->wiphy.max_num_csa_counters))
2381 			goto nla_put_failure;
2382 
2383 		if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
2384 		    nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
2385 			goto nla_put_failure;
2386 
2387 		if (rdev->wiphy.max_sched_scan_reqs &&
2388 		    nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
2389 				rdev->wiphy.max_sched_scan_reqs))
2390 			goto nla_put_failure;
2391 
2392 		if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
2393 			    sizeof(rdev->wiphy.ext_features),
2394 			    rdev->wiphy.ext_features))
2395 			goto nla_put_failure;
2396 
2397 		if (rdev->wiphy.bss_select_support) {
2398 			struct nlattr *nested;
2399 			u32 bss_select_support = rdev->wiphy.bss_select_support;
2400 
2401 			nested = nla_nest_start_noflag(msg,
2402 						       NL80211_ATTR_BSS_SELECT);
2403 			if (!nested)
2404 				goto nla_put_failure;
2405 
2406 			i = 0;
2407 			while (bss_select_support) {
2408 				if ((bss_select_support & 1) &&
2409 				    nla_put_flag(msg, i))
2410 					goto nla_put_failure;
2411 				i++;
2412 				bss_select_support >>= 1;
2413 			}
2414 			nla_nest_end(msg, nested);
2415 		}
2416 
2417 		state->split_start++;
2418 		break;
2419 	case 13:
2420 		if (rdev->wiphy.num_iftype_ext_capab &&
2421 		    rdev->wiphy.iftype_ext_capab) {
2422 			struct nlattr *nested_ext_capab, *nested;
2423 
2424 			nested = nla_nest_start_noflag(msg,
2425 						       NL80211_ATTR_IFTYPE_EXT_CAPA);
2426 			if (!nested)
2427 				goto nla_put_failure;
2428 
2429 			for (i = state->capa_start;
2430 			     i < rdev->wiphy.num_iftype_ext_capab; i++) {
2431 				const struct wiphy_iftype_ext_capab *capab;
2432 
2433 				capab = &rdev->wiphy.iftype_ext_capab[i];
2434 
2435 				nested_ext_capab = nla_nest_start_noflag(msg,
2436 									 i);
2437 				if (!nested_ext_capab ||
2438 				    nla_put_u32(msg, NL80211_ATTR_IFTYPE,
2439 						capab->iftype) ||
2440 				    nla_put(msg, NL80211_ATTR_EXT_CAPA,
2441 					    capab->extended_capabilities_len,
2442 					    capab->extended_capabilities) ||
2443 				    nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
2444 					    capab->extended_capabilities_len,
2445 					    capab->extended_capabilities_mask))
2446 					goto nla_put_failure;
2447 
2448 				nla_nest_end(msg, nested_ext_capab);
2449 				if (state->split)
2450 					break;
2451 			}
2452 			nla_nest_end(msg, nested);
2453 			if (i < rdev->wiphy.num_iftype_ext_capab) {
2454 				state->capa_start = i + 1;
2455 				break;
2456 			}
2457 		}
2458 
2459 		if (nla_put_u32(msg, NL80211_ATTR_BANDS,
2460 				rdev->wiphy.nan_supported_bands))
2461 			goto nla_put_failure;
2462 
2463 		if (wiphy_ext_feature_isset(&rdev->wiphy,
2464 					    NL80211_EXT_FEATURE_TXQS)) {
2465 			struct cfg80211_txq_stats txqstats = {};
2466 			int res;
2467 
2468 			res = rdev_get_txq_stats(rdev, NULL, &txqstats);
2469 			if (!res &&
2470 			    !nl80211_put_txq_stats(msg, &txqstats,
2471 						   NL80211_ATTR_TXQ_STATS))
2472 				goto nla_put_failure;
2473 
2474 			if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT,
2475 					rdev->wiphy.txq_limit))
2476 				goto nla_put_failure;
2477 			if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT,
2478 					rdev->wiphy.txq_memory_limit))
2479 				goto nla_put_failure;
2480 			if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM,
2481 					rdev->wiphy.txq_quantum))
2482 				goto nla_put_failure;
2483 		}
2484 
2485 		state->split_start++;
2486 		break;
2487 	case 14:
2488 		if (nl80211_send_pmsr_capa(rdev, msg))
2489 			goto nla_put_failure;
2490 
2491 		state->split_start++;
2492 		break;
2493 	case 15:
2494 		if (rdev->wiphy.akm_suites &&
2495 		    nla_put(msg, NL80211_ATTR_AKM_SUITES,
2496 			    sizeof(u32) * rdev->wiphy.n_akm_suites,
2497 			    rdev->wiphy.akm_suites))
2498 			goto nla_put_failure;
2499 
2500 		if (nl80211_put_iftype_akm_suites(rdev, msg))
2501 			goto nla_put_failure;
2502 
2503 		/* done */
2504 		state->split_start = 0;
2505 		break;
2506 	}
2507  finish:
2508 	genlmsg_end(msg, hdr);
2509 	return 0;
2510 
2511  nla_put_failure:
2512 	genlmsg_cancel(msg, hdr);
2513 	return -EMSGSIZE;
2514 }
2515 
2516 static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
2517 				    struct netlink_callback *cb,
2518 				    struct nl80211_dump_wiphy_state *state)
2519 {
2520 	struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
2521 	int ret;
2522 
2523 	if (!tb)
2524 		return -ENOMEM;
2525 
2526 	ret = nlmsg_parse_deprecated(cb->nlh,
2527 				     GENL_HDRLEN + nl80211_fam.hdrsize,
2528 				     tb, nl80211_fam.maxattr,
2529 				     nl80211_policy, NULL);
2530 	/* ignore parse errors for backward compatibility */
2531 	if (ret) {
2532 		ret = 0;
2533 		goto out;
2534 	}
2535 
2536 	state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
2537 	if (tb[NL80211_ATTR_WIPHY])
2538 		state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
2539 	if (tb[NL80211_ATTR_WDEV])
2540 		state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
2541 	if (tb[NL80211_ATTR_IFINDEX]) {
2542 		struct net_device *netdev;
2543 		struct cfg80211_registered_device *rdev;
2544 		int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
2545 
2546 		netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
2547 		if (!netdev) {
2548 			ret = -ENODEV;
2549 			goto out;
2550 		}
2551 		if (netdev->ieee80211_ptr) {
2552 			rdev = wiphy_to_rdev(
2553 				netdev->ieee80211_ptr->wiphy);
2554 			state->filter_wiphy = rdev->wiphy_idx;
2555 		}
2556 	}
2557 
2558 	ret = 0;
2559 out:
2560 	kfree(tb);
2561 	return ret;
2562 }
2563 
2564 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
2565 {
2566 	int idx = 0, ret;
2567 	struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
2568 	struct cfg80211_registered_device *rdev;
2569 
2570 	rtnl_lock();
2571 	if (!state) {
2572 		state = kzalloc(sizeof(*state), GFP_KERNEL);
2573 		if (!state) {
2574 			rtnl_unlock();
2575 			return -ENOMEM;
2576 		}
2577 		state->filter_wiphy = -1;
2578 		ret = nl80211_dump_wiphy_parse(skb, cb, state);
2579 		if (ret) {
2580 			kfree(state);
2581 			rtnl_unlock();
2582 			return ret;
2583 		}
2584 		cb->args[0] = (long)state;
2585 	}
2586 
2587 	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2588 		if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
2589 			continue;
2590 		if (++idx <= state->start)
2591 			continue;
2592 		if (state->filter_wiphy != -1 &&
2593 		    state->filter_wiphy != rdev->wiphy_idx)
2594 			continue;
2595 		/* attempt to fit multiple wiphy data chunks into the skb */
2596 		do {
2597 			ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
2598 						 skb,
2599 						 NETLINK_CB(cb->skb).portid,
2600 						 cb->nlh->nlmsg_seq,
2601 						 NLM_F_MULTI, state);
2602 			if (ret < 0) {
2603 				/*
2604 				 * If sending the wiphy data didn't fit (ENOBUFS
2605 				 * or EMSGSIZE returned), this SKB is still
2606 				 * empty (so it's not too big because another
2607 				 * wiphy dataset is already in the skb) and
2608 				 * we've not tried to adjust the dump allocation
2609 				 * yet ... then adjust the alloc size to be
2610 				 * bigger, and return 1 but with the empty skb.
2611 				 * This results in an empty message being RX'ed
2612 				 * in userspace, but that is ignored.
2613 				 *
2614 				 * We can then retry with the larger buffer.
2615 				 */
2616 				if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
2617 				    !skb->len && !state->split &&
2618 				    cb->min_dump_alloc < 4096) {
2619 					cb->min_dump_alloc = 4096;
2620 					state->split_start = 0;
2621 					rtnl_unlock();
2622 					return 1;
2623 				}
2624 				idx--;
2625 				break;
2626 			}
2627 		} while (state->split_start > 0);
2628 		break;
2629 	}
2630 	rtnl_unlock();
2631 
2632 	state->start = idx;
2633 
2634 	return skb->len;
2635 }
2636 
2637 static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
2638 {
2639 	kfree((void *)cb->args[0]);
2640 	return 0;
2641 }
2642 
2643 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
2644 {
2645 	struct sk_buff *msg;
2646 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
2647 	struct nl80211_dump_wiphy_state state = {};
2648 
2649 	msg = nlmsg_new(4096, GFP_KERNEL);
2650 	if (!msg)
2651 		return -ENOMEM;
2652 
2653 	if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
2654 			       info->snd_portid, info->snd_seq, 0,
2655 			       &state) < 0) {
2656 		nlmsg_free(msg);
2657 		return -ENOBUFS;
2658 	}
2659 
2660 	return genlmsg_reply(msg, info);
2661 }
2662 
2663 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
2664 	[NL80211_TXQ_ATTR_QUEUE]		= { .type = NLA_U8 },
2665 	[NL80211_TXQ_ATTR_TXOP]			= { .type = NLA_U16 },
2666 	[NL80211_TXQ_ATTR_CWMIN]		= { .type = NLA_U16 },
2667 	[NL80211_TXQ_ATTR_CWMAX]		= { .type = NLA_U16 },
2668 	[NL80211_TXQ_ATTR_AIFS]			= { .type = NLA_U8 },
2669 };
2670 
2671 static int parse_txq_params(struct nlattr *tb[],
2672 			    struct ieee80211_txq_params *txq_params)
2673 {
2674 	u8 ac;
2675 
2676 	if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
2677 	    !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
2678 	    !tb[NL80211_TXQ_ATTR_AIFS])
2679 		return -EINVAL;
2680 
2681 	ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
2682 	txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
2683 	txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
2684 	txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
2685 	txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
2686 
2687 	if (ac >= NL80211_NUM_ACS)
2688 		return -EINVAL;
2689 	txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS);
2690 	return 0;
2691 }
2692 
2693 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
2694 {
2695 	/*
2696 	 * You can only set the channel explicitly for WDS interfaces,
2697 	 * all others have their channel managed via their respective
2698 	 * "establish a connection" command (connect, join, ...)
2699 	 *
2700 	 * For AP/GO and mesh mode, the channel can be set with the
2701 	 * channel userspace API, but is only stored and passed to the
2702 	 * low-level driver when the AP starts or the mesh is joined.
2703 	 * This is for backward compatibility, userspace can also give
2704 	 * the channel in the start-ap or join-mesh commands instead.
2705 	 *
2706 	 * Monitors are special as they are normally slaved to
2707 	 * whatever else is going on, so they have their own special
2708 	 * operation to set the monitor channel if possible.
2709 	 */
2710 	return !wdev ||
2711 		wdev->iftype == NL80211_IFTYPE_AP ||
2712 		wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
2713 		wdev->iftype == NL80211_IFTYPE_MONITOR ||
2714 		wdev->iftype == NL80211_IFTYPE_P2P_GO;
2715 }
2716 
2717 int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
2718 			  struct genl_info *info,
2719 			  struct cfg80211_chan_def *chandef)
2720 {
2721 	struct netlink_ext_ack *extack = info->extack;
2722 	struct nlattr **attrs = info->attrs;
2723 	u32 control_freq;
2724 
2725 	if (!attrs[NL80211_ATTR_WIPHY_FREQ])
2726 		return -EINVAL;
2727 
2728 	control_freq = nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ]);
2729 
2730 	memset(chandef, 0, sizeof(*chandef));
2731 
2732 	chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
2733 	chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
2734 	chandef->center_freq1 = control_freq;
2735 	chandef->center_freq2 = 0;
2736 
2737 	/* Primary channel not allowed */
2738 	if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED) {
2739 		NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ],
2740 				    "Channel is disabled");
2741 		return -EINVAL;
2742 	}
2743 
2744 	if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
2745 		enum nl80211_channel_type chantype;
2746 
2747 		chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
2748 
2749 		switch (chantype) {
2750 		case NL80211_CHAN_NO_HT:
2751 		case NL80211_CHAN_HT20:
2752 		case NL80211_CHAN_HT40PLUS:
2753 		case NL80211_CHAN_HT40MINUS:
2754 			cfg80211_chandef_create(chandef, chandef->chan,
2755 						chantype);
2756 			/* user input for center_freq is incorrect */
2757 			if (attrs[NL80211_ATTR_CENTER_FREQ1] &&
2758 			    chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) {
2759 				NL_SET_ERR_MSG_ATTR(extack,
2760 						    attrs[NL80211_ATTR_CENTER_FREQ1],
2761 						    "bad center frequency 1");
2762 				return -EINVAL;
2763 			}
2764 			/* center_freq2 must be zero */
2765 			if (attrs[NL80211_ATTR_CENTER_FREQ2] &&
2766 			    nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) {
2767 				NL_SET_ERR_MSG_ATTR(extack,
2768 						    attrs[NL80211_ATTR_CENTER_FREQ2],
2769 						    "center frequency 2 can't be used");
2770 				return -EINVAL;
2771 			}
2772 			break;
2773 		default:
2774 			NL_SET_ERR_MSG_ATTR(extack,
2775 					    attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE],
2776 					    "invalid channel type");
2777 			return -EINVAL;
2778 		}
2779 	} else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
2780 		chandef->width =
2781 			nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]);
2782 		if (attrs[NL80211_ATTR_CENTER_FREQ1])
2783 			chandef->center_freq1 =
2784 				nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]);
2785 		if (attrs[NL80211_ATTR_CENTER_FREQ2])
2786 			chandef->center_freq2 =
2787 				nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]);
2788 	}
2789 
2790 	if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) {
2791 		chandef->edmg.channels =
2792 		      nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]);
2793 
2794 		if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG])
2795 			chandef->edmg.bw_config =
2796 		     nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]);
2797 	} else {
2798 		chandef->edmg.bw_config = 0;
2799 		chandef->edmg.channels = 0;
2800 	}
2801 
2802 	if (!cfg80211_chandef_valid(chandef)) {
2803 		NL_SET_ERR_MSG(extack, "invalid channel definition");
2804 		return -EINVAL;
2805 	}
2806 
2807 	if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
2808 				     IEEE80211_CHAN_DISABLED)) {
2809 		NL_SET_ERR_MSG(extack, "(extension) channel is disabled");
2810 		return -EINVAL;
2811 	}
2812 
2813 	if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
2814 	     chandef->width == NL80211_CHAN_WIDTH_10) &&
2815 	    !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) {
2816 		NL_SET_ERR_MSG(extack, "5/10 MHz not supported");
2817 		return -EINVAL;
2818 	}
2819 
2820 	return 0;
2821 }
2822 
2823 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
2824 				 struct net_device *dev,
2825 				 struct genl_info *info)
2826 {
2827 	struct cfg80211_chan_def chandef;
2828 	int result;
2829 	enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
2830 	struct wireless_dev *wdev = NULL;
2831 
2832 	if (dev)
2833 		wdev = dev->ieee80211_ptr;
2834 	if (!nl80211_can_set_dev_channel(wdev))
2835 		return -EOPNOTSUPP;
2836 	if (wdev)
2837 		iftype = wdev->iftype;
2838 
2839 	result = nl80211_parse_chandef(rdev, info, &chandef);
2840 	if (result)
2841 		return result;
2842 
2843 	switch (iftype) {
2844 	case NL80211_IFTYPE_AP:
2845 	case NL80211_IFTYPE_P2P_GO:
2846 		if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
2847 						   iftype)) {
2848 			result = -EINVAL;
2849 			break;
2850 		}
2851 		if (wdev->beacon_interval) {
2852 			if (!dev || !rdev->ops->set_ap_chanwidth ||
2853 			    !(rdev->wiphy.features &
2854 			      NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
2855 				result = -EBUSY;
2856 				break;
2857 			}
2858 
2859 			/* Only allow dynamic channel width changes */
2860 			if (chandef.chan != wdev->preset_chandef.chan) {
2861 				result = -EBUSY;
2862 				break;
2863 			}
2864 			result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
2865 			if (result)
2866 				break;
2867 		}
2868 		wdev->preset_chandef = chandef;
2869 		result = 0;
2870 		break;
2871 	case NL80211_IFTYPE_MESH_POINT:
2872 		result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
2873 		break;
2874 	case NL80211_IFTYPE_MONITOR:
2875 		result = cfg80211_set_monitor_channel(rdev, &chandef);
2876 		break;
2877 	default:
2878 		result = -EINVAL;
2879 	}
2880 
2881 	return result;
2882 }
2883 
2884 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
2885 {
2886 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
2887 	struct net_device *netdev = info->user_ptr[1];
2888 
2889 	return __nl80211_set_channel(rdev, netdev, info);
2890 }
2891 
2892 static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
2893 {
2894 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
2895 	struct net_device *dev = info->user_ptr[1];
2896 	struct wireless_dev *wdev = dev->ieee80211_ptr;
2897 	const u8 *bssid;
2898 
2899 	if (!info->attrs[NL80211_ATTR_MAC])
2900 		return -EINVAL;
2901 
2902 	if (netif_running(dev))
2903 		return -EBUSY;
2904 
2905 	if (!rdev->ops->set_wds_peer)
2906 		return -EOPNOTSUPP;
2907 
2908 	if (wdev->iftype != NL80211_IFTYPE_WDS)
2909 		return -EOPNOTSUPP;
2910 
2911 	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
2912 	return rdev_set_wds_peer(rdev, dev, bssid);
2913 }
2914 
2915 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
2916 {
2917 	struct cfg80211_registered_device *rdev;
2918 	struct net_device *netdev = NULL;
2919 	struct wireless_dev *wdev;
2920 	int result = 0, rem_txq_params = 0;
2921 	struct nlattr *nl_txq_params;
2922 	u32 changed;
2923 	u8 retry_short = 0, retry_long = 0;
2924 	u32 frag_threshold = 0, rts_threshold = 0;
2925 	u8 coverage_class = 0;
2926 	u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0;
2927 
2928 	ASSERT_RTNL();
2929 
2930 	/*
2931 	 * Try to find the wiphy and netdev. Normally this
2932 	 * function shouldn't need the netdev, but this is
2933 	 * done for backward compatibility -- previously
2934 	 * setting the channel was done per wiphy, but now
2935 	 * it is per netdev. Previous userland like hostapd
2936 	 * also passed a netdev to set_wiphy, so that it is
2937 	 * possible to let that go to the right netdev!
2938 	 */
2939 
2940 	if (info->attrs[NL80211_ATTR_IFINDEX]) {
2941 		int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
2942 
2943 		netdev = __dev_get_by_index(genl_info_net(info), ifindex);
2944 		if (netdev && netdev->ieee80211_ptr)
2945 			rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
2946 		else
2947 			netdev = NULL;
2948 	}
2949 
2950 	if (!netdev) {
2951 		rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
2952 						  info->attrs);
2953 		if (IS_ERR(rdev))
2954 			return PTR_ERR(rdev);
2955 		wdev = NULL;
2956 		netdev = NULL;
2957 		result = 0;
2958 	} else
2959 		wdev = netdev->ieee80211_ptr;
2960 
2961 	/*
2962 	 * end workaround code, by now the rdev is available
2963 	 * and locked, and wdev may or may not be NULL.
2964 	 */
2965 
2966 	if (info->attrs[NL80211_ATTR_WIPHY_NAME])
2967 		result = cfg80211_dev_rename(
2968 			rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
2969 
2970 	if (result)
2971 		return result;
2972 
2973 	if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
2974 		struct ieee80211_txq_params txq_params;
2975 		struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
2976 
2977 		if (!rdev->ops->set_txq_params)
2978 			return -EOPNOTSUPP;
2979 
2980 		if (!netdev)
2981 			return -EINVAL;
2982 
2983 		if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2984 		    netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2985 			return -EINVAL;
2986 
2987 		if (!netif_running(netdev))
2988 			return -ENETDOWN;
2989 
2990 		nla_for_each_nested(nl_txq_params,
2991 				    info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
2992 				    rem_txq_params) {
2993 			result = nla_parse_nested_deprecated(tb,
2994 							     NL80211_TXQ_ATTR_MAX,
2995 							     nl_txq_params,
2996 							     txq_params_policy,
2997 							     info->extack);
2998 			if (result)
2999 				return result;
3000 			result = parse_txq_params(tb, &txq_params);
3001 			if (result)
3002 				return result;
3003 
3004 			result = rdev_set_txq_params(rdev, netdev,
3005 						     &txq_params);
3006 			if (result)
3007 				return result;
3008 		}
3009 	}
3010 
3011 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
3012 		result = __nl80211_set_channel(
3013 			rdev,
3014 			nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
3015 			info);
3016 		if (result)
3017 			return result;
3018 	}
3019 
3020 	if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
3021 		struct wireless_dev *txp_wdev = wdev;
3022 		enum nl80211_tx_power_setting type;
3023 		int idx, mbm = 0;
3024 
3025 		if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
3026 			txp_wdev = NULL;
3027 
3028 		if (!rdev->ops->set_tx_power)
3029 			return -EOPNOTSUPP;
3030 
3031 		idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
3032 		type = nla_get_u32(info->attrs[idx]);
3033 
3034 		if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
3035 		    (type != NL80211_TX_POWER_AUTOMATIC))
3036 			return -EINVAL;
3037 
3038 		if (type != NL80211_TX_POWER_AUTOMATIC) {
3039 			idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
3040 			mbm = nla_get_u32(info->attrs[idx]);
3041 		}
3042 
3043 		result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
3044 		if (result)
3045 			return result;
3046 	}
3047 
3048 	if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
3049 	    info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
3050 		u32 tx_ant, rx_ant;
3051 
3052 		if ((!rdev->wiphy.available_antennas_tx &&
3053 		     !rdev->wiphy.available_antennas_rx) ||
3054 		    !rdev->ops->set_antenna)
3055 			return -EOPNOTSUPP;
3056 
3057 		tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
3058 		rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
3059 
3060 		/* reject antenna configurations which don't match the
3061 		 * available antenna masks, except for the "all" mask */
3062 		if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
3063 		    (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
3064 			return -EINVAL;
3065 
3066 		tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
3067 		rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
3068 
3069 		result = rdev_set_antenna(rdev, tx_ant, rx_ant);
3070 		if (result)
3071 			return result;
3072 	}
3073 
3074 	changed = 0;
3075 
3076 	if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
3077 		retry_short = nla_get_u8(
3078 			info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
3079 
3080 		changed |= WIPHY_PARAM_RETRY_SHORT;
3081 	}
3082 
3083 	if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
3084 		retry_long = nla_get_u8(
3085 			info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
3086 
3087 		changed |= WIPHY_PARAM_RETRY_LONG;
3088 	}
3089 
3090 	if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
3091 		frag_threshold = nla_get_u32(
3092 			info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
3093 		if (frag_threshold < 256)
3094 			return -EINVAL;
3095 
3096 		if (frag_threshold != (u32) -1) {
3097 			/*
3098 			 * Fragments (apart from the last one) are required to
3099 			 * have even length. Make the fragmentation code
3100 			 * simpler by stripping LSB should someone try to use
3101 			 * odd threshold value.
3102 			 */
3103 			frag_threshold &= ~0x1;
3104 		}
3105 		changed |= WIPHY_PARAM_FRAG_THRESHOLD;
3106 	}
3107 
3108 	if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
3109 		rts_threshold = nla_get_u32(
3110 			info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
3111 		changed |= WIPHY_PARAM_RTS_THRESHOLD;
3112 	}
3113 
3114 	if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
3115 		if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
3116 			return -EINVAL;
3117 
3118 		coverage_class = nla_get_u8(
3119 			info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
3120 		changed |= WIPHY_PARAM_COVERAGE_CLASS;
3121 	}
3122 
3123 	if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
3124 		if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
3125 			return -EOPNOTSUPP;
3126 
3127 		changed |= WIPHY_PARAM_DYN_ACK;
3128 	}
3129 
3130 	if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) {
3131 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
3132 					     NL80211_EXT_FEATURE_TXQS))
3133 			return -EOPNOTSUPP;
3134 		txq_limit = nla_get_u32(
3135 			info->attrs[NL80211_ATTR_TXQ_LIMIT]);
3136 		changed |= WIPHY_PARAM_TXQ_LIMIT;
3137 	}
3138 
3139 	if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) {
3140 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
3141 					     NL80211_EXT_FEATURE_TXQS))
3142 			return -EOPNOTSUPP;
3143 		txq_memory_limit = nla_get_u32(
3144 			info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]);
3145 		changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT;
3146 	}
3147 
3148 	if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) {
3149 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
3150 					     NL80211_EXT_FEATURE_TXQS))
3151 			return -EOPNOTSUPP;
3152 		txq_quantum = nla_get_u32(
3153 			info->attrs[NL80211_ATTR_TXQ_QUANTUM]);
3154 		changed |= WIPHY_PARAM_TXQ_QUANTUM;
3155 	}
3156 
3157 	if (changed) {
3158 		u8 old_retry_short, old_retry_long;
3159 		u32 old_frag_threshold, old_rts_threshold;
3160 		u8 old_coverage_class;
3161 		u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum;
3162 
3163 		if (!rdev->ops->set_wiphy_params)
3164 			return -EOPNOTSUPP;
3165 
3166 		old_retry_short = rdev->wiphy.retry_short;
3167 		old_retry_long = rdev->wiphy.retry_long;
3168 		old_frag_threshold = rdev->wiphy.frag_threshold;
3169 		old_rts_threshold = rdev->wiphy.rts_threshold;
3170 		old_coverage_class = rdev->wiphy.coverage_class;
3171 		old_txq_limit = rdev->wiphy.txq_limit;
3172 		old_txq_memory_limit = rdev->wiphy.txq_memory_limit;
3173 		old_txq_quantum = rdev->wiphy.txq_quantum;
3174 
3175 		if (changed & WIPHY_PARAM_RETRY_SHORT)
3176 			rdev->wiphy.retry_short = retry_short;
3177 		if (changed & WIPHY_PARAM_RETRY_LONG)
3178 			rdev->wiphy.retry_long = retry_long;
3179 		if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
3180 			rdev->wiphy.frag_threshold = frag_threshold;
3181 		if (changed & WIPHY_PARAM_RTS_THRESHOLD)
3182 			rdev->wiphy.rts_threshold = rts_threshold;
3183 		if (changed & WIPHY_PARAM_COVERAGE_CLASS)
3184 			rdev->wiphy.coverage_class = coverage_class;
3185 		if (changed & WIPHY_PARAM_TXQ_LIMIT)
3186 			rdev->wiphy.txq_limit = txq_limit;
3187 		if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT)
3188 			rdev->wiphy.txq_memory_limit = txq_memory_limit;
3189 		if (changed & WIPHY_PARAM_TXQ_QUANTUM)
3190 			rdev->wiphy.txq_quantum = txq_quantum;
3191 
3192 		result = rdev_set_wiphy_params(rdev, changed);
3193 		if (result) {
3194 			rdev->wiphy.retry_short = old_retry_short;
3195 			rdev->wiphy.retry_long = old_retry_long;
3196 			rdev->wiphy.frag_threshold = old_frag_threshold;
3197 			rdev->wiphy.rts_threshold = old_rts_threshold;
3198 			rdev->wiphy.coverage_class = old_coverage_class;
3199 			rdev->wiphy.txq_limit = old_txq_limit;
3200 			rdev->wiphy.txq_memory_limit = old_txq_memory_limit;
3201 			rdev->wiphy.txq_quantum = old_txq_quantum;
3202 			return result;
3203 		}
3204 	}
3205 	return 0;
3206 }
3207 
3208 static int nl80211_send_chandef(struct sk_buff *msg,
3209 				const struct cfg80211_chan_def *chandef)
3210 {
3211 	if (WARN_ON(!cfg80211_chandef_valid(chandef)))
3212 		return -EINVAL;
3213 
3214 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
3215 			chandef->chan->center_freq))
3216 		return -ENOBUFS;
3217 	switch (chandef->width) {
3218 	case NL80211_CHAN_WIDTH_20_NOHT:
3219 	case NL80211_CHAN_WIDTH_20:
3220 	case NL80211_CHAN_WIDTH_40:
3221 		if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
3222 				cfg80211_get_chandef_type(chandef)))
3223 			return -ENOBUFS;
3224 		break;
3225 	default:
3226 		break;
3227 	}
3228 	if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
3229 		return -ENOBUFS;
3230 	if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
3231 		return -ENOBUFS;
3232 	if (chandef->center_freq2 &&
3233 	    nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
3234 		return -ENOBUFS;
3235 	return 0;
3236 }
3237 
3238 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
3239 			      struct cfg80211_registered_device *rdev,
3240 			      struct wireless_dev *wdev,
3241 			      enum nl80211_commands cmd)
3242 {
3243 	struct net_device *dev = wdev->netdev;
3244 	void *hdr;
3245 
3246 	WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
3247 		cmd != NL80211_CMD_DEL_INTERFACE &&
3248 		cmd != NL80211_CMD_SET_INTERFACE);
3249 
3250 	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
3251 	if (!hdr)
3252 		return -1;
3253 
3254 	if (dev &&
3255 	    (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3256 	     nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
3257 		goto nla_put_failure;
3258 
3259 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
3260 	    nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
3261 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
3262 			      NL80211_ATTR_PAD) ||
3263 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
3264 	    nla_put_u32(msg, NL80211_ATTR_GENERATION,
3265 			rdev->devlist_generation ^
3266 			(cfg80211_rdev_list_generation << 2)) ||
3267 	    nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr))
3268 		goto nla_put_failure;
3269 
3270 	if (rdev->ops->get_channel) {
3271 		int ret;
3272 		struct cfg80211_chan_def chandef = {};
3273 
3274 		ret = rdev_get_channel(rdev, wdev, &chandef);
3275 		if (ret == 0) {
3276 			if (nl80211_send_chandef(msg, &chandef))
3277 				goto nla_put_failure;
3278 		}
3279 	}
3280 
3281 	if (rdev->ops->get_tx_power) {
3282 		int dbm, ret;
3283 
3284 		ret = rdev_get_tx_power(rdev, wdev, &dbm);
3285 		if (ret == 0 &&
3286 		    nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
3287 				DBM_TO_MBM(dbm)))
3288 			goto nla_put_failure;
3289 	}
3290 
3291 	wdev_lock(wdev);
3292 	switch (wdev->iftype) {
3293 	case NL80211_IFTYPE_AP:
3294 		if (wdev->ssid_len &&
3295 		    nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
3296 			goto nla_put_failure_locked;
3297 		break;
3298 	case NL80211_IFTYPE_STATION:
3299 	case NL80211_IFTYPE_P2P_CLIENT:
3300 	case NL80211_IFTYPE_ADHOC: {
3301 		const u8 *ssid_ie;
3302 		if (!wdev->current_bss)
3303 			break;
3304 		rcu_read_lock();
3305 		ssid_ie = ieee80211_bss_get_ie(&wdev->current_bss->pub,
3306 					       WLAN_EID_SSID);
3307 		if (ssid_ie &&
3308 		    nla_put(msg, NL80211_ATTR_SSID, ssid_ie[1], ssid_ie + 2))
3309 			goto nla_put_failure_rcu_locked;
3310 		rcu_read_unlock();
3311 		break;
3312 		}
3313 	default:
3314 		/* nothing */
3315 		break;
3316 	}
3317 	wdev_unlock(wdev);
3318 
3319 	if (rdev->ops->get_txq_stats) {
3320 		struct cfg80211_txq_stats txqstats = {};
3321 		int ret = rdev_get_txq_stats(rdev, wdev, &txqstats);
3322 
3323 		if (ret == 0 &&
3324 		    !nl80211_put_txq_stats(msg, &txqstats,
3325 					   NL80211_ATTR_TXQ_STATS))
3326 			goto nla_put_failure;
3327 	}
3328 
3329 	genlmsg_end(msg, hdr);
3330 	return 0;
3331 
3332  nla_put_failure_rcu_locked:
3333 	rcu_read_unlock();
3334  nla_put_failure_locked:
3335 	wdev_unlock(wdev);
3336  nla_put_failure:
3337 	genlmsg_cancel(msg, hdr);
3338 	return -EMSGSIZE;
3339 }
3340 
3341 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
3342 {
3343 	int wp_idx = 0;
3344 	int if_idx = 0;
3345 	int wp_start = cb->args[0];
3346 	int if_start = cb->args[1];
3347 	int filter_wiphy = -1;
3348 	struct cfg80211_registered_device *rdev;
3349 	struct wireless_dev *wdev;
3350 	int ret;
3351 
3352 	rtnl_lock();
3353 	if (!cb->args[2]) {
3354 		struct nl80211_dump_wiphy_state state = {
3355 			.filter_wiphy = -1,
3356 		};
3357 
3358 		ret = nl80211_dump_wiphy_parse(skb, cb, &state);
3359 		if (ret)
3360 			goto out_unlock;
3361 
3362 		filter_wiphy = state.filter_wiphy;
3363 
3364 		/*
3365 		 * if filtering, set cb->args[2] to +1 since 0 is the default
3366 		 * value needed to determine that parsing is necessary.
3367 		 */
3368 		if (filter_wiphy >= 0)
3369 			cb->args[2] = filter_wiphy + 1;
3370 		else
3371 			cb->args[2] = -1;
3372 	} else if (cb->args[2] > 0) {
3373 		filter_wiphy = cb->args[2] - 1;
3374 	}
3375 
3376 	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
3377 		if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
3378 			continue;
3379 		if (wp_idx < wp_start) {
3380 			wp_idx++;
3381 			continue;
3382 		}
3383 
3384 		if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
3385 			continue;
3386 
3387 		if_idx = 0;
3388 
3389 		list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
3390 			if (if_idx < if_start) {
3391 				if_idx++;
3392 				continue;
3393 			}
3394 			if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
3395 					       cb->nlh->nlmsg_seq, NLM_F_MULTI,
3396 					       rdev, wdev,
3397 					       NL80211_CMD_NEW_INTERFACE) < 0) {
3398 				goto out;
3399 			}
3400 			if_idx++;
3401 		}
3402 
3403 		wp_idx++;
3404 	}
3405  out:
3406 	cb->args[0] = wp_idx;
3407 	cb->args[1] = if_idx;
3408 
3409 	ret = skb->len;
3410  out_unlock:
3411 	rtnl_unlock();
3412 
3413 	return ret;
3414 }
3415 
3416 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
3417 {
3418 	struct sk_buff *msg;
3419 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3420 	struct wireless_dev *wdev = info->user_ptr[1];
3421 
3422 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3423 	if (!msg)
3424 		return -ENOMEM;
3425 
3426 	if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
3427 			       rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
3428 		nlmsg_free(msg);
3429 		return -ENOBUFS;
3430 	}
3431 
3432 	return genlmsg_reply(msg, info);
3433 }
3434 
3435 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
3436 	[NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
3437 	[NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
3438 	[NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
3439 	[NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
3440 	[NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
3441 	[NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
3442 };
3443 
3444 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
3445 {
3446 	struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
3447 	int flag;
3448 
3449 	*mntrflags = 0;
3450 
3451 	if (!nla)
3452 		return -EINVAL;
3453 
3454 	if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL))
3455 		return -EINVAL;
3456 
3457 	for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
3458 		if (flags[flag])
3459 			*mntrflags |= (1<<flag);
3460 
3461 	*mntrflags |= MONITOR_FLAG_CHANGED;
3462 
3463 	return 0;
3464 }
3465 
3466 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
3467 				     enum nl80211_iftype type,
3468 				     struct genl_info *info,
3469 				     struct vif_params *params)
3470 {
3471 	bool change = false;
3472 	int err;
3473 
3474 	if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
3475 		if (type != NL80211_IFTYPE_MONITOR)
3476 			return -EINVAL;
3477 
3478 		err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
3479 					  &params->flags);
3480 		if (err)
3481 			return err;
3482 
3483 		change = true;
3484 	}
3485 
3486 	if (params->flags & MONITOR_FLAG_ACTIVE &&
3487 	    !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
3488 		return -EOPNOTSUPP;
3489 
3490 	if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
3491 		const u8 *mumimo_groups;
3492 		u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
3493 
3494 		if (type != NL80211_IFTYPE_MONITOR)
3495 			return -EINVAL;
3496 
3497 		if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
3498 			return -EOPNOTSUPP;
3499 
3500 		mumimo_groups =
3501 			nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
3502 
3503 		/* bits 0 and 63 are reserved and must be zero */
3504 		if ((mumimo_groups[0] & BIT(0)) ||
3505 		    (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7)))
3506 			return -EINVAL;
3507 
3508 		params->vht_mumimo_groups = mumimo_groups;
3509 		change = true;
3510 	}
3511 
3512 	if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
3513 		u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
3514 
3515 		if (type != NL80211_IFTYPE_MONITOR)
3516 			return -EINVAL;
3517 
3518 		if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
3519 			return -EOPNOTSUPP;
3520 
3521 		params->vht_mumimo_follow_addr =
3522 			nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
3523 		change = true;
3524 	}
3525 
3526 	return change ? 1 : 0;
3527 }
3528 
3529 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
3530 			       struct net_device *netdev, u8 use_4addr,
3531 			       enum nl80211_iftype iftype)
3532 {
3533 	if (!use_4addr) {
3534 		if (netdev && netif_is_bridge_port(netdev))
3535 			return -EBUSY;
3536 		return 0;
3537 	}
3538 
3539 	switch (iftype) {
3540 	case NL80211_IFTYPE_AP_VLAN:
3541 		if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
3542 			return 0;
3543 		break;
3544 	case NL80211_IFTYPE_STATION:
3545 		if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
3546 			return 0;
3547 		break;
3548 	default:
3549 		break;
3550 	}
3551 
3552 	return -EOPNOTSUPP;
3553 }
3554 
3555 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
3556 {
3557 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3558 	struct vif_params params;
3559 	int err;
3560 	enum nl80211_iftype otype, ntype;
3561 	struct net_device *dev = info->user_ptr[1];
3562 	bool change = false;
3563 
3564 	memset(&params, 0, sizeof(params));
3565 
3566 	otype = ntype = dev->ieee80211_ptr->iftype;
3567 
3568 	if (info->attrs[NL80211_ATTR_IFTYPE]) {
3569 		ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
3570 		if (otype != ntype)
3571 			change = true;
3572 	}
3573 
3574 	if (info->attrs[NL80211_ATTR_MESH_ID]) {
3575 		struct wireless_dev *wdev = dev->ieee80211_ptr;
3576 
3577 		if (ntype != NL80211_IFTYPE_MESH_POINT)
3578 			return -EINVAL;
3579 		if (netif_running(dev))
3580 			return -EBUSY;
3581 
3582 		wdev_lock(wdev);
3583 		BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
3584 			     IEEE80211_MAX_MESH_ID_LEN);
3585 		wdev->mesh_id_up_len =
3586 			nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
3587 		memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
3588 		       wdev->mesh_id_up_len);
3589 		wdev_unlock(wdev);
3590 	}
3591 
3592 	if (info->attrs[NL80211_ATTR_4ADDR]) {
3593 		params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
3594 		change = true;
3595 		err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
3596 		if (err)
3597 			return err;
3598 	} else {
3599 		params.use_4addr = -1;
3600 	}
3601 
3602 	err = nl80211_parse_mon_options(rdev, ntype, info, &params);
3603 	if (err < 0)
3604 		return err;
3605 	if (err > 0)
3606 		change = true;
3607 
3608 	if (change)
3609 		err = cfg80211_change_iface(rdev, dev, ntype, &params);
3610 	else
3611 		err = 0;
3612 
3613 	if (!err && params.use_4addr != -1)
3614 		dev->ieee80211_ptr->use_4addr = params.use_4addr;
3615 
3616 	if (change && !err) {
3617 		struct wireless_dev *wdev = dev->ieee80211_ptr;
3618 
3619 		nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE);
3620 	}
3621 
3622 	return err;
3623 }
3624 
3625 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
3626 {
3627 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3628 	struct vif_params params;
3629 	struct wireless_dev *wdev;
3630 	struct sk_buff *msg;
3631 	int err;
3632 	enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
3633 
3634 	/* to avoid failing a new interface creation due to pending removal */
3635 	cfg80211_destroy_ifaces(rdev);
3636 
3637 	memset(&params, 0, sizeof(params));
3638 
3639 	if (!info->attrs[NL80211_ATTR_IFNAME])
3640 		return -EINVAL;
3641 
3642 	if (info->attrs[NL80211_ATTR_IFTYPE])
3643 		type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
3644 
3645 	if (!rdev->ops->add_virtual_intf)
3646 		return -EOPNOTSUPP;
3647 
3648 	if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
3649 	     rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
3650 	    info->attrs[NL80211_ATTR_MAC]) {
3651 		nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
3652 			   ETH_ALEN);
3653 		if (!is_valid_ether_addr(params.macaddr))
3654 			return -EADDRNOTAVAIL;
3655 	}
3656 
3657 	if (info->attrs[NL80211_ATTR_4ADDR]) {
3658 		params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
3659 		err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
3660 		if (err)
3661 			return err;
3662 	}
3663 
3664 	if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0))
3665 		return -EOPNOTSUPP;
3666 
3667 	err = nl80211_parse_mon_options(rdev, type, info, &params);
3668 	if (err < 0)
3669 		return err;
3670 
3671 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3672 	if (!msg)
3673 		return -ENOMEM;
3674 
3675 	wdev = rdev_add_virtual_intf(rdev,
3676 				nla_data(info->attrs[NL80211_ATTR_IFNAME]),
3677 				NET_NAME_USER, type, &params);
3678 	if (WARN_ON(!wdev)) {
3679 		nlmsg_free(msg);
3680 		return -EPROTO;
3681 	} else if (IS_ERR(wdev)) {
3682 		nlmsg_free(msg);
3683 		return PTR_ERR(wdev);
3684 	}
3685 
3686 	if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
3687 		wdev->owner_nlportid = info->snd_portid;
3688 
3689 	switch (type) {
3690 	case NL80211_IFTYPE_MESH_POINT:
3691 		if (!info->attrs[NL80211_ATTR_MESH_ID])
3692 			break;
3693 		wdev_lock(wdev);
3694 		BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
3695 			     IEEE80211_MAX_MESH_ID_LEN);
3696 		wdev->mesh_id_up_len =
3697 			nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
3698 		memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
3699 		       wdev->mesh_id_up_len);
3700 		wdev_unlock(wdev);
3701 		break;
3702 	case NL80211_IFTYPE_NAN:
3703 	case NL80211_IFTYPE_P2P_DEVICE:
3704 		/*
3705 		 * P2P Device and NAN do not have a netdev, so don't go
3706 		 * through the netdev notifier and must be added here
3707 		 */
3708 		cfg80211_init_wdev(rdev, wdev);
3709 		break;
3710 	default:
3711 		break;
3712 	}
3713 
3714 	if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
3715 			       rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
3716 		nlmsg_free(msg);
3717 		return -ENOBUFS;
3718 	}
3719 
3720 	return genlmsg_reply(msg, info);
3721 }
3722 
3723 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
3724 {
3725 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3726 	struct wireless_dev *wdev = info->user_ptr[1];
3727 
3728 	if (!rdev->ops->del_virtual_intf)
3729 		return -EOPNOTSUPP;
3730 
3731 	/*
3732 	 * If we remove a wireless device without a netdev then clear
3733 	 * user_ptr[1] so that nl80211_post_doit won't dereference it
3734 	 * to check if it needs to do dev_put(). Otherwise it crashes
3735 	 * since the wdev has been freed, unlike with a netdev where
3736 	 * we need the dev_put() for the netdev to really be freed.
3737 	 */
3738 	if (!wdev->netdev)
3739 		info->user_ptr[1] = NULL;
3740 
3741 	return rdev_del_virtual_intf(rdev, wdev);
3742 }
3743 
3744 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
3745 {
3746 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3747 	struct net_device *dev = info->user_ptr[1];
3748 	u16 noack_map;
3749 
3750 	if (!info->attrs[NL80211_ATTR_NOACK_MAP])
3751 		return -EINVAL;
3752 
3753 	if (!rdev->ops->set_noack_map)
3754 		return -EOPNOTSUPP;
3755 
3756 	noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
3757 
3758 	return rdev_set_noack_map(rdev, dev, noack_map);
3759 }
3760 
3761 struct get_key_cookie {
3762 	struct sk_buff *msg;
3763 	int error;
3764 	int idx;
3765 };
3766 
3767 static void get_key_callback(void *c, struct key_params *params)
3768 {
3769 	struct nlattr *key;
3770 	struct get_key_cookie *cookie = c;
3771 
3772 	if ((params->key &&
3773 	     nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
3774 		     params->key_len, params->key)) ||
3775 	    (params->seq &&
3776 	     nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
3777 		     params->seq_len, params->seq)) ||
3778 	    (params->cipher &&
3779 	     nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
3780 			 params->cipher)))
3781 		goto nla_put_failure;
3782 
3783 	key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY);
3784 	if (!key)
3785 		goto nla_put_failure;
3786 
3787 	if ((params->key &&
3788 	     nla_put(cookie->msg, NL80211_KEY_DATA,
3789 		     params->key_len, params->key)) ||
3790 	    (params->seq &&
3791 	     nla_put(cookie->msg, NL80211_KEY_SEQ,
3792 		     params->seq_len, params->seq)) ||
3793 	    (params->cipher &&
3794 	     nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
3795 			 params->cipher)))
3796 		goto nla_put_failure;
3797 
3798 	if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx))
3799 		goto nla_put_failure;
3800 
3801 	nla_nest_end(cookie->msg, key);
3802 
3803 	return;
3804  nla_put_failure:
3805 	cookie->error = 1;
3806 }
3807 
3808 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
3809 {
3810 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3811 	int err;
3812 	struct net_device *dev = info->user_ptr[1];
3813 	u8 key_idx = 0;
3814 	const u8 *mac_addr = NULL;
3815 	bool pairwise;
3816 	struct get_key_cookie cookie = {
3817 		.error = 0,
3818 	};
3819 	void *hdr;
3820 	struct sk_buff *msg;
3821 
3822 	if (info->attrs[NL80211_ATTR_KEY_IDX])
3823 		key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
3824 
3825 	if (info->attrs[NL80211_ATTR_MAC])
3826 		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3827 
3828 	pairwise = !!mac_addr;
3829 	if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
3830 		u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
3831 
3832 		if (kt != NL80211_KEYTYPE_GROUP &&
3833 		    kt != NL80211_KEYTYPE_PAIRWISE)
3834 			return -EINVAL;
3835 		pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
3836 	}
3837 
3838 	if (!rdev->ops->get_key)
3839 		return -EOPNOTSUPP;
3840 
3841 	if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3842 		return -ENOENT;
3843 
3844 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3845 	if (!msg)
3846 		return -ENOMEM;
3847 
3848 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
3849 			     NL80211_CMD_NEW_KEY);
3850 	if (!hdr)
3851 		goto nla_put_failure;
3852 
3853 	cookie.msg = msg;
3854 	cookie.idx = key_idx;
3855 
3856 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3857 	    nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
3858 		goto nla_put_failure;
3859 	if (mac_addr &&
3860 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
3861 		goto nla_put_failure;
3862 
3863 	err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
3864 			   get_key_callback);
3865 
3866 	if (err)
3867 		goto free_msg;
3868 
3869 	if (cookie.error)
3870 		goto nla_put_failure;
3871 
3872 	genlmsg_end(msg, hdr);
3873 	return genlmsg_reply(msg, info);
3874 
3875  nla_put_failure:
3876 	err = -ENOBUFS;
3877  free_msg:
3878 	nlmsg_free(msg);
3879 	return err;
3880 }
3881 
3882 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
3883 {
3884 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3885 	struct key_parse key;
3886 	int err;
3887 	struct net_device *dev = info->user_ptr[1];
3888 
3889 	err = nl80211_parse_key(info, &key);
3890 	if (err)
3891 		return err;
3892 
3893 	if (key.idx < 0)
3894 		return -EINVAL;
3895 
3896 	/* Only support setting default key and
3897 	 * Extended Key ID action NL80211_KEY_SET_TX.
3898 	 */
3899 	if (!key.def && !key.defmgmt &&
3900 	    !(key.p.mode == NL80211_KEY_SET_TX))
3901 		return -EINVAL;
3902 
3903 	wdev_lock(dev->ieee80211_ptr);
3904 
3905 	if (key.def) {
3906 		if (!rdev->ops->set_default_key) {
3907 			err = -EOPNOTSUPP;
3908 			goto out;
3909 		}
3910 
3911 		err = nl80211_key_allowed(dev->ieee80211_ptr);
3912 		if (err)
3913 			goto out;
3914 
3915 		err = rdev_set_default_key(rdev, dev, key.idx,
3916 						 key.def_uni, key.def_multi);
3917 
3918 		if (err)
3919 			goto out;
3920 
3921 #ifdef CONFIG_CFG80211_WEXT
3922 		dev->ieee80211_ptr->wext.default_key = key.idx;
3923 #endif
3924 	} else if (key.defmgmt) {
3925 		if (key.def_uni || !key.def_multi) {
3926 			err = -EINVAL;
3927 			goto out;
3928 		}
3929 
3930 		if (!rdev->ops->set_default_mgmt_key) {
3931 			err = -EOPNOTSUPP;
3932 			goto out;
3933 		}
3934 
3935 		err = nl80211_key_allowed(dev->ieee80211_ptr);
3936 		if (err)
3937 			goto out;
3938 
3939 		err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
3940 		if (err)
3941 			goto out;
3942 
3943 #ifdef CONFIG_CFG80211_WEXT
3944 		dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
3945 #endif
3946 	} else if (key.p.mode == NL80211_KEY_SET_TX &&
3947 		   wiphy_ext_feature_isset(&rdev->wiphy,
3948 					   NL80211_EXT_FEATURE_EXT_KEY_ID)) {
3949 		u8 *mac_addr = NULL;
3950 
3951 		if (info->attrs[NL80211_ATTR_MAC])
3952 			mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3953 
3954 		if (!mac_addr || key.idx < 0 || key.idx > 1) {
3955 			err = -EINVAL;
3956 			goto out;
3957 		}
3958 
3959 		err = rdev_add_key(rdev, dev, key.idx,
3960 				   NL80211_KEYTYPE_PAIRWISE,
3961 				   mac_addr, &key.p);
3962 	} else {
3963 		err = -EINVAL;
3964 	}
3965  out:
3966 	wdev_unlock(dev->ieee80211_ptr);
3967 
3968 	return err;
3969 }
3970 
3971 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
3972 {
3973 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3974 	int err;
3975 	struct net_device *dev = info->user_ptr[1];
3976 	struct key_parse key;
3977 	const u8 *mac_addr = NULL;
3978 
3979 	err = nl80211_parse_key(info, &key);
3980 	if (err)
3981 		return err;
3982 
3983 	if (!key.p.key)
3984 		return -EINVAL;
3985 
3986 	if (info->attrs[NL80211_ATTR_MAC])
3987 		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3988 
3989 	if (key.type == -1) {
3990 		if (mac_addr)
3991 			key.type = NL80211_KEYTYPE_PAIRWISE;
3992 		else
3993 			key.type = NL80211_KEYTYPE_GROUP;
3994 	}
3995 
3996 	/* for now */
3997 	if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3998 	    key.type != NL80211_KEYTYPE_GROUP)
3999 		return -EINVAL;
4000 
4001 	if (key.type == NL80211_KEYTYPE_GROUP &&
4002 	    info->attrs[NL80211_ATTR_VLAN_ID])
4003 		key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
4004 
4005 	if (!rdev->ops->add_key)
4006 		return -EOPNOTSUPP;
4007 
4008 	if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
4009 					   key.type == NL80211_KEYTYPE_PAIRWISE,
4010 					   mac_addr))
4011 		return -EINVAL;
4012 
4013 	wdev_lock(dev->ieee80211_ptr);
4014 	err = nl80211_key_allowed(dev->ieee80211_ptr);
4015 	if (!err)
4016 		err = rdev_add_key(rdev, dev, key.idx,
4017 				   key.type == NL80211_KEYTYPE_PAIRWISE,
4018 				    mac_addr, &key.p);
4019 	wdev_unlock(dev->ieee80211_ptr);
4020 
4021 	return err;
4022 }
4023 
4024 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
4025 {
4026 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4027 	int err;
4028 	struct net_device *dev = info->user_ptr[1];
4029 	u8 *mac_addr = NULL;
4030 	struct key_parse key;
4031 
4032 	err = nl80211_parse_key(info, &key);
4033 	if (err)
4034 		return err;
4035 
4036 	if (info->attrs[NL80211_ATTR_MAC])
4037 		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4038 
4039 	if (key.type == -1) {
4040 		if (mac_addr)
4041 			key.type = NL80211_KEYTYPE_PAIRWISE;
4042 		else
4043 			key.type = NL80211_KEYTYPE_GROUP;
4044 	}
4045 
4046 	/* for now */
4047 	if (key.type != NL80211_KEYTYPE_PAIRWISE &&
4048 	    key.type != NL80211_KEYTYPE_GROUP)
4049 		return -EINVAL;
4050 
4051 	if (!rdev->ops->del_key)
4052 		return -EOPNOTSUPP;
4053 
4054 	wdev_lock(dev->ieee80211_ptr);
4055 	err = nl80211_key_allowed(dev->ieee80211_ptr);
4056 
4057 	if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
4058 	    !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
4059 		err = -ENOENT;
4060 
4061 	if (!err)
4062 		err = rdev_del_key(rdev, dev, key.idx,
4063 				   key.type == NL80211_KEYTYPE_PAIRWISE,
4064 				   mac_addr);
4065 
4066 #ifdef CONFIG_CFG80211_WEXT
4067 	if (!err) {
4068 		if (key.idx == dev->ieee80211_ptr->wext.default_key)
4069 			dev->ieee80211_ptr->wext.default_key = -1;
4070 		else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
4071 			dev->ieee80211_ptr->wext.default_mgmt_key = -1;
4072 	}
4073 #endif
4074 	wdev_unlock(dev->ieee80211_ptr);
4075 
4076 	return err;
4077 }
4078 
4079 /* This function returns an error or the number of nested attributes */
4080 static int validate_acl_mac_addrs(struct nlattr *nl_attr)
4081 {
4082 	struct nlattr *attr;
4083 	int n_entries = 0, tmp;
4084 
4085 	nla_for_each_nested(attr, nl_attr, tmp) {
4086 		if (nla_len(attr) != ETH_ALEN)
4087 			return -EINVAL;
4088 
4089 		n_entries++;
4090 	}
4091 
4092 	return n_entries;
4093 }
4094 
4095 /*
4096  * This function parses ACL information and allocates memory for ACL data.
4097  * On successful return, the calling function is responsible to free the
4098  * ACL buffer returned by this function.
4099  */
4100 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
4101 						struct genl_info *info)
4102 {
4103 	enum nl80211_acl_policy acl_policy;
4104 	struct nlattr *attr;
4105 	struct cfg80211_acl_data *acl;
4106 	int i = 0, n_entries, tmp;
4107 
4108 	if (!wiphy->max_acl_mac_addrs)
4109 		return ERR_PTR(-EOPNOTSUPP);
4110 
4111 	if (!info->attrs[NL80211_ATTR_ACL_POLICY])
4112 		return ERR_PTR(-EINVAL);
4113 
4114 	acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
4115 	if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
4116 	    acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
4117 		return ERR_PTR(-EINVAL);
4118 
4119 	if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
4120 		return ERR_PTR(-EINVAL);
4121 
4122 	n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
4123 	if (n_entries < 0)
4124 		return ERR_PTR(n_entries);
4125 
4126 	if (n_entries > wiphy->max_acl_mac_addrs)
4127 		return ERR_PTR(-ENOTSUPP);
4128 
4129 	acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL);
4130 	if (!acl)
4131 		return ERR_PTR(-ENOMEM);
4132 
4133 	nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
4134 		memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
4135 		i++;
4136 	}
4137 
4138 	acl->n_acl_entries = n_entries;
4139 	acl->acl_policy = acl_policy;
4140 
4141 	return acl;
4142 }
4143 
4144 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
4145 {
4146 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4147 	struct net_device *dev = info->user_ptr[1];
4148 	struct cfg80211_acl_data *acl;
4149 	int err;
4150 
4151 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4152 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4153 		return -EOPNOTSUPP;
4154 
4155 	if (!dev->ieee80211_ptr->beacon_interval)
4156 		return -EINVAL;
4157 
4158 	acl = parse_acl_data(&rdev->wiphy, info);
4159 	if (IS_ERR(acl))
4160 		return PTR_ERR(acl);
4161 
4162 	err = rdev_set_mac_acl(rdev, dev, acl);
4163 
4164 	kfree(acl);
4165 
4166 	return err;
4167 }
4168 
4169 static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
4170 			   u8 *rates, u8 rates_len)
4171 {
4172 	u8 i;
4173 	u32 mask = 0;
4174 
4175 	for (i = 0; i < rates_len; i++) {
4176 		int rate = (rates[i] & 0x7f) * 5;
4177 		int ridx;
4178 
4179 		for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
4180 			struct ieee80211_rate *srate =
4181 				&sband->bitrates[ridx];
4182 			if (rate == srate->bitrate) {
4183 				mask |= 1 << ridx;
4184 				break;
4185 			}
4186 		}
4187 		if (ridx == sband->n_bitrates)
4188 			return 0; /* rate not found */
4189 	}
4190 
4191 	return mask;
4192 }
4193 
4194 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
4195 			       u8 *rates, u8 rates_len,
4196 			       u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
4197 {
4198 	u8 i;
4199 
4200 	memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
4201 
4202 	for (i = 0; i < rates_len; i++) {
4203 		int ridx, rbit;
4204 
4205 		ridx = rates[i] / 8;
4206 		rbit = BIT(rates[i] % 8);
4207 
4208 		/* check validity */
4209 		if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
4210 			return false;
4211 
4212 		/* check availability */
4213 		ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN);
4214 		if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
4215 			mcs[ridx] |= rbit;
4216 		else
4217 			return false;
4218 	}
4219 
4220 	return true;
4221 }
4222 
4223 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
4224 {
4225 	u16 mcs_mask = 0;
4226 
4227 	switch (vht_mcs_map) {
4228 	case IEEE80211_VHT_MCS_NOT_SUPPORTED:
4229 		break;
4230 	case IEEE80211_VHT_MCS_SUPPORT_0_7:
4231 		mcs_mask = 0x00FF;
4232 		break;
4233 	case IEEE80211_VHT_MCS_SUPPORT_0_8:
4234 		mcs_mask = 0x01FF;
4235 		break;
4236 	case IEEE80211_VHT_MCS_SUPPORT_0_9:
4237 		mcs_mask = 0x03FF;
4238 		break;
4239 	default:
4240 		break;
4241 	}
4242 
4243 	return mcs_mask;
4244 }
4245 
4246 static void vht_build_mcs_mask(u16 vht_mcs_map,
4247 			       u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
4248 {
4249 	u8 nss;
4250 
4251 	for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
4252 		vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
4253 		vht_mcs_map >>= 2;
4254 	}
4255 }
4256 
4257 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
4258 			     struct nl80211_txrate_vht *txrate,
4259 			     u16 mcs[NL80211_VHT_NSS_MAX])
4260 {
4261 	u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
4262 	u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
4263 	u8 i;
4264 
4265 	if (!sband->vht_cap.vht_supported)
4266 		return false;
4267 
4268 	memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
4269 
4270 	/* Build vht_mcs_mask from VHT capabilities */
4271 	vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
4272 
4273 	for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
4274 		if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
4275 			mcs[i] = txrate->mcs[i];
4276 		else
4277 			return false;
4278 	}
4279 
4280 	return true;
4281 }
4282 
4283 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
4284 	[NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
4285 				    .len = NL80211_MAX_SUPP_RATES },
4286 	[NL80211_TXRATE_HT] = { .type = NLA_BINARY,
4287 				.len = NL80211_MAX_SUPP_HT_RATES },
4288 	[NL80211_TXRATE_VHT] = {
4289 		.type = NLA_EXACT_LEN_WARN,
4290 		.len = sizeof(struct nl80211_txrate_vht),
4291 	},
4292 	[NL80211_TXRATE_GI] = { .type = NLA_U8 },
4293 };
4294 
4295 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
4296 					 struct cfg80211_bitrate_mask *mask)
4297 {
4298 	struct nlattr *tb[NL80211_TXRATE_MAX + 1];
4299 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4300 	int rem, i;
4301 	struct nlattr *tx_rates;
4302 	struct ieee80211_supported_band *sband;
4303 	u16 vht_tx_mcs_map;
4304 
4305 	memset(mask, 0, sizeof(*mask));
4306 	/* Default to all rates enabled */
4307 	for (i = 0; i < NUM_NL80211_BANDS; i++) {
4308 		sband = rdev->wiphy.bands[i];
4309 
4310 		if (!sband)
4311 			continue;
4312 
4313 		mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
4314 		memcpy(mask->control[i].ht_mcs,
4315 		       sband->ht_cap.mcs.rx_mask,
4316 		       sizeof(mask->control[i].ht_mcs));
4317 
4318 		if (!sband->vht_cap.vht_supported)
4319 			continue;
4320 
4321 		vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
4322 		vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
4323 	}
4324 
4325 	/* if no rates are given set it back to the defaults */
4326 	if (!info->attrs[NL80211_ATTR_TX_RATES])
4327 		goto out;
4328 
4329 	/* The nested attribute uses enum nl80211_band as the index. This maps
4330 	 * directly to the enum nl80211_band values used in cfg80211.
4331 	 */
4332 	BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
4333 	nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
4334 		enum nl80211_band band = nla_type(tx_rates);
4335 		int err;
4336 
4337 		if (band < 0 || band >= NUM_NL80211_BANDS)
4338 			return -EINVAL;
4339 		sband = rdev->wiphy.bands[band];
4340 		if (sband == NULL)
4341 			return -EINVAL;
4342 		err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX,
4343 						  tx_rates,
4344 						  nl80211_txattr_policy,
4345 						  info->extack);
4346 		if (err)
4347 			return err;
4348 		if (tb[NL80211_TXRATE_LEGACY]) {
4349 			mask->control[band].legacy = rateset_to_mask(
4350 				sband,
4351 				nla_data(tb[NL80211_TXRATE_LEGACY]),
4352 				nla_len(tb[NL80211_TXRATE_LEGACY]));
4353 			if ((mask->control[band].legacy == 0) &&
4354 			    nla_len(tb[NL80211_TXRATE_LEGACY]))
4355 				return -EINVAL;
4356 		}
4357 		if (tb[NL80211_TXRATE_HT]) {
4358 			if (!ht_rateset_to_mask(
4359 					sband,
4360 					nla_data(tb[NL80211_TXRATE_HT]),
4361 					nla_len(tb[NL80211_TXRATE_HT]),
4362 					mask->control[band].ht_mcs))
4363 				return -EINVAL;
4364 		}
4365 		if (tb[NL80211_TXRATE_VHT]) {
4366 			if (!vht_set_mcs_mask(
4367 					sband,
4368 					nla_data(tb[NL80211_TXRATE_VHT]),
4369 					mask->control[band].vht_mcs))
4370 				return -EINVAL;
4371 		}
4372 		if (tb[NL80211_TXRATE_GI]) {
4373 			mask->control[band].gi =
4374 				nla_get_u8(tb[NL80211_TXRATE_GI]);
4375 			if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
4376 				return -EINVAL;
4377 		}
4378 
4379 		if (mask->control[band].legacy == 0) {
4380 			/* don't allow empty legacy rates if HT or VHT
4381 			 * are not even supported.
4382 			 */
4383 			if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
4384 			      rdev->wiphy.bands[band]->vht_cap.vht_supported))
4385 				return -EINVAL;
4386 
4387 			for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
4388 				if (mask->control[band].ht_mcs[i])
4389 					goto out;
4390 
4391 			for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
4392 				if (mask->control[band].vht_mcs[i])
4393 					goto out;
4394 
4395 			/* legacy and mcs rates may not be both empty */
4396 			return -EINVAL;
4397 		}
4398 	}
4399 
4400 out:
4401 	return 0;
4402 }
4403 
4404 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
4405 				   enum nl80211_band band,
4406 				   struct cfg80211_bitrate_mask *beacon_rate)
4407 {
4408 	u32 count_ht, count_vht, i;
4409 	u32 rate = beacon_rate->control[band].legacy;
4410 
4411 	/* Allow only one rate */
4412 	if (hweight32(rate) > 1)
4413 		return -EINVAL;
4414 
4415 	count_ht = 0;
4416 	for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
4417 		if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
4418 			return -EINVAL;
4419 		} else if (beacon_rate->control[band].ht_mcs[i]) {
4420 			count_ht++;
4421 			if (count_ht > 1)
4422 				return -EINVAL;
4423 		}
4424 		if (count_ht && rate)
4425 			return -EINVAL;
4426 	}
4427 
4428 	count_vht = 0;
4429 	for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
4430 		if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
4431 			return -EINVAL;
4432 		} else if (beacon_rate->control[band].vht_mcs[i]) {
4433 			count_vht++;
4434 			if (count_vht > 1)
4435 				return -EINVAL;
4436 		}
4437 		if (count_vht && rate)
4438 			return -EINVAL;
4439 	}
4440 
4441 	if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
4442 		return -EINVAL;
4443 
4444 	if (rate &&
4445 	    !wiphy_ext_feature_isset(&rdev->wiphy,
4446 				     NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
4447 		return -EINVAL;
4448 	if (count_ht &&
4449 	    !wiphy_ext_feature_isset(&rdev->wiphy,
4450 				     NL80211_EXT_FEATURE_BEACON_RATE_HT))
4451 		return -EINVAL;
4452 	if (count_vht &&
4453 	    !wiphy_ext_feature_isset(&rdev->wiphy,
4454 				     NL80211_EXT_FEATURE_BEACON_RATE_VHT))
4455 		return -EINVAL;
4456 
4457 	return 0;
4458 }
4459 
4460 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev,
4461 				struct nlattr *attrs[],
4462 				struct cfg80211_beacon_data *bcn)
4463 {
4464 	bool haveinfo = false;
4465 	int err;
4466 
4467 	memset(bcn, 0, sizeof(*bcn));
4468 
4469 	if (attrs[NL80211_ATTR_BEACON_HEAD]) {
4470 		bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
4471 		bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
4472 		if (!bcn->head_len)
4473 			return -EINVAL;
4474 		haveinfo = true;
4475 	}
4476 
4477 	if (attrs[NL80211_ATTR_BEACON_TAIL]) {
4478 		bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
4479 		bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
4480 		haveinfo = true;
4481 	}
4482 
4483 	if (!haveinfo)
4484 		return -EINVAL;
4485 
4486 	if (attrs[NL80211_ATTR_IE]) {
4487 		bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
4488 		bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
4489 	}
4490 
4491 	if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
4492 		bcn->proberesp_ies =
4493 			nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
4494 		bcn->proberesp_ies_len =
4495 			nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
4496 	}
4497 
4498 	if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
4499 		bcn->assocresp_ies =
4500 			nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
4501 		bcn->assocresp_ies_len =
4502 			nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
4503 	}
4504 
4505 	if (attrs[NL80211_ATTR_PROBE_RESP]) {
4506 		bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
4507 		bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
4508 	}
4509 
4510 	if (attrs[NL80211_ATTR_FTM_RESPONDER]) {
4511 		struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1];
4512 
4513 		err = nla_parse_nested_deprecated(tb,
4514 						  NL80211_FTM_RESP_ATTR_MAX,
4515 						  attrs[NL80211_ATTR_FTM_RESPONDER],
4516 						  NULL, NULL);
4517 		if (err)
4518 			return err;
4519 
4520 		if (tb[NL80211_FTM_RESP_ATTR_ENABLED] &&
4521 		    wiphy_ext_feature_isset(&rdev->wiphy,
4522 					    NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER))
4523 			bcn->ftm_responder = 1;
4524 		else
4525 			return -EOPNOTSUPP;
4526 
4527 		if (tb[NL80211_FTM_RESP_ATTR_LCI]) {
4528 			bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]);
4529 			bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]);
4530 		}
4531 
4532 		if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) {
4533 			bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
4534 			bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
4535 		}
4536 	} else {
4537 		bcn->ftm_responder = -1;
4538 	}
4539 
4540 	return 0;
4541 }
4542 
4543 static int nl80211_parse_he_obss_pd(struct nlattr *attrs,
4544 				    struct ieee80211_he_obss_pd *he_obss_pd)
4545 {
4546 	struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1];
4547 	int err;
4548 
4549 	err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs,
4550 			       he_obss_pd_policy, NULL);
4551 	if (err)
4552 		return err;
4553 
4554 	if (!tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] ||
4555 	    !tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET])
4556 		return -EINVAL;
4557 
4558 	he_obss_pd->min_offset =
4559 		nla_get_u32(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]);
4560 	he_obss_pd->max_offset =
4561 		nla_get_u32(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]);
4562 
4563 	if (he_obss_pd->min_offset >= he_obss_pd->max_offset)
4564 		return -EINVAL;
4565 
4566 	he_obss_pd->enable = true;
4567 
4568 	return 0;
4569 }
4570 
4571 static int nl80211_parse_he_bss_color(struct nlattr *attrs,
4572 				      struct cfg80211_he_bss_color *he_bss_color)
4573 {
4574 	struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1];
4575 	int err;
4576 
4577 	err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs,
4578 			       he_bss_color_policy, NULL);
4579 	if (err)
4580 		return err;
4581 
4582 	if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR])
4583 		return -EINVAL;
4584 
4585 	he_bss_color->color =
4586 		nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]);
4587 	he_bss_color->disabled =
4588 		nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]);
4589 	he_bss_color->partial =
4590 		nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]);
4591 
4592 	return 0;
4593 }
4594 
4595 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
4596 					    const u8 *rates)
4597 {
4598 	int i;
4599 
4600 	if (!rates)
4601 		return;
4602 
4603 	for (i = 0; i < rates[1]; i++) {
4604 		if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
4605 			params->ht_required = true;
4606 		if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
4607 			params->vht_required = true;
4608 	}
4609 }
4610 
4611 /*
4612  * Since the nl80211 API didn't include, from the beginning, attributes about
4613  * HT/VHT requirements/capabilities, we parse them out of the IEs for the
4614  * benefit of drivers that rebuild IEs in the firmware.
4615  */
4616 static void nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
4617 {
4618 	const struct cfg80211_beacon_data *bcn = &params->beacon;
4619 	size_t ies_len = bcn->tail_len;
4620 	const u8 *ies = bcn->tail;
4621 	const u8 *rates;
4622 	const u8 *cap;
4623 
4624 	rates = cfg80211_find_ie(WLAN_EID_SUPP_RATES, ies, ies_len);
4625 	nl80211_check_ap_rate_selectors(params, rates);
4626 
4627 	rates = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
4628 	nl80211_check_ap_rate_selectors(params, rates);
4629 
4630 	cap = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies, ies_len);
4631 	if (cap && cap[1] >= sizeof(*params->ht_cap))
4632 		params->ht_cap = (void *)(cap + 2);
4633 	cap = cfg80211_find_ie(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
4634 	if (cap && cap[1] >= sizeof(*params->vht_cap))
4635 		params->vht_cap = (void *)(cap + 2);
4636 	cap = cfg80211_find_ext_ie(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len);
4637 	if (cap && cap[1] >= sizeof(*params->he_cap) + 1)
4638 		params->he_cap = (void *)(cap + 3);
4639 }
4640 
4641 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
4642 				   struct cfg80211_ap_settings *params)
4643 {
4644 	struct wireless_dev *wdev;
4645 	bool ret = false;
4646 
4647 	list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
4648 		if (wdev->iftype != NL80211_IFTYPE_AP &&
4649 		    wdev->iftype != NL80211_IFTYPE_P2P_GO)
4650 			continue;
4651 
4652 		if (!wdev->preset_chandef.chan)
4653 			continue;
4654 
4655 		params->chandef = wdev->preset_chandef;
4656 		ret = true;
4657 		break;
4658 	}
4659 
4660 	return ret;
4661 }
4662 
4663 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
4664 				    enum nl80211_auth_type auth_type,
4665 				    enum nl80211_commands cmd)
4666 {
4667 	if (auth_type > NL80211_AUTHTYPE_MAX)
4668 		return false;
4669 
4670 	switch (cmd) {
4671 	case NL80211_CMD_AUTHENTICATE:
4672 		if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
4673 		    auth_type == NL80211_AUTHTYPE_SAE)
4674 			return false;
4675 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
4676 					     NL80211_EXT_FEATURE_FILS_STA) &&
4677 		    (auth_type == NL80211_AUTHTYPE_FILS_SK ||
4678 		     auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
4679 		     auth_type == NL80211_AUTHTYPE_FILS_PK))
4680 			return false;
4681 		return true;
4682 	case NL80211_CMD_CONNECT:
4683 		if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
4684 		    !wiphy_ext_feature_isset(&rdev->wiphy,
4685 					     NL80211_EXT_FEATURE_SAE_OFFLOAD) &&
4686 		    auth_type == NL80211_AUTHTYPE_SAE)
4687 			return false;
4688 
4689 		/* FILS with SK PFS or PK not supported yet */
4690 		if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
4691 		    auth_type == NL80211_AUTHTYPE_FILS_PK)
4692 			return false;
4693 		if (!wiphy_ext_feature_isset(
4694 			    &rdev->wiphy,
4695 			    NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
4696 		    auth_type == NL80211_AUTHTYPE_FILS_SK)
4697 			return false;
4698 		return true;
4699 	case NL80211_CMD_START_AP:
4700 		/* SAE not supported yet */
4701 		if (auth_type == NL80211_AUTHTYPE_SAE)
4702 			return false;
4703 		/* FILS not supported yet */
4704 		if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
4705 		    auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
4706 		    auth_type == NL80211_AUTHTYPE_FILS_PK)
4707 			return false;
4708 		return true;
4709 	default:
4710 		return false;
4711 	}
4712 }
4713 
4714 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
4715 {
4716 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4717 	struct net_device *dev = info->user_ptr[1];
4718 	struct wireless_dev *wdev = dev->ieee80211_ptr;
4719 	struct cfg80211_ap_settings params;
4720 	int err;
4721 
4722 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4723 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4724 		return -EOPNOTSUPP;
4725 
4726 	if (!rdev->ops->start_ap)
4727 		return -EOPNOTSUPP;
4728 
4729 	if (wdev->beacon_interval)
4730 		return -EALREADY;
4731 
4732 	memset(&params, 0, sizeof(params));
4733 
4734 	/* these are required for START_AP */
4735 	if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
4736 	    !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
4737 	    !info->attrs[NL80211_ATTR_BEACON_HEAD])
4738 		return -EINVAL;
4739 
4740 	err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon);
4741 	if (err)
4742 		return err;
4743 
4744 	params.beacon_interval =
4745 		nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
4746 	params.dtim_period =
4747 		nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
4748 
4749 	err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
4750 					   params.beacon_interval);
4751 	if (err)
4752 		return err;
4753 
4754 	/*
4755 	 * In theory, some of these attributes should be required here
4756 	 * but since they were not used when the command was originally
4757 	 * added, keep them optional for old user space programs to let
4758 	 * them continue to work with drivers that do not need the
4759 	 * additional information -- drivers must check!
4760 	 */
4761 	if (info->attrs[NL80211_ATTR_SSID]) {
4762 		params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
4763 		params.ssid_len =
4764 			nla_len(info->attrs[NL80211_ATTR_SSID]);
4765 		if (params.ssid_len == 0 ||
4766 		    params.ssid_len > IEEE80211_MAX_SSID_LEN)
4767 			return -EINVAL;
4768 	}
4769 
4770 	if (info->attrs[NL80211_ATTR_HIDDEN_SSID])
4771 		params.hidden_ssid = nla_get_u32(
4772 			info->attrs[NL80211_ATTR_HIDDEN_SSID]);
4773 
4774 	params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
4775 
4776 	if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
4777 		params.auth_type = nla_get_u32(
4778 			info->attrs[NL80211_ATTR_AUTH_TYPE]);
4779 		if (!nl80211_valid_auth_type(rdev, params.auth_type,
4780 					     NL80211_CMD_START_AP))
4781 			return -EINVAL;
4782 	} else
4783 		params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
4784 
4785 	err = nl80211_crypto_settings(rdev, info, &params.crypto,
4786 				      NL80211_MAX_NR_CIPHER_SUITES);
4787 	if (err)
4788 		return err;
4789 
4790 	if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
4791 		if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
4792 			return -EOPNOTSUPP;
4793 		params.inactivity_timeout = nla_get_u16(
4794 			info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
4795 	}
4796 
4797 	if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
4798 		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4799 			return -EINVAL;
4800 		params.p2p_ctwindow =
4801 			nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
4802 		if (params.p2p_ctwindow != 0 &&
4803 		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
4804 			return -EINVAL;
4805 	}
4806 
4807 	if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
4808 		u8 tmp;
4809 
4810 		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4811 			return -EINVAL;
4812 		tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
4813 		params.p2p_opp_ps = tmp;
4814 		if (params.p2p_opp_ps != 0 &&
4815 		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
4816 			return -EINVAL;
4817 	}
4818 
4819 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
4820 		err = nl80211_parse_chandef(rdev, info, &params.chandef);
4821 		if (err)
4822 			return err;
4823 	} else if (wdev->preset_chandef.chan) {
4824 		params.chandef = wdev->preset_chandef;
4825 	} else if (!nl80211_get_ap_channel(rdev, &params))
4826 		return -EINVAL;
4827 
4828 	if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
4829 					   wdev->iftype))
4830 		return -EINVAL;
4831 
4832 	if (info->attrs[NL80211_ATTR_TX_RATES]) {
4833 		err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
4834 		if (err)
4835 			return err;
4836 
4837 		err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
4838 					      &params.beacon_rate);
4839 		if (err)
4840 			return err;
4841 	}
4842 
4843 	if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
4844 		params.smps_mode =
4845 			nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
4846 		switch (params.smps_mode) {
4847 		case NL80211_SMPS_OFF:
4848 			break;
4849 		case NL80211_SMPS_STATIC:
4850 			if (!(rdev->wiphy.features &
4851 			      NL80211_FEATURE_STATIC_SMPS))
4852 				return -EINVAL;
4853 			break;
4854 		case NL80211_SMPS_DYNAMIC:
4855 			if (!(rdev->wiphy.features &
4856 			      NL80211_FEATURE_DYNAMIC_SMPS))
4857 				return -EINVAL;
4858 			break;
4859 		default:
4860 			return -EINVAL;
4861 		}
4862 	} else {
4863 		params.smps_mode = NL80211_SMPS_OFF;
4864 	}
4865 
4866 	params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
4867 	if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
4868 		return -EOPNOTSUPP;
4869 
4870 	if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
4871 		params.acl = parse_acl_data(&rdev->wiphy, info);
4872 		if (IS_ERR(params.acl))
4873 			return PTR_ERR(params.acl);
4874 	}
4875 
4876 	params.twt_responder =
4877 		    nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]);
4878 
4879 	if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) {
4880 		err = nl80211_parse_he_obss_pd(
4881 					info->attrs[NL80211_ATTR_HE_OBSS_PD],
4882 					&params.he_obss_pd);
4883 		if (err)
4884 			return err;
4885 	}
4886 
4887 	if (info->attrs[NL80211_ATTR_HE_BSS_COLOR]) {
4888 		err = nl80211_parse_he_bss_color(
4889 					info->attrs[NL80211_ATTR_HE_BSS_COLOR],
4890 					&params.he_bss_color);
4891 		if (err)
4892 			return err;
4893 	}
4894 
4895 	nl80211_calculate_ap_params(&params);
4896 
4897 	if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])
4898 		params.flags |= AP_SETTINGS_EXTERNAL_AUTH_SUPPORT;
4899 
4900 	wdev_lock(wdev);
4901 	err = rdev_start_ap(rdev, dev, &params);
4902 	if (!err) {
4903 		wdev->preset_chandef = params.chandef;
4904 		wdev->beacon_interval = params.beacon_interval;
4905 		wdev->chandef = params.chandef;
4906 		wdev->ssid_len = params.ssid_len;
4907 		memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
4908 
4909 		if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
4910 			wdev->conn_owner_nlportid = info->snd_portid;
4911 	}
4912 	wdev_unlock(wdev);
4913 
4914 	kfree(params.acl);
4915 
4916 	return err;
4917 }
4918 
4919 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
4920 {
4921 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4922 	struct net_device *dev = info->user_ptr[1];
4923 	struct wireless_dev *wdev = dev->ieee80211_ptr;
4924 	struct cfg80211_beacon_data params;
4925 	int err;
4926 
4927 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4928 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4929 		return -EOPNOTSUPP;
4930 
4931 	if (!rdev->ops->change_beacon)
4932 		return -EOPNOTSUPP;
4933 
4934 	if (!wdev->beacon_interval)
4935 		return -EINVAL;
4936 
4937 	err = nl80211_parse_beacon(rdev, info->attrs, &params);
4938 	if (err)
4939 		return err;
4940 
4941 	wdev_lock(wdev);
4942 	err = rdev_change_beacon(rdev, dev, &params);
4943 	wdev_unlock(wdev);
4944 
4945 	return err;
4946 }
4947 
4948 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
4949 {
4950 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4951 	struct net_device *dev = info->user_ptr[1];
4952 
4953 	return cfg80211_stop_ap(rdev, dev, false);
4954 }
4955 
4956 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
4957 	[NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
4958 	[NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
4959 	[NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
4960 	[NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
4961 	[NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
4962 	[NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
4963 };
4964 
4965 static int parse_station_flags(struct genl_info *info,
4966 			       enum nl80211_iftype iftype,
4967 			       struct station_parameters *params)
4968 {
4969 	struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
4970 	struct nlattr *nla;
4971 	int flag;
4972 
4973 	/*
4974 	 * Try parsing the new attribute first so userspace
4975 	 * can specify both for older kernels.
4976 	 */
4977 	nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
4978 	if (nla) {
4979 		struct nl80211_sta_flag_update *sta_flags;
4980 
4981 		sta_flags = nla_data(nla);
4982 		params->sta_flags_mask = sta_flags->mask;
4983 		params->sta_flags_set = sta_flags->set;
4984 		params->sta_flags_set &= params->sta_flags_mask;
4985 		if ((params->sta_flags_mask |
4986 		     params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
4987 			return -EINVAL;
4988 		return 0;
4989 	}
4990 
4991 	/* if present, parse the old attribute */
4992 
4993 	nla = info->attrs[NL80211_ATTR_STA_FLAGS];
4994 	if (!nla)
4995 		return 0;
4996 
4997 	if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack))
4998 		return -EINVAL;
4999 
5000 	/*
5001 	 * Only allow certain flags for interface types so that
5002 	 * other attributes are silently ignored. Remember that
5003 	 * this is backward compatibility code with old userspace
5004 	 * and shouldn't be hit in other cases anyway.
5005 	 */
5006 	switch (iftype) {
5007 	case NL80211_IFTYPE_AP:
5008 	case NL80211_IFTYPE_AP_VLAN:
5009 	case NL80211_IFTYPE_P2P_GO:
5010 		params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
5011 					 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
5012 					 BIT(NL80211_STA_FLAG_WME) |
5013 					 BIT(NL80211_STA_FLAG_MFP);
5014 		break;
5015 	case NL80211_IFTYPE_P2P_CLIENT:
5016 	case NL80211_IFTYPE_STATION:
5017 		params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
5018 					 BIT(NL80211_STA_FLAG_TDLS_PEER);
5019 		break;
5020 	case NL80211_IFTYPE_MESH_POINT:
5021 		params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5022 					 BIT(NL80211_STA_FLAG_MFP) |
5023 					 BIT(NL80211_STA_FLAG_AUTHORIZED);
5024 		break;
5025 	default:
5026 		return -EINVAL;
5027 	}
5028 
5029 	for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
5030 		if (flags[flag]) {
5031 			params->sta_flags_set |= (1<<flag);
5032 
5033 			/* no longer support new API additions in old API */
5034 			if (flag > NL80211_STA_FLAG_MAX_OLD_API)
5035 				return -EINVAL;
5036 		}
5037 	}
5038 
5039 	return 0;
5040 }
5041 
5042 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr)
5043 {
5044 	struct nlattr *rate;
5045 	u32 bitrate;
5046 	u16 bitrate_compat;
5047 	enum nl80211_rate_info rate_flg;
5048 
5049 	rate = nla_nest_start_noflag(msg, attr);
5050 	if (!rate)
5051 		return false;
5052 
5053 	/* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
5054 	bitrate = cfg80211_calculate_bitrate(info);
5055 	/* report 16-bit bitrate only if we can */
5056 	bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
5057 	if (bitrate > 0 &&
5058 	    nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
5059 		return false;
5060 	if (bitrate_compat > 0 &&
5061 	    nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
5062 		return false;
5063 
5064 	switch (info->bw) {
5065 	case RATE_INFO_BW_5:
5066 		rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
5067 		break;
5068 	case RATE_INFO_BW_10:
5069 		rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
5070 		break;
5071 	default:
5072 		WARN_ON(1);
5073 		/* fall through */
5074 	case RATE_INFO_BW_20:
5075 		rate_flg = 0;
5076 		break;
5077 	case RATE_INFO_BW_40:
5078 		rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
5079 		break;
5080 	case RATE_INFO_BW_80:
5081 		rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
5082 		break;
5083 	case RATE_INFO_BW_160:
5084 		rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
5085 		break;
5086 	case RATE_INFO_BW_HE_RU:
5087 		rate_flg = 0;
5088 		WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS));
5089 	}
5090 
5091 	if (rate_flg && nla_put_flag(msg, rate_flg))
5092 		return false;
5093 
5094 	if (info->flags & RATE_INFO_FLAGS_MCS) {
5095 		if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
5096 			return false;
5097 		if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
5098 		    nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
5099 			return false;
5100 	} else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
5101 		if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
5102 			return false;
5103 		if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
5104 			return false;
5105 		if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
5106 		    nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
5107 			return false;
5108 	} else if (info->flags & RATE_INFO_FLAGS_HE_MCS) {
5109 		if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs))
5110 			return false;
5111 		if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss))
5112 			return false;
5113 		if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi))
5114 			return false;
5115 		if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm))
5116 			return false;
5117 		if (info->bw == RATE_INFO_BW_HE_RU &&
5118 		    nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC,
5119 			       info->he_ru_alloc))
5120 			return false;
5121 	}
5122 
5123 	nla_nest_end(msg, rate);
5124 	return true;
5125 }
5126 
5127 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
5128 			       int id)
5129 {
5130 	void *attr;
5131 	int i = 0;
5132 
5133 	if (!mask)
5134 		return true;
5135 
5136 	attr = nla_nest_start_noflag(msg, id);
5137 	if (!attr)
5138 		return false;
5139 
5140 	for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
5141 		if (!(mask & BIT(i)))
5142 			continue;
5143 
5144 		if (nla_put_u8(msg, i, signal[i]))
5145 			return false;
5146 	}
5147 
5148 	nla_nest_end(msg, attr);
5149 
5150 	return true;
5151 }
5152 
5153 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
5154 				u32 seq, int flags,
5155 				struct cfg80211_registered_device *rdev,
5156 				struct net_device *dev,
5157 				const u8 *mac_addr, struct station_info *sinfo)
5158 {
5159 	void *hdr;
5160 	struct nlattr *sinfoattr, *bss_param;
5161 
5162 	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
5163 	if (!hdr) {
5164 		cfg80211_sinfo_release_content(sinfo);
5165 		return -1;
5166 	}
5167 
5168 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5169 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
5170 	    nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
5171 		goto nla_put_failure;
5172 
5173 	sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO);
5174 	if (!sinfoattr)
5175 		goto nla_put_failure;
5176 
5177 #define PUT_SINFO(attr, memb, type) do {				\
5178 	BUILD_BUG_ON(sizeof(type) == sizeof(u64));			\
5179 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) &&	\
5180 	    nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr,		\
5181 			     sinfo->memb))				\
5182 		goto nla_put_failure;					\
5183 	} while (0)
5184 #define PUT_SINFO_U64(attr, memb) do {					\
5185 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) &&	\
5186 	    nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr,		\
5187 			      sinfo->memb, NL80211_STA_INFO_PAD))	\
5188 		goto nla_put_failure;					\
5189 	} while (0)
5190 
5191 	PUT_SINFO(CONNECTED_TIME, connected_time, u32);
5192 	PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
5193 	PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at);
5194 
5195 	if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) |
5196 			     BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) &&
5197 	    nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
5198 			(u32)sinfo->rx_bytes))
5199 		goto nla_put_failure;
5200 
5201 	if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) |
5202 			     BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) &&
5203 	    nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
5204 			(u32)sinfo->tx_bytes))
5205 		goto nla_put_failure;
5206 
5207 	PUT_SINFO_U64(RX_BYTES64, rx_bytes);
5208 	PUT_SINFO_U64(TX_BYTES64, tx_bytes);
5209 	PUT_SINFO(LLID, llid, u16);
5210 	PUT_SINFO(PLID, plid, u16);
5211 	PUT_SINFO(PLINK_STATE, plink_state, u8);
5212 	PUT_SINFO_U64(RX_DURATION, rx_duration);
5213 	PUT_SINFO_U64(TX_DURATION, tx_duration);
5214 
5215 	if (wiphy_ext_feature_isset(&rdev->wiphy,
5216 				    NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
5217 		PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16);
5218 
5219 	switch (rdev->wiphy.signal_type) {
5220 	case CFG80211_SIGNAL_TYPE_MBM:
5221 		PUT_SINFO(SIGNAL, signal, u8);
5222 		PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
5223 		break;
5224 	default:
5225 		break;
5226 	}
5227 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) {
5228 		if (!nl80211_put_signal(msg, sinfo->chains,
5229 					sinfo->chain_signal,
5230 					NL80211_STA_INFO_CHAIN_SIGNAL))
5231 			goto nla_put_failure;
5232 	}
5233 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
5234 		if (!nl80211_put_signal(msg, sinfo->chains,
5235 					sinfo->chain_signal_avg,
5236 					NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
5237 			goto nla_put_failure;
5238 	}
5239 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) {
5240 		if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
5241 					  NL80211_STA_INFO_TX_BITRATE))
5242 			goto nla_put_failure;
5243 	}
5244 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) {
5245 		if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
5246 					  NL80211_STA_INFO_RX_BITRATE))
5247 			goto nla_put_failure;
5248 	}
5249 
5250 	PUT_SINFO(RX_PACKETS, rx_packets, u32);
5251 	PUT_SINFO(TX_PACKETS, tx_packets, u32);
5252 	PUT_SINFO(TX_RETRIES, tx_retries, u32);
5253 	PUT_SINFO(TX_FAILED, tx_failed, u32);
5254 	PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
5255 	PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32);
5256 	PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
5257 	PUT_SINFO(LOCAL_PM, local_pm, u32);
5258 	PUT_SINFO(PEER_PM, peer_pm, u32);
5259 	PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
5260 	PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8);
5261 
5262 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) {
5263 		bss_param = nla_nest_start_noflag(msg,
5264 						  NL80211_STA_INFO_BSS_PARAM);
5265 		if (!bss_param)
5266 			goto nla_put_failure;
5267 
5268 		if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
5269 		     nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
5270 		    ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
5271 		     nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
5272 		    ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
5273 		     nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
5274 		    nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
5275 			       sinfo->bss_param.dtim_period) ||
5276 		    nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
5277 				sinfo->bss_param.beacon_interval))
5278 			goto nla_put_failure;
5279 
5280 		nla_nest_end(msg, bss_param);
5281 	}
5282 	if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) &&
5283 	    nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
5284 		    sizeof(struct nl80211_sta_flag_update),
5285 		    &sinfo->sta_flags))
5286 		goto nla_put_failure;
5287 
5288 	PUT_SINFO_U64(T_OFFSET, t_offset);
5289 	PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
5290 	PUT_SINFO_U64(BEACON_RX, rx_beacon);
5291 	PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
5292 	PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32);
5293 	PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32);
5294 	if (wiphy_ext_feature_isset(&rdev->wiphy,
5295 				    NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) {
5296 		PUT_SINFO(ACK_SIGNAL, ack_signal, u8);
5297 		PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8);
5298 	}
5299 
5300 #undef PUT_SINFO
5301 #undef PUT_SINFO_U64
5302 
5303 	if (sinfo->pertid) {
5304 		struct nlattr *tidsattr;
5305 		int tid;
5306 
5307 		tidsattr = nla_nest_start_noflag(msg,
5308 						 NL80211_STA_INFO_TID_STATS);
5309 		if (!tidsattr)
5310 			goto nla_put_failure;
5311 
5312 		for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
5313 			struct cfg80211_tid_stats *tidstats;
5314 			struct nlattr *tidattr;
5315 
5316 			tidstats = &sinfo->pertid[tid];
5317 
5318 			if (!tidstats->filled)
5319 				continue;
5320 
5321 			tidattr = nla_nest_start_noflag(msg, tid + 1);
5322 			if (!tidattr)
5323 				goto nla_put_failure;
5324 
5325 #define PUT_TIDVAL_U64(attr, memb) do {					\
5326 	if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) &&	\
5327 	    nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr,		\
5328 			      tidstats->memb, NL80211_TID_STATS_PAD))	\
5329 		goto nla_put_failure;					\
5330 	} while (0)
5331 
5332 			PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
5333 			PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
5334 			PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
5335 			PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
5336 
5337 #undef PUT_TIDVAL_U64
5338 			if ((tidstats->filled &
5339 			     BIT(NL80211_TID_STATS_TXQ_STATS)) &&
5340 			    !nl80211_put_txq_stats(msg, &tidstats->txq_stats,
5341 						   NL80211_TID_STATS_TXQ_STATS))
5342 				goto nla_put_failure;
5343 
5344 			nla_nest_end(msg, tidattr);
5345 		}
5346 
5347 		nla_nest_end(msg, tidsattr);
5348 	}
5349 
5350 	nla_nest_end(msg, sinfoattr);
5351 
5352 	if (sinfo->assoc_req_ies_len &&
5353 	    nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
5354 		    sinfo->assoc_req_ies))
5355 		goto nla_put_failure;
5356 
5357 	cfg80211_sinfo_release_content(sinfo);
5358 	genlmsg_end(msg, hdr);
5359 	return 0;
5360 
5361  nla_put_failure:
5362 	cfg80211_sinfo_release_content(sinfo);
5363 	genlmsg_cancel(msg, hdr);
5364 	return -EMSGSIZE;
5365 }
5366 
5367 static int nl80211_dump_station(struct sk_buff *skb,
5368 				struct netlink_callback *cb)
5369 {
5370 	struct station_info sinfo;
5371 	struct cfg80211_registered_device *rdev;
5372 	struct wireless_dev *wdev;
5373 	u8 mac_addr[ETH_ALEN];
5374 	int sta_idx = cb->args[2];
5375 	int err;
5376 
5377 	rtnl_lock();
5378 	err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
5379 	if (err)
5380 		goto out_err;
5381 
5382 	if (!wdev->netdev) {
5383 		err = -EINVAL;
5384 		goto out_err;
5385 	}
5386 
5387 	if (!rdev->ops->dump_station) {
5388 		err = -EOPNOTSUPP;
5389 		goto out_err;
5390 	}
5391 
5392 	while (1) {
5393 		memset(&sinfo, 0, sizeof(sinfo));
5394 		err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
5395 					mac_addr, &sinfo);
5396 		if (err == -ENOENT)
5397 			break;
5398 		if (err)
5399 			goto out_err;
5400 
5401 		if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
5402 				NETLINK_CB(cb->skb).portid,
5403 				cb->nlh->nlmsg_seq, NLM_F_MULTI,
5404 				rdev, wdev->netdev, mac_addr,
5405 				&sinfo) < 0)
5406 			goto out;
5407 
5408 		sta_idx++;
5409 	}
5410 
5411  out:
5412 	cb->args[2] = sta_idx;
5413 	err = skb->len;
5414  out_err:
5415 	rtnl_unlock();
5416 
5417 	return err;
5418 }
5419 
5420 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
5421 {
5422 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
5423 	struct net_device *dev = info->user_ptr[1];
5424 	struct station_info sinfo;
5425 	struct sk_buff *msg;
5426 	u8 *mac_addr = NULL;
5427 	int err;
5428 
5429 	memset(&sinfo, 0, sizeof(sinfo));
5430 
5431 	if (!info->attrs[NL80211_ATTR_MAC])
5432 		return -EINVAL;
5433 
5434 	mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5435 
5436 	if (!rdev->ops->get_station)
5437 		return -EOPNOTSUPP;
5438 
5439 	err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
5440 	if (err)
5441 		return err;
5442 
5443 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5444 	if (!msg) {
5445 		cfg80211_sinfo_release_content(&sinfo);
5446 		return -ENOMEM;
5447 	}
5448 
5449 	if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
5450 				 info->snd_portid, info->snd_seq, 0,
5451 				 rdev, dev, mac_addr, &sinfo) < 0) {
5452 		nlmsg_free(msg);
5453 		return -ENOBUFS;
5454 	}
5455 
5456 	return genlmsg_reply(msg, info);
5457 }
5458 
5459 int cfg80211_check_station_change(struct wiphy *wiphy,
5460 				  struct station_parameters *params,
5461 				  enum cfg80211_station_type statype)
5462 {
5463 	if (params->listen_interval != -1 &&
5464 	    statype != CFG80211_STA_AP_CLIENT_UNASSOC)
5465 		return -EINVAL;
5466 
5467 	if (params->support_p2p_ps != -1 &&
5468 	    statype != CFG80211_STA_AP_CLIENT_UNASSOC)
5469 		return -EINVAL;
5470 
5471 	if (params->aid &&
5472 	    !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
5473 	    statype != CFG80211_STA_AP_CLIENT_UNASSOC)
5474 		return -EINVAL;
5475 
5476 	/* When you run into this, adjust the code below for the new flag */
5477 	BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
5478 
5479 	switch (statype) {
5480 	case CFG80211_STA_MESH_PEER_KERNEL:
5481 	case CFG80211_STA_MESH_PEER_USER:
5482 		/*
5483 		 * No ignoring the TDLS flag here -- the userspace mesh
5484 		 * code doesn't have the bug of including TDLS in the
5485 		 * mask everywhere.
5486 		 */
5487 		if (params->sta_flags_mask &
5488 				~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5489 				  BIT(NL80211_STA_FLAG_MFP) |
5490 				  BIT(NL80211_STA_FLAG_AUTHORIZED)))
5491 			return -EINVAL;
5492 		break;
5493 	case CFG80211_STA_TDLS_PEER_SETUP:
5494 	case CFG80211_STA_TDLS_PEER_ACTIVE:
5495 		if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
5496 			return -EINVAL;
5497 		/* ignore since it can't change */
5498 		params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5499 		break;
5500 	default:
5501 		/* disallow mesh-specific things */
5502 		if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
5503 			return -EINVAL;
5504 		if (params->local_pm)
5505 			return -EINVAL;
5506 		if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
5507 			return -EINVAL;
5508 	}
5509 
5510 	if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
5511 	    statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
5512 		/* TDLS can't be set, ... */
5513 		if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
5514 			return -EINVAL;
5515 		/*
5516 		 * ... but don't bother the driver with it. This works around
5517 		 * a hostapd/wpa_supplicant issue -- it always includes the
5518 		 * TLDS_PEER flag in the mask even for AP mode.
5519 		 */
5520 		params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5521 	}
5522 
5523 	if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
5524 	    statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
5525 		/* reject other things that can't change */
5526 		if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
5527 			return -EINVAL;
5528 		if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
5529 			return -EINVAL;
5530 		if (params->supported_rates)
5531 			return -EINVAL;
5532 		if (params->ext_capab || params->ht_capa || params->vht_capa ||
5533 		    params->he_capa)
5534 			return -EINVAL;
5535 	}
5536 
5537 	if (statype != CFG80211_STA_AP_CLIENT &&
5538 	    statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
5539 		if (params->vlan)
5540 			return -EINVAL;
5541 	}
5542 
5543 	switch (statype) {
5544 	case CFG80211_STA_AP_MLME_CLIENT:
5545 		/* Use this only for authorizing/unauthorizing a station */
5546 		if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
5547 			return -EOPNOTSUPP;
5548 		break;
5549 	case CFG80211_STA_AP_CLIENT:
5550 	case CFG80211_STA_AP_CLIENT_UNASSOC:
5551 		/* accept only the listed bits */
5552 		if (params->sta_flags_mask &
5553 				~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
5554 				  BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5555 				  BIT(NL80211_STA_FLAG_ASSOCIATED) |
5556 				  BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
5557 				  BIT(NL80211_STA_FLAG_WME) |
5558 				  BIT(NL80211_STA_FLAG_MFP)))
5559 			return -EINVAL;
5560 
5561 		/* but authenticated/associated only if driver handles it */
5562 		if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
5563 		    params->sta_flags_mask &
5564 				(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5565 				 BIT(NL80211_STA_FLAG_ASSOCIATED)))
5566 			return -EINVAL;
5567 		break;
5568 	case CFG80211_STA_IBSS:
5569 	case CFG80211_STA_AP_STA:
5570 		/* reject any changes other than AUTHORIZED */
5571 		if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
5572 			return -EINVAL;
5573 		break;
5574 	case CFG80211_STA_TDLS_PEER_SETUP:
5575 		/* reject any changes other than AUTHORIZED or WME */
5576 		if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
5577 					       BIT(NL80211_STA_FLAG_WME)))
5578 			return -EINVAL;
5579 		/* force (at least) rates when authorizing */
5580 		if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
5581 		    !params->supported_rates)
5582 			return -EINVAL;
5583 		break;
5584 	case CFG80211_STA_TDLS_PEER_ACTIVE:
5585 		/* reject any changes */
5586 		return -EINVAL;
5587 	case CFG80211_STA_MESH_PEER_KERNEL:
5588 		if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
5589 			return -EINVAL;
5590 		break;
5591 	case CFG80211_STA_MESH_PEER_USER:
5592 		if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
5593 		    params->plink_action != NL80211_PLINK_ACTION_BLOCK)
5594 			return -EINVAL;
5595 		break;
5596 	}
5597 
5598 	/*
5599 	 * Older kernel versions ignored this attribute entirely, so don't
5600 	 * reject attempts to update it but mark it as unused instead so the
5601 	 * driver won't look at the data.
5602 	 */
5603 	if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
5604 	    statype != CFG80211_STA_TDLS_PEER_SETUP)
5605 		params->opmode_notif_used = false;
5606 
5607 	return 0;
5608 }
5609 EXPORT_SYMBOL(cfg80211_check_station_change);
5610 
5611 /*
5612  * Get vlan interface making sure it is running and on the right wiphy.
5613  */
5614 static struct net_device *get_vlan(struct genl_info *info,
5615 				   struct cfg80211_registered_device *rdev)
5616 {
5617 	struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
5618 	struct net_device *v;
5619 	int ret;
5620 
5621 	if (!vlanattr)
5622 		return NULL;
5623 
5624 	v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
5625 	if (!v)
5626 		return ERR_PTR(-ENODEV);
5627 
5628 	if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
5629 		ret = -EINVAL;
5630 		goto error;
5631 	}
5632 
5633 	if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
5634 	    v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5635 	    v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
5636 		ret = -EINVAL;
5637 		goto error;
5638 	}
5639 
5640 	if (!netif_running(v)) {
5641 		ret = -ENETDOWN;
5642 		goto error;
5643 	}
5644 
5645 	return v;
5646  error:
5647 	dev_put(v);
5648 	return ERR_PTR(ret);
5649 }
5650 
5651 static const struct nla_policy
5652 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
5653 	[NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
5654 	[NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
5655 };
5656 
5657 static int nl80211_parse_sta_wme(struct genl_info *info,
5658 				 struct station_parameters *params)
5659 {
5660 	struct nlattr *tb[NL80211_STA_WME_MAX + 1];
5661 	struct nlattr *nla;
5662 	int err;
5663 
5664 	/* parse WME attributes if present */
5665 	if (!info->attrs[NL80211_ATTR_STA_WME])
5666 		return 0;
5667 
5668 	nla = info->attrs[NL80211_ATTR_STA_WME];
5669 	err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla,
5670 					  nl80211_sta_wme_policy,
5671 					  info->extack);
5672 	if (err)
5673 		return err;
5674 
5675 	if (tb[NL80211_STA_WME_UAPSD_QUEUES])
5676 		params->uapsd_queues = nla_get_u8(
5677 			tb[NL80211_STA_WME_UAPSD_QUEUES]);
5678 	if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
5679 		return -EINVAL;
5680 
5681 	if (tb[NL80211_STA_WME_MAX_SP])
5682 		params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
5683 
5684 	if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
5685 		return -EINVAL;
5686 
5687 	params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
5688 
5689 	return 0;
5690 }
5691 
5692 static int nl80211_parse_sta_channel_info(struct genl_info *info,
5693 				      struct station_parameters *params)
5694 {
5695 	if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
5696 		params->supported_channels =
5697 		     nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
5698 		params->supported_channels_len =
5699 		     nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
5700 		/*
5701 		 * Need to include at least one (first channel, number of
5702 		 * channels) tuple for each subband, and must have proper
5703 		 * tuples for the rest of the data as well.
5704 		 */
5705 		if (params->supported_channels_len < 2)
5706 			return -EINVAL;
5707 		if (params->supported_channels_len % 2)
5708 			return -EINVAL;
5709 	}
5710 
5711 	if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
5712 		params->supported_oper_classes =
5713 		 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
5714 		params->supported_oper_classes_len =
5715 		  nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
5716 		/*
5717 		 * The value of the Length field of the Supported Operating
5718 		 * Classes element is between 2 and 253.
5719 		 */
5720 		if (params->supported_oper_classes_len < 2 ||
5721 		    params->supported_oper_classes_len > 253)
5722 			return -EINVAL;
5723 	}
5724 	return 0;
5725 }
5726 
5727 static int nl80211_set_station_tdls(struct genl_info *info,
5728 				    struct station_parameters *params)
5729 {
5730 	int err;
5731 	/* Dummy STA entry gets updated once the peer capabilities are known */
5732 	if (info->attrs[NL80211_ATTR_PEER_AID])
5733 		params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
5734 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
5735 		params->ht_capa =
5736 			nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5737 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
5738 		params->vht_capa =
5739 			nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
5740 	if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
5741 		params->he_capa =
5742 			nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
5743 		params->he_capa_len =
5744 			nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
5745 
5746 		if (params->he_capa_len < NL80211_HE_MIN_CAPABILITY_LEN)
5747 			return -EINVAL;
5748 	}
5749 
5750 	err = nl80211_parse_sta_channel_info(info, params);
5751 	if (err)
5752 		return err;
5753 
5754 	return nl80211_parse_sta_wme(info, params);
5755 }
5756 
5757 static int nl80211_parse_sta_txpower_setting(struct genl_info *info,
5758 					     struct station_parameters *params)
5759 {
5760 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
5761 	int idx;
5762 
5763 	if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) {
5764 		if (!rdev->ops->set_tx_power ||
5765 		    !wiphy_ext_feature_isset(&rdev->wiphy,
5766 					 NL80211_EXT_FEATURE_STA_TX_PWR))
5767 			return -EOPNOTSUPP;
5768 
5769 		idx = NL80211_ATTR_STA_TX_POWER_SETTING;
5770 		params->txpwr.type = nla_get_u8(info->attrs[idx]);
5771 
5772 		if (params->txpwr.type == NL80211_TX_POWER_LIMITED) {
5773 			idx = NL80211_ATTR_STA_TX_POWER;
5774 
5775 			if (info->attrs[idx])
5776 				params->txpwr.power =
5777 					nla_get_s16(info->attrs[idx]);
5778 			else
5779 				return -EINVAL;
5780 		}
5781 		params->sta_modify_mask |= STATION_PARAM_APPLY_STA_TXPOWER;
5782 	}
5783 
5784 	return 0;
5785 }
5786 
5787 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
5788 {
5789 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
5790 	struct net_device *dev = info->user_ptr[1];
5791 	struct station_parameters params;
5792 	u8 *mac_addr;
5793 	int err;
5794 
5795 	memset(&params, 0, sizeof(params));
5796 
5797 	if (!rdev->ops->change_station)
5798 		return -EOPNOTSUPP;
5799 
5800 	/*
5801 	 * AID and listen_interval properties can be set only for unassociated
5802 	 * station. Include these parameters here and will check them in
5803 	 * cfg80211_check_station_change().
5804 	 */
5805 	if (info->attrs[NL80211_ATTR_STA_AID])
5806 		params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
5807 
5808 	if (info->attrs[NL80211_ATTR_VLAN_ID])
5809 		params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
5810 
5811 	if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
5812 		params.listen_interval =
5813 		     nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
5814 	else
5815 		params.listen_interval = -1;
5816 
5817 	if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS])
5818 		params.support_p2p_ps =
5819 			nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
5820 	else
5821 		params.support_p2p_ps = -1;
5822 
5823 	if (!info->attrs[NL80211_ATTR_MAC])
5824 		return -EINVAL;
5825 
5826 	mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5827 
5828 	if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
5829 		params.supported_rates =
5830 			nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5831 		params.supported_rates_len =
5832 			nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5833 	}
5834 
5835 	if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
5836 		params.capability =
5837 			nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5838 		params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5839 	}
5840 
5841 	if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5842 		params.ext_capab =
5843 			nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5844 		params.ext_capab_len =
5845 			nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5846 	}
5847 
5848 	if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5849 		return -EINVAL;
5850 
5851 	if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
5852 		params.plink_action =
5853 			nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
5854 
5855 	if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
5856 		params.plink_state =
5857 			nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
5858 		if (info->attrs[NL80211_ATTR_MESH_PEER_AID])
5859 			params.peer_aid = nla_get_u16(
5860 				info->attrs[NL80211_ATTR_MESH_PEER_AID]);
5861 		params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
5862 	}
5863 
5864 	if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE])
5865 		params.local_pm = nla_get_u32(
5866 			info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
5867 
5868 	if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5869 		params.opmode_notif_used = true;
5870 		params.opmode_notif =
5871 			nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5872 	}
5873 
5874 	if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
5875 		params.airtime_weight =
5876 			nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
5877 
5878 	if (params.airtime_weight &&
5879 	    !wiphy_ext_feature_isset(&rdev->wiphy,
5880 				     NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
5881 		return -EOPNOTSUPP;
5882 
5883 	err = nl80211_parse_sta_txpower_setting(info, &params);
5884 	if (err)
5885 		return err;
5886 
5887 	/* Include parameters for TDLS peer (will check later) */
5888 	err = nl80211_set_station_tdls(info, &params);
5889 	if (err)
5890 		return err;
5891 
5892 	params.vlan = get_vlan(info, rdev);
5893 	if (IS_ERR(params.vlan))
5894 		return PTR_ERR(params.vlan);
5895 
5896 	switch (dev->ieee80211_ptr->iftype) {
5897 	case NL80211_IFTYPE_AP:
5898 	case NL80211_IFTYPE_AP_VLAN:
5899 	case NL80211_IFTYPE_P2P_GO:
5900 	case NL80211_IFTYPE_P2P_CLIENT:
5901 	case NL80211_IFTYPE_STATION:
5902 	case NL80211_IFTYPE_ADHOC:
5903 	case NL80211_IFTYPE_MESH_POINT:
5904 		break;
5905 	default:
5906 		err = -EOPNOTSUPP;
5907 		goto out_put_vlan;
5908 	}
5909 
5910 	/* driver will call cfg80211_check_station_change() */
5911 	err = rdev_change_station(rdev, dev, mac_addr, &params);
5912 
5913  out_put_vlan:
5914 	if (params.vlan)
5915 		dev_put(params.vlan);
5916 
5917 	return err;
5918 }
5919 
5920 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
5921 {
5922 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
5923 	int err;
5924 	struct net_device *dev = info->user_ptr[1];
5925 	struct station_parameters params;
5926 	u8 *mac_addr = NULL;
5927 	u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5928 			 BIT(NL80211_STA_FLAG_ASSOCIATED);
5929 
5930 	memset(&params, 0, sizeof(params));
5931 
5932 	if (!rdev->ops->add_station)
5933 		return -EOPNOTSUPP;
5934 
5935 	if (!info->attrs[NL80211_ATTR_MAC])
5936 		return -EINVAL;
5937 
5938 	if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
5939 		return -EINVAL;
5940 
5941 	if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
5942 		return -EINVAL;
5943 
5944 	if (!info->attrs[NL80211_ATTR_STA_AID] &&
5945 	    !info->attrs[NL80211_ATTR_PEER_AID])
5946 		return -EINVAL;
5947 
5948 	mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5949 	params.supported_rates =
5950 		nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5951 	params.supported_rates_len =
5952 		nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5953 	params.listen_interval =
5954 		nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
5955 
5956 	if (info->attrs[NL80211_ATTR_VLAN_ID])
5957 		params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
5958 
5959 	if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
5960 		params.support_p2p_ps =
5961 			nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
5962 	} else {
5963 		/*
5964 		 * if not specified, assume it's supported for P2P GO interface,
5965 		 * and is NOT supported for AP interface
5966 		 */
5967 		params.support_p2p_ps =
5968 			dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
5969 	}
5970 
5971 	if (info->attrs[NL80211_ATTR_PEER_AID])
5972 		params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
5973 	else
5974 		params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
5975 
5976 	if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
5977 		params.capability =
5978 			nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5979 		params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5980 	}
5981 
5982 	if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5983 		params.ext_capab =
5984 			nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5985 		params.ext_capab_len =
5986 			nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5987 	}
5988 
5989 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
5990 		params.ht_capa =
5991 			nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5992 
5993 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
5994 		params.vht_capa =
5995 			nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
5996 
5997 	if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
5998 		params.he_capa =
5999 			nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
6000 		params.he_capa_len =
6001 			nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
6002 
6003 		/* max len is validated in nla policy */
6004 		if (params.he_capa_len < NL80211_HE_MIN_CAPABILITY_LEN)
6005 			return -EINVAL;
6006 	}
6007 
6008 	if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
6009 		params.opmode_notif_used = true;
6010 		params.opmode_notif =
6011 			nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
6012 	}
6013 
6014 	if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
6015 		params.plink_action =
6016 			nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
6017 
6018 	if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
6019 		params.airtime_weight =
6020 			nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
6021 
6022 	if (params.airtime_weight &&
6023 	    !wiphy_ext_feature_isset(&rdev->wiphy,
6024 				     NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
6025 		return -EOPNOTSUPP;
6026 
6027 	err = nl80211_parse_sta_txpower_setting(info, &params);
6028 	if (err)
6029 		return err;
6030 
6031 	err = nl80211_parse_sta_channel_info(info, &params);
6032 	if (err)
6033 		return err;
6034 
6035 	err = nl80211_parse_sta_wme(info, &params);
6036 	if (err)
6037 		return err;
6038 
6039 	if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
6040 		return -EINVAL;
6041 
6042 	/* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
6043 	 * as userspace might just pass through the capabilities from the IEs
6044 	 * directly, rather than enforcing this restriction and returning an
6045 	 * error in this case.
6046 	 */
6047 	if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
6048 		params.ht_capa = NULL;
6049 		params.vht_capa = NULL;
6050 
6051 		/* HE requires WME */
6052 		if (params.he_capa_len)
6053 			return -EINVAL;
6054 	}
6055 
6056 	/* When you run into this, adjust the code below for the new flag */
6057 	BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
6058 
6059 	switch (dev->ieee80211_ptr->iftype) {
6060 	case NL80211_IFTYPE_AP:
6061 	case NL80211_IFTYPE_AP_VLAN:
6062 	case NL80211_IFTYPE_P2P_GO:
6063 		/* ignore WME attributes if iface/sta is not capable */
6064 		if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
6065 		    !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
6066 			params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
6067 
6068 		/* TDLS peers cannot be added */
6069 		if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
6070 		    info->attrs[NL80211_ATTR_PEER_AID])
6071 			return -EINVAL;
6072 		/* but don't bother the driver with it */
6073 		params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
6074 
6075 		/* allow authenticated/associated only if driver handles it */
6076 		if (!(rdev->wiphy.features &
6077 				NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
6078 		    params.sta_flags_mask & auth_assoc)
6079 			return -EINVAL;
6080 
6081 		/* Older userspace, or userspace wanting to be compatible with
6082 		 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
6083 		 * and assoc flags in the mask, but assumes the station will be
6084 		 * added as associated anyway since this was the required driver
6085 		 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
6086 		 * introduced.
6087 		 * In order to not bother drivers with this quirk in the API
6088 		 * set the flags in both the mask and set for new stations in
6089 		 * this case.
6090 		 */
6091 		if (!(params.sta_flags_mask & auth_assoc)) {
6092 			params.sta_flags_mask |= auth_assoc;
6093 			params.sta_flags_set |= auth_assoc;
6094 		}
6095 
6096 		/* must be last in here for error handling */
6097 		params.vlan = get_vlan(info, rdev);
6098 		if (IS_ERR(params.vlan))
6099 			return PTR_ERR(params.vlan);
6100 		break;
6101 	case NL80211_IFTYPE_MESH_POINT:
6102 		/* ignore uAPSD data */
6103 		params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
6104 
6105 		/* associated is disallowed */
6106 		if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
6107 			return -EINVAL;
6108 		/* TDLS peers cannot be added */
6109 		if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
6110 		    info->attrs[NL80211_ATTR_PEER_AID])
6111 			return -EINVAL;
6112 		break;
6113 	case NL80211_IFTYPE_STATION:
6114 	case NL80211_IFTYPE_P2P_CLIENT:
6115 		/* ignore uAPSD data */
6116 		params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
6117 
6118 		/* these are disallowed */
6119 		if (params.sta_flags_mask &
6120 				(BIT(NL80211_STA_FLAG_ASSOCIATED) |
6121 				 BIT(NL80211_STA_FLAG_AUTHENTICATED)))
6122 			return -EINVAL;
6123 		/* Only TDLS peers can be added */
6124 		if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
6125 			return -EINVAL;
6126 		/* Can only add if TDLS ... */
6127 		if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
6128 			return -EOPNOTSUPP;
6129 		/* ... with external setup is supported */
6130 		if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
6131 			return -EOPNOTSUPP;
6132 		/*
6133 		 * Older wpa_supplicant versions always mark the TDLS peer
6134 		 * as authorized, but it shouldn't yet be.
6135 		 */
6136 		params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
6137 		break;
6138 	default:
6139 		return -EOPNOTSUPP;
6140 	}
6141 
6142 	/* be aware of params.vlan when changing code here */
6143 
6144 	err = rdev_add_station(rdev, dev, mac_addr, &params);
6145 
6146 	if (params.vlan)
6147 		dev_put(params.vlan);
6148 	return err;
6149 }
6150 
6151 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
6152 {
6153 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6154 	struct net_device *dev = info->user_ptr[1];
6155 	struct station_del_parameters params;
6156 
6157 	memset(&params, 0, sizeof(params));
6158 
6159 	if (info->attrs[NL80211_ATTR_MAC])
6160 		params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
6161 
6162 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
6163 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
6164 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
6165 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6166 		return -EINVAL;
6167 
6168 	if (!rdev->ops->del_station)
6169 		return -EOPNOTSUPP;
6170 
6171 	if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
6172 		params.subtype =
6173 			nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
6174 		if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
6175 		    params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
6176 			return -EINVAL;
6177 	} else {
6178 		/* Default to Deauthentication frame */
6179 		params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
6180 	}
6181 
6182 	if (info->attrs[NL80211_ATTR_REASON_CODE]) {
6183 		params.reason_code =
6184 			nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
6185 		if (params.reason_code == 0)
6186 			return -EINVAL; /* 0 is reserved */
6187 	} else {
6188 		/* Default to reason code 2 */
6189 		params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
6190 	}
6191 
6192 	return rdev_del_station(rdev, dev, &params);
6193 }
6194 
6195 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
6196 				int flags, struct net_device *dev,
6197 				u8 *dst, u8 *next_hop,
6198 				struct mpath_info *pinfo)
6199 {
6200 	void *hdr;
6201 	struct nlattr *pinfoattr;
6202 
6203 	hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
6204 	if (!hdr)
6205 		return -1;
6206 
6207 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
6208 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
6209 	    nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
6210 	    nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
6211 		goto nla_put_failure;
6212 
6213 	pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO);
6214 	if (!pinfoattr)
6215 		goto nla_put_failure;
6216 	if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
6217 	    nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
6218 			pinfo->frame_qlen))
6219 		goto nla_put_failure;
6220 	if (((pinfo->filled & MPATH_INFO_SN) &&
6221 	     nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
6222 	    ((pinfo->filled & MPATH_INFO_METRIC) &&
6223 	     nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
6224 			 pinfo->metric)) ||
6225 	    ((pinfo->filled & MPATH_INFO_EXPTIME) &&
6226 	     nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
6227 			 pinfo->exptime)) ||
6228 	    ((pinfo->filled & MPATH_INFO_FLAGS) &&
6229 	     nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
6230 			pinfo->flags)) ||
6231 	    ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
6232 	     nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
6233 			 pinfo->discovery_timeout)) ||
6234 	    ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
6235 	     nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
6236 			pinfo->discovery_retries)) ||
6237 	    ((pinfo->filled & MPATH_INFO_HOP_COUNT) &&
6238 	     nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT,
6239 			pinfo->hop_count)) ||
6240 	    ((pinfo->filled & MPATH_INFO_PATH_CHANGE) &&
6241 	     nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE,
6242 			 pinfo->path_change_count)))
6243 		goto nla_put_failure;
6244 
6245 	nla_nest_end(msg, pinfoattr);
6246 
6247 	genlmsg_end(msg, hdr);
6248 	return 0;
6249 
6250  nla_put_failure:
6251 	genlmsg_cancel(msg, hdr);
6252 	return -EMSGSIZE;
6253 }
6254 
6255 static int nl80211_dump_mpath(struct sk_buff *skb,
6256 			      struct netlink_callback *cb)
6257 {
6258 	struct mpath_info pinfo;
6259 	struct cfg80211_registered_device *rdev;
6260 	struct wireless_dev *wdev;
6261 	u8 dst[ETH_ALEN];
6262 	u8 next_hop[ETH_ALEN];
6263 	int path_idx = cb->args[2];
6264 	int err;
6265 
6266 	rtnl_lock();
6267 	err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
6268 	if (err)
6269 		goto out_err;
6270 
6271 	if (!rdev->ops->dump_mpath) {
6272 		err = -EOPNOTSUPP;
6273 		goto out_err;
6274 	}
6275 
6276 	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
6277 		err = -EOPNOTSUPP;
6278 		goto out_err;
6279 	}
6280 
6281 	while (1) {
6282 		err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
6283 				      next_hop, &pinfo);
6284 		if (err == -ENOENT)
6285 			break;
6286 		if (err)
6287 			goto out_err;
6288 
6289 		if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
6290 				       cb->nlh->nlmsg_seq, NLM_F_MULTI,
6291 				       wdev->netdev, dst, next_hop,
6292 				       &pinfo) < 0)
6293 			goto out;
6294 
6295 		path_idx++;
6296 	}
6297 
6298  out:
6299 	cb->args[2] = path_idx;
6300 	err = skb->len;
6301  out_err:
6302 	rtnl_unlock();
6303 	return err;
6304 }
6305 
6306 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
6307 {
6308 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6309 	int err;
6310 	struct net_device *dev = info->user_ptr[1];
6311 	struct mpath_info pinfo;
6312 	struct sk_buff *msg;
6313 	u8 *dst = NULL;
6314 	u8 next_hop[ETH_ALEN];
6315 
6316 	memset(&pinfo, 0, sizeof(pinfo));
6317 
6318 	if (!info->attrs[NL80211_ATTR_MAC])
6319 		return -EINVAL;
6320 
6321 	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6322 
6323 	if (!rdev->ops->get_mpath)
6324 		return -EOPNOTSUPP;
6325 
6326 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6327 		return -EOPNOTSUPP;
6328 
6329 	err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
6330 	if (err)
6331 		return err;
6332 
6333 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6334 	if (!msg)
6335 		return -ENOMEM;
6336 
6337 	if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
6338 				 dev, dst, next_hop, &pinfo) < 0) {
6339 		nlmsg_free(msg);
6340 		return -ENOBUFS;
6341 	}
6342 
6343 	return genlmsg_reply(msg, info);
6344 }
6345 
6346 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
6347 {
6348 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6349 	struct net_device *dev = info->user_ptr[1];
6350 	u8 *dst = NULL;
6351 	u8 *next_hop = NULL;
6352 
6353 	if (!info->attrs[NL80211_ATTR_MAC])
6354 		return -EINVAL;
6355 
6356 	if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
6357 		return -EINVAL;
6358 
6359 	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6360 	next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
6361 
6362 	if (!rdev->ops->change_mpath)
6363 		return -EOPNOTSUPP;
6364 
6365 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6366 		return -EOPNOTSUPP;
6367 
6368 	return rdev_change_mpath(rdev, dev, dst, next_hop);
6369 }
6370 
6371 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
6372 {
6373 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6374 	struct net_device *dev = info->user_ptr[1];
6375 	u8 *dst = NULL;
6376 	u8 *next_hop = NULL;
6377 
6378 	if (!info->attrs[NL80211_ATTR_MAC])
6379 		return -EINVAL;
6380 
6381 	if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
6382 		return -EINVAL;
6383 
6384 	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6385 	next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
6386 
6387 	if (!rdev->ops->add_mpath)
6388 		return -EOPNOTSUPP;
6389 
6390 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6391 		return -EOPNOTSUPP;
6392 
6393 	return rdev_add_mpath(rdev, dev, dst, next_hop);
6394 }
6395 
6396 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
6397 {
6398 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6399 	struct net_device *dev = info->user_ptr[1];
6400 	u8 *dst = NULL;
6401 
6402 	if (info->attrs[NL80211_ATTR_MAC])
6403 		dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6404 
6405 	if (!rdev->ops->del_mpath)
6406 		return -EOPNOTSUPP;
6407 
6408 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6409 		return -EOPNOTSUPP;
6410 
6411 	return rdev_del_mpath(rdev, dev, dst);
6412 }
6413 
6414 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
6415 {
6416 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6417 	int err;
6418 	struct net_device *dev = info->user_ptr[1];
6419 	struct mpath_info pinfo;
6420 	struct sk_buff *msg;
6421 	u8 *dst = NULL;
6422 	u8 mpp[ETH_ALEN];
6423 
6424 	memset(&pinfo, 0, sizeof(pinfo));
6425 
6426 	if (!info->attrs[NL80211_ATTR_MAC])
6427 		return -EINVAL;
6428 
6429 	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6430 
6431 	if (!rdev->ops->get_mpp)
6432 		return -EOPNOTSUPP;
6433 
6434 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6435 		return -EOPNOTSUPP;
6436 
6437 	err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
6438 	if (err)
6439 		return err;
6440 
6441 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6442 	if (!msg)
6443 		return -ENOMEM;
6444 
6445 	if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
6446 			       dev, dst, mpp, &pinfo) < 0) {
6447 		nlmsg_free(msg);
6448 		return -ENOBUFS;
6449 	}
6450 
6451 	return genlmsg_reply(msg, info);
6452 }
6453 
6454 static int nl80211_dump_mpp(struct sk_buff *skb,
6455 			    struct netlink_callback *cb)
6456 {
6457 	struct mpath_info pinfo;
6458 	struct cfg80211_registered_device *rdev;
6459 	struct wireless_dev *wdev;
6460 	u8 dst[ETH_ALEN];
6461 	u8 mpp[ETH_ALEN];
6462 	int path_idx = cb->args[2];
6463 	int err;
6464 
6465 	rtnl_lock();
6466 	err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
6467 	if (err)
6468 		goto out_err;
6469 
6470 	if (!rdev->ops->dump_mpp) {
6471 		err = -EOPNOTSUPP;
6472 		goto out_err;
6473 	}
6474 
6475 	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
6476 		err = -EOPNOTSUPP;
6477 		goto out_err;
6478 	}
6479 
6480 	while (1) {
6481 		err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
6482 				    mpp, &pinfo);
6483 		if (err == -ENOENT)
6484 			break;
6485 		if (err)
6486 			goto out_err;
6487 
6488 		if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
6489 				       cb->nlh->nlmsg_seq, NLM_F_MULTI,
6490 				       wdev->netdev, dst, mpp,
6491 				       &pinfo) < 0)
6492 			goto out;
6493 
6494 		path_idx++;
6495 	}
6496 
6497  out:
6498 	cb->args[2] = path_idx;
6499 	err = skb->len;
6500  out_err:
6501 	rtnl_unlock();
6502 	return err;
6503 }
6504 
6505 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
6506 {
6507 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6508 	struct net_device *dev = info->user_ptr[1];
6509 	struct wireless_dev *wdev = dev->ieee80211_ptr;
6510 	struct bss_parameters params;
6511 	int err;
6512 
6513 	memset(&params, 0, sizeof(params));
6514 	/* default to not changing parameters */
6515 	params.use_cts_prot = -1;
6516 	params.use_short_preamble = -1;
6517 	params.use_short_slot_time = -1;
6518 	params.ap_isolate = -1;
6519 	params.ht_opmode = -1;
6520 	params.p2p_ctwindow = -1;
6521 	params.p2p_opp_ps = -1;
6522 
6523 	if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
6524 		params.use_cts_prot =
6525 		    nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
6526 	if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
6527 		params.use_short_preamble =
6528 		    nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
6529 	if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
6530 		params.use_short_slot_time =
6531 		    nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
6532 	if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
6533 		params.basic_rates =
6534 			nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
6535 		params.basic_rates_len =
6536 			nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
6537 	}
6538 	if (info->attrs[NL80211_ATTR_AP_ISOLATE])
6539 		params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
6540 	if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
6541 		params.ht_opmode =
6542 			nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
6543 
6544 	if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
6545 		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6546 			return -EINVAL;
6547 		params.p2p_ctwindow =
6548 			nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
6549 		if (params.p2p_ctwindow != 0 &&
6550 		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
6551 			return -EINVAL;
6552 	}
6553 
6554 	if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
6555 		u8 tmp;
6556 
6557 		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6558 			return -EINVAL;
6559 		tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
6560 		params.p2p_opp_ps = tmp;
6561 		if (params.p2p_opp_ps &&
6562 		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
6563 			return -EINVAL;
6564 	}
6565 
6566 	if (!rdev->ops->change_bss)
6567 		return -EOPNOTSUPP;
6568 
6569 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
6570 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6571 		return -EOPNOTSUPP;
6572 
6573 	wdev_lock(wdev);
6574 	err = rdev_change_bss(rdev, dev, &params);
6575 	wdev_unlock(wdev);
6576 
6577 	return err;
6578 }
6579 
6580 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
6581 {
6582 	char *data = NULL;
6583 	bool is_indoor;
6584 	enum nl80211_user_reg_hint_type user_reg_hint_type;
6585 	u32 owner_nlportid;
6586 
6587 	/*
6588 	 * You should only get this when cfg80211 hasn't yet initialized
6589 	 * completely when built-in to the kernel right between the time
6590 	 * window between nl80211_init() and regulatory_init(), if that is
6591 	 * even possible.
6592 	 */
6593 	if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
6594 		return -EINPROGRESS;
6595 
6596 	if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
6597 		user_reg_hint_type =
6598 		  nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
6599 	else
6600 		user_reg_hint_type = NL80211_USER_REG_HINT_USER;
6601 
6602 	switch (user_reg_hint_type) {
6603 	case NL80211_USER_REG_HINT_USER:
6604 	case NL80211_USER_REG_HINT_CELL_BASE:
6605 		if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
6606 			return -EINVAL;
6607 
6608 		data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
6609 		return regulatory_hint_user(data, user_reg_hint_type);
6610 	case NL80211_USER_REG_HINT_INDOOR:
6611 		if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
6612 			owner_nlportid = info->snd_portid;
6613 			is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
6614 		} else {
6615 			owner_nlportid = 0;
6616 			is_indoor = true;
6617 		}
6618 
6619 		return regulatory_hint_indoor(is_indoor, owner_nlportid);
6620 	default:
6621 		return -EINVAL;
6622 	}
6623 }
6624 
6625 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info)
6626 {
6627 	return reg_reload_regdb();
6628 }
6629 
6630 static int nl80211_get_mesh_config(struct sk_buff *skb,
6631 				   struct genl_info *info)
6632 {
6633 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6634 	struct net_device *dev = info->user_ptr[1];
6635 	struct wireless_dev *wdev = dev->ieee80211_ptr;
6636 	struct mesh_config cur_params;
6637 	int err = 0;
6638 	void *hdr;
6639 	struct nlattr *pinfoattr;
6640 	struct sk_buff *msg;
6641 
6642 	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
6643 		return -EOPNOTSUPP;
6644 
6645 	if (!rdev->ops->get_mesh_config)
6646 		return -EOPNOTSUPP;
6647 
6648 	wdev_lock(wdev);
6649 	/* If not connected, get default parameters */
6650 	if (!wdev->mesh_id_len)
6651 		memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
6652 	else
6653 		err = rdev_get_mesh_config(rdev, dev, &cur_params);
6654 	wdev_unlock(wdev);
6655 
6656 	if (err)
6657 		return err;
6658 
6659 	/* Draw up a netlink message to send back */
6660 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6661 	if (!msg)
6662 		return -ENOMEM;
6663 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6664 			     NL80211_CMD_GET_MESH_CONFIG);
6665 	if (!hdr)
6666 		goto out;
6667 	pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG);
6668 	if (!pinfoattr)
6669 		goto nla_put_failure;
6670 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
6671 	    nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
6672 			cur_params.dot11MeshRetryTimeout) ||
6673 	    nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
6674 			cur_params.dot11MeshConfirmTimeout) ||
6675 	    nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
6676 			cur_params.dot11MeshHoldingTimeout) ||
6677 	    nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
6678 			cur_params.dot11MeshMaxPeerLinks) ||
6679 	    nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
6680 		       cur_params.dot11MeshMaxRetries) ||
6681 	    nla_put_u8(msg, NL80211_MESHCONF_TTL,
6682 		       cur_params.dot11MeshTTL) ||
6683 	    nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
6684 		       cur_params.element_ttl) ||
6685 	    nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
6686 		       cur_params.auto_open_plinks) ||
6687 	    nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
6688 			cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
6689 	    nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
6690 		       cur_params.dot11MeshHWMPmaxPREQretries) ||
6691 	    nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
6692 			cur_params.path_refresh_time) ||
6693 	    nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
6694 			cur_params.min_discovery_timeout) ||
6695 	    nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
6696 			cur_params.dot11MeshHWMPactivePathTimeout) ||
6697 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
6698 			cur_params.dot11MeshHWMPpreqMinInterval) ||
6699 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
6700 			cur_params.dot11MeshHWMPperrMinInterval) ||
6701 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
6702 			cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
6703 	    nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
6704 		       cur_params.dot11MeshHWMPRootMode) ||
6705 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
6706 			cur_params.dot11MeshHWMPRannInterval) ||
6707 	    nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
6708 		       cur_params.dot11MeshGateAnnouncementProtocol) ||
6709 	    nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
6710 		       cur_params.dot11MeshForwarding) ||
6711 	    nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
6712 			cur_params.rssi_threshold) ||
6713 	    nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
6714 			cur_params.ht_opmode) ||
6715 	    nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
6716 			cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
6717 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
6718 			cur_params.dot11MeshHWMProotInterval) ||
6719 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
6720 			cur_params.dot11MeshHWMPconfirmationInterval) ||
6721 	    nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
6722 			cur_params.power_mode) ||
6723 	    nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
6724 			cur_params.dot11MeshAwakeWindowDuration) ||
6725 	    nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
6726 			cur_params.plink_timeout) ||
6727 	    nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE,
6728 		       cur_params.dot11MeshConnectedToMeshGate))
6729 		goto nla_put_failure;
6730 	nla_nest_end(msg, pinfoattr);
6731 	genlmsg_end(msg, hdr);
6732 	return genlmsg_reply(msg, info);
6733 
6734  nla_put_failure:
6735  out:
6736 	nlmsg_free(msg);
6737 	return -ENOBUFS;
6738 }
6739 
6740 static const struct nla_policy
6741 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
6742 	[NL80211_MESHCONF_RETRY_TIMEOUT] =
6743 		NLA_POLICY_RANGE(NLA_U16, 1, 255),
6744 	[NL80211_MESHCONF_CONFIRM_TIMEOUT] =
6745 		NLA_POLICY_RANGE(NLA_U16, 1, 255),
6746 	[NL80211_MESHCONF_HOLDING_TIMEOUT] =
6747 		NLA_POLICY_RANGE(NLA_U16, 1, 255),
6748 	[NL80211_MESHCONF_MAX_PEER_LINKS] =
6749 		NLA_POLICY_RANGE(NLA_U16, 0, 255),
6750 	[NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16),
6751 	[NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
6752 	[NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
6753 	[NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1),
6754 	[NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] =
6755 		NLA_POLICY_RANGE(NLA_U32, 1, 255),
6756 	[NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
6757 	[NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
6758 	[NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1),
6759 	[NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
6760 	[NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] =
6761 		NLA_POLICY_MIN(NLA_U16, 1),
6762 	[NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] =
6763 		NLA_POLICY_MIN(NLA_U16, 1),
6764 	[NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] =
6765 		NLA_POLICY_MIN(NLA_U16, 1),
6766 	[NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4),
6767 	[NL80211_MESHCONF_HWMP_RANN_INTERVAL] =
6768 		NLA_POLICY_MIN(NLA_U16, 1),
6769 	[NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1),
6770 	[NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1),
6771 	[NL80211_MESHCONF_RSSI_THRESHOLD] =
6772 		NLA_POLICY_RANGE(NLA_S32, -255, 0),
6773 	[NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
6774 	[NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
6775 	[NL80211_MESHCONF_HWMP_ROOT_INTERVAL] =
6776 		NLA_POLICY_MIN(NLA_U16, 1),
6777 	[NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] =
6778 		NLA_POLICY_MIN(NLA_U16, 1),
6779 	[NL80211_MESHCONF_POWER_MODE] =
6780 		NLA_POLICY_RANGE(NLA_U32,
6781 				 NL80211_MESH_POWER_ACTIVE,
6782 				 NL80211_MESH_POWER_MAX),
6783 	[NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
6784 	[NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
6785 	[NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
6786 };
6787 
6788 static const struct nla_policy
6789 	nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
6790 	[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
6791 	[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
6792 	[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
6793 	[NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
6794 	[NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
6795 	[NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
6796 	[NL80211_MESH_SETUP_IE] =
6797 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
6798 				       IEEE80211_MAX_DATA_LEN),
6799 	[NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
6800 };
6801 
6802 static int nl80211_parse_mesh_config(struct genl_info *info,
6803 				     struct mesh_config *cfg,
6804 				     u32 *mask_out)
6805 {
6806 	struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
6807 	u32 mask = 0;
6808 	u16 ht_opmode;
6809 
6810 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn)	\
6811 do {									\
6812 	if (tb[attr]) {							\
6813 		cfg->param = fn(tb[attr]);				\
6814 		mask |= BIT((attr) - 1);				\
6815 	}								\
6816 } while (0)
6817 
6818 	if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
6819 		return -EINVAL;
6820 	if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack))
6821 		return -EINVAL;
6822 
6823 	/* This makes sure that there aren't more than 32 mesh config
6824 	 * parameters (otherwise our bitfield scheme would not work.) */
6825 	BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
6826 
6827 	/* Fill in the params struct */
6828 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask,
6829 				  NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16);
6830 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask,
6831 				  NL80211_MESHCONF_CONFIRM_TIMEOUT,
6832 				  nla_get_u16);
6833 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask,
6834 				  NL80211_MESHCONF_HOLDING_TIMEOUT,
6835 				  nla_get_u16);
6836 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask,
6837 				  NL80211_MESHCONF_MAX_PEER_LINKS,
6838 				  nla_get_u16);
6839 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask,
6840 				  NL80211_MESHCONF_MAX_RETRIES, nla_get_u8);
6841 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask,
6842 				  NL80211_MESHCONF_TTL, nla_get_u8);
6843 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask,
6844 				  NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8);
6845 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask,
6846 				  NL80211_MESHCONF_AUTO_OPEN_PLINKS,
6847 				  nla_get_u8);
6848 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
6849 				  mask,
6850 				  NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
6851 				  nla_get_u32);
6852 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask,
6853 				  NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
6854 				  nla_get_u8);
6855 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask,
6856 				  NL80211_MESHCONF_PATH_REFRESH_TIME,
6857 				  nla_get_u32);
6858 	if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) &&
6859 	    (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535))
6860 		return -EINVAL;
6861 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask,
6862 				  NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
6863 				  nla_get_u16);
6864 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
6865 				  mask,
6866 				  NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
6867 				  nla_get_u32);
6868 	if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) &&
6869 	    (cfg->dot11MeshHWMPactivePathTimeout < 1 ||
6870 	     cfg->dot11MeshHWMPactivePathTimeout > 65535))
6871 		return -EINVAL;
6872 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask,
6873 				  NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
6874 				  nla_get_u16);
6875 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask,
6876 				  NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
6877 				  nla_get_u16);
6878 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6879 				  dot11MeshHWMPnetDiameterTraversalTime, mask,
6880 				  NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
6881 				  nla_get_u16);
6882 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask,
6883 				  NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8);
6884 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask,
6885 				  NL80211_MESHCONF_HWMP_RANN_INTERVAL,
6886 				  nla_get_u16);
6887 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol,
6888 				  mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
6889 				  nla_get_u8);
6890 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask,
6891 				  NL80211_MESHCONF_FORWARDING, nla_get_u8);
6892 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask,
6893 				  NL80211_MESHCONF_RSSI_THRESHOLD,
6894 				  nla_get_s32);
6895 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask,
6896 				  NL80211_MESHCONF_CONNECTED_TO_GATE,
6897 				  nla_get_u8);
6898 	/*
6899 	 * Check HT operation mode based on
6900 	 * IEEE 802.11-2016 9.4.2.57 HT Operation element.
6901 	 */
6902 	if (tb[NL80211_MESHCONF_HT_OPMODE]) {
6903 		ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
6904 
6905 		if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
6906 				  IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
6907 				  IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
6908 			return -EINVAL;
6909 
6910 		/* NON_HT_STA bit is reserved, but some programs set it */
6911 		ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT;
6912 
6913 		cfg->ht_opmode = ht_opmode;
6914 		mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
6915 	}
6916 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6917 				  dot11MeshHWMPactivePathToRootTimeout, mask,
6918 				  NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
6919 				  nla_get_u32);
6920 	if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) &&
6921 	    (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 ||
6922 	     cfg->dot11MeshHWMPactivePathToRootTimeout > 65535))
6923 		return -EINVAL;
6924 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask,
6925 				  NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
6926 				  nla_get_u16);
6927 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval,
6928 				  mask,
6929 				  NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
6930 				  nla_get_u16);
6931 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask,
6932 				  NL80211_MESHCONF_POWER_MODE, nla_get_u32);
6933 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask,
6934 				  NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16);
6935 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask,
6936 				  NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32);
6937 	if (mask_out)
6938 		*mask_out = mask;
6939 
6940 	return 0;
6941 
6942 #undef FILL_IN_MESH_PARAM_IF_SET
6943 }
6944 
6945 static int nl80211_parse_mesh_setup(struct genl_info *info,
6946 				     struct mesh_setup *setup)
6947 {
6948 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6949 	struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
6950 
6951 	if (!info->attrs[NL80211_ATTR_MESH_SETUP])
6952 		return -EINVAL;
6953 	if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack))
6954 		return -EINVAL;
6955 
6956 	if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
6957 		setup->sync_method =
6958 		(nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
6959 		 IEEE80211_SYNC_METHOD_VENDOR :
6960 		 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
6961 
6962 	if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
6963 		setup->path_sel_proto =
6964 		(nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
6965 		 IEEE80211_PATH_PROTOCOL_VENDOR :
6966 		 IEEE80211_PATH_PROTOCOL_HWMP;
6967 
6968 	if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
6969 		setup->path_metric =
6970 		(nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
6971 		 IEEE80211_PATH_METRIC_VENDOR :
6972 		 IEEE80211_PATH_METRIC_AIRTIME;
6973 
6974 	if (tb[NL80211_MESH_SETUP_IE]) {
6975 		struct nlattr *ieattr =
6976 			tb[NL80211_MESH_SETUP_IE];
6977 		setup->ie = nla_data(ieattr);
6978 		setup->ie_len = nla_len(ieattr);
6979 	}
6980 	if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
6981 	    !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
6982 		return -EINVAL;
6983 	setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
6984 	setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
6985 	setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
6986 	if (setup->is_secure)
6987 		setup->user_mpm = true;
6988 
6989 	if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
6990 		if (!setup->user_mpm)
6991 			return -EINVAL;
6992 		setup->auth_id =
6993 			nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
6994 	}
6995 
6996 	return 0;
6997 }
6998 
6999 static int nl80211_update_mesh_config(struct sk_buff *skb,
7000 				      struct genl_info *info)
7001 {
7002 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
7003 	struct net_device *dev = info->user_ptr[1];
7004 	struct wireless_dev *wdev = dev->ieee80211_ptr;
7005 	struct mesh_config cfg;
7006 	u32 mask;
7007 	int err;
7008 
7009 	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
7010 		return -EOPNOTSUPP;
7011 
7012 	if (!rdev->ops->update_mesh_config)
7013 		return -EOPNOTSUPP;
7014 
7015 	err = nl80211_parse_mesh_config(info, &cfg, &mask);
7016 	if (err)
7017 		return err;
7018 
7019 	wdev_lock(wdev);
7020 	if (!wdev->mesh_id_len)
7021 		err = -ENOLINK;
7022 
7023 	if (!err)
7024 		err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
7025 
7026 	wdev_unlock(wdev);
7027 
7028 	return err;
7029 }
7030 
7031 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
7032 			      struct sk_buff *msg)
7033 {
7034 	struct nlattr *nl_reg_rules;
7035 	unsigned int i;
7036 
7037 	if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
7038 	    (regdom->dfs_region &&
7039 	     nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
7040 		goto nla_put_failure;
7041 
7042 	nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES);
7043 	if (!nl_reg_rules)
7044 		goto nla_put_failure;
7045 
7046 	for (i = 0; i < regdom->n_reg_rules; i++) {
7047 		struct nlattr *nl_reg_rule;
7048 		const struct ieee80211_reg_rule *reg_rule;
7049 		const struct ieee80211_freq_range *freq_range;
7050 		const struct ieee80211_power_rule *power_rule;
7051 		unsigned int max_bandwidth_khz;
7052 
7053 		reg_rule = &regdom->reg_rules[i];
7054 		freq_range = &reg_rule->freq_range;
7055 		power_rule = &reg_rule->power_rule;
7056 
7057 		nl_reg_rule = nla_nest_start_noflag(msg, i);
7058 		if (!nl_reg_rule)
7059 			goto nla_put_failure;
7060 
7061 		max_bandwidth_khz = freq_range->max_bandwidth_khz;
7062 		if (!max_bandwidth_khz)
7063 			max_bandwidth_khz = reg_get_max_bandwidth(regdom,
7064 								  reg_rule);
7065 
7066 		if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
7067 				reg_rule->flags) ||
7068 		    nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
7069 				freq_range->start_freq_khz) ||
7070 		    nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
7071 				freq_range->end_freq_khz) ||
7072 		    nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
7073 				max_bandwidth_khz) ||
7074 		    nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
7075 				power_rule->max_antenna_gain) ||
7076 		    nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
7077 				power_rule->max_eirp) ||
7078 		    nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
7079 				reg_rule->dfs_cac_ms))
7080 			goto nla_put_failure;
7081 
7082 		nla_nest_end(msg, nl_reg_rule);
7083 	}
7084 
7085 	nla_nest_end(msg, nl_reg_rules);
7086 	return 0;
7087 
7088 nla_put_failure:
7089 	return -EMSGSIZE;
7090 }
7091 
7092 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
7093 {
7094 	const struct ieee80211_regdomain *regdom = NULL;
7095 	struct cfg80211_registered_device *rdev;
7096 	struct wiphy *wiphy = NULL;
7097 	struct sk_buff *msg;
7098 	void *hdr;
7099 
7100 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
7101 	if (!msg)
7102 		return -ENOBUFS;
7103 
7104 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
7105 			     NL80211_CMD_GET_REG);
7106 	if (!hdr)
7107 		goto put_failure;
7108 
7109 	if (info->attrs[NL80211_ATTR_WIPHY]) {
7110 		bool self_managed;
7111 
7112 		rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
7113 		if (IS_ERR(rdev)) {
7114 			nlmsg_free(msg);
7115 			return PTR_ERR(rdev);
7116 		}
7117 
7118 		wiphy = &rdev->wiphy;
7119 		self_managed = wiphy->regulatory_flags &
7120 			       REGULATORY_WIPHY_SELF_MANAGED;
7121 		regdom = get_wiphy_regdom(wiphy);
7122 
7123 		/* a self-managed-reg device must have a private regdom */
7124 		if (WARN_ON(!regdom && self_managed)) {
7125 			nlmsg_free(msg);
7126 			return -EINVAL;
7127 		}
7128 
7129 		if (regdom &&
7130 		    nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
7131 			goto nla_put_failure;
7132 	}
7133 
7134 	if (!wiphy && reg_last_request_cell_base() &&
7135 	    nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
7136 			NL80211_USER_REG_HINT_CELL_BASE))
7137 		goto nla_put_failure;
7138 
7139 	rcu_read_lock();
7140 
7141 	if (!regdom)
7142 		regdom = rcu_dereference(cfg80211_regdomain);
7143 
7144 	if (nl80211_put_regdom(regdom, msg))
7145 		goto nla_put_failure_rcu;
7146 
7147 	rcu_read_unlock();
7148 
7149 	genlmsg_end(msg, hdr);
7150 	return genlmsg_reply(msg, info);
7151 
7152 nla_put_failure_rcu:
7153 	rcu_read_unlock();
7154 nla_put_failure:
7155 put_failure:
7156 	nlmsg_free(msg);
7157 	return -EMSGSIZE;
7158 }
7159 
7160 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
7161 			       u32 seq, int flags, struct wiphy *wiphy,
7162 			       const struct ieee80211_regdomain *regdom)
7163 {
7164 	void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
7165 				   NL80211_CMD_GET_REG);
7166 
7167 	if (!hdr)
7168 		return -1;
7169 
7170 	genl_dump_check_consistent(cb, hdr);
7171 
7172 	if (nl80211_put_regdom(regdom, msg))
7173 		goto nla_put_failure;
7174 
7175 	if (!wiphy && reg_last_request_cell_base() &&
7176 	    nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
7177 			NL80211_USER_REG_HINT_CELL_BASE))
7178 		goto nla_put_failure;
7179 
7180 	if (wiphy &&
7181 	    nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
7182 		goto nla_put_failure;
7183 
7184 	if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
7185 	    nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
7186 		goto nla_put_failure;
7187 
7188 	genlmsg_end(msg, hdr);
7189 	return 0;
7190 
7191 nla_put_failure:
7192 	genlmsg_cancel(msg, hdr);
7193 	return -EMSGSIZE;
7194 }
7195 
7196 static int nl80211_get_reg_dump(struct sk_buff *skb,
7197 				struct netlink_callback *cb)
7198 {
7199 	const struct ieee80211_regdomain *regdom = NULL;
7200 	struct cfg80211_registered_device *rdev;
7201 	int err, reg_idx, start = cb->args[2];
7202 
7203 	rtnl_lock();
7204 
7205 	if (cfg80211_regdomain && start == 0) {
7206 		err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
7207 					  NLM_F_MULTI, NULL,
7208 					  rtnl_dereference(cfg80211_regdomain));
7209 		if (err < 0)
7210 			goto out_err;
7211 	}
7212 
7213 	/* the global regdom is idx 0 */
7214 	reg_idx = 1;
7215 	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
7216 		regdom = get_wiphy_regdom(&rdev->wiphy);
7217 		if (!regdom)
7218 			continue;
7219 
7220 		if (++reg_idx <= start)
7221 			continue;
7222 
7223 		err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
7224 					  NLM_F_MULTI, &rdev->wiphy, regdom);
7225 		if (err < 0) {
7226 			reg_idx--;
7227 			break;
7228 		}
7229 	}
7230 
7231 	cb->args[2] = reg_idx;
7232 	err = skb->len;
7233 out_err:
7234 	rtnl_unlock();
7235 	return err;
7236 }
7237 
7238 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
7239 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
7240 	[NL80211_ATTR_REG_RULE_FLAGS]		= { .type = NLA_U32 },
7241 	[NL80211_ATTR_FREQ_RANGE_START]		= { .type = NLA_U32 },
7242 	[NL80211_ATTR_FREQ_RANGE_END]		= { .type = NLA_U32 },
7243 	[NL80211_ATTR_FREQ_RANGE_MAX_BW]	= { .type = NLA_U32 },
7244 	[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]	= { .type = NLA_U32 },
7245 	[NL80211_ATTR_POWER_RULE_MAX_EIRP]	= { .type = NLA_U32 },
7246 	[NL80211_ATTR_DFS_CAC_TIME]		= { .type = NLA_U32 },
7247 };
7248 
7249 static int parse_reg_rule(struct nlattr *tb[],
7250 	struct ieee80211_reg_rule *reg_rule)
7251 {
7252 	struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
7253 	struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
7254 
7255 	if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
7256 		return -EINVAL;
7257 	if (!tb[NL80211_ATTR_FREQ_RANGE_START])
7258 		return -EINVAL;
7259 	if (!tb[NL80211_ATTR_FREQ_RANGE_END])
7260 		return -EINVAL;
7261 	if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
7262 		return -EINVAL;
7263 	if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
7264 		return -EINVAL;
7265 
7266 	reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
7267 
7268 	freq_range->start_freq_khz =
7269 		nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
7270 	freq_range->end_freq_khz =
7271 		nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
7272 	freq_range->max_bandwidth_khz =
7273 		nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
7274 
7275 	power_rule->max_eirp =
7276 		nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
7277 
7278 	if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
7279 		power_rule->max_antenna_gain =
7280 			nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
7281 
7282 	if (tb[NL80211_ATTR_DFS_CAC_TIME])
7283 		reg_rule->dfs_cac_ms =
7284 			nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
7285 
7286 	return 0;
7287 }
7288 
7289 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
7290 {
7291 	struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
7292 	struct nlattr *nl_reg_rule;
7293 	char *alpha2;
7294 	int rem_reg_rules, r;
7295 	u32 num_rules = 0, rule_idx = 0;
7296 	enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
7297 	struct ieee80211_regdomain *rd;
7298 
7299 	if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
7300 		return -EINVAL;
7301 
7302 	if (!info->attrs[NL80211_ATTR_REG_RULES])
7303 		return -EINVAL;
7304 
7305 	alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
7306 
7307 	if (info->attrs[NL80211_ATTR_DFS_REGION])
7308 		dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
7309 
7310 	nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
7311 			    rem_reg_rules) {
7312 		num_rules++;
7313 		if (num_rules > NL80211_MAX_SUPP_REG_RULES)
7314 			return -EINVAL;
7315 	}
7316 
7317 	if (!reg_is_valid_request(alpha2))
7318 		return -EINVAL;
7319 
7320 	rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL);
7321 	if (!rd)
7322 		return -ENOMEM;
7323 
7324 	rd->n_reg_rules = num_rules;
7325 	rd->alpha2[0] = alpha2[0];
7326 	rd->alpha2[1] = alpha2[1];
7327 
7328 	/*
7329 	 * Disable DFS master mode if the DFS region was
7330 	 * not supported or known on this kernel.
7331 	 */
7332 	if (reg_supported_dfs_region(dfs_region))
7333 		rd->dfs_region = dfs_region;
7334 
7335 	nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
7336 			    rem_reg_rules) {
7337 		r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX,
7338 						nl_reg_rule, reg_rule_policy,
7339 						info->extack);
7340 		if (r)
7341 			goto bad_reg;
7342 		r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
7343 		if (r)
7344 			goto bad_reg;
7345 
7346 		rule_idx++;
7347 
7348 		if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
7349 			r = -EINVAL;
7350 			goto bad_reg;
7351 		}
7352 	}
7353 
7354 	/* set_regdom takes ownership of rd */
7355 	return set_regdom(rd, REGD_SOURCE_CRDA);
7356  bad_reg:
7357 	kfree(rd);
7358 	return r;
7359 }
7360 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */
7361 
7362 static int validate_scan_freqs(struct nlattr *freqs)
7363 {
7364 	struct nlattr *attr1, *attr2;
7365 	int n_channels = 0, tmp1, tmp2;
7366 
7367 	nla_for_each_nested(attr1, freqs, tmp1)
7368 		if (nla_len(attr1) != sizeof(u32))
7369 			return 0;
7370 
7371 	nla_for_each_nested(attr1, freqs, tmp1) {
7372 		n_channels++;
7373 		/*
7374 		 * Some hardware has a limited channel list for
7375 		 * scanning, and it is pretty much nonsensical
7376 		 * to scan for a channel twice, so disallow that
7377 		 * and don't require drivers to check that the
7378 		 * channel list they get isn't longer than what
7379 		 * they can scan, as long as they can scan all
7380 		 * the channels they registered at once.
7381 		 */
7382 		nla_for_each_nested(attr2, freqs, tmp2)
7383 			if (attr1 != attr2 &&
7384 			    nla_get_u32(attr1) == nla_get_u32(attr2))
7385 				return 0;
7386 	}
7387 
7388 	return n_channels;
7389 }
7390 
7391 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
7392 {
7393 	return b < NUM_NL80211_BANDS && wiphy->bands[b];
7394 }
7395 
7396 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
7397 			    struct cfg80211_bss_selection *bss_select)
7398 {
7399 	struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
7400 	struct nlattr *nest;
7401 	int err;
7402 	bool found = false;
7403 	int i;
7404 
7405 	/* only process one nested attribute */
7406 	nest = nla_data(nla);
7407 	if (!nla_ok(nest, nla_len(nest)))
7408 		return -EINVAL;
7409 
7410 	err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX,
7411 					  nest, nl80211_bss_select_policy,
7412 					  NULL);
7413 	if (err)
7414 		return err;
7415 
7416 	/* only one attribute may be given */
7417 	for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
7418 		if (attr[i]) {
7419 			if (found)
7420 				return -EINVAL;
7421 			found = true;
7422 		}
7423 	}
7424 
7425 	bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
7426 
7427 	if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
7428 		bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
7429 
7430 	if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
7431 		bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
7432 		bss_select->param.band_pref =
7433 			nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
7434 		if (!is_band_valid(wiphy, bss_select->param.band_pref))
7435 			return -EINVAL;
7436 	}
7437 
7438 	if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
7439 		struct nl80211_bss_select_rssi_adjust *adj_param;
7440 
7441 		adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
7442 		bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
7443 		bss_select->param.adjust.band = adj_param->band;
7444 		bss_select->param.adjust.delta = adj_param->delta;
7445 		if (!is_band_valid(wiphy, bss_select->param.adjust.band))
7446 			return -EINVAL;
7447 	}
7448 
7449 	/* user-space did not provide behaviour attribute */
7450 	if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
7451 		return -EINVAL;
7452 
7453 	if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
7454 		return -EINVAL;
7455 
7456 	return 0;
7457 }
7458 
7459 int nl80211_parse_random_mac(struct nlattr **attrs,
7460 			     u8 *mac_addr, u8 *mac_addr_mask)
7461 {
7462 	int i;
7463 
7464 	if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
7465 		eth_zero_addr(mac_addr);
7466 		eth_zero_addr(mac_addr_mask);
7467 		mac_addr[0] = 0x2;
7468 		mac_addr_mask[0] = 0x3;
7469 
7470 		return 0;
7471 	}
7472 
7473 	/* need both or none */
7474 	if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
7475 		return -EINVAL;
7476 
7477 	memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
7478 	memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
7479 
7480 	/* don't allow or configure an mcast address */
7481 	if (!is_multicast_ether_addr(mac_addr_mask) ||
7482 	    is_multicast_ether_addr(mac_addr))
7483 		return -EINVAL;
7484 
7485 	/*
7486 	 * allow users to pass a MAC address that has bits set outside
7487 	 * of the mask, but don't bother drivers with having to deal
7488 	 * with such bits
7489 	 */
7490 	for (i = 0; i < ETH_ALEN; i++)
7491 		mac_addr[i] &= mac_addr_mask[i];
7492 
7493 	return 0;
7494 }
7495 
7496 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev)
7497 {
7498 	ASSERT_WDEV_LOCK(wdev);
7499 
7500 	if (!cfg80211_beaconing_iface_active(wdev))
7501 		return true;
7502 
7503 	if (!(wdev->chandef.chan->flags & IEEE80211_CHAN_RADAR))
7504 		return true;
7505 
7506 	return regulatory_pre_cac_allowed(wdev->wiphy);
7507 }
7508 
7509 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag,
7510 				    enum nl80211_ext_feature_index feat)
7511 {
7512 	if (!(flags & flag))
7513 		return true;
7514 	if (wiphy_ext_feature_isset(wiphy, feat))
7515 		return true;
7516 	return false;
7517 }
7518 
7519 static int
7520 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev,
7521 			 void *request, struct nlattr **attrs,
7522 			 bool is_sched_scan)
7523 {
7524 	u8 *mac_addr, *mac_addr_mask;
7525 	u32 *flags;
7526 	enum nl80211_feature_flags randomness_flag;
7527 
7528 	if (!attrs[NL80211_ATTR_SCAN_FLAGS])
7529 		return 0;
7530 
7531 	if (is_sched_scan) {
7532 		struct cfg80211_sched_scan_request *req = request;
7533 
7534 		randomness_flag = wdev ?
7535 				  NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR :
7536 				  NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
7537 		flags = &req->flags;
7538 		mac_addr = req->mac_addr;
7539 		mac_addr_mask = req->mac_addr_mask;
7540 	} else {
7541 		struct cfg80211_scan_request *req = request;
7542 
7543 		randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
7544 		flags = &req->flags;
7545 		mac_addr = req->mac_addr;
7546 		mac_addr_mask = req->mac_addr_mask;
7547 	}
7548 
7549 	*flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]);
7550 
7551 	if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
7552 	     !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
7553 	    !nl80211_check_scan_feat(wiphy, *flags,
7554 				     NL80211_SCAN_FLAG_LOW_SPAN,
7555 				     NL80211_EXT_FEATURE_LOW_SPAN_SCAN) ||
7556 	    !nl80211_check_scan_feat(wiphy, *flags,
7557 				     NL80211_SCAN_FLAG_LOW_POWER,
7558 				     NL80211_EXT_FEATURE_LOW_POWER_SCAN) ||
7559 	    !nl80211_check_scan_feat(wiphy, *flags,
7560 				     NL80211_SCAN_FLAG_HIGH_ACCURACY,
7561 				     NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) ||
7562 	    !nl80211_check_scan_feat(wiphy, *flags,
7563 				     NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME,
7564 				     NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) ||
7565 	    !nl80211_check_scan_feat(wiphy, *flags,
7566 				     NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP,
7567 				     NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) ||
7568 	    !nl80211_check_scan_feat(wiphy, *flags,
7569 				     NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION,
7570 				     NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) ||
7571 	    !nl80211_check_scan_feat(wiphy, *flags,
7572 				     NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE,
7573 				     NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) ||
7574 	    !nl80211_check_scan_feat(wiphy, *flags,
7575 				     NL80211_SCAN_FLAG_RANDOM_SN,
7576 				     NL80211_EXT_FEATURE_SCAN_RANDOM_SN) ||
7577 	    !nl80211_check_scan_feat(wiphy, *flags,
7578 				     NL80211_SCAN_FLAG_MIN_PREQ_CONTENT,
7579 				     NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT))
7580 		return -EOPNOTSUPP;
7581 
7582 	if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
7583 		int err;
7584 
7585 		if (!(wiphy->features & randomness_flag) ||
7586 		    (wdev && wdev->current_bss))
7587 			return -EOPNOTSUPP;
7588 
7589 		err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask);
7590 		if (err)
7591 			return err;
7592 	}
7593 
7594 	return 0;
7595 }
7596 
7597 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
7598 {
7599 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
7600 	struct wireless_dev *wdev = info->user_ptr[1];
7601 	struct cfg80211_scan_request *request;
7602 	struct nlattr *attr;
7603 	struct wiphy *wiphy;
7604 	int err, tmp, n_ssids = 0, n_channels, i;
7605 	size_t ie_len;
7606 
7607 	wiphy = &rdev->wiphy;
7608 
7609 	if (wdev->iftype == NL80211_IFTYPE_NAN)
7610 		return -EOPNOTSUPP;
7611 
7612 	if (!rdev->ops->scan)
7613 		return -EOPNOTSUPP;
7614 
7615 	if (rdev->scan_req || rdev->scan_msg) {
7616 		err = -EBUSY;
7617 		goto unlock;
7618 	}
7619 
7620 	if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7621 		n_channels = validate_scan_freqs(
7622 				info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
7623 		if (!n_channels) {
7624 			err = -EINVAL;
7625 			goto unlock;
7626 		}
7627 	} else {
7628 		n_channels = ieee80211_get_num_supported_channels(wiphy);
7629 	}
7630 
7631 	if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
7632 		nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
7633 			n_ssids++;
7634 
7635 	if (n_ssids > wiphy->max_scan_ssids) {
7636 		err = -EINVAL;
7637 		goto unlock;
7638 	}
7639 
7640 	if (info->attrs[NL80211_ATTR_IE])
7641 		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
7642 	else
7643 		ie_len = 0;
7644 
7645 	if (ie_len > wiphy->max_scan_ie_len) {
7646 		err = -EINVAL;
7647 		goto unlock;
7648 	}
7649 
7650 	request = kzalloc(sizeof(*request)
7651 			+ sizeof(*request->ssids) * n_ssids
7652 			+ sizeof(*request->channels) * n_channels
7653 			+ ie_len, GFP_KERNEL);
7654 	if (!request) {
7655 		err = -ENOMEM;
7656 		goto unlock;
7657 	}
7658 
7659 	if (n_ssids)
7660 		request->ssids = (void *)&request->channels[n_channels];
7661 	request->n_ssids = n_ssids;
7662 	if (ie_len) {
7663 		if (n_ssids)
7664 			request->ie = (void *)(request->ssids + n_ssids);
7665 		else
7666 			request->ie = (void *)(request->channels + n_channels);
7667 	}
7668 
7669 	i = 0;
7670 	if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7671 		/* user specified, bail out if channel not found */
7672 		nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
7673 			struct ieee80211_channel *chan;
7674 
7675 			chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
7676 
7677 			if (!chan) {
7678 				err = -EINVAL;
7679 				goto out_free;
7680 			}
7681 
7682 			/* ignore disabled channels */
7683 			if (chan->flags & IEEE80211_CHAN_DISABLED)
7684 				continue;
7685 
7686 			request->channels[i] = chan;
7687 			i++;
7688 		}
7689 	} else {
7690 		enum nl80211_band band;
7691 
7692 		/* all channels */
7693 		for (band = 0; band < NUM_NL80211_BANDS; band++) {
7694 			int j;
7695 
7696 			if (!wiphy->bands[band])
7697 				continue;
7698 			for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
7699 				struct ieee80211_channel *chan;
7700 
7701 				chan = &wiphy->bands[band]->channels[j];
7702 
7703 				if (chan->flags & IEEE80211_CHAN_DISABLED)
7704 					continue;
7705 
7706 				request->channels[i] = chan;
7707 				i++;
7708 			}
7709 		}
7710 	}
7711 
7712 	if (!i) {
7713 		err = -EINVAL;
7714 		goto out_free;
7715 	}
7716 
7717 	request->n_channels = i;
7718 
7719 	wdev_lock(wdev);
7720 	if (!cfg80211_off_channel_oper_allowed(wdev)) {
7721 		struct ieee80211_channel *chan;
7722 
7723 		if (request->n_channels != 1) {
7724 			wdev_unlock(wdev);
7725 			err = -EBUSY;
7726 			goto out_free;
7727 		}
7728 
7729 		chan = request->channels[0];
7730 		if (chan->center_freq != wdev->chandef.chan->center_freq) {
7731 			wdev_unlock(wdev);
7732 			err = -EBUSY;
7733 			goto out_free;
7734 		}
7735 	}
7736 	wdev_unlock(wdev);
7737 
7738 	i = 0;
7739 	if (n_ssids) {
7740 		nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
7741 			if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
7742 				err = -EINVAL;
7743 				goto out_free;
7744 			}
7745 			request->ssids[i].ssid_len = nla_len(attr);
7746 			memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
7747 			i++;
7748 		}
7749 	}
7750 
7751 	if (info->attrs[NL80211_ATTR_IE]) {
7752 		request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
7753 		memcpy((void *)request->ie,
7754 		       nla_data(info->attrs[NL80211_ATTR_IE]),
7755 		       request->ie_len);
7756 	}
7757 
7758 	for (i = 0; i < NUM_NL80211_BANDS; i++)
7759 		if (wiphy->bands[i])
7760 			request->rates[i] =
7761 				(1 << wiphy->bands[i]->n_bitrates) - 1;
7762 
7763 	if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
7764 		nla_for_each_nested(attr,
7765 				    info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
7766 				    tmp) {
7767 			enum nl80211_band band = nla_type(attr);
7768 
7769 			if (band < 0 || band >= NUM_NL80211_BANDS) {
7770 				err = -EINVAL;
7771 				goto out_free;
7772 			}
7773 
7774 			if (!wiphy->bands[band])
7775 				continue;
7776 
7777 			err = ieee80211_get_ratemask(wiphy->bands[band],
7778 						     nla_data(attr),
7779 						     nla_len(attr),
7780 						     &request->rates[band]);
7781 			if (err)
7782 				goto out_free;
7783 		}
7784 	}
7785 
7786 	if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
7787 		if (!wiphy_ext_feature_isset(wiphy,
7788 					NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
7789 			err = -EOPNOTSUPP;
7790 			goto out_free;
7791 		}
7792 
7793 		request->duration =
7794 			nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
7795 		request->duration_mandatory =
7796 			nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
7797 	}
7798 
7799 	err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs,
7800 				       false);
7801 	if (err)
7802 		goto out_free;
7803 
7804 	request->no_cck =
7805 		nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
7806 
7807 	/* Initial implementation used NL80211_ATTR_MAC to set the specific
7808 	 * BSSID to scan for. This was problematic because that same attribute
7809 	 * was already used for another purpose (local random MAC address). The
7810 	 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
7811 	 * compatibility with older userspace components, also use the
7812 	 * NL80211_ATTR_MAC value here if it can be determined to be used for
7813 	 * the specific BSSID use case instead of the random MAC address
7814 	 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
7815 	 */
7816 	if (info->attrs[NL80211_ATTR_BSSID])
7817 		memcpy(request->bssid,
7818 		       nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
7819 	else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
7820 		 info->attrs[NL80211_ATTR_MAC])
7821 		memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
7822 		       ETH_ALEN);
7823 	else
7824 		eth_broadcast_addr(request->bssid);
7825 
7826 	request->wdev = wdev;
7827 	request->wiphy = &rdev->wiphy;
7828 	request->scan_start = jiffies;
7829 
7830 	rdev->scan_req = request;
7831 	err = rdev_scan(rdev, request);
7832 
7833 	if (!err) {
7834 		nl80211_send_scan_start(rdev, wdev);
7835 		if (wdev->netdev)
7836 			dev_hold(wdev->netdev);
7837 	} else {
7838  out_free:
7839 		rdev->scan_req = NULL;
7840 		kfree(request);
7841 	}
7842 
7843  unlock:
7844 	return err;
7845 }
7846 
7847 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
7848 {
7849 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
7850 	struct wireless_dev *wdev = info->user_ptr[1];
7851 
7852 	if (!rdev->ops->abort_scan)
7853 		return -EOPNOTSUPP;
7854 
7855 	if (rdev->scan_msg)
7856 		return 0;
7857 
7858 	if (!rdev->scan_req)
7859 		return -ENOENT;
7860 
7861 	rdev_abort_scan(rdev, wdev);
7862 	return 0;
7863 }
7864 
7865 static int
7866 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
7867 			       struct cfg80211_sched_scan_request *request,
7868 			       struct nlattr **attrs)
7869 {
7870 	int tmp, err, i = 0;
7871 	struct nlattr *attr;
7872 
7873 	if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7874 		u32 interval;
7875 
7876 		/*
7877 		 * If scan plans are not specified,
7878 		 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
7879 		 * case one scan plan will be set with the specified scan
7880 		 * interval and infinite number of iterations.
7881 		 */
7882 		interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
7883 		if (!interval)
7884 			return -EINVAL;
7885 
7886 		request->scan_plans[0].interval =
7887 			DIV_ROUND_UP(interval, MSEC_PER_SEC);
7888 		if (!request->scan_plans[0].interval)
7889 			return -EINVAL;
7890 
7891 		if (request->scan_plans[0].interval >
7892 		    wiphy->max_sched_scan_plan_interval)
7893 			request->scan_plans[0].interval =
7894 				wiphy->max_sched_scan_plan_interval;
7895 
7896 		return 0;
7897 	}
7898 
7899 	nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
7900 		struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
7901 
7902 		if (WARN_ON(i >= n_plans))
7903 			return -EINVAL;
7904 
7905 		err = nla_parse_nested_deprecated(plan,
7906 						  NL80211_SCHED_SCAN_PLAN_MAX,
7907 						  attr, nl80211_plan_policy,
7908 						  NULL);
7909 		if (err)
7910 			return err;
7911 
7912 		if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
7913 			return -EINVAL;
7914 
7915 		request->scan_plans[i].interval =
7916 			nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
7917 		if (!request->scan_plans[i].interval ||
7918 		    request->scan_plans[i].interval >
7919 		    wiphy->max_sched_scan_plan_interval)
7920 			return -EINVAL;
7921 
7922 		if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
7923 			request->scan_plans[i].iterations =
7924 				nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
7925 			if (!request->scan_plans[i].iterations ||
7926 			    (request->scan_plans[i].iterations >
7927 			     wiphy->max_sched_scan_plan_iterations))
7928 				return -EINVAL;
7929 		} else if (i < n_plans - 1) {
7930 			/*
7931 			 * All scan plans but the last one must specify
7932 			 * a finite number of iterations
7933 			 */
7934 			return -EINVAL;
7935 		}
7936 
7937 		i++;
7938 	}
7939 
7940 	/*
7941 	 * The last scan plan must not specify the number of
7942 	 * iterations, it is supposed to run infinitely
7943 	 */
7944 	if (request->scan_plans[n_plans - 1].iterations)
7945 		return  -EINVAL;
7946 
7947 	return 0;
7948 }
7949 
7950 static int
7951 nl80211_parse_sched_scan_per_band_rssi(struct wiphy *wiphy,
7952 				       struct cfg80211_match_set *match_sets,
7953 				       struct nlattr *tb_band_rssi,
7954 				       s32 rssi_thold)
7955 {
7956 	struct nlattr *attr;
7957 	int i, tmp, ret = 0;
7958 
7959 	if (!wiphy_ext_feature_isset(wiphy,
7960 		    NL80211_EXT_FEATURE_SCHED_SCAN_BAND_SPECIFIC_RSSI_THOLD)) {
7961 		if (tb_band_rssi)
7962 			ret = -EOPNOTSUPP;
7963 		else
7964 			for (i = 0; i < NUM_NL80211_BANDS; i++)
7965 				match_sets->per_band_rssi_thold[i] =
7966 					NL80211_SCAN_RSSI_THOLD_OFF;
7967 		return ret;
7968 	}
7969 
7970 	for (i = 0; i < NUM_NL80211_BANDS; i++)
7971 		match_sets->per_band_rssi_thold[i] = rssi_thold;
7972 
7973 	nla_for_each_nested(attr, tb_band_rssi, tmp) {
7974 		enum nl80211_band band = nla_type(attr);
7975 
7976 		if (band < 0 || band >= NUM_NL80211_BANDS)
7977 			return -EINVAL;
7978 
7979 		match_sets->per_band_rssi_thold[band] =	nla_get_s32(attr);
7980 	}
7981 
7982 	return 0;
7983 }
7984 
7985 static struct cfg80211_sched_scan_request *
7986 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
7987 			 struct nlattr **attrs, int max_match_sets)
7988 {
7989 	struct cfg80211_sched_scan_request *request;
7990 	struct nlattr *attr;
7991 	int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
7992 	enum nl80211_band band;
7993 	size_t ie_len;
7994 	struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
7995 	s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
7996 
7997 	if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7998 		n_channels = validate_scan_freqs(
7999 				attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
8000 		if (!n_channels)
8001 			return ERR_PTR(-EINVAL);
8002 	} else {
8003 		n_channels = ieee80211_get_num_supported_channels(wiphy);
8004 	}
8005 
8006 	if (attrs[NL80211_ATTR_SCAN_SSIDS])
8007 		nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
8008 				    tmp)
8009 			n_ssids++;
8010 
8011 	if (n_ssids > wiphy->max_sched_scan_ssids)
8012 		return ERR_PTR(-EINVAL);
8013 
8014 	/*
8015 	 * First, count the number of 'real' matchsets. Due to an issue with
8016 	 * the old implementation, matchsets containing only the RSSI attribute
8017 	 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
8018 	 * RSSI for all matchsets, rather than their own matchset for reporting
8019 	 * all APs with a strong RSSI. This is needed to be compatible with
8020 	 * older userspace that treated a matchset with only the RSSI as the
8021 	 * global RSSI for all other matchsets - if there are other matchsets.
8022 	 */
8023 	if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
8024 		nla_for_each_nested(attr,
8025 				    attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
8026 				    tmp) {
8027 			struct nlattr *rssi;
8028 
8029 			err = nla_parse_nested_deprecated(tb,
8030 							  NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
8031 							  attr,
8032 							  nl80211_match_policy,
8033 							  NULL);
8034 			if (err)
8035 				return ERR_PTR(err);
8036 
8037 			/* SSID and BSSID are mutually exclusive */
8038 			if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] &&
8039 			    tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID])
8040 				return ERR_PTR(-EINVAL);
8041 
8042 			/* add other standalone attributes here */
8043 			if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] ||
8044 			    tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) {
8045 				n_match_sets++;
8046 				continue;
8047 			}
8048 			rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
8049 			if (rssi)
8050 				default_match_rssi = nla_get_s32(rssi);
8051 		}
8052 	}
8053 
8054 	/* However, if there's no other matchset, add the RSSI one */
8055 	if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
8056 		n_match_sets = 1;
8057 
8058 	if (n_match_sets > max_match_sets)
8059 		return ERR_PTR(-EINVAL);
8060 
8061 	if (attrs[NL80211_ATTR_IE])
8062 		ie_len = nla_len(attrs[NL80211_ATTR_IE]);
8063 	else
8064 		ie_len = 0;
8065 
8066 	if (ie_len > wiphy->max_sched_scan_ie_len)
8067 		return ERR_PTR(-EINVAL);
8068 
8069 	if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
8070 		/*
8071 		 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
8072 		 * each scan plan already specifies its own interval
8073 		 */
8074 		if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
8075 			return ERR_PTR(-EINVAL);
8076 
8077 		nla_for_each_nested(attr,
8078 				    attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
8079 			n_plans++;
8080 	} else {
8081 		/*
8082 		 * The scan interval attribute is kept for backward
8083 		 * compatibility. If no scan plans are specified and sched scan
8084 		 * interval is specified, one scan plan will be set with this
8085 		 * scan interval and infinite number of iterations.
8086 		 */
8087 		if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
8088 			return ERR_PTR(-EINVAL);
8089 
8090 		n_plans = 1;
8091 	}
8092 
8093 	if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
8094 		return ERR_PTR(-EINVAL);
8095 
8096 	if (!wiphy_ext_feature_isset(
8097 		    wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
8098 	    (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
8099 	     attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
8100 		return ERR_PTR(-EINVAL);
8101 
8102 	request = kzalloc(sizeof(*request)
8103 			+ sizeof(*request->ssids) * n_ssids
8104 			+ sizeof(*request->match_sets) * n_match_sets
8105 			+ sizeof(*request->scan_plans) * n_plans
8106 			+ sizeof(*request->channels) * n_channels
8107 			+ ie_len, GFP_KERNEL);
8108 	if (!request)
8109 		return ERR_PTR(-ENOMEM);
8110 
8111 	if (n_ssids)
8112 		request->ssids = (void *)&request->channels[n_channels];
8113 	request->n_ssids = n_ssids;
8114 	if (ie_len) {
8115 		if (n_ssids)
8116 			request->ie = (void *)(request->ssids + n_ssids);
8117 		else
8118 			request->ie = (void *)(request->channels + n_channels);
8119 	}
8120 
8121 	if (n_match_sets) {
8122 		if (request->ie)
8123 			request->match_sets = (void *)(request->ie + ie_len);
8124 		else if (n_ssids)
8125 			request->match_sets =
8126 				(void *)(request->ssids + n_ssids);
8127 		else
8128 			request->match_sets =
8129 				(void *)(request->channels + n_channels);
8130 	}
8131 	request->n_match_sets = n_match_sets;
8132 
8133 	if (n_match_sets)
8134 		request->scan_plans = (void *)(request->match_sets +
8135 					       n_match_sets);
8136 	else if (request->ie)
8137 		request->scan_plans = (void *)(request->ie + ie_len);
8138 	else if (n_ssids)
8139 		request->scan_plans = (void *)(request->ssids + n_ssids);
8140 	else
8141 		request->scan_plans = (void *)(request->channels + n_channels);
8142 
8143 	request->n_scan_plans = n_plans;
8144 
8145 	i = 0;
8146 	if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
8147 		/* user specified, bail out if channel not found */
8148 		nla_for_each_nested(attr,
8149 				    attrs[NL80211_ATTR_SCAN_FREQUENCIES],
8150 				    tmp) {
8151 			struct ieee80211_channel *chan;
8152 
8153 			chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
8154 
8155 			if (!chan) {
8156 				err = -EINVAL;
8157 				goto out_free;
8158 			}
8159 
8160 			/* ignore disabled channels */
8161 			if (chan->flags & IEEE80211_CHAN_DISABLED)
8162 				continue;
8163 
8164 			request->channels[i] = chan;
8165 			i++;
8166 		}
8167 	} else {
8168 		/* all channels */
8169 		for (band = 0; band < NUM_NL80211_BANDS; band++) {
8170 			int j;
8171 
8172 			if (!wiphy->bands[band])
8173 				continue;
8174 			for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
8175 				struct ieee80211_channel *chan;
8176 
8177 				chan = &wiphy->bands[band]->channels[j];
8178 
8179 				if (chan->flags & IEEE80211_CHAN_DISABLED)
8180 					continue;
8181 
8182 				request->channels[i] = chan;
8183 				i++;
8184 			}
8185 		}
8186 	}
8187 
8188 	if (!i) {
8189 		err = -EINVAL;
8190 		goto out_free;
8191 	}
8192 
8193 	request->n_channels = i;
8194 
8195 	i = 0;
8196 	if (n_ssids) {
8197 		nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
8198 				    tmp) {
8199 			if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
8200 				err = -EINVAL;
8201 				goto out_free;
8202 			}
8203 			request->ssids[i].ssid_len = nla_len(attr);
8204 			memcpy(request->ssids[i].ssid, nla_data(attr),
8205 			       nla_len(attr));
8206 			i++;
8207 		}
8208 	}
8209 
8210 	i = 0;
8211 	if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
8212 		nla_for_each_nested(attr,
8213 				    attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
8214 				    tmp) {
8215 			struct nlattr *ssid, *bssid, *rssi;
8216 
8217 			err = nla_parse_nested_deprecated(tb,
8218 							  NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
8219 							  attr,
8220 							  nl80211_match_policy,
8221 							  NULL);
8222 			if (err)
8223 				goto out_free;
8224 			ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
8225 			bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID];
8226 
8227 			if (!ssid && !bssid) {
8228 				i++;
8229 				continue;
8230 			}
8231 
8232 			if (WARN_ON(i >= n_match_sets)) {
8233 				/* this indicates a programming error,
8234 				 * the loop above should have verified
8235 				 * things properly
8236 				 */
8237 				err = -EINVAL;
8238 				goto out_free;
8239 			}
8240 
8241 			if (ssid) {
8242 				if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
8243 					err = -EINVAL;
8244 					goto out_free;
8245 				}
8246 				memcpy(request->match_sets[i].ssid.ssid,
8247 				       nla_data(ssid), nla_len(ssid));
8248 				request->match_sets[i].ssid.ssid_len =
8249 					nla_len(ssid);
8250 			}
8251 			if (bssid) {
8252 				if (nla_len(bssid) != ETH_ALEN) {
8253 					err = -EINVAL;
8254 					goto out_free;
8255 				}
8256 				memcpy(request->match_sets[i].bssid,
8257 				       nla_data(bssid), ETH_ALEN);
8258 			}
8259 
8260 			/* special attribute - old implementation w/a */
8261 			request->match_sets[i].rssi_thold = default_match_rssi;
8262 			rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
8263 			if (rssi)
8264 				request->match_sets[i].rssi_thold =
8265 					nla_get_s32(rssi);
8266 
8267 			/* Parse per band RSSI attribute */
8268 			err = nl80211_parse_sched_scan_per_band_rssi(wiphy,
8269 				&request->match_sets[i],
8270 				tb[NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI],
8271 				request->match_sets[i].rssi_thold);
8272 			if (err)
8273 				goto out_free;
8274 
8275 			i++;
8276 		}
8277 
8278 		/* there was no other matchset, so the RSSI one is alone */
8279 		if (i == 0 && n_match_sets)
8280 			request->match_sets[0].rssi_thold = default_match_rssi;
8281 
8282 		request->min_rssi_thold = INT_MAX;
8283 		for (i = 0; i < n_match_sets; i++)
8284 			request->min_rssi_thold =
8285 				min(request->match_sets[i].rssi_thold,
8286 				    request->min_rssi_thold);
8287 	} else {
8288 		request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
8289 	}
8290 
8291 	if (ie_len) {
8292 		request->ie_len = ie_len;
8293 		memcpy((void *)request->ie,
8294 		       nla_data(attrs[NL80211_ATTR_IE]),
8295 		       request->ie_len);
8296 	}
8297 
8298 	err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true);
8299 	if (err)
8300 		goto out_free;
8301 
8302 	if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
8303 		request->delay =
8304 			nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
8305 
8306 	if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
8307 		request->relative_rssi = nla_get_s8(
8308 			attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
8309 		request->relative_rssi_set = true;
8310 	}
8311 
8312 	if (request->relative_rssi_set &&
8313 	    attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
8314 		struct nl80211_bss_select_rssi_adjust *rssi_adjust;
8315 
8316 		rssi_adjust = nla_data(
8317 			attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
8318 		request->rssi_adjust.band = rssi_adjust->band;
8319 		request->rssi_adjust.delta = rssi_adjust->delta;
8320 		if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
8321 			err = -EINVAL;
8322 			goto out_free;
8323 		}
8324 	}
8325 
8326 	err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
8327 	if (err)
8328 		goto out_free;
8329 
8330 	request->scan_start = jiffies;
8331 
8332 	return request;
8333 
8334 out_free:
8335 	kfree(request);
8336 	return ERR_PTR(err);
8337 }
8338 
8339 static int nl80211_start_sched_scan(struct sk_buff *skb,
8340 				    struct genl_info *info)
8341 {
8342 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8343 	struct net_device *dev = info->user_ptr[1];
8344 	struct wireless_dev *wdev = dev->ieee80211_ptr;
8345 	struct cfg80211_sched_scan_request *sched_scan_req;
8346 	bool want_multi;
8347 	int err;
8348 
8349 	if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
8350 		return -EOPNOTSUPP;
8351 
8352 	want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
8353 	err = cfg80211_sched_scan_req_possible(rdev, want_multi);
8354 	if (err)
8355 		return err;
8356 
8357 	sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
8358 						  info->attrs,
8359 						  rdev->wiphy.max_match_sets);
8360 
8361 	err = PTR_ERR_OR_ZERO(sched_scan_req);
8362 	if (err)
8363 		goto out_err;
8364 
8365 	/* leave request id zero for legacy request
8366 	 * or if driver does not support multi-scheduled scan
8367 	 */
8368 	if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1)
8369 		sched_scan_req->reqid = cfg80211_assign_cookie(rdev);
8370 
8371 	err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
8372 	if (err)
8373 		goto out_free;
8374 
8375 	sched_scan_req->dev = dev;
8376 	sched_scan_req->wiphy = &rdev->wiphy;
8377 
8378 	if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
8379 		sched_scan_req->owner_nlportid = info->snd_portid;
8380 
8381 	cfg80211_add_sched_scan_req(rdev, sched_scan_req);
8382 
8383 	nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
8384 	return 0;
8385 
8386 out_free:
8387 	kfree(sched_scan_req);
8388 out_err:
8389 	return err;
8390 }
8391 
8392 static int nl80211_stop_sched_scan(struct sk_buff *skb,
8393 				   struct genl_info *info)
8394 {
8395 	struct cfg80211_sched_scan_request *req;
8396 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8397 	u64 cookie;
8398 
8399 	if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
8400 		return -EOPNOTSUPP;
8401 
8402 	if (info->attrs[NL80211_ATTR_COOKIE]) {
8403 		cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
8404 		return __cfg80211_stop_sched_scan(rdev, cookie, false);
8405 	}
8406 
8407 	req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
8408 				     struct cfg80211_sched_scan_request,
8409 				     list);
8410 	if (!req || req->reqid ||
8411 	    (req->owner_nlportid &&
8412 	     req->owner_nlportid != info->snd_portid))
8413 		return -ENOENT;
8414 
8415 	return cfg80211_stop_sched_scan_req(rdev, req, false);
8416 }
8417 
8418 static int nl80211_start_radar_detection(struct sk_buff *skb,
8419 					 struct genl_info *info)
8420 {
8421 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8422 	struct net_device *dev = info->user_ptr[1];
8423 	struct wireless_dev *wdev = dev->ieee80211_ptr;
8424 	struct wiphy *wiphy = wdev->wiphy;
8425 	struct cfg80211_chan_def chandef;
8426 	enum nl80211_dfs_regions dfs_region;
8427 	unsigned int cac_time_ms;
8428 	int err;
8429 
8430 	dfs_region = reg_get_dfs_region(wiphy);
8431 	if (dfs_region == NL80211_DFS_UNSET)
8432 		return -EINVAL;
8433 
8434 	err = nl80211_parse_chandef(rdev, info, &chandef);
8435 	if (err)
8436 		return err;
8437 
8438 	if (netif_carrier_ok(dev))
8439 		return -EBUSY;
8440 
8441 	if (wdev->cac_started)
8442 		return -EBUSY;
8443 
8444 	err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
8445 	if (err < 0)
8446 		return err;
8447 
8448 	if (err == 0)
8449 		return -EINVAL;
8450 
8451 	if (!cfg80211_chandef_dfs_usable(wiphy, &chandef))
8452 		return -EINVAL;
8453 
8454 	/* CAC start is offloaded to HW and can't be started manually */
8455 	if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD))
8456 		return -EOPNOTSUPP;
8457 
8458 	if (!rdev->ops->start_radar_detection)
8459 		return -EOPNOTSUPP;
8460 
8461 	cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
8462 	if (WARN_ON(!cac_time_ms))
8463 		cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
8464 
8465 	err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
8466 	if (!err) {
8467 		wdev->chandef = chandef;
8468 		wdev->cac_started = true;
8469 		wdev->cac_start_time = jiffies;
8470 		wdev->cac_time_ms = cac_time_ms;
8471 	}
8472 	return err;
8473 }
8474 
8475 static int nl80211_notify_radar_detection(struct sk_buff *skb,
8476 					  struct genl_info *info)
8477 {
8478 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8479 	struct net_device *dev = info->user_ptr[1];
8480 	struct wireless_dev *wdev = dev->ieee80211_ptr;
8481 	struct wiphy *wiphy = wdev->wiphy;
8482 	struct cfg80211_chan_def chandef;
8483 	enum nl80211_dfs_regions dfs_region;
8484 	int err;
8485 
8486 	dfs_region = reg_get_dfs_region(wiphy);
8487 	if (dfs_region == NL80211_DFS_UNSET) {
8488 		GENL_SET_ERR_MSG(info,
8489 				 "DFS Region is not set. Unexpected Radar indication");
8490 		return -EINVAL;
8491 	}
8492 
8493 	err = nl80211_parse_chandef(rdev, info, &chandef);
8494 	if (err) {
8495 		GENL_SET_ERR_MSG(info, "Unable to extract chandef info");
8496 		return err;
8497 	}
8498 
8499 	err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
8500 	if (err < 0) {
8501 		GENL_SET_ERR_MSG(info, "chandef is invalid");
8502 		return err;
8503 	}
8504 
8505 	if (err == 0) {
8506 		GENL_SET_ERR_MSG(info,
8507 				 "Unexpected Radar indication for chandef/iftype");
8508 		return -EINVAL;
8509 	}
8510 
8511 	/* Do not process this notification if radar is already detected
8512 	 * by kernel on this channel, and return success.
8513 	 */
8514 	if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE)
8515 		return 0;
8516 
8517 	cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE);
8518 
8519 	cfg80211_sched_dfs_chan_update(rdev);
8520 
8521 	rdev->radar_chandef = chandef;
8522 
8523 	/* Propagate this notification to other radios as well */
8524 	queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk);
8525 
8526 	return 0;
8527 }
8528 
8529 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
8530 {
8531 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8532 	struct net_device *dev = info->user_ptr[1];
8533 	struct wireless_dev *wdev = dev->ieee80211_ptr;
8534 	struct cfg80211_csa_settings params;
8535 	/* csa_attrs is defined static to avoid waste of stack size - this
8536 	 * function is called under RTNL lock, so this should not be a problem.
8537 	 */
8538 	static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
8539 	int err;
8540 	bool need_new_beacon = false;
8541 	bool need_handle_dfs_flag = true;
8542 	int len, i;
8543 	u32 cs_count;
8544 
8545 	if (!rdev->ops->channel_switch ||
8546 	    !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
8547 		return -EOPNOTSUPP;
8548 
8549 	switch (dev->ieee80211_ptr->iftype) {
8550 	case NL80211_IFTYPE_AP:
8551 	case NL80211_IFTYPE_P2P_GO:
8552 		need_new_beacon = true;
8553 		/* For all modes except AP the handle_dfs flag needs to be
8554 		 * supplied to tell the kernel that userspace will handle radar
8555 		 * events when they happen. Otherwise a switch to a channel
8556 		 * requiring DFS will be rejected.
8557 		 */
8558 		need_handle_dfs_flag = false;
8559 
8560 		/* useless if AP is not running */
8561 		if (!wdev->beacon_interval)
8562 			return -ENOTCONN;
8563 		break;
8564 	case NL80211_IFTYPE_ADHOC:
8565 		if (!wdev->ssid_len)
8566 			return -ENOTCONN;
8567 		break;
8568 	case NL80211_IFTYPE_MESH_POINT:
8569 		if (!wdev->mesh_id_len)
8570 			return -ENOTCONN;
8571 		break;
8572 	default:
8573 		return -EOPNOTSUPP;
8574 	}
8575 
8576 	memset(&params, 0, sizeof(params));
8577 	params.beacon_csa.ftm_responder = -1;
8578 
8579 	if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
8580 	    !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
8581 		return -EINVAL;
8582 
8583 	/* only important for AP, IBSS and mesh create IEs internally */
8584 	if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
8585 		return -EINVAL;
8586 
8587 	/* Even though the attribute is u32, the specification says
8588 	 * u8, so let's make sure we don't overflow.
8589 	 */
8590 	cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
8591 	if (cs_count > 255)
8592 		return -EINVAL;
8593 
8594 	params.count = cs_count;
8595 
8596 	if (!need_new_beacon)
8597 		goto skip_beacons;
8598 
8599 	err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon_after);
8600 	if (err)
8601 		return err;
8602 
8603 	err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX,
8604 					  info->attrs[NL80211_ATTR_CSA_IES],
8605 					  nl80211_policy, info->extack);
8606 	if (err)
8607 		return err;
8608 
8609 	err = nl80211_parse_beacon(rdev, csa_attrs, &params.beacon_csa);
8610 	if (err)
8611 		return err;
8612 
8613 	if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
8614 		return -EINVAL;
8615 
8616 	len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
8617 	if (!len || (len % sizeof(u16)))
8618 		return -EINVAL;
8619 
8620 	params.n_counter_offsets_beacon = len / sizeof(u16);
8621 	if (rdev->wiphy.max_num_csa_counters &&
8622 	    (params.n_counter_offsets_beacon >
8623 	     rdev->wiphy.max_num_csa_counters))
8624 		return -EINVAL;
8625 
8626 	params.counter_offsets_beacon =
8627 		nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
8628 
8629 	/* sanity checks - counters should fit and be the same */
8630 	for (i = 0; i < params.n_counter_offsets_beacon; i++) {
8631 		u16 offset = params.counter_offsets_beacon[i];
8632 
8633 		if (offset >= params.beacon_csa.tail_len)
8634 			return -EINVAL;
8635 
8636 		if (params.beacon_csa.tail[offset] != params.count)
8637 			return -EINVAL;
8638 	}
8639 
8640 	if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
8641 		len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
8642 		if (!len || (len % sizeof(u16)))
8643 			return -EINVAL;
8644 
8645 		params.n_counter_offsets_presp = len / sizeof(u16);
8646 		if (rdev->wiphy.max_num_csa_counters &&
8647 		    (params.n_counter_offsets_presp >
8648 		     rdev->wiphy.max_num_csa_counters))
8649 			return -EINVAL;
8650 
8651 		params.counter_offsets_presp =
8652 			nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
8653 
8654 		/* sanity checks - counters should fit and be the same */
8655 		for (i = 0; i < params.n_counter_offsets_presp; i++) {
8656 			u16 offset = params.counter_offsets_presp[i];
8657 
8658 			if (offset >= params.beacon_csa.probe_resp_len)
8659 				return -EINVAL;
8660 
8661 			if (params.beacon_csa.probe_resp[offset] !=
8662 			    params.count)
8663 				return -EINVAL;
8664 		}
8665 	}
8666 
8667 skip_beacons:
8668 	err = nl80211_parse_chandef(rdev, info, &params.chandef);
8669 	if (err)
8670 		return err;
8671 
8672 	if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
8673 					   wdev->iftype))
8674 		return -EINVAL;
8675 
8676 	err = cfg80211_chandef_dfs_required(wdev->wiphy,
8677 					    &params.chandef,
8678 					    wdev->iftype);
8679 	if (err < 0)
8680 		return err;
8681 
8682 	if (err > 0) {
8683 		params.radar_required = true;
8684 		if (need_handle_dfs_flag &&
8685 		    !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) {
8686 			return -EINVAL;
8687 		}
8688 	}
8689 
8690 	if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
8691 		params.block_tx = true;
8692 
8693 	wdev_lock(wdev);
8694 	err = rdev_channel_switch(rdev, dev, &params);
8695 	wdev_unlock(wdev);
8696 
8697 	return err;
8698 }
8699 
8700 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
8701 			    u32 seq, int flags,
8702 			    struct cfg80211_registered_device *rdev,
8703 			    struct wireless_dev *wdev,
8704 			    struct cfg80211_internal_bss *intbss)
8705 {
8706 	struct cfg80211_bss *res = &intbss->pub;
8707 	const struct cfg80211_bss_ies *ies;
8708 	void *hdr;
8709 	struct nlattr *bss;
8710 
8711 	ASSERT_WDEV_LOCK(wdev);
8712 
8713 	hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
8714 			     NL80211_CMD_NEW_SCAN_RESULTS);
8715 	if (!hdr)
8716 		return -1;
8717 
8718 	genl_dump_check_consistent(cb, hdr);
8719 
8720 	if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
8721 		goto nla_put_failure;
8722 	if (wdev->netdev &&
8723 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
8724 		goto nla_put_failure;
8725 	if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
8726 			      NL80211_ATTR_PAD))
8727 		goto nla_put_failure;
8728 
8729 	bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS);
8730 	if (!bss)
8731 		goto nla_put_failure;
8732 	if ((!is_zero_ether_addr(res->bssid) &&
8733 	     nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
8734 		goto nla_put_failure;
8735 
8736 	rcu_read_lock();
8737 	/* indicate whether we have probe response data or not */
8738 	if (rcu_access_pointer(res->proberesp_ies) &&
8739 	    nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
8740 		goto fail_unlock_rcu;
8741 
8742 	/* this pointer prefers to be pointed to probe response data
8743 	 * but is always valid
8744 	 */
8745 	ies = rcu_dereference(res->ies);
8746 	if (ies) {
8747 		if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
8748 				      NL80211_BSS_PAD))
8749 			goto fail_unlock_rcu;
8750 		if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
8751 					ies->len, ies->data))
8752 			goto fail_unlock_rcu;
8753 	}
8754 
8755 	/* and this pointer is always (unless driver didn't know) beacon data */
8756 	ies = rcu_dereference(res->beacon_ies);
8757 	if (ies && ies->from_beacon) {
8758 		if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
8759 				      NL80211_BSS_PAD))
8760 			goto fail_unlock_rcu;
8761 		if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
8762 					ies->len, ies->data))
8763 			goto fail_unlock_rcu;
8764 	}
8765 	rcu_read_unlock();
8766 
8767 	if (res->beacon_interval &&
8768 	    nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
8769 		goto nla_put_failure;
8770 	if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
8771 	    nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
8772 	    nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
8773 	    nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
8774 			jiffies_to_msecs(jiffies - intbss->ts)))
8775 		goto nla_put_failure;
8776 
8777 	if (intbss->parent_tsf &&
8778 	    (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
8779 			       intbss->parent_tsf, NL80211_BSS_PAD) ||
8780 	     nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
8781 		     intbss->parent_bssid)))
8782 		goto nla_put_failure;
8783 
8784 	if (intbss->ts_boottime &&
8785 	    nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
8786 			      intbss->ts_boottime, NL80211_BSS_PAD))
8787 		goto nla_put_failure;
8788 
8789 	if (!nl80211_put_signal(msg, intbss->pub.chains,
8790 				intbss->pub.chain_signal,
8791 				NL80211_BSS_CHAIN_SIGNAL))
8792 		goto nla_put_failure;
8793 
8794 	switch (rdev->wiphy.signal_type) {
8795 	case CFG80211_SIGNAL_TYPE_MBM:
8796 		if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
8797 			goto nla_put_failure;
8798 		break;
8799 	case CFG80211_SIGNAL_TYPE_UNSPEC:
8800 		if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
8801 			goto nla_put_failure;
8802 		break;
8803 	default:
8804 		break;
8805 	}
8806 
8807 	switch (wdev->iftype) {
8808 	case NL80211_IFTYPE_P2P_CLIENT:
8809 	case NL80211_IFTYPE_STATION:
8810 		if (intbss == wdev->current_bss &&
8811 		    nla_put_u32(msg, NL80211_BSS_STATUS,
8812 				NL80211_BSS_STATUS_ASSOCIATED))
8813 			goto nla_put_failure;
8814 		break;
8815 	case NL80211_IFTYPE_ADHOC:
8816 		if (intbss == wdev->current_bss &&
8817 		    nla_put_u32(msg, NL80211_BSS_STATUS,
8818 				NL80211_BSS_STATUS_IBSS_JOINED))
8819 			goto nla_put_failure;
8820 		break;
8821 	default:
8822 		break;
8823 	}
8824 
8825 	nla_nest_end(msg, bss);
8826 
8827 	genlmsg_end(msg, hdr);
8828 	return 0;
8829 
8830  fail_unlock_rcu:
8831 	rcu_read_unlock();
8832  nla_put_failure:
8833 	genlmsg_cancel(msg, hdr);
8834 	return -EMSGSIZE;
8835 }
8836 
8837 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
8838 {
8839 	struct cfg80211_registered_device *rdev;
8840 	struct cfg80211_internal_bss *scan;
8841 	struct wireless_dev *wdev;
8842 	int start = cb->args[2], idx = 0;
8843 	int err;
8844 
8845 	rtnl_lock();
8846 	err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
8847 	if (err) {
8848 		rtnl_unlock();
8849 		return err;
8850 	}
8851 
8852 	wdev_lock(wdev);
8853 	spin_lock_bh(&rdev->bss_lock);
8854 
8855 	/*
8856 	 * dump_scan will be called multiple times to break up the scan results
8857 	 * into multiple messages.  It is unlikely that any more bss-es will be
8858 	 * expired after the first call, so only call only call this on the
8859 	 * first dump_scan invocation.
8860 	 */
8861 	if (start == 0)
8862 		cfg80211_bss_expire(rdev);
8863 
8864 	cb->seq = rdev->bss_generation;
8865 
8866 	list_for_each_entry(scan, &rdev->bss_list, list) {
8867 		if (++idx <= start)
8868 			continue;
8869 		if (nl80211_send_bss(skb, cb,
8870 				cb->nlh->nlmsg_seq, NLM_F_MULTI,
8871 				rdev, wdev, scan) < 0) {
8872 			idx--;
8873 			break;
8874 		}
8875 	}
8876 
8877 	spin_unlock_bh(&rdev->bss_lock);
8878 	wdev_unlock(wdev);
8879 
8880 	cb->args[2] = idx;
8881 	rtnl_unlock();
8882 
8883 	return skb->len;
8884 }
8885 
8886 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
8887 			       int flags, struct net_device *dev,
8888 			       bool allow_radio_stats,
8889 			       struct survey_info *survey)
8890 {
8891 	void *hdr;
8892 	struct nlattr *infoattr;
8893 
8894 	/* skip radio stats if userspace didn't request them */
8895 	if (!survey->channel && !allow_radio_stats)
8896 		return 0;
8897 
8898 	hdr = nl80211hdr_put(msg, portid, seq, flags,
8899 			     NL80211_CMD_NEW_SURVEY_RESULTS);
8900 	if (!hdr)
8901 		return -ENOMEM;
8902 
8903 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
8904 		goto nla_put_failure;
8905 
8906 	infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO);
8907 	if (!infoattr)
8908 		goto nla_put_failure;
8909 
8910 	if (survey->channel &&
8911 	    nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
8912 			survey->channel->center_freq))
8913 		goto nla_put_failure;
8914 
8915 	if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
8916 	    nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
8917 		goto nla_put_failure;
8918 	if ((survey->filled & SURVEY_INFO_IN_USE) &&
8919 	    nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
8920 		goto nla_put_failure;
8921 	if ((survey->filled & SURVEY_INFO_TIME) &&
8922 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
8923 			survey->time, NL80211_SURVEY_INFO_PAD))
8924 		goto nla_put_failure;
8925 	if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
8926 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
8927 			      survey->time_busy, NL80211_SURVEY_INFO_PAD))
8928 		goto nla_put_failure;
8929 	if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
8930 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
8931 			      survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
8932 		goto nla_put_failure;
8933 	if ((survey->filled & SURVEY_INFO_TIME_RX) &&
8934 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
8935 			      survey->time_rx, NL80211_SURVEY_INFO_PAD))
8936 		goto nla_put_failure;
8937 	if ((survey->filled & SURVEY_INFO_TIME_TX) &&
8938 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
8939 			      survey->time_tx, NL80211_SURVEY_INFO_PAD))
8940 		goto nla_put_failure;
8941 	if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
8942 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
8943 			      survey->time_scan, NL80211_SURVEY_INFO_PAD))
8944 		goto nla_put_failure;
8945 	if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) &&
8946 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX,
8947 			      survey->time_bss_rx, NL80211_SURVEY_INFO_PAD))
8948 		goto nla_put_failure;
8949 
8950 	nla_nest_end(msg, infoattr);
8951 
8952 	genlmsg_end(msg, hdr);
8953 	return 0;
8954 
8955  nla_put_failure:
8956 	genlmsg_cancel(msg, hdr);
8957 	return -EMSGSIZE;
8958 }
8959 
8960 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
8961 {
8962 	struct nlattr **attrbuf;
8963 	struct survey_info survey;
8964 	struct cfg80211_registered_device *rdev;
8965 	struct wireless_dev *wdev;
8966 	int survey_idx = cb->args[2];
8967 	int res;
8968 	bool radio_stats;
8969 
8970 	attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
8971 	if (!attrbuf)
8972 		return -ENOMEM;
8973 
8974 	rtnl_lock();
8975 	res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
8976 	if (res)
8977 		goto out_err;
8978 
8979 	/* prepare_wdev_dump parsed the attributes */
8980 	radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
8981 
8982 	if (!wdev->netdev) {
8983 		res = -EINVAL;
8984 		goto out_err;
8985 	}
8986 
8987 	if (!rdev->ops->dump_survey) {
8988 		res = -EOPNOTSUPP;
8989 		goto out_err;
8990 	}
8991 
8992 	while (1) {
8993 		res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
8994 		if (res == -ENOENT)
8995 			break;
8996 		if (res)
8997 			goto out_err;
8998 
8999 		/* don't send disabled channels, but do send non-channel data */
9000 		if (survey.channel &&
9001 		    survey.channel->flags & IEEE80211_CHAN_DISABLED) {
9002 			survey_idx++;
9003 			continue;
9004 		}
9005 
9006 		if (nl80211_send_survey(skb,
9007 				NETLINK_CB(cb->skb).portid,
9008 				cb->nlh->nlmsg_seq, NLM_F_MULTI,
9009 				wdev->netdev, radio_stats, &survey) < 0)
9010 			goto out;
9011 		survey_idx++;
9012 	}
9013 
9014  out:
9015 	cb->args[2] = survey_idx;
9016 	res = skb->len;
9017  out_err:
9018 	kfree(attrbuf);
9019 	rtnl_unlock();
9020 	return res;
9021 }
9022 
9023 static bool nl80211_valid_wpa_versions(u32 wpa_versions)
9024 {
9025 	return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
9026 				  NL80211_WPA_VERSION_2 |
9027 				  NL80211_WPA_VERSION_3));
9028 }
9029 
9030 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
9031 {
9032 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9033 	struct net_device *dev = info->user_ptr[1];
9034 	struct ieee80211_channel *chan;
9035 	const u8 *bssid, *ssid, *ie = NULL, *auth_data = NULL;
9036 	int err, ssid_len, ie_len = 0, auth_data_len = 0;
9037 	enum nl80211_auth_type auth_type;
9038 	struct key_parse key;
9039 	bool local_state_change;
9040 
9041 	if (!info->attrs[NL80211_ATTR_MAC])
9042 		return -EINVAL;
9043 
9044 	if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
9045 		return -EINVAL;
9046 
9047 	if (!info->attrs[NL80211_ATTR_SSID])
9048 		return -EINVAL;
9049 
9050 	if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
9051 		return -EINVAL;
9052 
9053 	err = nl80211_parse_key(info, &key);
9054 	if (err)
9055 		return err;
9056 
9057 	if (key.idx >= 0) {
9058 		if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
9059 			return -EINVAL;
9060 		if (!key.p.key || !key.p.key_len)
9061 			return -EINVAL;
9062 		if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
9063 		     key.p.key_len != WLAN_KEY_LEN_WEP40) &&
9064 		    (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
9065 		     key.p.key_len != WLAN_KEY_LEN_WEP104))
9066 			return -EINVAL;
9067 		if (key.idx > 3)
9068 			return -EINVAL;
9069 	} else {
9070 		key.p.key_len = 0;
9071 		key.p.key = NULL;
9072 	}
9073 
9074 	if (key.idx >= 0) {
9075 		int i;
9076 		bool ok = false;
9077 
9078 		for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
9079 			if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
9080 				ok = true;
9081 				break;
9082 			}
9083 		}
9084 		if (!ok)
9085 			return -EINVAL;
9086 	}
9087 
9088 	if (!rdev->ops->auth)
9089 		return -EOPNOTSUPP;
9090 
9091 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9092 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9093 		return -EOPNOTSUPP;
9094 
9095 	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9096 	chan = nl80211_get_valid_chan(&rdev->wiphy,
9097 				      info->attrs[NL80211_ATTR_WIPHY_FREQ]);
9098 	if (!chan)
9099 		return -EINVAL;
9100 
9101 	ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9102 	ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9103 
9104 	if (info->attrs[NL80211_ATTR_IE]) {
9105 		ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9106 		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9107 	}
9108 
9109 	auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
9110 	if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
9111 		return -EINVAL;
9112 
9113 	if ((auth_type == NL80211_AUTHTYPE_SAE ||
9114 	     auth_type == NL80211_AUTHTYPE_FILS_SK ||
9115 	     auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
9116 	     auth_type == NL80211_AUTHTYPE_FILS_PK) &&
9117 	    !info->attrs[NL80211_ATTR_AUTH_DATA])
9118 		return -EINVAL;
9119 
9120 	if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
9121 		if (auth_type != NL80211_AUTHTYPE_SAE &&
9122 		    auth_type != NL80211_AUTHTYPE_FILS_SK &&
9123 		    auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
9124 		    auth_type != NL80211_AUTHTYPE_FILS_PK)
9125 			return -EINVAL;
9126 		auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
9127 		auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
9128 		/* need to include at least Auth Transaction and Status Code */
9129 		if (auth_data_len < 4)
9130 			return -EINVAL;
9131 	}
9132 
9133 	local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
9134 
9135 	/*
9136 	 * Since we no longer track auth state, ignore
9137 	 * requests to only change local state.
9138 	 */
9139 	if (local_state_change)
9140 		return 0;
9141 
9142 	wdev_lock(dev->ieee80211_ptr);
9143 	err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
9144 				 ssid, ssid_len, ie, ie_len,
9145 				 key.p.key, key.p.key_len, key.idx,
9146 				 auth_data, auth_data_len);
9147 	wdev_unlock(dev->ieee80211_ptr);
9148 	return err;
9149 }
9150 
9151 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev,
9152 				     struct genl_info *info)
9153 {
9154 	if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9155 		GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set");
9156 		return -EINVAL;
9157 	}
9158 
9159 	if (!rdev->ops->tx_control_port ||
9160 	    !wiphy_ext_feature_isset(&rdev->wiphy,
9161 				     NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
9162 		return -EOPNOTSUPP;
9163 
9164 	return 0;
9165 }
9166 
9167 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
9168 				   struct genl_info *info,
9169 				   struct cfg80211_crypto_settings *settings,
9170 				   int cipher_limit)
9171 {
9172 	memset(settings, 0, sizeof(*settings));
9173 
9174 	settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
9175 
9176 	if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
9177 		u16 proto;
9178 
9179 		proto = nla_get_u16(
9180 			info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
9181 		settings->control_port_ethertype = cpu_to_be16(proto);
9182 		if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
9183 		    proto != ETH_P_PAE)
9184 			return -EINVAL;
9185 		if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
9186 			settings->control_port_no_encrypt = true;
9187 	} else
9188 		settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
9189 
9190 	if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
9191 		int r = validate_pae_over_nl80211(rdev, info);
9192 
9193 		if (r < 0)
9194 			return r;
9195 
9196 		settings->control_port_over_nl80211 = true;
9197 	}
9198 
9199 	if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
9200 		void *data;
9201 		int len, i;
9202 
9203 		data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
9204 		len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
9205 		settings->n_ciphers_pairwise = len / sizeof(u32);
9206 
9207 		if (len % sizeof(u32))
9208 			return -EINVAL;
9209 
9210 		if (settings->n_ciphers_pairwise > cipher_limit)
9211 			return -EINVAL;
9212 
9213 		memcpy(settings->ciphers_pairwise, data, len);
9214 
9215 		for (i = 0; i < settings->n_ciphers_pairwise; i++)
9216 			if (!cfg80211_supported_cipher_suite(
9217 					&rdev->wiphy,
9218 					settings->ciphers_pairwise[i]))
9219 				return -EINVAL;
9220 	}
9221 
9222 	if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
9223 		settings->cipher_group =
9224 			nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
9225 		if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
9226 						     settings->cipher_group))
9227 			return -EINVAL;
9228 	}
9229 
9230 	if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
9231 		settings->wpa_versions =
9232 			nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
9233 		if (!nl80211_valid_wpa_versions(settings->wpa_versions))
9234 			return -EINVAL;
9235 	}
9236 
9237 	if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
9238 		void *data;
9239 		int len;
9240 
9241 		data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
9242 		len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
9243 		settings->n_akm_suites = len / sizeof(u32);
9244 
9245 		if (len % sizeof(u32))
9246 			return -EINVAL;
9247 
9248 		if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
9249 			return -EINVAL;
9250 
9251 		memcpy(settings->akm_suites, data, len);
9252 	}
9253 
9254 	if (info->attrs[NL80211_ATTR_PMK]) {
9255 		if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN)
9256 			return -EINVAL;
9257 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
9258 					     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK))
9259 			return -EINVAL;
9260 		settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]);
9261 	}
9262 
9263 	if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) {
9264 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
9265 					     NL80211_EXT_FEATURE_SAE_OFFLOAD))
9266 			return -EINVAL;
9267 		settings->sae_pwd =
9268 			nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]);
9269 		settings->sae_pwd_len =
9270 			nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]);
9271 	}
9272 
9273 	return 0;
9274 }
9275 
9276 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
9277 {
9278 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9279 	struct net_device *dev = info->user_ptr[1];
9280 	struct ieee80211_channel *chan;
9281 	struct cfg80211_assoc_request req = {};
9282 	const u8 *bssid, *ssid;
9283 	int err, ssid_len = 0;
9284 
9285 	if (dev->ieee80211_ptr->conn_owner_nlportid &&
9286 	    dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
9287 		return -EPERM;
9288 
9289 	if (!info->attrs[NL80211_ATTR_MAC] ||
9290 	    !info->attrs[NL80211_ATTR_SSID] ||
9291 	    !info->attrs[NL80211_ATTR_WIPHY_FREQ])
9292 		return -EINVAL;
9293 
9294 	if (!rdev->ops->assoc)
9295 		return -EOPNOTSUPP;
9296 
9297 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9298 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9299 		return -EOPNOTSUPP;
9300 
9301 	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9302 
9303 	chan = nl80211_get_valid_chan(&rdev->wiphy,
9304 				      info->attrs[NL80211_ATTR_WIPHY_FREQ]);
9305 	if (!chan)
9306 		return -EINVAL;
9307 
9308 	ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9309 	ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9310 
9311 	if (info->attrs[NL80211_ATTR_IE]) {
9312 		req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9313 		req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9314 	}
9315 
9316 	if (info->attrs[NL80211_ATTR_USE_MFP]) {
9317 		enum nl80211_mfp mfp =
9318 			nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
9319 		if (mfp == NL80211_MFP_REQUIRED)
9320 			req.use_mfp = true;
9321 		else if (mfp != NL80211_MFP_NO)
9322 			return -EINVAL;
9323 	}
9324 
9325 	if (info->attrs[NL80211_ATTR_PREV_BSSID])
9326 		req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
9327 
9328 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
9329 		req.flags |= ASSOC_REQ_DISABLE_HT;
9330 
9331 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9332 		memcpy(&req.ht_capa_mask,
9333 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
9334 		       sizeof(req.ht_capa_mask));
9335 
9336 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
9337 		if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9338 			return -EINVAL;
9339 		memcpy(&req.ht_capa,
9340 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
9341 		       sizeof(req.ht_capa));
9342 	}
9343 
9344 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
9345 		req.flags |= ASSOC_REQ_DISABLE_VHT;
9346 
9347 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
9348 		memcpy(&req.vht_capa_mask,
9349 		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
9350 		       sizeof(req.vht_capa_mask));
9351 
9352 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
9353 		if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
9354 			return -EINVAL;
9355 		memcpy(&req.vht_capa,
9356 		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
9357 		       sizeof(req.vht_capa));
9358 	}
9359 
9360 	if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
9361 		if (!((rdev->wiphy.features &
9362 			NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
9363 		       (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
9364 		    !wiphy_ext_feature_isset(&rdev->wiphy,
9365 					     NL80211_EXT_FEATURE_RRM))
9366 			return -EINVAL;
9367 		req.flags |= ASSOC_REQ_USE_RRM;
9368 	}
9369 
9370 	if (info->attrs[NL80211_ATTR_FILS_KEK]) {
9371 		req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
9372 		req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
9373 		if (!info->attrs[NL80211_ATTR_FILS_NONCES])
9374 			return -EINVAL;
9375 		req.fils_nonces =
9376 			nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
9377 	}
9378 
9379 	err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
9380 	if (!err) {
9381 		wdev_lock(dev->ieee80211_ptr);
9382 
9383 		err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
9384 					  ssid, ssid_len, &req);
9385 
9386 		if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9387 			dev->ieee80211_ptr->conn_owner_nlportid =
9388 				info->snd_portid;
9389 			memcpy(dev->ieee80211_ptr->disconnect_bssid,
9390 			       bssid, ETH_ALEN);
9391 		}
9392 
9393 		wdev_unlock(dev->ieee80211_ptr);
9394 	}
9395 
9396 	return err;
9397 }
9398 
9399 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
9400 {
9401 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9402 	struct net_device *dev = info->user_ptr[1];
9403 	const u8 *ie = NULL, *bssid;
9404 	int ie_len = 0, err;
9405 	u16 reason_code;
9406 	bool local_state_change;
9407 
9408 	if (dev->ieee80211_ptr->conn_owner_nlportid &&
9409 	    dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
9410 		return -EPERM;
9411 
9412 	if (!info->attrs[NL80211_ATTR_MAC])
9413 		return -EINVAL;
9414 
9415 	if (!info->attrs[NL80211_ATTR_REASON_CODE])
9416 		return -EINVAL;
9417 
9418 	if (!rdev->ops->deauth)
9419 		return -EOPNOTSUPP;
9420 
9421 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9422 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9423 		return -EOPNOTSUPP;
9424 
9425 	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9426 
9427 	reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9428 	if (reason_code == 0) {
9429 		/* Reason Code 0 is reserved */
9430 		return -EINVAL;
9431 	}
9432 
9433 	if (info->attrs[NL80211_ATTR_IE]) {
9434 		ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9435 		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9436 	}
9437 
9438 	local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
9439 
9440 	wdev_lock(dev->ieee80211_ptr);
9441 	err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
9442 				   local_state_change);
9443 	wdev_unlock(dev->ieee80211_ptr);
9444 	return err;
9445 }
9446 
9447 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
9448 {
9449 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9450 	struct net_device *dev = info->user_ptr[1];
9451 	const u8 *ie = NULL, *bssid;
9452 	int ie_len = 0, err;
9453 	u16 reason_code;
9454 	bool local_state_change;
9455 
9456 	if (dev->ieee80211_ptr->conn_owner_nlportid &&
9457 	    dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
9458 		return -EPERM;
9459 
9460 	if (!info->attrs[NL80211_ATTR_MAC])
9461 		return -EINVAL;
9462 
9463 	if (!info->attrs[NL80211_ATTR_REASON_CODE])
9464 		return -EINVAL;
9465 
9466 	if (!rdev->ops->disassoc)
9467 		return -EOPNOTSUPP;
9468 
9469 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9470 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9471 		return -EOPNOTSUPP;
9472 
9473 	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9474 
9475 	reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9476 	if (reason_code == 0) {
9477 		/* Reason Code 0 is reserved */
9478 		return -EINVAL;
9479 	}
9480 
9481 	if (info->attrs[NL80211_ATTR_IE]) {
9482 		ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9483 		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9484 	}
9485 
9486 	local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
9487 
9488 	wdev_lock(dev->ieee80211_ptr);
9489 	err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
9490 				     local_state_change);
9491 	wdev_unlock(dev->ieee80211_ptr);
9492 	return err;
9493 }
9494 
9495 static bool
9496 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
9497 			 int mcast_rate[NUM_NL80211_BANDS],
9498 			 int rateval)
9499 {
9500 	struct wiphy *wiphy = &rdev->wiphy;
9501 	bool found = false;
9502 	int band, i;
9503 
9504 	for (band = 0; band < NUM_NL80211_BANDS; band++) {
9505 		struct ieee80211_supported_band *sband;
9506 
9507 		sband = wiphy->bands[band];
9508 		if (!sband)
9509 			continue;
9510 
9511 		for (i = 0; i < sband->n_bitrates; i++) {
9512 			if (sband->bitrates[i].bitrate == rateval) {
9513 				mcast_rate[band] = i + 1;
9514 				found = true;
9515 				break;
9516 			}
9517 		}
9518 	}
9519 
9520 	return found;
9521 }
9522 
9523 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
9524 {
9525 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9526 	struct net_device *dev = info->user_ptr[1];
9527 	struct cfg80211_ibss_params ibss;
9528 	struct wiphy *wiphy;
9529 	struct cfg80211_cached_keys *connkeys = NULL;
9530 	int err;
9531 
9532 	memset(&ibss, 0, sizeof(ibss));
9533 
9534 	if (!info->attrs[NL80211_ATTR_SSID] ||
9535 	    !nla_len(info->attrs[NL80211_ATTR_SSID]))
9536 		return -EINVAL;
9537 
9538 	ibss.beacon_interval = 100;
9539 
9540 	if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
9541 		ibss.beacon_interval =
9542 			nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
9543 
9544 	err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
9545 					   ibss.beacon_interval);
9546 	if (err)
9547 		return err;
9548 
9549 	if (!rdev->ops->join_ibss)
9550 		return -EOPNOTSUPP;
9551 
9552 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
9553 		return -EOPNOTSUPP;
9554 
9555 	wiphy = &rdev->wiphy;
9556 
9557 	if (info->attrs[NL80211_ATTR_MAC]) {
9558 		ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9559 
9560 		if (!is_valid_ether_addr(ibss.bssid))
9561 			return -EINVAL;
9562 	}
9563 	ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9564 	ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9565 
9566 	if (info->attrs[NL80211_ATTR_IE]) {
9567 		ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9568 		ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9569 	}
9570 
9571 	err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
9572 	if (err)
9573 		return err;
9574 
9575 	if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
9576 				     NL80211_IFTYPE_ADHOC))
9577 		return -EINVAL;
9578 
9579 	switch (ibss.chandef.width) {
9580 	case NL80211_CHAN_WIDTH_5:
9581 	case NL80211_CHAN_WIDTH_10:
9582 	case NL80211_CHAN_WIDTH_20_NOHT:
9583 		break;
9584 	case NL80211_CHAN_WIDTH_20:
9585 	case NL80211_CHAN_WIDTH_40:
9586 		if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
9587 			return -EINVAL;
9588 		break;
9589 	case NL80211_CHAN_WIDTH_80:
9590 	case NL80211_CHAN_WIDTH_80P80:
9591 	case NL80211_CHAN_WIDTH_160:
9592 		if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
9593 			return -EINVAL;
9594 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
9595 					     NL80211_EXT_FEATURE_VHT_IBSS))
9596 			return -EINVAL;
9597 		break;
9598 	default:
9599 		return -EINVAL;
9600 	}
9601 
9602 	ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
9603 	ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
9604 
9605 	if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
9606 		u8 *rates =
9607 			nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9608 		int n_rates =
9609 			nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9610 		struct ieee80211_supported_band *sband =
9611 			wiphy->bands[ibss.chandef.chan->band];
9612 
9613 		err = ieee80211_get_ratemask(sband, rates, n_rates,
9614 					     &ibss.basic_rates);
9615 		if (err)
9616 			return err;
9617 	}
9618 
9619 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9620 		memcpy(&ibss.ht_capa_mask,
9621 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
9622 		       sizeof(ibss.ht_capa_mask));
9623 
9624 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
9625 		if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9626 			return -EINVAL;
9627 		memcpy(&ibss.ht_capa,
9628 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
9629 		       sizeof(ibss.ht_capa));
9630 	}
9631 
9632 	if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
9633 	    !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
9634 			nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
9635 		return -EINVAL;
9636 
9637 	if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
9638 		bool no_ht = false;
9639 
9640 		connkeys = nl80211_parse_connkeys(rdev, info, &no_ht);
9641 		if (IS_ERR(connkeys))
9642 			return PTR_ERR(connkeys);
9643 
9644 		if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
9645 		    no_ht) {
9646 			kzfree(connkeys);
9647 			return -EINVAL;
9648 		}
9649 	}
9650 
9651 	ibss.control_port =
9652 		nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
9653 
9654 	if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
9655 		int r = validate_pae_over_nl80211(rdev, info);
9656 
9657 		if (r < 0) {
9658 			kzfree(connkeys);
9659 			return r;
9660 		}
9661 
9662 		ibss.control_port_over_nl80211 = true;
9663 	}
9664 
9665 	ibss.userspace_handles_dfs =
9666 		nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
9667 
9668 	wdev_lock(dev->ieee80211_ptr);
9669 	err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
9670 	if (err)
9671 		kzfree(connkeys);
9672 	else if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
9673 		dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
9674 	wdev_unlock(dev->ieee80211_ptr);
9675 
9676 	return err;
9677 }
9678 
9679 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
9680 {
9681 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9682 	struct net_device *dev = info->user_ptr[1];
9683 
9684 	if (!rdev->ops->leave_ibss)
9685 		return -EOPNOTSUPP;
9686 
9687 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
9688 		return -EOPNOTSUPP;
9689 
9690 	return cfg80211_leave_ibss(rdev, dev, false);
9691 }
9692 
9693 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
9694 {
9695 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9696 	struct net_device *dev = info->user_ptr[1];
9697 	int mcast_rate[NUM_NL80211_BANDS];
9698 	u32 nla_rate;
9699 	int err;
9700 
9701 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
9702 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
9703 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
9704 		return -EOPNOTSUPP;
9705 
9706 	if (!rdev->ops->set_mcast_rate)
9707 		return -EOPNOTSUPP;
9708 
9709 	memset(mcast_rate, 0, sizeof(mcast_rate));
9710 
9711 	if (!info->attrs[NL80211_ATTR_MCAST_RATE])
9712 		return -EINVAL;
9713 
9714 	nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
9715 	if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
9716 		return -EINVAL;
9717 
9718 	err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
9719 
9720 	return err;
9721 }
9722 
9723 static struct sk_buff *
9724 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
9725 			    struct wireless_dev *wdev, int approxlen,
9726 			    u32 portid, u32 seq, enum nl80211_commands cmd,
9727 			    enum nl80211_attrs attr,
9728 			    const struct nl80211_vendor_cmd_info *info,
9729 			    gfp_t gfp)
9730 {
9731 	struct sk_buff *skb;
9732 	void *hdr;
9733 	struct nlattr *data;
9734 
9735 	skb = nlmsg_new(approxlen + 100, gfp);
9736 	if (!skb)
9737 		return NULL;
9738 
9739 	hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
9740 	if (!hdr) {
9741 		kfree_skb(skb);
9742 		return NULL;
9743 	}
9744 
9745 	if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
9746 		goto nla_put_failure;
9747 
9748 	if (info) {
9749 		if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
9750 				info->vendor_id))
9751 			goto nla_put_failure;
9752 		if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
9753 				info->subcmd))
9754 			goto nla_put_failure;
9755 	}
9756 
9757 	if (wdev) {
9758 		if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
9759 				      wdev_id(wdev), NL80211_ATTR_PAD))
9760 			goto nla_put_failure;
9761 		if (wdev->netdev &&
9762 		    nla_put_u32(skb, NL80211_ATTR_IFINDEX,
9763 				wdev->netdev->ifindex))
9764 			goto nla_put_failure;
9765 	}
9766 
9767 	data = nla_nest_start_noflag(skb, attr);
9768 	if (!data)
9769 		goto nla_put_failure;
9770 
9771 	((void **)skb->cb)[0] = rdev;
9772 	((void **)skb->cb)[1] = hdr;
9773 	((void **)skb->cb)[2] = data;
9774 
9775 	return skb;
9776 
9777  nla_put_failure:
9778 	kfree_skb(skb);
9779 	return NULL;
9780 }
9781 
9782 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
9783 					   struct wireless_dev *wdev,
9784 					   enum nl80211_commands cmd,
9785 					   enum nl80211_attrs attr,
9786 					   unsigned int portid,
9787 					   int vendor_event_idx,
9788 					   int approxlen, gfp_t gfp)
9789 {
9790 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
9791 	const struct nl80211_vendor_cmd_info *info;
9792 
9793 	switch (cmd) {
9794 	case NL80211_CMD_TESTMODE:
9795 		if (WARN_ON(vendor_event_idx != -1))
9796 			return NULL;
9797 		info = NULL;
9798 		break;
9799 	case NL80211_CMD_VENDOR:
9800 		if (WARN_ON(vendor_event_idx < 0 ||
9801 			    vendor_event_idx >= wiphy->n_vendor_events))
9802 			return NULL;
9803 		info = &wiphy->vendor_events[vendor_event_idx];
9804 		break;
9805 	default:
9806 		WARN_ON(1);
9807 		return NULL;
9808 	}
9809 
9810 	return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0,
9811 					   cmd, attr, info, gfp);
9812 }
9813 EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
9814 
9815 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
9816 {
9817 	struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
9818 	void *hdr = ((void **)skb->cb)[1];
9819 	struct nlmsghdr *nlhdr = nlmsg_hdr(skb);
9820 	struct nlattr *data = ((void **)skb->cb)[2];
9821 	enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
9822 
9823 	/* clear CB data for netlink core to own from now on */
9824 	memset(skb->cb, 0, sizeof(skb->cb));
9825 
9826 	nla_nest_end(skb, data);
9827 	genlmsg_end(skb, hdr);
9828 
9829 	if (nlhdr->nlmsg_pid) {
9830 		genlmsg_unicast(wiphy_net(&rdev->wiphy), skb,
9831 				nlhdr->nlmsg_pid);
9832 	} else {
9833 		if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
9834 			mcgrp = NL80211_MCGRP_VENDOR;
9835 
9836 		genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
9837 					skb, 0, mcgrp, gfp);
9838 	}
9839 }
9840 EXPORT_SYMBOL(__cfg80211_send_event_skb);
9841 
9842 #ifdef CONFIG_NL80211_TESTMODE
9843 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
9844 {
9845 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9846 	struct wireless_dev *wdev =
9847 		__cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
9848 	int err;
9849 
9850 	if (!rdev->ops->testmode_cmd)
9851 		return -EOPNOTSUPP;
9852 
9853 	if (IS_ERR(wdev)) {
9854 		err = PTR_ERR(wdev);
9855 		if (err != -EINVAL)
9856 			return err;
9857 		wdev = NULL;
9858 	} else if (wdev->wiphy != &rdev->wiphy) {
9859 		return -EINVAL;
9860 	}
9861 
9862 	if (!info->attrs[NL80211_ATTR_TESTDATA])
9863 		return -EINVAL;
9864 
9865 	rdev->cur_cmd_info = info;
9866 	err = rdev_testmode_cmd(rdev, wdev,
9867 				nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
9868 				nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
9869 	rdev->cur_cmd_info = NULL;
9870 
9871 	return err;
9872 }
9873 
9874 static int nl80211_testmode_dump(struct sk_buff *skb,
9875 				 struct netlink_callback *cb)
9876 {
9877 	struct cfg80211_registered_device *rdev;
9878 	struct nlattr **attrbuf = NULL;
9879 	int err;
9880 	long phy_idx;
9881 	void *data = NULL;
9882 	int data_len = 0;
9883 
9884 	rtnl_lock();
9885 
9886 	if (cb->args[0]) {
9887 		/*
9888 		 * 0 is a valid index, but not valid for args[0],
9889 		 * so we need to offset by 1.
9890 		 */
9891 		phy_idx = cb->args[0] - 1;
9892 
9893 		rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
9894 		if (!rdev) {
9895 			err = -ENOENT;
9896 			goto out_err;
9897 		}
9898 	} else {
9899 		attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf),
9900 				  GFP_KERNEL);
9901 		if (!attrbuf) {
9902 			err = -ENOMEM;
9903 			goto out_err;
9904 		}
9905 
9906 		err = nlmsg_parse_deprecated(cb->nlh,
9907 					     GENL_HDRLEN + nl80211_fam.hdrsize,
9908 					     attrbuf, nl80211_fam.maxattr,
9909 					     nl80211_policy, NULL);
9910 		if (err)
9911 			goto out_err;
9912 
9913 		rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
9914 		if (IS_ERR(rdev)) {
9915 			err = PTR_ERR(rdev);
9916 			goto out_err;
9917 		}
9918 		phy_idx = rdev->wiphy_idx;
9919 
9920 		if (attrbuf[NL80211_ATTR_TESTDATA])
9921 			cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
9922 	}
9923 
9924 	if (cb->args[1]) {
9925 		data = nla_data((void *)cb->args[1]);
9926 		data_len = nla_len((void *)cb->args[1]);
9927 	}
9928 
9929 	if (!rdev->ops->testmode_dump) {
9930 		err = -EOPNOTSUPP;
9931 		goto out_err;
9932 	}
9933 
9934 	while (1) {
9935 		void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
9936 					   cb->nlh->nlmsg_seq, NLM_F_MULTI,
9937 					   NL80211_CMD_TESTMODE);
9938 		struct nlattr *tmdata;
9939 
9940 		if (!hdr)
9941 			break;
9942 
9943 		if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
9944 			genlmsg_cancel(skb, hdr);
9945 			break;
9946 		}
9947 
9948 		tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA);
9949 		if (!tmdata) {
9950 			genlmsg_cancel(skb, hdr);
9951 			break;
9952 		}
9953 		err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
9954 		nla_nest_end(skb, tmdata);
9955 
9956 		if (err == -ENOBUFS || err == -ENOENT) {
9957 			genlmsg_cancel(skb, hdr);
9958 			break;
9959 		} else if (err) {
9960 			genlmsg_cancel(skb, hdr);
9961 			goto out_err;
9962 		}
9963 
9964 		genlmsg_end(skb, hdr);
9965 	}
9966 
9967 	err = skb->len;
9968 	/* see above */
9969 	cb->args[0] = phy_idx + 1;
9970  out_err:
9971 	kfree(attrbuf);
9972 	rtnl_unlock();
9973 	return err;
9974 }
9975 #endif
9976 
9977 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
9978 {
9979 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9980 	struct net_device *dev = info->user_ptr[1];
9981 	struct cfg80211_connect_params connect;
9982 	struct wiphy *wiphy;
9983 	struct cfg80211_cached_keys *connkeys = NULL;
9984 	int err;
9985 
9986 	memset(&connect, 0, sizeof(connect));
9987 
9988 	if (!info->attrs[NL80211_ATTR_SSID] ||
9989 	    !nla_len(info->attrs[NL80211_ATTR_SSID]))
9990 		return -EINVAL;
9991 
9992 	if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
9993 		connect.auth_type =
9994 			nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
9995 		if (!nl80211_valid_auth_type(rdev, connect.auth_type,
9996 					     NL80211_CMD_CONNECT))
9997 			return -EINVAL;
9998 	} else
9999 		connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
10000 
10001 	connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
10002 
10003 	if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] &&
10004 	    !wiphy_ext_feature_isset(&rdev->wiphy,
10005 				     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
10006 		return -EINVAL;
10007 	connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS];
10008 
10009 	err = nl80211_crypto_settings(rdev, info, &connect.crypto,
10010 				      NL80211_MAX_NR_CIPHER_SUITES);
10011 	if (err)
10012 		return err;
10013 
10014 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
10015 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
10016 		return -EOPNOTSUPP;
10017 
10018 	wiphy = &rdev->wiphy;
10019 
10020 	connect.bg_scan_period = -1;
10021 	if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
10022 		(wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
10023 		connect.bg_scan_period =
10024 			nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
10025 	}
10026 
10027 	if (info->attrs[NL80211_ATTR_MAC])
10028 		connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
10029 	else if (info->attrs[NL80211_ATTR_MAC_HINT])
10030 		connect.bssid_hint =
10031 			nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
10032 	connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
10033 	connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
10034 
10035 	if (info->attrs[NL80211_ATTR_IE]) {
10036 		connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
10037 		connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
10038 	}
10039 
10040 	if (info->attrs[NL80211_ATTR_USE_MFP]) {
10041 		connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
10042 		if (connect.mfp == NL80211_MFP_OPTIONAL &&
10043 		    !wiphy_ext_feature_isset(&rdev->wiphy,
10044 					     NL80211_EXT_FEATURE_MFP_OPTIONAL))
10045 			return -EOPNOTSUPP;
10046 	} else {
10047 		connect.mfp = NL80211_MFP_NO;
10048 	}
10049 
10050 	if (info->attrs[NL80211_ATTR_PREV_BSSID])
10051 		connect.prev_bssid =
10052 			nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
10053 
10054 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
10055 		connect.channel = nl80211_get_valid_chan(
10056 			wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
10057 		if (!connect.channel)
10058 			return -EINVAL;
10059 	} else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
10060 		connect.channel_hint = nl80211_get_valid_chan(
10061 			wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
10062 		if (!connect.channel_hint)
10063 			return -EINVAL;
10064 	}
10065 
10066 	if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) {
10067 		connect.edmg.channels =
10068 		      nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]);
10069 
10070 		if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG])
10071 			connect.edmg.bw_config =
10072 				nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]);
10073 	}
10074 
10075 	if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
10076 		connkeys = nl80211_parse_connkeys(rdev, info, NULL);
10077 		if (IS_ERR(connkeys))
10078 			return PTR_ERR(connkeys);
10079 	}
10080 
10081 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
10082 		connect.flags |= ASSOC_REQ_DISABLE_HT;
10083 
10084 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
10085 		memcpy(&connect.ht_capa_mask,
10086 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
10087 		       sizeof(connect.ht_capa_mask));
10088 
10089 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
10090 		if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
10091 			kzfree(connkeys);
10092 			return -EINVAL;
10093 		}
10094 		memcpy(&connect.ht_capa,
10095 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
10096 		       sizeof(connect.ht_capa));
10097 	}
10098 
10099 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
10100 		connect.flags |= ASSOC_REQ_DISABLE_VHT;
10101 
10102 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
10103 		memcpy(&connect.vht_capa_mask,
10104 		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
10105 		       sizeof(connect.vht_capa_mask));
10106 
10107 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
10108 		if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
10109 			kzfree(connkeys);
10110 			return -EINVAL;
10111 		}
10112 		memcpy(&connect.vht_capa,
10113 		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
10114 		       sizeof(connect.vht_capa));
10115 	}
10116 
10117 	if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
10118 		if (!((rdev->wiphy.features &
10119 			NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
10120 		       (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
10121 		    !wiphy_ext_feature_isset(&rdev->wiphy,
10122 					     NL80211_EXT_FEATURE_RRM)) {
10123 			kzfree(connkeys);
10124 			return -EINVAL;
10125 		}
10126 		connect.flags |= ASSOC_REQ_USE_RRM;
10127 	}
10128 
10129 	connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
10130 	if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
10131 		kzfree(connkeys);
10132 		return -EOPNOTSUPP;
10133 	}
10134 
10135 	if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
10136 		/* bss selection makes no sense if bssid is set */
10137 		if (connect.bssid) {
10138 			kzfree(connkeys);
10139 			return -EINVAL;
10140 		}
10141 
10142 		err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
10143 				       wiphy, &connect.bss_select);
10144 		if (err) {
10145 			kzfree(connkeys);
10146 			return err;
10147 		}
10148 	}
10149 
10150 	if (wiphy_ext_feature_isset(&rdev->wiphy,
10151 				    NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
10152 	    info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
10153 	    info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
10154 	    info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
10155 	    info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
10156 		connect.fils_erp_username =
10157 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
10158 		connect.fils_erp_username_len =
10159 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
10160 		connect.fils_erp_realm =
10161 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
10162 		connect.fils_erp_realm_len =
10163 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
10164 		connect.fils_erp_next_seq_num =
10165 			nla_get_u16(
10166 			   info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
10167 		connect.fils_erp_rrk =
10168 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
10169 		connect.fils_erp_rrk_len =
10170 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
10171 	} else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
10172 		   info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
10173 		   info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
10174 		   info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
10175 		kzfree(connkeys);
10176 		return -EINVAL;
10177 	}
10178 
10179 	if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) {
10180 		if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
10181 			kzfree(connkeys);
10182 			GENL_SET_ERR_MSG(info,
10183 					 "external auth requires connection ownership");
10184 			return -EINVAL;
10185 		}
10186 		connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT;
10187 	}
10188 
10189 	wdev_lock(dev->ieee80211_ptr);
10190 
10191 	err = cfg80211_connect(rdev, dev, &connect, connkeys,
10192 			       connect.prev_bssid);
10193 	if (err)
10194 		kzfree(connkeys);
10195 
10196 	if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
10197 		dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
10198 		if (connect.bssid)
10199 			memcpy(dev->ieee80211_ptr->disconnect_bssid,
10200 			       connect.bssid, ETH_ALEN);
10201 		else
10202 			memset(dev->ieee80211_ptr->disconnect_bssid,
10203 			       0, ETH_ALEN);
10204 	}
10205 
10206 	wdev_unlock(dev->ieee80211_ptr);
10207 
10208 	return err;
10209 }
10210 
10211 static int nl80211_update_connect_params(struct sk_buff *skb,
10212 					 struct genl_info *info)
10213 {
10214 	struct cfg80211_connect_params connect = {};
10215 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10216 	struct net_device *dev = info->user_ptr[1];
10217 	struct wireless_dev *wdev = dev->ieee80211_ptr;
10218 	bool fils_sk_offload;
10219 	u32 auth_type;
10220 	u32 changed = 0;
10221 	int ret;
10222 
10223 	if (!rdev->ops->update_connect_params)
10224 		return -EOPNOTSUPP;
10225 
10226 	if (info->attrs[NL80211_ATTR_IE]) {
10227 		connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
10228 		connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
10229 		changed |= UPDATE_ASSOC_IES;
10230 	}
10231 
10232 	fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy,
10233 						  NL80211_EXT_FEATURE_FILS_SK_OFFLOAD);
10234 
10235 	/*
10236 	 * when driver supports fils-sk offload all attributes must be
10237 	 * provided. So the else covers "fils-sk-not-all" and
10238 	 * "no-fils-sk-any".
10239 	 */
10240 	if (fils_sk_offload &&
10241 	    info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
10242 	    info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
10243 	    info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
10244 	    info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
10245 		connect.fils_erp_username =
10246 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
10247 		connect.fils_erp_username_len =
10248 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
10249 		connect.fils_erp_realm =
10250 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
10251 		connect.fils_erp_realm_len =
10252 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
10253 		connect.fils_erp_next_seq_num =
10254 			nla_get_u16(
10255 			   info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
10256 		connect.fils_erp_rrk =
10257 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
10258 		connect.fils_erp_rrk_len =
10259 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
10260 		changed |= UPDATE_FILS_ERP_INFO;
10261 	} else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
10262 		   info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
10263 		   info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
10264 		   info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
10265 		return -EINVAL;
10266 	}
10267 
10268 	if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
10269 		auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
10270 		if (!nl80211_valid_auth_type(rdev, auth_type,
10271 					     NL80211_CMD_CONNECT))
10272 			return -EINVAL;
10273 
10274 		if (auth_type == NL80211_AUTHTYPE_FILS_SK &&
10275 		    fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO))
10276 			return -EINVAL;
10277 
10278 		connect.auth_type = auth_type;
10279 		changed |= UPDATE_AUTH_TYPE;
10280 	}
10281 
10282 	wdev_lock(dev->ieee80211_ptr);
10283 	if (!wdev->current_bss)
10284 		ret = -ENOLINK;
10285 	else
10286 		ret = rdev_update_connect_params(rdev, dev, &connect, changed);
10287 	wdev_unlock(dev->ieee80211_ptr);
10288 
10289 	return ret;
10290 }
10291 
10292 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
10293 {
10294 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10295 	struct net_device *dev = info->user_ptr[1];
10296 	u16 reason;
10297 	int ret;
10298 
10299 	if (dev->ieee80211_ptr->conn_owner_nlportid &&
10300 	    dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
10301 		return -EPERM;
10302 
10303 	if (!info->attrs[NL80211_ATTR_REASON_CODE])
10304 		reason = WLAN_REASON_DEAUTH_LEAVING;
10305 	else
10306 		reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
10307 
10308 	if (reason == 0)
10309 		return -EINVAL;
10310 
10311 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
10312 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
10313 		return -EOPNOTSUPP;
10314 
10315 	wdev_lock(dev->ieee80211_ptr);
10316 	ret = cfg80211_disconnect(rdev, dev, reason, true);
10317 	wdev_unlock(dev->ieee80211_ptr);
10318 	return ret;
10319 }
10320 
10321 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
10322 {
10323 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10324 	struct net *net;
10325 	int err;
10326 
10327 	if (info->attrs[NL80211_ATTR_PID]) {
10328 		u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
10329 
10330 		net = get_net_ns_by_pid(pid);
10331 	} else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
10332 		u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
10333 
10334 		net = get_net_ns_by_fd(fd);
10335 	} else {
10336 		return -EINVAL;
10337 	}
10338 
10339 	if (IS_ERR(net))
10340 		return PTR_ERR(net);
10341 
10342 	err = 0;
10343 
10344 	/* check if anything to do */
10345 	if (!net_eq(wiphy_net(&rdev->wiphy), net))
10346 		err = cfg80211_switch_netns(rdev, net);
10347 
10348 	put_net(net);
10349 	return err;
10350 }
10351 
10352 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
10353 {
10354 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10355 	int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
10356 			struct cfg80211_pmksa *pmksa) = NULL;
10357 	struct net_device *dev = info->user_ptr[1];
10358 	struct cfg80211_pmksa pmksa;
10359 
10360 	memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
10361 
10362 	if (!info->attrs[NL80211_ATTR_PMKID])
10363 		return -EINVAL;
10364 
10365 	pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
10366 
10367 	if (info->attrs[NL80211_ATTR_MAC]) {
10368 		pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
10369 	} else if (info->attrs[NL80211_ATTR_SSID] &&
10370 		   info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
10371 		   (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA ||
10372 		    info->attrs[NL80211_ATTR_PMK])) {
10373 		pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
10374 		pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
10375 		pmksa.cache_id =
10376 			nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
10377 	} else {
10378 		return -EINVAL;
10379 	}
10380 	if (info->attrs[NL80211_ATTR_PMK]) {
10381 		pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
10382 		pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
10383 	}
10384 
10385 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
10386 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
10387 	    !(dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP &&
10388 	      wiphy_ext_feature_isset(&rdev->wiphy,
10389 				      NL80211_EXT_FEATURE_AP_PMKSA_CACHING)))
10390 		return -EOPNOTSUPP;
10391 
10392 	switch (info->genlhdr->cmd) {
10393 	case NL80211_CMD_SET_PMKSA:
10394 		rdev_ops = rdev->ops->set_pmksa;
10395 		break;
10396 	case NL80211_CMD_DEL_PMKSA:
10397 		rdev_ops = rdev->ops->del_pmksa;
10398 		break;
10399 	default:
10400 		WARN_ON(1);
10401 		break;
10402 	}
10403 
10404 	if (!rdev_ops)
10405 		return -EOPNOTSUPP;
10406 
10407 	return rdev_ops(&rdev->wiphy, dev, &pmksa);
10408 }
10409 
10410 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
10411 {
10412 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10413 	struct net_device *dev = info->user_ptr[1];
10414 
10415 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
10416 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
10417 		return -EOPNOTSUPP;
10418 
10419 	if (!rdev->ops->flush_pmksa)
10420 		return -EOPNOTSUPP;
10421 
10422 	return rdev_flush_pmksa(rdev, dev);
10423 }
10424 
10425 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
10426 {
10427 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10428 	struct net_device *dev = info->user_ptr[1];
10429 	u8 action_code, dialog_token;
10430 	u32 peer_capability = 0;
10431 	u16 status_code;
10432 	u8 *peer;
10433 	bool initiator;
10434 
10435 	if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
10436 	    !rdev->ops->tdls_mgmt)
10437 		return -EOPNOTSUPP;
10438 
10439 	if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
10440 	    !info->attrs[NL80211_ATTR_STATUS_CODE] ||
10441 	    !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
10442 	    !info->attrs[NL80211_ATTR_IE] ||
10443 	    !info->attrs[NL80211_ATTR_MAC])
10444 		return -EINVAL;
10445 
10446 	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
10447 	action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
10448 	status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
10449 	dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
10450 	initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
10451 	if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
10452 		peer_capability =
10453 			nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
10454 
10455 	return rdev_tdls_mgmt(rdev, dev, peer, action_code,
10456 			      dialog_token, status_code, peer_capability,
10457 			      initiator,
10458 			      nla_data(info->attrs[NL80211_ATTR_IE]),
10459 			      nla_len(info->attrs[NL80211_ATTR_IE]));
10460 }
10461 
10462 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
10463 {
10464 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10465 	struct net_device *dev = info->user_ptr[1];
10466 	enum nl80211_tdls_operation operation;
10467 	u8 *peer;
10468 
10469 	if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
10470 	    !rdev->ops->tdls_oper)
10471 		return -EOPNOTSUPP;
10472 
10473 	if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
10474 	    !info->attrs[NL80211_ATTR_MAC])
10475 		return -EINVAL;
10476 
10477 	operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
10478 	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
10479 
10480 	return rdev_tdls_oper(rdev, dev, peer, operation);
10481 }
10482 
10483 static int nl80211_remain_on_channel(struct sk_buff *skb,
10484 				     struct genl_info *info)
10485 {
10486 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10487 	struct wireless_dev *wdev = info->user_ptr[1];
10488 	struct cfg80211_chan_def chandef;
10489 	const struct cfg80211_chan_def *compat_chandef;
10490 	struct sk_buff *msg;
10491 	void *hdr;
10492 	u64 cookie;
10493 	u32 duration;
10494 	int err;
10495 
10496 	if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
10497 	    !info->attrs[NL80211_ATTR_DURATION])
10498 		return -EINVAL;
10499 
10500 	duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
10501 
10502 	if (!rdev->ops->remain_on_channel ||
10503 	    !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
10504 		return -EOPNOTSUPP;
10505 
10506 	/*
10507 	 * We should be on that channel for at least a minimum amount of
10508 	 * time (10ms) but no longer than the driver supports.
10509 	 */
10510 	if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
10511 	    duration > rdev->wiphy.max_remain_on_channel_duration)
10512 		return -EINVAL;
10513 
10514 	err = nl80211_parse_chandef(rdev, info, &chandef);
10515 	if (err)
10516 		return err;
10517 
10518 	wdev_lock(wdev);
10519 	if (!cfg80211_off_channel_oper_allowed(wdev) &&
10520 	    !cfg80211_chandef_identical(&wdev->chandef, &chandef)) {
10521 		compat_chandef = cfg80211_chandef_compatible(&wdev->chandef,
10522 							     &chandef);
10523 		if (compat_chandef != &chandef) {
10524 			wdev_unlock(wdev);
10525 			return -EBUSY;
10526 		}
10527 	}
10528 	wdev_unlock(wdev);
10529 
10530 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10531 	if (!msg)
10532 		return -ENOMEM;
10533 
10534 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10535 			     NL80211_CMD_REMAIN_ON_CHANNEL);
10536 	if (!hdr) {
10537 		err = -ENOBUFS;
10538 		goto free_msg;
10539 	}
10540 
10541 	err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
10542 				     duration, &cookie);
10543 
10544 	if (err)
10545 		goto free_msg;
10546 
10547 	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
10548 			      NL80211_ATTR_PAD))
10549 		goto nla_put_failure;
10550 
10551 	genlmsg_end(msg, hdr);
10552 
10553 	return genlmsg_reply(msg, info);
10554 
10555  nla_put_failure:
10556 	err = -ENOBUFS;
10557  free_msg:
10558 	nlmsg_free(msg);
10559 	return err;
10560 }
10561 
10562 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
10563 					    struct genl_info *info)
10564 {
10565 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10566 	struct wireless_dev *wdev = info->user_ptr[1];
10567 	u64 cookie;
10568 
10569 	if (!info->attrs[NL80211_ATTR_COOKIE])
10570 		return -EINVAL;
10571 
10572 	if (!rdev->ops->cancel_remain_on_channel)
10573 		return -EOPNOTSUPP;
10574 
10575 	cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
10576 
10577 	return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
10578 }
10579 
10580 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
10581 				       struct genl_info *info)
10582 {
10583 	struct cfg80211_bitrate_mask mask;
10584 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10585 	struct net_device *dev = info->user_ptr[1];
10586 	int err;
10587 
10588 	if (!rdev->ops->set_bitrate_mask)
10589 		return -EOPNOTSUPP;
10590 
10591 	err = nl80211_parse_tx_bitrate_mask(info, &mask);
10592 	if (err)
10593 		return err;
10594 
10595 	return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
10596 }
10597 
10598 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
10599 {
10600 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10601 	struct wireless_dev *wdev = info->user_ptr[1];
10602 	u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
10603 
10604 	if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
10605 		return -EINVAL;
10606 
10607 	if (info->attrs[NL80211_ATTR_FRAME_TYPE])
10608 		frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
10609 
10610 	switch (wdev->iftype) {
10611 	case NL80211_IFTYPE_STATION:
10612 	case NL80211_IFTYPE_ADHOC:
10613 	case NL80211_IFTYPE_P2P_CLIENT:
10614 	case NL80211_IFTYPE_AP:
10615 	case NL80211_IFTYPE_AP_VLAN:
10616 	case NL80211_IFTYPE_MESH_POINT:
10617 	case NL80211_IFTYPE_P2P_GO:
10618 	case NL80211_IFTYPE_P2P_DEVICE:
10619 		break;
10620 	case NL80211_IFTYPE_NAN:
10621 	default:
10622 		return -EOPNOTSUPP;
10623 	}
10624 
10625 	/* not much point in registering if we can't reply */
10626 	if (!rdev->ops->mgmt_tx)
10627 		return -EOPNOTSUPP;
10628 
10629 	return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
10630 					   nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
10631 					   nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]),
10632 					   info->extack);
10633 }
10634 
10635 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
10636 {
10637 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10638 	struct wireless_dev *wdev = info->user_ptr[1];
10639 	struct cfg80211_chan_def chandef;
10640 	int err;
10641 	void *hdr = NULL;
10642 	u64 cookie;
10643 	struct sk_buff *msg = NULL;
10644 	struct cfg80211_mgmt_tx_params params = {
10645 		.dont_wait_for_ack =
10646 			info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
10647 	};
10648 
10649 	if (!info->attrs[NL80211_ATTR_FRAME])
10650 		return -EINVAL;
10651 
10652 	if (!rdev->ops->mgmt_tx)
10653 		return -EOPNOTSUPP;
10654 
10655 	switch (wdev->iftype) {
10656 	case NL80211_IFTYPE_P2P_DEVICE:
10657 		if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
10658 			return -EINVAL;
10659 	case NL80211_IFTYPE_STATION:
10660 	case NL80211_IFTYPE_ADHOC:
10661 	case NL80211_IFTYPE_P2P_CLIENT:
10662 	case NL80211_IFTYPE_AP:
10663 	case NL80211_IFTYPE_AP_VLAN:
10664 	case NL80211_IFTYPE_MESH_POINT:
10665 	case NL80211_IFTYPE_P2P_GO:
10666 		break;
10667 	case NL80211_IFTYPE_NAN:
10668 	default:
10669 		return -EOPNOTSUPP;
10670 	}
10671 
10672 	if (info->attrs[NL80211_ATTR_DURATION]) {
10673 		if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
10674 			return -EINVAL;
10675 		params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
10676 
10677 		/*
10678 		 * We should wait on the channel for at least a minimum amount
10679 		 * of time (10ms) but no longer than the driver supports.
10680 		 */
10681 		if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
10682 		    params.wait > rdev->wiphy.max_remain_on_channel_duration)
10683 			return -EINVAL;
10684 	}
10685 
10686 	params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
10687 
10688 	if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
10689 		return -EINVAL;
10690 
10691 	params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
10692 
10693 	/* get the channel if any has been specified, otherwise pass NULL to
10694 	 * the driver. The latter will use the current one
10695 	 */
10696 	chandef.chan = NULL;
10697 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
10698 		err = nl80211_parse_chandef(rdev, info, &chandef);
10699 		if (err)
10700 			return err;
10701 	}
10702 
10703 	if (!chandef.chan && params.offchan)
10704 		return -EINVAL;
10705 
10706 	wdev_lock(wdev);
10707 	if (params.offchan && !cfg80211_off_channel_oper_allowed(wdev)) {
10708 		wdev_unlock(wdev);
10709 		return -EBUSY;
10710 	}
10711 	wdev_unlock(wdev);
10712 
10713 	params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
10714 	params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
10715 
10716 	if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
10717 		int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
10718 		int i;
10719 
10720 		if (len % sizeof(u16))
10721 			return -EINVAL;
10722 
10723 		params.n_csa_offsets = len / sizeof(u16);
10724 		params.csa_offsets =
10725 			nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
10726 
10727 		/* check that all the offsets fit the frame */
10728 		for (i = 0; i < params.n_csa_offsets; i++) {
10729 			if (params.csa_offsets[i] >= params.len)
10730 				return -EINVAL;
10731 		}
10732 	}
10733 
10734 	if (!params.dont_wait_for_ack) {
10735 		msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10736 		if (!msg)
10737 			return -ENOMEM;
10738 
10739 		hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10740 				     NL80211_CMD_FRAME);
10741 		if (!hdr) {
10742 			err = -ENOBUFS;
10743 			goto free_msg;
10744 		}
10745 	}
10746 
10747 	params.chan = chandef.chan;
10748 	err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
10749 	if (err)
10750 		goto free_msg;
10751 
10752 	if (msg) {
10753 		if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
10754 				      NL80211_ATTR_PAD))
10755 			goto nla_put_failure;
10756 
10757 		genlmsg_end(msg, hdr);
10758 		return genlmsg_reply(msg, info);
10759 	}
10760 
10761 	return 0;
10762 
10763  nla_put_failure:
10764 	err = -ENOBUFS;
10765  free_msg:
10766 	nlmsg_free(msg);
10767 	return err;
10768 }
10769 
10770 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
10771 {
10772 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10773 	struct wireless_dev *wdev = info->user_ptr[1];
10774 	u64 cookie;
10775 
10776 	if (!info->attrs[NL80211_ATTR_COOKIE])
10777 		return -EINVAL;
10778 
10779 	if (!rdev->ops->mgmt_tx_cancel_wait)
10780 		return -EOPNOTSUPP;
10781 
10782 	switch (wdev->iftype) {
10783 	case NL80211_IFTYPE_STATION:
10784 	case NL80211_IFTYPE_ADHOC:
10785 	case NL80211_IFTYPE_P2P_CLIENT:
10786 	case NL80211_IFTYPE_AP:
10787 	case NL80211_IFTYPE_AP_VLAN:
10788 	case NL80211_IFTYPE_P2P_GO:
10789 	case NL80211_IFTYPE_P2P_DEVICE:
10790 		break;
10791 	case NL80211_IFTYPE_NAN:
10792 	default:
10793 		return -EOPNOTSUPP;
10794 	}
10795 
10796 	cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
10797 
10798 	return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
10799 }
10800 
10801 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
10802 {
10803 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10804 	struct wireless_dev *wdev;
10805 	struct net_device *dev = info->user_ptr[1];
10806 	u8 ps_state;
10807 	bool state;
10808 	int err;
10809 
10810 	if (!info->attrs[NL80211_ATTR_PS_STATE])
10811 		return -EINVAL;
10812 
10813 	ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
10814 
10815 	wdev = dev->ieee80211_ptr;
10816 
10817 	if (!rdev->ops->set_power_mgmt)
10818 		return -EOPNOTSUPP;
10819 
10820 	state = (ps_state == NL80211_PS_ENABLED) ? true : false;
10821 
10822 	if (state == wdev->ps)
10823 		return 0;
10824 
10825 	err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
10826 	if (!err)
10827 		wdev->ps = state;
10828 	return err;
10829 }
10830 
10831 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
10832 {
10833 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10834 	enum nl80211_ps_state ps_state;
10835 	struct wireless_dev *wdev;
10836 	struct net_device *dev = info->user_ptr[1];
10837 	struct sk_buff *msg;
10838 	void *hdr;
10839 	int err;
10840 
10841 	wdev = dev->ieee80211_ptr;
10842 
10843 	if (!rdev->ops->set_power_mgmt)
10844 		return -EOPNOTSUPP;
10845 
10846 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10847 	if (!msg)
10848 		return -ENOMEM;
10849 
10850 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10851 			     NL80211_CMD_GET_POWER_SAVE);
10852 	if (!hdr) {
10853 		err = -ENOBUFS;
10854 		goto free_msg;
10855 	}
10856 
10857 	if (wdev->ps)
10858 		ps_state = NL80211_PS_ENABLED;
10859 	else
10860 		ps_state = NL80211_PS_DISABLED;
10861 
10862 	if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
10863 		goto nla_put_failure;
10864 
10865 	genlmsg_end(msg, hdr);
10866 	return genlmsg_reply(msg, info);
10867 
10868  nla_put_failure:
10869 	err = -ENOBUFS;
10870  free_msg:
10871 	nlmsg_free(msg);
10872 	return err;
10873 }
10874 
10875 static const struct nla_policy
10876 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
10877 	[NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
10878 	[NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
10879 	[NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
10880 	[NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
10881 	[NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
10882 	[NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
10883 	[NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
10884 };
10885 
10886 static int nl80211_set_cqm_txe(struct genl_info *info,
10887 			       u32 rate, u32 pkts, u32 intvl)
10888 {
10889 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10890 	struct net_device *dev = info->user_ptr[1];
10891 	struct wireless_dev *wdev = dev->ieee80211_ptr;
10892 
10893 	if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
10894 		return -EINVAL;
10895 
10896 	if (!rdev->ops->set_cqm_txe_config)
10897 		return -EOPNOTSUPP;
10898 
10899 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
10900 	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
10901 		return -EOPNOTSUPP;
10902 
10903 	return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
10904 }
10905 
10906 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
10907 				    struct net_device *dev)
10908 {
10909 	struct wireless_dev *wdev = dev->ieee80211_ptr;
10910 	s32 last, low, high;
10911 	u32 hyst;
10912 	int i, n, low_index;
10913 	int err;
10914 
10915 	/* RSSI reporting disabled? */
10916 	if (!wdev->cqm_config)
10917 		return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);
10918 
10919 	/*
10920 	 * Obtain current RSSI value if possible, if not and no RSSI threshold
10921 	 * event has been received yet, we should receive an event after a
10922 	 * connection is established and enough beacons received to calculate
10923 	 * the average.
10924 	 */
10925 	if (!wdev->cqm_config->last_rssi_event_value && wdev->current_bss &&
10926 	    rdev->ops->get_station) {
10927 		struct station_info sinfo = {};
10928 		u8 *mac_addr;
10929 
10930 		mac_addr = wdev->current_bss->pub.bssid;
10931 
10932 		err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
10933 		if (err)
10934 			return err;
10935 
10936 		cfg80211_sinfo_release_content(&sinfo);
10937 		if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
10938 			wdev->cqm_config->last_rssi_event_value =
10939 				(s8) sinfo.rx_beacon_signal_avg;
10940 	}
10941 
10942 	last = wdev->cqm_config->last_rssi_event_value;
10943 	hyst = wdev->cqm_config->rssi_hyst;
10944 	n = wdev->cqm_config->n_rssi_thresholds;
10945 
10946 	for (i = 0; i < n; i++) {
10947 		i = array_index_nospec(i, n);
10948 		if (last < wdev->cqm_config->rssi_thresholds[i])
10949 			break;
10950 	}
10951 
10952 	low_index = i - 1;
10953 	if (low_index >= 0) {
10954 		low_index = array_index_nospec(low_index, n);
10955 		low = wdev->cqm_config->rssi_thresholds[low_index] - hyst;
10956 	} else {
10957 		low = S32_MIN;
10958 	}
10959 	if (i < n) {
10960 		i = array_index_nospec(i, n);
10961 		high = wdev->cqm_config->rssi_thresholds[i] + hyst - 1;
10962 	} else {
10963 		high = S32_MAX;
10964 	}
10965 
10966 	return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
10967 }
10968 
10969 static int nl80211_set_cqm_rssi(struct genl_info *info,
10970 				const s32 *thresholds, int n_thresholds,
10971 				u32 hysteresis)
10972 {
10973 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10974 	struct net_device *dev = info->user_ptr[1];
10975 	struct wireless_dev *wdev = dev->ieee80211_ptr;
10976 	int i, err;
10977 	s32 prev = S32_MIN;
10978 
10979 	/* Check all values negative and sorted */
10980 	for (i = 0; i < n_thresholds; i++) {
10981 		if (thresholds[i] > 0 || thresholds[i] <= prev)
10982 			return -EINVAL;
10983 
10984 		prev = thresholds[i];
10985 	}
10986 
10987 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
10988 	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
10989 		return -EOPNOTSUPP;
10990 
10991 	wdev_lock(wdev);
10992 	cfg80211_cqm_config_free(wdev);
10993 	wdev_unlock(wdev);
10994 
10995 	if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) {
10996 		if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */
10997 			return rdev_set_cqm_rssi_config(rdev, dev, 0, 0);
10998 
10999 		return rdev_set_cqm_rssi_config(rdev, dev,
11000 						thresholds[0], hysteresis);
11001 	}
11002 
11003 	if (!wiphy_ext_feature_isset(&rdev->wiphy,
11004 				     NL80211_EXT_FEATURE_CQM_RSSI_LIST))
11005 		return -EOPNOTSUPP;
11006 
11007 	if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
11008 		n_thresholds = 0;
11009 
11010 	wdev_lock(wdev);
11011 	if (n_thresholds) {
11012 		struct cfg80211_cqm_config *cqm_config;
11013 
11014 		cqm_config = kzalloc(sizeof(struct cfg80211_cqm_config) +
11015 				     n_thresholds * sizeof(s32), GFP_KERNEL);
11016 		if (!cqm_config) {
11017 			err = -ENOMEM;
11018 			goto unlock;
11019 		}
11020 
11021 		cqm_config->rssi_hyst = hysteresis;
11022 		cqm_config->n_rssi_thresholds = n_thresholds;
11023 		memcpy(cqm_config->rssi_thresholds, thresholds,
11024 		       n_thresholds * sizeof(s32));
11025 
11026 		wdev->cqm_config = cqm_config;
11027 	}
11028 
11029 	err = cfg80211_cqm_rssi_update(rdev, dev);
11030 
11031 unlock:
11032 	wdev_unlock(wdev);
11033 
11034 	return err;
11035 }
11036 
11037 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
11038 {
11039 	struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
11040 	struct nlattr *cqm;
11041 	int err;
11042 
11043 	cqm = info->attrs[NL80211_ATTR_CQM];
11044 	if (!cqm)
11045 		return -EINVAL;
11046 
11047 	err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm,
11048 					  nl80211_attr_cqm_policy,
11049 					  info->extack);
11050 	if (err)
11051 		return err;
11052 
11053 	if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
11054 	    attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
11055 		const s32 *thresholds =
11056 			nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
11057 		int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
11058 		u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
11059 
11060 		if (len % 4)
11061 			return -EINVAL;
11062 
11063 		return nl80211_set_cqm_rssi(info, thresholds, len / 4,
11064 					    hysteresis);
11065 	}
11066 
11067 	if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
11068 	    attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
11069 	    attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
11070 		u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
11071 		u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
11072 		u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
11073 
11074 		return nl80211_set_cqm_txe(info, rate, pkts, intvl);
11075 	}
11076 
11077 	return -EINVAL;
11078 }
11079 
11080 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
11081 {
11082 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11083 	struct net_device *dev = info->user_ptr[1];
11084 	struct ocb_setup setup = {};
11085 	int err;
11086 
11087 	err = nl80211_parse_chandef(rdev, info, &setup.chandef);
11088 	if (err)
11089 		return err;
11090 
11091 	return cfg80211_join_ocb(rdev, dev, &setup);
11092 }
11093 
11094 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
11095 {
11096 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11097 	struct net_device *dev = info->user_ptr[1];
11098 
11099 	return cfg80211_leave_ocb(rdev, dev);
11100 }
11101 
11102 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
11103 {
11104 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11105 	struct net_device *dev = info->user_ptr[1];
11106 	struct mesh_config cfg;
11107 	struct mesh_setup setup;
11108 	int err;
11109 
11110 	/* start with default */
11111 	memcpy(&cfg, &default_mesh_config, sizeof(cfg));
11112 	memcpy(&setup, &default_mesh_setup, sizeof(setup));
11113 
11114 	if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
11115 		/* and parse parameters if given */
11116 		err = nl80211_parse_mesh_config(info, &cfg, NULL);
11117 		if (err)
11118 			return err;
11119 	}
11120 
11121 	if (!info->attrs[NL80211_ATTR_MESH_ID] ||
11122 	    !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
11123 		return -EINVAL;
11124 
11125 	setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
11126 	setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
11127 
11128 	if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
11129 	    !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
11130 			    nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
11131 			return -EINVAL;
11132 
11133 	if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
11134 		setup.beacon_interval =
11135 			nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
11136 
11137 		err = cfg80211_validate_beacon_int(rdev,
11138 						   NL80211_IFTYPE_MESH_POINT,
11139 						   setup.beacon_interval);
11140 		if (err)
11141 			return err;
11142 	}
11143 
11144 	if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
11145 		setup.dtim_period =
11146 			nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
11147 		if (setup.dtim_period < 1 || setup.dtim_period > 100)
11148 			return -EINVAL;
11149 	}
11150 
11151 	if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
11152 		/* parse additional setup parameters if given */
11153 		err = nl80211_parse_mesh_setup(info, &setup);
11154 		if (err)
11155 			return err;
11156 	}
11157 
11158 	if (setup.user_mpm)
11159 		cfg.auto_open_plinks = false;
11160 
11161 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
11162 		err = nl80211_parse_chandef(rdev, info, &setup.chandef);
11163 		if (err)
11164 			return err;
11165 	} else {
11166 		/* __cfg80211_join_mesh() will sort it out */
11167 		setup.chandef.chan = NULL;
11168 	}
11169 
11170 	if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
11171 		u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
11172 		int n_rates =
11173 			nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
11174 		struct ieee80211_supported_band *sband;
11175 
11176 		if (!setup.chandef.chan)
11177 			return -EINVAL;
11178 
11179 		sband = rdev->wiphy.bands[setup.chandef.chan->band];
11180 
11181 		err = ieee80211_get_ratemask(sband, rates, n_rates,
11182 					     &setup.basic_rates);
11183 		if (err)
11184 			return err;
11185 	}
11186 
11187 	if (info->attrs[NL80211_ATTR_TX_RATES]) {
11188 		err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
11189 		if (err)
11190 			return err;
11191 
11192 		if (!setup.chandef.chan)
11193 			return -EINVAL;
11194 
11195 		err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
11196 					      &setup.beacon_rate);
11197 		if (err)
11198 			return err;
11199 	}
11200 
11201 	setup.userspace_handles_dfs =
11202 		nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
11203 
11204 	if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
11205 		int r = validate_pae_over_nl80211(rdev, info);
11206 
11207 		if (r < 0)
11208 			return r;
11209 
11210 		setup.control_port_over_nl80211 = true;
11211 	}
11212 
11213 	wdev_lock(dev->ieee80211_ptr);
11214 	err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg);
11215 	if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER])
11216 		dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
11217 	wdev_unlock(dev->ieee80211_ptr);
11218 
11219 	return err;
11220 }
11221 
11222 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
11223 {
11224 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11225 	struct net_device *dev = info->user_ptr[1];
11226 
11227 	return cfg80211_leave_mesh(rdev, dev);
11228 }
11229 
11230 #ifdef CONFIG_PM
11231 static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
11232 					struct cfg80211_registered_device *rdev)
11233 {
11234 	struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
11235 	struct nlattr *nl_pats, *nl_pat;
11236 	int i, pat_len;
11237 
11238 	if (!wowlan->n_patterns)
11239 		return 0;
11240 
11241 	nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
11242 	if (!nl_pats)
11243 		return -ENOBUFS;
11244 
11245 	for (i = 0; i < wowlan->n_patterns; i++) {
11246 		nl_pat = nla_nest_start_noflag(msg, i + 1);
11247 		if (!nl_pat)
11248 			return -ENOBUFS;
11249 		pat_len = wowlan->patterns[i].pattern_len;
11250 		if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
11251 			    wowlan->patterns[i].mask) ||
11252 		    nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
11253 			    wowlan->patterns[i].pattern) ||
11254 		    nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
11255 				wowlan->patterns[i].pkt_offset))
11256 			return -ENOBUFS;
11257 		nla_nest_end(msg, nl_pat);
11258 	}
11259 	nla_nest_end(msg, nl_pats);
11260 
11261 	return 0;
11262 }
11263 
11264 static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
11265 				   struct cfg80211_wowlan_tcp *tcp)
11266 {
11267 	struct nlattr *nl_tcp;
11268 
11269 	if (!tcp)
11270 		return 0;
11271 
11272 	nl_tcp = nla_nest_start_noflag(msg,
11273 				       NL80211_WOWLAN_TRIG_TCP_CONNECTION);
11274 	if (!nl_tcp)
11275 		return -ENOBUFS;
11276 
11277 	if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
11278 	    nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
11279 	    nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
11280 	    nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
11281 	    nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
11282 	    nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
11283 		    tcp->payload_len, tcp->payload) ||
11284 	    nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
11285 			tcp->data_interval) ||
11286 	    nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
11287 		    tcp->wake_len, tcp->wake_data) ||
11288 	    nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
11289 		    DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
11290 		return -ENOBUFS;
11291 
11292 	if (tcp->payload_seq.len &&
11293 	    nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
11294 		    sizeof(tcp->payload_seq), &tcp->payload_seq))
11295 		return -ENOBUFS;
11296 
11297 	if (tcp->payload_tok.len &&
11298 	    nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
11299 		    sizeof(tcp->payload_tok) + tcp->tokens_size,
11300 		    &tcp->payload_tok))
11301 		return -ENOBUFS;
11302 
11303 	nla_nest_end(msg, nl_tcp);
11304 
11305 	return 0;
11306 }
11307 
11308 static int nl80211_send_wowlan_nd(struct sk_buff *msg,
11309 				  struct cfg80211_sched_scan_request *req)
11310 {
11311 	struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
11312 	int i;
11313 
11314 	if (!req)
11315 		return 0;
11316 
11317 	nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
11318 	if (!nd)
11319 		return -ENOBUFS;
11320 
11321 	if (req->n_scan_plans == 1 &&
11322 	    nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
11323 			req->scan_plans[0].interval * 1000))
11324 		return -ENOBUFS;
11325 
11326 	if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
11327 		return -ENOBUFS;
11328 
11329 	if (req->relative_rssi_set) {
11330 		struct nl80211_bss_select_rssi_adjust rssi_adjust;
11331 
11332 		if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
11333 			       req->relative_rssi))
11334 			return -ENOBUFS;
11335 
11336 		rssi_adjust.band = req->rssi_adjust.band;
11337 		rssi_adjust.delta = req->rssi_adjust.delta;
11338 		if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
11339 			    sizeof(rssi_adjust), &rssi_adjust))
11340 			return -ENOBUFS;
11341 	}
11342 
11343 	freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES);
11344 	if (!freqs)
11345 		return -ENOBUFS;
11346 
11347 	for (i = 0; i < req->n_channels; i++) {
11348 		if (nla_put_u32(msg, i, req->channels[i]->center_freq))
11349 			return -ENOBUFS;
11350 	}
11351 
11352 	nla_nest_end(msg, freqs);
11353 
11354 	if (req->n_match_sets) {
11355 		matches = nla_nest_start_noflag(msg,
11356 						NL80211_ATTR_SCHED_SCAN_MATCH);
11357 		if (!matches)
11358 			return -ENOBUFS;
11359 
11360 		for (i = 0; i < req->n_match_sets; i++) {
11361 			match = nla_nest_start_noflag(msg, i);
11362 			if (!match)
11363 				return -ENOBUFS;
11364 
11365 			if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
11366 				    req->match_sets[i].ssid.ssid_len,
11367 				    req->match_sets[i].ssid.ssid))
11368 				return -ENOBUFS;
11369 			nla_nest_end(msg, match);
11370 		}
11371 		nla_nest_end(msg, matches);
11372 	}
11373 
11374 	scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
11375 	if (!scan_plans)
11376 		return -ENOBUFS;
11377 
11378 	for (i = 0; i < req->n_scan_plans; i++) {
11379 		scan_plan = nla_nest_start_noflag(msg, i + 1);
11380 		if (!scan_plan)
11381 			return -ENOBUFS;
11382 
11383 		if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
11384 				req->scan_plans[i].interval) ||
11385 		    (req->scan_plans[i].iterations &&
11386 		     nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
11387 				 req->scan_plans[i].iterations)))
11388 			return -ENOBUFS;
11389 		nla_nest_end(msg, scan_plan);
11390 	}
11391 	nla_nest_end(msg, scan_plans);
11392 
11393 	nla_nest_end(msg, nd);
11394 
11395 	return 0;
11396 }
11397 
11398 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
11399 {
11400 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11401 	struct sk_buff *msg;
11402 	void *hdr;
11403 	u32 size = NLMSG_DEFAULT_SIZE;
11404 
11405 	if (!rdev->wiphy.wowlan)
11406 		return -EOPNOTSUPP;
11407 
11408 	if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
11409 		/* adjust size to have room for all the data */
11410 		size += rdev->wiphy.wowlan_config->tcp->tokens_size +
11411 			rdev->wiphy.wowlan_config->tcp->payload_len +
11412 			rdev->wiphy.wowlan_config->tcp->wake_len +
11413 			rdev->wiphy.wowlan_config->tcp->wake_len / 8;
11414 	}
11415 
11416 	msg = nlmsg_new(size, GFP_KERNEL);
11417 	if (!msg)
11418 		return -ENOMEM;
11419 
11420 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11421 			     NL80211_CMD_GET_WOWLAN);
11422 	if (!hdr)
11423 		goto nla_put_failure;
11424 
11425 	if (rdev->wiphy.wowlan_config) {
11426 		struct nlattr *nl_wowlan;
11427 
11428 		nl_wowlan = nla_nest_start_noflag(msg,
11429 						  NL80211_ATTR_WOWLAN_TRIGGERS);
11430 		if (!nl_wowlan)
11431 			goto nla_put_failure;
11432 
11433 		if ((rdev->wiphy.wowlan_config->any &&
11434 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
11435 		    (rdev->wiphy.wowlan_config->disconnect &&
11436 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
11437 		    (rdev->wiphy.wowlan_config->magic_pkt &&
11438 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
11439 		    (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
11440 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
11441 		    (rdev->wiphy.wowlan_config->eap_identity_req &&
11442 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
11443 		    (rdev->wiphy.wowlan_config->four_way_handshake &&
11444 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
11445 		    (rdev->wiphy.wowlan_config->rfkill_release &&
11446 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
11447 			goto nla_put_failure;
11448 
11449 		if (nl80211_send_wowlan_patterns(msg, rdev))
11450 			goto nla_put_failure;
11451 
11452 		if (nl80211_send_wowlan_tcp(msg,
11453 					    rdev->wiphy.wowlan_config->tcp))
11454 			goto nla_put_failure;
11455 
11456 		if (nl80211_send_wowlan_nd(
11457 			    msg,
11458 			    rdev->wiphy.wowlan_config->nd_config))
11459 			goto nla_put_failure;
11460 
11461 		nla_nest_end(msg, nl_wowlan);
11462 	}
11463 
11464 	genlmsg_end(msg, hdr);
11465 	return genlmsg_reply(msg, info);
11466 
11467 nla_put_failure:
11468 	nlmsg_free(msg);
11469 	return -ENOBUFS;
11470 }
11471 
11472 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
11473 				    struct nlattr *attr,
11474 				    struct cfg80211_wowlan *trig)
11475 {
11476 	struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
11477 	struct cfg80211_wowlan_tcp *cfg;
11478 	struct nl80211_wowlan_tcp_data_token *tok = NULL;
11479 	struct nl80211_wowlan_tcp_data_seq *seq = NULL;
11480 	u32 size;
11481 	u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
11482 	int err, port;
11483 
11484 	if (!rdev->wiphy.wowlan->tcp)
11485 		return -EINVAL;
11486 
11487 	err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr,
11488 					  nl80211_wowlan_tcp_policy, NULL);
11489 	if (err)
11490 		return err;
11491 
11492 	if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
11493 	    !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
11494 	    !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
11495 	    !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
11496 	    !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
11497 	    !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
11498 	    !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
11499 	    !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
11500 		return -EINVAL;
11501 
11502 	data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
11503 	if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
11504 		return -EINVAL;
11505 
11506 	if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
11507 			rdev->wiphy.wowlan->tcp->data_interval_max ||
11508 	    nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
11509 		return -EINVAL;
11510 
11511 	wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
11512 	if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
11513 		return -EINVAL;
11514 
11515 	wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
11516 	if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
11517 		return -EINVAL;
11518 
11519 	if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
11520 		u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
11521 
11522 		tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
11523 		tokens_size = tokln - sizeof(*tok);
11524 
11525 		if (!tok->len || tokens_size % tok->len)
11526 			return -EINVAL;
11527 		if (!rdev->wiphy.wowlan->tcp->tok)
11528 			return -EINVAL;
11529 		if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
11530 			return -EINVAL;
11531 		if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
11532 			return -EINVAL;
11533 		if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
11534 			return -EINVAL;
11535 		if (tok->offset + tok->len > data_size)
11536 			return -EINVAL;
11537 	}
11538 
11539 	if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
11540 		seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
11541 		if (!rdev->wiphy.wowlan->tcp->seq)
11542 			return -EINVAL;
11543 		if (seq->len == 0 || seq->len > 4)
11544 			return -EINVAL;
11545 		if (seq->len + seq->offset > data_size)
11546 			return -EINVAL;
11547 	}
11548 
11549 	size = sizeof(*cfg);
11550 	size += data_size;
11551 	size += wake_size + wake_mask_size;
11552 	size += tokens_size;
11553 
11554 	cfg = kzalloc(size, GFP_KERNEL);
11555 	if (!cfg)
11556 		return -ENOMEM;
11557 	cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
11558 	cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
11559 	memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
11560 	       ETH_ALEN);
11561 	if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
11562 		port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
11563 	else
11564 		port = 0;
11565 #ifdef CONFIG_INET
11566 	/* allocate a socket and port for it and use it */
11567 	err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
11568 			    IPPROTO_TCP, &cfg->sock, 1);
11569 	if (err) {
11570 		kfree(cfg);
11571 		return err;
11572 	}
11573 	if (inet_csk_get_port(cfg->sock->sk, port)) {
11574 		sock_release(cfg->sock);
11575 		kfree(cfg);
11576 		return -EADDRINUSE;
11577 	}
11578 	cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
11579 #else
11580 	if (!port) {
11581 		kfree(cfg);
11582 		return -EINVAL;
11583 	}
11584 	cfg->src_port = port;
11585 #endif
11586 
11587 	cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
11588 	cfg->payload_len = data_size;
11589 	cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
11590 	memcpy((void *)cfg->payload,
11591 	       nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
11592 	       data_size);
11593 	if (seq)
11594 		cfg->payload_seq = *seq;
11595 	cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
11596 	cfg->wake_len = wake_size;
11597 	cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
11598 	memcpy((void *)cfg->wake_data,
11599 	       nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
11600 	       wake_size);
11601 	cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
11602 			 data_size + wake_size;
11603 	memcpy((void *)cfg->wake_mask,
11604 	       nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
11605 	       wake_mask_size);
11606 	if (tok) {
11607 		cfg->tokens_size = tokens_size;
11608 		memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
11609 	}
11610 
11611 	trig->tcp = cfg;
11612 
11613 	return 0;
11614 }
11615 
11616 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
11617 				   const struct wiphy_wowlan_support *wowlan,
11618 				   struct nlattr *attr,
11619 				   struct cfg80211_wowlan *trig)
11620 {
11621 	struct nlattr **tb;
11622 	int err;
11623 
11624 	tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
11625 	if (!tb)
11626 		return -ENOMEM;
11627 
11628 	if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
11629 		err = -EOPNOTSUPP;
11630 		goto out;
11631 	}
11632 
11633 	err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr,
11634 					  nl80211_policy, NULL);
11635 	if (err)
11636 		goto out;
11637 
11638 	trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
11639 						   wowlan->max_nd_match_sets);
11640 	err = PTR_ERR_OR_ZERO(trig->nd_config);
11641 	if (err)
11642 		trig->nd_config = NULL;
11643 
11644 out:
11645 	kfree(tb);
11646 	return err;
11647 }
11648 
11649 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
11650 {
11651 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11652 	struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
11653 	struct cfg80211_wowlan new_triggers = {};
11654 	struct cfg80211_wowlan *ntrig;
11655 	const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
11656 	int err, i;
11657 	bool prev_enabled = rdev->wiphy.wowlan_config;
11658 	bool regular = false;
11659 
11660 	if (!wowlan)
11661 		return -EOPNOTSUPP;
11662 
11663 	if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
11664 		cfg80211_rdev_free_wowlan(rdev);
11665 		rdev->wiphy.wowlan_config = NULL;
11666 		goto set_wakeup;
11667 	}
11668 
11669 	err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG,
11670 					  info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
11671 					  nl80211_wowlan_policy, info->extack);
11672 	if (err)
11673 		return err;
11674 
11675 	if (tb[NL80211_WOWLAN_TRIG_ANY]) {
11676 		if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
11677 			return -EINVAL;
11678 		new_triggers.any = true;
11679 	}
11680 
11681 	if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
11682 		if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
11683 			return -EINVAL;
11684 		new_triggers.disconnect = true;
11685 		regular = true;
11686 	}
11687 
11688 	if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
11689 		if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
11690 			return -EINVAL;
11691 		new_triggers.magic_pkt = true;
11692 		regular = true;
11693 	}
11694 
11695 	if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
11696 		return -EINVAL;
11697 
11698 	if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
11699 		if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
11700 			return -EINVAL;
11701 		new_triggers.gtk_rekey_failure = true;
11702 		regular = true;
11703 	}
11704 
11705 	if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
11706 		if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
11707 			return -EINVAL;
11708 		new_triggers.eap_identity_req = true;
11709 		regular = true;
11710 	}
11711 
11712 	if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
11713 		if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
11714 			return -EINVAL;
11715 		new_triggers.four_way_handshake = true;
11716 		regular = true;
11717 	}
11718 
11719 	if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
11720 		if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
11721 			return -EINVAL;
11722 		new_triggers.rfkill_release = true;
11723 		regular = true;
11724 	}
11725 
11726 	if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
11727 		struct nlattr *pat;
11728 		int n_patterns = 0;
11729 		int rem, pat_len, mask_len, pkt_offset;
11730 		struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
11731 
11732 		regular = true;
11733 
11734 		nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
11735 				    rem)
11736 			n_patterns++;
11737 		if (n_patterns > wowlan->n_patterns)
11738 			return -EINVAL;
11739 
11740 		new_triggers.patterns = kcalloc(n_patterns,
11741 						sizeof(new_triggers.patterns[0]),
11742 						GFP_KERNEL);
11743 		if (!new_triggers.patterns)
11744 			return -ENOMEM;
11745 
11746 		new_triggers.n_patterns = n_patterns;
11747 		i = 0;
11748 
11749 		nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
11750 				    rem) {
11751 			u8 *mask_pat;
11752 
11753 			err = nla_parse_nested_deprecated(pat_tb,
11754 							  MAX_NL80211_PKTPAT,
11755 							  pat,
11756 							  nl80211_packet_pattern_policy,
11757 							  info->extack);
11758 			if (err)
11759 				goto error;
11760 
11761 			err = -EINVAL;
11762 			if (!pat_tb[NL80211_PKTPAT_MASK] ||
11763 			    !pat_tb[NL80211_PKTPAT_PATTERN])
11764 				goto error;
11765 			pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
11766 			mask_len = DIV_ROUND_UP(pat_len, 8);
11767 			if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
11768 				goto error;
11769 			if (pat_len > wowlan->pattern_max_len ||
11770 			    pat_len < wowlan->pattern_min_len)
11771 				goto error;
11772 
11773 			if (!pat_tb[NL80211_PKTPAT_OFFSET])
11774 				pkt_offset = 0;
11775 			else
11776 				pkt_offset = nla_get_u32(
11777 					pat_tb[NL80211_PKTPAT_OFFSET]);
11778 			if (pkt_offset > wowlan->max_pkt_offset)
11779 				goto error;
11780 			new_triggers.patterns[i].pkt_offset = pkt_offset;
11781 
11782 			mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
11783 			if (!mask_pat) {
11784 				err = -ENOMEM;
11785 				goto error;
11786 			}
11787 			new_triggers.patterns[i].mask = mask_pat;
11788 			memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
11789 			       mask_len);
11790 			mask_pat += mask_len;
11791 			new_triggers.patterns[i].pattern = mask_pat;
11792 			new_triggers.patterns[i].pattern_len = pat_len;
11793 			memcpy(mask_pat,
11794 			       nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
11795 			       pat_len);
11796 			i++;
11797 		}
11798 	}
11799 
11800 	if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
11801 		regular = true;
11802 		err = nl80211_parse_wowlan_tcp(
11803 			rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
11804 			&new_triggers);
11805 		if (err)
11806 			goto error;
11807 	}
11808 
11809 	if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
11810 		regular = true;
11811 		err = nl80211_parse_wowlan_nd(
11812 			rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
11813 			&new_triggers);
11814 		if (err)
11815 			goto error;
11816 	}
11817 
11818 	/* The 'any' trigger means the device continues operating more or less
11819 	 * as in its normal operation mode and wakes up the host on most of the
11820 	 * normal interrupts (like packet RX, ...)
11821 	 * It therefore makes little sense to combine with the more constrained
11822 	 * wakeup trigger modes.
11823 	 */
11824 	if (new_triggers.any && regular) {
11825 		err = -EINVAL;
11826 		goto error;
11827 	}
11828 
11829 	ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
11830 	if (!ntrig) {
11831 		err = -ENOMEM;
11832 		goto error;
11833 	}
11834 	cfg80211_rdev_free_wowlan(rdev);
11835 	rdev->wiphy.wowlan_config = ntrig;
11836 
11837  set_wakeup:
11838 	if (rdev->ops->set_wakeup &&
11839 	    prev_enabled != !!rdev->wiphy.wowlan_config)
11840 		rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
11841 
11842 	return 0;
11843  error:
11844 	for (i = 0; i < new_triggers.n_patterns; i++)
11845 		kfree(new_triggers.patterns[i].mask);
11846 	kfree(new_triggers.patterns);
11847 	if (new_triggers.tcp && new_triggers.tcp->sock)
11848 		sock_release(new_triggers.tcp->sock);
11849 	kfree(new_triggers.tcp);
11850 	kfree(new_triggers.nd_config);
11851 	return err;
11852 }
11853 #endif
11854 
11855 static int nl80211_send_coalesce_rules(struct sk_buff *msg,
11856 				       struct cfg80211_registered_device *rdev)
11857 {
11858 	struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
11859 	int i, j, pat_len;
11860 	struct cfg80211_coalesce_rules *rule;
11861 
11862 	if (!rdev->coalesce->n_rules)
11863 		return 0;
11864 
11865 	nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE);
11866 	if (!nl_rules)
11867 		return -ENOBUFS;
11868 
11869 	for (i = 0; i < rdev->coalesce->n_rules; i++) {
11870 		nl_rule = nla_nest_start_noflag(msg, i + 1);
11871 		if (!nl_rule)
11872 			return -ENOBUFS;
11873 
11874 		rule = &rdev->coalesce->rules[i];
11875 		if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
11876 				rule->delay))
11877 			return -ENOBUFS;
11878 
11879 		if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
11880 				rule->condition))
11881 			return -ENOBUFS;
11882 
11883 		nl_pats = nla_nest_start_noflag(msg,
11884 						NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
11885 		if (!nl_pats)
11886 			return -ENOBUFS;
11887 
11888 		for (j = 0; j < rule->n_patterns; j++) {
11889 			nl_pat = nla_nest_start_noflag(msg, j + 1);
11890 			if (!nl_pat)
11891 				return -ENOBUFS;
11892 			pat_len = rule->patterns[j].pattern_len;
11893 			if (nla_put(msg, NL80211_PKTPAT_MASK,
11894 				    DIV_ROUND_UP(pat_len, 8),
11895 				    rule->patterns[j].mask) ||
11896 			    nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
11897 				    rule->patterns[j].pattern) ||
11898 			    nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
11899 					rule->patterns[j].pkt_offset))
11900 				return -ENOBUFS;
11901 			nla_nest_end(msg, nl_pat);
11902 		}
11903 		nla_nest_end(msg, nl_pats);
11904 		nla_nest_end(msg, nl_rule);
11905 	}
11906 	nla_nest_end(msg, nl_rules);
11907 
11908 	return 0;
11909 }
11910 
11911 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
11912 {
11913 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11914 	struct sk_buff *msg;
11915 	void *hdr;
11916 
11917 	if (!rdev->wiphy.coalesce)
11918 		return -EOPNOTSUPP;
11919 
11920 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11921 	if (!msg)
11922 		return -ENOMEM;
11923 
11924 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11925 			     NL80211_CMD_GET_COALESCE);
11926 	if (!hdr)
11927 		goto nla_put_failure;
11928 
11929 	if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
11930 		goto nla_put_failure;
11931 
11932 	genlmsg_end(msg, hdr);
11933 	return genlmsg_reply(msg, info);
11934 
11935 nla_put_failure:
11936 	nlmsg_free(msg);
11937 	return -ENOBUFS;
11938 }
11939 
11940 void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
11941 {
11942 	struct cfg80211_coalesce *coalesce = rdev->coalesce;
11943 	int i, j;
11944 	struct cfg80211_coalesce_rules *rule;
11945 
11946 	if (!coalesce)
11947 		return;
11948 
11949 	for (i = 0; i < coalesce->n_rules; i++) {
11950 		rule = &coalesce->rules[i];
11951 		for (j = 0; j < rule->n_patterns; j++)
11952 			kfree(rule->patterns[j].mask);
11953 		kfree(rule->patterns);
11954 	}
11955 	kfree(coalesce->rules);
11956 	kfree(coalesce);
11957 	rdev->coalesce = NULL;
11958 }
11959 
11960 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
11961 				       struct nlattr *rule,
11962 				       struct cfg80211_coalesce_rules *new_rule)
11963 {
11964 	int err, i;
11965 	const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
11966 	struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
11967 	int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
11968 	struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
11969 
11970 	err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX,
11971 					  rule, nl80211_coalesce_policy, NULL);
11972 	if (err)
11973 		return err;
11974 
11975 	if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
11976 		new_rule->delay =
11977 			nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
11978 	if (new_rule->delay > coalesce->max_delay)
11979 		return -EINVAL;
11980 
11981 	if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
11982 		new_rule->condition =
11983 			nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
11984 
11985 	if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
11986 		return -EINVAL;
11987 
11988 	nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
11989 			    rem)
11990 		n_patterns++;
11991 	if (n_patterns > coalesce->n_patterns)
11992 		return -EINVAL;
11993 
11994 	new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
11995 				     GFP_KERNEL);
11996 	if (!new_rule->patterns)
11997 		return -ENOMEM;
11998 
11999 	new_rule->n_patterns = n_patterns;
12000 	i = 0;
12001 
12002 	nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
12003 			    rem) {
12004 		u8 *mask_pat;
12005 
12006 		err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT,
12007 						  pat,
12008 						  nl80211_packet_pattern_policy,
12009 						  NULL);
12010 		if (err)
12011 			return err;
12012 
12013 		if (!pat_tb[NL80211_PKTPAT_MASK] ||
12014 		    !pat_tb[NL80211_PKTPAT_PATTERN])
12015 			return -EINVAL;
12016 		pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
12017 		mask_len = DIV_ROUND_UP(pat_len, 8);
12018 		if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
12019 			return -EINVAL;
12020 		if (pat_len > coalesce->pattern_max_len ||
12021 		    pat_len < coalesce->pattern_min_len)
12022 			return -EINVAL;
12023 
12024 		if (!pat_tb[NL80211_PKTPAT_OFFSET])
12025 			pkt_offset = 0;
12026 		else
12027 			pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
12028 		if (pkt_offset > coalesce->max_pkt_offset)
12029 			return -EINVAL;
12030 		new_rule->patterns[i].pkt_offset = pkt_offset;
12031 
12032 		mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
12033 		if (!mask_pat)
12034 			return -ENOMEM;
12035 
12036 		new_rule->patterns[i].mask = mask_pat;
12037 		memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
12038 		       mask_len);
12039 
12040 		mask_pat += mask_len;
12041 		new_rule->patterns[i].pattern = mask_pat;
12042 		new_rule->patterns[i].pattern_len = pat_len;
12043 		memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
12044 		       pat_len);
12045 		i++;
12046 	}
12047 
12048 	return 0;
12049 }
12050 
12051 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
12052 {
12053 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12054 	const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
12055 	struct cfg80211_coalesce new_coalesce = {};
12056 	struct cfg80211_coalesce *n_coalesce;
12057 	int err, rem_rule, n_rules = 0, i, j;
12058 	struct nlattr *rule;
12059 	struct cfg80211_coalesce_rules *tmp_rule;
12060 
12061 	if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
12062 		return -EOPNOTSUPP;
12063 
12064 	if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
12065 		cfg80211_rdev_free_coalesce(rdev);
12066 		rdev_set_coalesce(rdev, NULL);
12067 		return 0;
12068 	}
12069 
12070 	nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
12071 			    rem_rule)
12072 		n_rules++;
12073 	if (n_rules > coalesce->n_rules)
12074 		return -EINVAL;
12075 
12076 	new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
12077 				     GFP_KERNEL);
12078 	if (!new_coalesce.rules)
12079 		return -ENOMEM;
12080 
12081 	new_coalesce.n_rules = n_rules;
12082 	i = 0;
12083 
12084 	nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
12085 			    rem_rule) {
12086 		err = nl80211_parse_coalesce_rule(rdev, rule,
12087 						  &new_coalesce.rules[i]);
12088 		if (err)
12089 			goto error;
12090 
12091 		i++;
12092 	}
12093 
12094 	err = rdev_set_coalesce(rdev, &new_coalesce);
12095 	if (err)
12096 		goto error;
12097 
12098 	n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
12099 	if (!n_coalesce) {
12100 		err = -ENOMEM;
12101 		goto error;
12102 	}
12103 	cfg80211_rdev_free_coalesce(rdev);
12104 	rdev->coalesce = n_coalesce;
12105 
12106 	return 0;
12107 error:
12108 	for (i = 0; i < new_coalesce.n_rules; i++) {
12109 		tmp_rule = &new_coalesce.rules[i];
12110 		for (j = 0; j < tmp_rule->n_patterns; j++)
12111 			kfree(tmp_rule->patterns[j].mask);
12112 		kfree(tmp_rule->patterns);
12113 	}
12114 	kfree(new_coalesce.rules);
12115 
12116 	return err;
12117 }
12118 
12119 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
12120 {
12121 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12122 	struct net_device *dev = info->user_ptr[1];
12123 	struct wireless_dev *wdev = dev->ieee80211_ptr;
12124 	struct nlattr *tb[NUM_NL80211_REKEY_DATA];
12125 	struct cfg80211_gtk_rekey_data rekey_data;
12126 	int err;
12127 
12128 	if (!info->attrs[NL80211_ATTR_REKEY_DATA])
12129 		return -EINVAL;
12130 
12131 	err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA,
12132 					  info->attrs[NL80211_ATTR_REKEY_DATA],
12133 					  nl80211_rekey_policy, info->extack);
12134 	if (err)
12135 		return err;
12136 
12137 	if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] ||
12138 	    !tb[NL80211_REKEY_DATA_KCK])
12139 		return -EINVAL;
12140 	if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
12141 		return -ERANGE;
12142 	if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
12143 		return -ERANGE;
12144 	if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
12145 		return -ERANGE;
12146 
12147 	rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
12148 	rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
12149 	rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
12150 
12151 	wdev_lock(wdev);
12152 	if (!wdev->current_bss) {
12153 		err = -ENOTCONN;
12154 		goto out;
12155 	}
12156 
12157 	if (!rdev->ops->set_rekey_data) {
12158 		err = -EOPNOTSUPP;
12159 		goto out;
12160 	}
12161 
12162 	err = rdev_set_rekey_data(rdev, dev, &rekey_data);
12163  out:
12164 	wdev_unlock(wdev);
12165 	return err;
12166 }
12167 
12168 static int nl80211_register_unexpected_frame(struct sk_buff *skb,
12169 					     struct genl_info *info)
12170 {
12171 	struct net_device *dev = info->user_ptr[1];
12172 	struct wireless_dev *wdev = dev->ieee80211_ptr;
12173 
12174 	if (wdev->iftype != NL80211_IFTYPE_AP &&
12175 	    wdev->iftype != NL80211_IFTYPE_P2P_GO)
12176 		return -EINVAL;
12177 
12178 	if (wdev->ap_unexpected_nlportid)
12179 		return -EBUSY;
12180 
12181 	wdev->ap_unexpected_nlportid = info->snd_portid;
12182 	return 0;
12183 }
12184 
12185 static int nl80211_probe_client(struct sk_buff *skb,
12186 				struct genl_info *info)
12187 {
12188 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12189 	struct net_device *dev = info->user_ptr[1];
12190 	struct wireless_dev *wdev = dev->ieee80211_ptr;
12191 	struct sk_buff *msg;
12192 	void *hdr;
12193 	const u8 *addr;
12194 	u64 cookie;
12195 	int err;
12196 
12197 	if (wdev->iftype != NL80211_IFTYPE_AP &&
12198 	    wdev->iftype != NL80211_IFTYPE_P2P_GO)
12199 		return -EOPNOTSUPP;
12200 
12201 	if (!info->attrs[NL80211_ATTR_MAC])
12202 		return -EINVAL;
12203 
12204 	if (!rdev->ops->probe_client)
12205 		return -EOPNOTSUPP;
12206 
12207 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12208 	if (!msg)
12209 		return -ENOMEM;
12210 
12211 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12212 			     NL80211_CMD_PROBE_CLIENT);
12213 	if (!hdr) {
12214 		err = -ENOBUFS;
12215 		goto free_msg;
12216 	}
12217 
12218 	addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
12219 
12220 	err = rdev_probe_client(rdev, dev, addr, &cookie);
12221 	if (err)
12222 		goto free_msg;
12223 
12224 	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
12225 			      NL80211_ATTR_PAD))
12226 		goto nla_put_failure;
12227 
12228 	genlmsg_end(msg, hdr);
12229 
12230 	return genlmsg_reply(msg, info);
12231 
12232  nla_put_failure:
12233 	err = -ENOBUFS;
12234  free_msg:
12235 	nlmsg_free(msg);
12236 	return err;
12237 }
12238 
12239 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
12240 {
12241 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12242 	struct cfg80211_beacon_registration *reg, *nreg;
12243 	int rv;
12244 
12245 	if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
12246 		return -EOPNOTSUPP;
12247 
12248 	nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
12249 	if (!nreg)
12250 		return -ENOMEM;
12251 
12252 	/* First, check if already registered. */
12253 	spin_lock_bh(&rdev->beacon_registrations_lock);
12254 	list_for_each_entry(reg, &rdev->beacon_registrations, list) {
12255 		if (reg->nlportid == info->snd_portid) {
12256 			rv = -EALREADY;
12257 			goto out_err;
12258 		}
12259 	}
12260 	/* Add it to the list */
12261 	nreg->nlportid = info->snd_portid;
12262 	list_add(&nreg->list, &rdev->beacon_registrations);
12263 
12264 	spin_unlock_bh(&rdev->beacon_registrations_lock);
12265 
12266 	return 0;
12267 out_err:
12268 	spin_unlock_bh(&rdev->beacon_registrations_lock);
12269 	kfree(nreg);
12270 	return rv;
12271 }
12272 
12273 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
12274 {
12275 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12276 	struct wireless_dev *wdev = info->user_ptr[1];
12277 	int err;
12278 
12279 	if (!rdev->ops->start_p2p_device)
12280 		return -EOPNOTSUPP;
12281 
12282 	if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
12283 		return -EOPNOTSUPP;
12284 
12285 	if (wdev_running(wdev))
12286 		return 0;
12287 
12288 	if (rfkill_blocked(rdev->rfkill))
12289 		return -ERFKILL;
12290 
12291 	err = rdev_start_p2p_device(rdev, wdev);
12292 	if (err)
12293 		return err;
12294 
12295 	wdev->is_running = true;
12296 	rdev->opencount++;
12297 
12298 	return 0;
12299 }
12300 
12301 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
12302 {
12303 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12304 	struct wireless_dev *wdev = info->user_ptr[1];
12305 
12306 	if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
12307 		return -EOPNOTSUPP;
12308 
12309 	if (!rdev->ops->stop_p2p_device)
12310 		return -EOPNOTSUPP;
12311 
12312 	cfg80211_stop_p2p_device(rdev, wdev);
12313 
12314 	return 0;
12315 }
12316 
12317 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
12318 {
12319 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12320 	struct wireless_dev *wdev = info->user_ptr[1];
12321 	struct cfg80211_nan_conf conf = {};
12322 	int err;
12323 
12324 	if (wdev->iftype != NL80211_IFTYPE_NAN)
12325 		return -EOPNOTSUPP;
12326 
12327 	if (wdev_running(wdev))
12328 		return -EEXIST;
12329 
12330 	if (rfkill_blocked(rdev->rfkill))
12331 		return -ERFKILL;
12332 
12333 	if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
12334 		return -EINVAL;
12335 
12336 	conf.master_pref =
12337 		nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
12338 
12339 	if (info->attrs[NL80211_ATTR_BANDS]) {
12340 		u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
12341 
12342 		if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
12343 			return -EOPNOTSUPP;
12344 
12345 		if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
12346 			return -EINVAL;
12347 
12348 		conf.bands = bands;
12349 	}
12350 
12351 	err = rdev_start_nan(rdev, wdev, &conf);
12352 	if (err)
12353 		return err;
12354 
12355 	wdev->is_running = true;
12356 	rdev->opencount++;
12357 
12358 	return 0;
12359 }
12360 
12361 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
12362 {
12363 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12364 	struct wireless_dev *wdev = info->user_ptr[1];
12365 
12366 	if (wdev->iftype != NL80211_IFTYPE_NAN)
12367 		return -EOPNOTSUPP;
12368 
12369 	cfg80211_stop_nan(rdev, wdev);
12370 
12371 	return 0;
12372 }
12373 
12374 static int validate_nan_filter(struct nlattr *filter_attr)
12375 {
12376 	struct nlattr *attr;
12377 	int len = 0, n_entries = 0, rem;
12378 
12379 	nla_for_each_nested(attr, filter_attr, rem) {
12380 		len += nla_len(attr);
12381 		n_entries++;
12382 	}
12383 
12384 	if (len >= U8_MAX)
12385 		return -EINVAL;
12386 
12387 	return n_entries;
12388 }
12389 
12390 static int handle_nan_filter(struct nlattr *attr_filter,
12391 			     struct cfg80211_nan_func *func,
12392 			     bool tx)
12393 {
12394 	struct nlattr *attr;
12395 	int n_entries, rem, i;
12396 	struct cfg80211_nan_func_filter *filter;
12397 
12398 	n_entries = validate_nan_filter(attr_filter);
12399 	if (n_entries < 0)
12400 		return n_entries;
12401 
12402 	BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
12403 
12404 	filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
12405 	if (!filter)
12406 		return -ENOMEM;
12407 
12408 	i = 0;
12409 	nla_for_each_nested(attr, attr_filter, rem) {
12410 		filter[i].filter = nla_memdup(attr, GFP_KERNEL);
12411 		filter[i].len = nla_len(attr);
12412 		i++;
12413 	}
12414 	if (tx) {
12415 		func->num_tx_filters = n_entries;
12416 		func->tx_filters = filter;
12417 	} else {
12418 		func->num_rx_filters = n_entries;
12419 		func->rx_filters = filter;
12420 	}
12421 
12422 	return 0;
12423 }
12424 
12425 static int nl80211_nan_add_func(struct sk_buff *skb,
12426 				struct genl_info *info)
12427 {
12428 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12429 	struct wireless_dev *wdev = info->user_ptr[1];
12430 	struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
12431 	struct cfg80211_nan_func *func;
12432 	struct sk_buff *msg = NULL;
12433 	void *hdr = NULL;
12434 	int err = 0;
12435 
12436 	if (wdev->iftype != NL80211_IFTYPE_NAN)
12437 		return -EOPNOTSUPP;
12438 
12439 	if (!wdev_running(wdev))
12440 		return -ENOTCONN;
12441 
12442 	if (!info->attrs[NL80211_ATTR_NAN_FUNC])
12443 		return -EINVAL;
12444 
12445 	err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX,
12446 					  info->attrs[NL80211_ATTR_NAN_FUNC],
12447 					  nl80211_nan_func_policy,
12448 					  info->extack);
12449 	if (err)
12450 		return err;
12451 
12452 	func = kzalloc(sizeof(*func), GFP_KERNEL);
12453 	if (!func)
12454 		return -ENOMEM;
12455 
12456 	func->cookie = cfg80211_assign_cookie(rdev);
12457 
12458 	if (!tb[NL80211_NAN_FUNC_TYPE] ||
12459 	    nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
12460 		err = -EINVAL;
12461 		goto out;
12462 	}
12463 
12464 
12465 	func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
12466 
12467 	if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
12468 		err = -EINVAL;
12469 		goto out;
12470 	}
12471 
12472 	memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
12473 	       sizeof(func->service_id));
12474 
12475 	func->close_range =
12476 		nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
12477 
12478 	if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
12479 		func->serv_spec_info_len =
12480 			nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
12481 		func->serv_spec_info =
12482 			kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
12483 				func->serv_spec_info_len,
12484 				GFP_KERNEL);
12485 		if (!func->serv_spec_info) {
12486 			err = -ENOMEM;
12487 			goto out;
12488 		}
12489 	}
12490 
12491 	if (tb[NL80211_NAN_FUNC_TTL])
12492 		func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
12493 
12494 	switch (func->type) {
12495 	case NL80211_NAN_FUNC_PUBLISH:
12496 		if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
12497 			err = -EINVAL;
12498 			goto out;
12499 		}
12500 
12501 		func->publish_type =
12502 			nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
12503 		func->publish_bcast =
12504 			nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
12505 
12506 		if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
12507 			func->publish_bcast) {
12508 			err = -EINVAL;
12509 			goto out;
12510 		}
12511 		break;
12512 	case NL80211_NAN_FUNC_SUBSCRIBE:
12513 		func->subscribe_active =
12514 			nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
12515 		break;
12516 	case NL80211_NAN_FUNC_FOLLOW_UP:
12517 		if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
12518 		    !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
12519 		    !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
12520 			err = -EINVAL;
12521 			goto out;
12522 		}
12523 
12524 		func->followup_id =
12525 			nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
12526 		func->followup_reqid =
12527 			nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
12528 		memcpy(func->followup_dest.addr,
12529 		       nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
12530 		       sizeof(func->followup_dest.addr));
12531 		if (func->ttl) {
12532 			err = -EINVAL;
12533 			goto out;
12534 		}
12535 		break;
12536 	default:
12537 		err = -EINVAL;
12538 		goto out;
12539 	}
12540 
12541 	if (tb[NL80211_NAN_FUNC_SRF]) {
12542 		struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
12543 
12544 		err = nla_parse_nested_deprecated(srf_tb,
12545 						  NL80211_NAN_SRF_ATTR_MAX,
12546 						  tb[NL80211_NAN_FUNC_SRF],
12547 						  nl80211_nan_srf_policy,
12548 						  info->extack);
12549 		if (err)
12550 			goto out;
12551 
12552 		func->srf_include =
12553 			nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
12554 
12555 		if (srf_tb[NL80211_NAN_SRF_BF]) {
12556 			if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
12557 			    !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
12558 				err = -EINVAL;
12559 				goto out;
12560 			}
12561 
12562 			func->srf_bf_len =
12563 				nla_len(srf_tb[NL80211_NAN_SRF_BF]);
12564 			func->srf_bf =
12565 				kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
12566 					func->srf_bf_len, GFP_KERNEL);
12567 			if (!func->srf_bf) {
12568 				err = -ENOMEM;
12569 				goto out;
12570 			}
12571 
12572 			func->srf_bf_idx =
12573 				nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
12574 		} else {
12575 			struct nlattr *attr, *mac_attr =
12576 				srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
12577 			int n_entries, rem, i = 0;
12578 
12579 			if (!mac_attr) {
12580 				err = -EINVAL;
12581 				goto out;
12582 			}
12583 
12584 			n_entries = validate_acl_mac_addrs(mac_attr);
12585 			if (n_entries <= 0) {
12586 				err = -EINVAL;
12587 				goto out;
12588 			}
12589 
12590 			func->srf_num_macs = n_entries;
12591 			func->srf_macs =
12592 				kcalloc(n_entries, sizeof(*func->srf_macs),
12593 					GFP_KERNEL);
12594 			if (!func->srf_macs) {
12595 				err = -ENOMEM;
12596 				goto out;
12597 			}
12598 
12599 			nla_for_each_nested(attr, mac_attr, rem)
12600 				memcpy(func->srf_macs[i++].addr, nla_data(attr),
12601 				       sizeof(*func->srf_macs));
12602 		}
12603 	}
12604 
12605 	if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
12606 		err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
12607 					func, true);
12608 		if (err)
12609 			goto out;
12610 	}
12611 
12612 	if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
12613 		err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
12614 					func, false);
12615 		if (err)
12616 			goto out;
12617 	}
12618 
12619 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12620 	if (!msg) {
12621 		err = -ENOMEM;
12622 		goto out;
12623 	}
12624 
12625 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12626 			     NL80211_CMD_ADD_NAN_FUNCTION);
12627 	/* This can't really happen - we just allocated 4KB */
12628 	if (WARN_ON(!hdr)) {
12629 		err = -ENOMEM;
12630 		goto out;
12631 	}
12632 
12633 	err = rdev_add_nan_func(rdev, wdev, func);
12634 out:
12635 	if (err < 0) {
12636 		cfg80211_free_nan_func(func);
12637 		nlmsg_free(msg);
12638 		return err;
12639 	}
12640 
12641 	/* propagate the instance id and cookie to userspace  */
12642 	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
12643 			      NL80211_ATTR_PAD))
12644 		goto nla_put_failure;
12645 
12646 	func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
12647 	if (!func_attr)
12648 		goto nla_put_failure;
12649 
12650 	if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
12651 		       func->instance_id))
12652 		goto nla_put_failure;
12653 
12654 	nla_nest_end(msg, func_attr);
12655 
12656 	genlmsg_end(msg, hdr);
12657 	return genlmsg_reply(msg, info);
12658 
12659 nla_put_failure:
12660 	nlmsg_free(msg);
12661 	return -ENOBUFS;
12662 }
12663 
12664 static int nl80211_nan_del_func(struct sk_buff *skb,
12665 			       struct genl_info *info)
12666 {
12667 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12668 	struct wireless_dev *wdev = info->user_ptr[1];
12669 	u64 cookie;
12670 
12671 	if (wdev->iftype != NL80211_IFTYPE_NAN)
12672 		return -EOPNOTSUPP;
12673 
12674 	if (!wdev_running(wdev))
12675 		return -ENOTCONN;
12676 
12677 	if (!info->attrs[NL80211_ATTR_COOKIE])
12678 		return -EINVAL;
12679 
12680 	cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
12681 
12682 	rdev_del_nan_func(rdev, wdev, cookie);
12683 
12684 	return 0;
12685 }
12686 
12687 static int nl80211_nan_change_config(struct sk_buff *skb,
12688 				     struct genl_info *info)
12689 {
12690 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12691 	struct wireless_dev *wdev = info->user_ptr[1];
12692 	struct cfg80211_nan_conf conf = {};
12693 	u32 changed = 0;
12694 
12695 	if (wdev->iftype != NL80211_IFTYPE_NAN)
12696 		return -EOPNOTSUPP;
12697 
12698 	if (!wdev_running(wdev))
12699 		return -ENOTCONN;
12700 
12701 	if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
12702 		conf.master_pref =
12703 			nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
12704 		if (conf.master_pref <= 1 || conf.master_pref == 255)
12705 			return -EINVAL;
12706 
12707 		changed |= CFG80211_NAN_CONF_CHANGED_PREF;
12708 	}
12709 
12710 	if (info->attrs[NL80211_ATTR_BANDS]) {
12711 		u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
12712 
12713 		if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
12714 			return -EOPNOTSUPP;
12715 
12716 		if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
12717 			return -EINVAL;
12718 
12719 		conf.bands = bands;
12720 		changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
12721 	}
12722 
12723 	if (!changed)
12724 		return -EINVAL;
12725 
12726 	return rdev_nan_change_conf(rdev, wdev, &conf, changed);
12727 }
12728 
12729 void cfg80211_nan_match(struct wireless_dev *wdev,
12730 			struct cfg80211_nan_match_params *match, gfp_t gfp)
12731 {
12732 	struct wiphy *wiphy = wdev->wiphy;
12733 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
12734 	struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
12735 	struct sk_buff *msg;
12736 	void *hdr;
12737 
12738 	if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
12739 		return;
12740 
12741 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
12742 	if (!msg)
12743 		return;
12744 
12745 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
12746 	if (!hdr) {
12747 		nlmsg_free(msg);
12748 		return;
12749 	}
12750 
12751 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12752 	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
12753 					 wdev->netdev->ifindex)) ||
12754 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
12755 			      NL80211_ATTR_PAD))
12756 		goto nla_put_failure;
12757 
12758 	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
12759 			      NL80211_ATTR_PAD) ||
12760 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
12761 		goto nla_put_failure;
12762 
12763 	match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH);
12764 	if (!match_attr)
12765 		goto nla_put_failure;
12766 
12767 	local_func_attr = nla_nest_start_noflag(msg,
12768 						NL80211_NAN_MATCH_FUNC_LOCAL);
12769 	if (!local_func_attr)
12770 		goto nla_put_failure;
12771 
12772 	if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
12773 		goto nla_put_failure;
12774 
12775 	nla_nest_end(msg, local_func_attr);
12776 
12777 	peer_func_attr = nla_nest_start_noflag(msg,
12778 					       NL80211_NAN_MATCH_FUNC_PEER);
12779 	if (!peer_func_attr)
12780 		goto nla_put_failure;
12781 
12782 	if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
12783 	    nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
12784 		goto nla_put_failure;
12785 
12786 	if (match->info && match->info_len &&
12787 	    nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
12788 		    match->info))
12789 		goto nla_put_failure;
12790 
12791 	nla_nest_end(msg, peer_func_attr);
12792 	nla_nest_end(msg, match_attr);
12793 	genlmsg_end(msg, hdr);
12794 
12795 	if (!wdev->owner_nlportid)
12796 		genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
12797 					msg, 0, NL80211_MCGRP_NAN, gfp);
12798 	else
12799 		genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
12800 				wdev->owner_nlportid);
12801 
12802 	return;
12803 
12804 nla_put_failure:
12805 	nlmsg_free(msg);
12806 }
12807 EXPORT_SYMBOL(cfg80211_nan_match);
12808 
12809 void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
12810 				  u8 inst_id,
12811 				  enum nl80211_nan_func_term_reason reason,
12812 				  u64 cookie, gfp_t gfp)
12813 {
12814 	struct wiphy *wiphy = wdev->wiphy;
12815 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
12816 	struct sk_buff *msg;
12817 	struct nlattr *func_attr;
12818 	void *hdr;
12819 
12820 	if (WARN_ON(!inst_id))
12821 		return;
12822 
12823 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
12824 	if (!msg)
12825 		return;
12826 
12827 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
12828 	if (!hdr) {
12829 		nlmsg_free(msg);
12830 		return;
12831 	}
12832 
12833 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12834 	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
12835 					 wdev->netdev->ifindex)) ||
12836 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
12837 			      NL80211_ATTR_PAD))
12838 		goto nla_put_failure;
12839 
12840 	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
12841 			      NL80211_ATTR_PAD))
12842 		goto nla_put_failure;
12843 
12844 	func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
12845 	if (!func_attr)
12846 		goto nla_put_failure;
12847 
12848 	if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
12849 	    nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
12850 		goto nla_put_failure;
12851 
12852 	nla_nest_end(msg, func_attr);
12853 	genlmsg_end(msg, hdr);
12854 
12855 	if (!wdev->owner_nlportid)
12856 		genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
12857 					msg, 0, NL80211_MCGRP_NAN, gfp);
12858 	else
12859 		genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
12860 				wdev->owner_nlportid);
12861 
12862 	return;
12863 
12864 nla_put_failure:
12865 	nlmsg_free(msg);
12866 }
12867 EXPORT_SYMBOL(cfg80211_nan_func_terminated);
12868 
12869 static int nl80211_get_protocol_features(struct sk_buff *skb,
12870 					 struct genl_info *info)
12871 {
12872 	void *hdr;
12873 	struct sk_buff *msg;
12874 
12875 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12876 	if (!msg)
12877 		return -ENOMEM;
12878 
12879 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12880 			     NL80211_CMD_GET_PROTOCOL_FEATURES);
12881 	if (!hdr)
12882 		goto nla_put_failure;
12883 
12884 	if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
12885 			NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
12886 		goto nla_put_failure;
12887 
12888 	genlmsg_end(msg, hdr);
12889 	return genlmsg_reply(msg, info);
12890 
12891  nla_put_failure:
12892 	kfree_skb(msg);
12893 	return -ENOBUFS;
12894 }
12895 
12896 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
12897 {
12898 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12899 	struct cfg80211_update_ft_ies_params ft_params;
12900 	struct net_device *dev = info->user_ptr[1];
12901 
12902 	if (!rdev->ops->update_ft_ies)
12903 		return -EOPNOTSUPP;
12904 
12905 	if (!info->attrs[NL80211_ATTR_MDID] ||
12906 	    !info->attrs[NL80211_ATTR_IE])
12907 		return -EINVAL;
12908 
12909 	memset(&ft_params, 0, sizeof(ft_params));
12910 	ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
12911 	ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
12912 	ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
12913 
12914 	return rdev_update_ft_ies(rdev, dev, &ft_params);
12915 }
12916 
12917 static int nl80211_crit_protocol_start(struct sk_buff *skb,
12918 				       struct genl_info *info)
12919 {
12920 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12921 	struct wireless_dev *wdev = info->user_ptr[1];
12922 	enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
12923 	u16 duration;
12924 	int ret;
12925 
12926 	if (!rdev->ops->crit_proto_start)
12927 		return -EOPNOTSUPP;
12928 
12929 	if (WARN_ON(!rdev->ops->crit_proto_stop))
12930 		return -EINVAL;
12931 
12932 	if (rdev->crit_proto_nlportid)
12933 		return -EBUSY;
12934 
12935 	/* determine protocol if provided */
12936 	if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
12937 		proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
12938 
12939 	if (proto >= NUM_NL80211_CRIT_PROTO)
12940 		return -EINVAL;
12941 
12942 	/* timeout must be provided */
12943 	if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
12944 		return -EINVAL;
12945 
12946 	duration =
12947 		nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
12948 
12949 	if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
12950 		return -ERANGE;
12951 
12952 	ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
12953 	if (!ret)
12954 		rdev->crit_proto_nlportid = info->snd_portid;
12955 
12956 	return ret;
12957 }
12958 
12959 static int nl80211_crit_protocol_stop(struct sk_buff *skb,
12960 				      struct genl_info *info)
12961 {
12962 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12963 	struct wireless_dev *wdev = info->user_ptr[1];
12964 
12965 	if (!rdev->ops->crit_proto_stop)
12966 		return -EOPNOTSUPP;
12967 
12968 	if (rdev->crit_proto_nlportid) {
12969 		rdev->crit_proto_nlportid = 0;
12970 		rdev_crit_proto_stop(rdev, wdev);
12971 	}
12972 	return 0;
12973 }
12974 
12975 static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd,
12976 				       struct nlattr *attr,
12977 				       struct netlink_ext_ack *extack)
12978 {
12979 	if (vcmd->policy == VENDOR_CMD_RAW_DATA) {
12980 		if (attr->nla_type & NLA_F_NESTED) {
12981 			NL_SET_ERR_MSG_ATTR(extack, attr,
12982 					    "unexpected nested data");
12983 			return -EINVAL;
12984 		}
12985 
12986 		return 0;
12987 	}
12988 
12989 	if (!(attr->nla_type & NLA_F_NESTED)) {
12990 		NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data");
12991 		return -EINVAL;
12992 	}
12993 
12994 	return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack);
12995 }
12996 
12997 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
12998 {
12999 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13000 	struct wireless_dev *wdev =
13001 		__cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
13002 	int i, err;
13003 	u32 vid, subcmd;
13004 
13005 	if (!rdev->wiphy.vendor_commands)
13006 		return -EOPNOTSUPP;
13007 
13008 	if (IS_ERR(wdev)) {
13009 		err = PTR_ERR(wdev);
13010 		if (err != -EINVAL)
13011 			return err;
13012 		wdev = NULL;
13013 	} else if (wdev->wiphy != &rdev->wiphy) {
13014 		return -EINVAL;
13015 	}
13016 
13017 	if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
13018 	    !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
13019 		return -EINVAL;
13020 
13021 	vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
13022 	subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
13023 	for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
13024 		const struct wiphy_vendor_command *vcmd;
13025 		void *data = NULL;
13026 		int len = 0;
13027 
13028 		vcmd = &rdev->wiphy.vendor_commands[i];
13029 
13030 		if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
13031 			continue;
13032 
13033 		if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
13034 				   WIPHY_VENDOR_CMD_NEED_NETDEV)) {
13035 			if (!wdev)
13036 				return -EINVAL;
13037 			if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
13038 			    !wdev->netdev)
13039 				return -EINVAL;
13040 
13041 			if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
13042 				if (!wdev_running(wdev))
13043 					return -ENETDOWN;
13044 			}
13045 
13046 			if (!vcmd->doit)
13047 				return -EOPNOTSUPP;
13048 		} else {
13049 			wdev = NULL;
13050 		}
13051 
13052 		if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
13053 			data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
13054 			len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
13055 
13056 			err = nl80211_vendor_check_policy(vcmd,
13057 					info->attrs[NL80211_ATTR_VENDOR_DATA],
13058 					info->extack);
13059 			if (err)
13060 				return err;
13061 		}
13062 
13063 		rdev->cur_cmd_info = info;
13064 		err = vcmd->doit(&rdev->wiphy, wdev, data, len);
13065 		rdev->cur_cmd_info = NULL;
13066 		return err;
13067 	}
13068 
13069 	return -EOPNOTSUPP;
13070 }
13071 
13072 static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
13073 				       struct netlink_callback *cb,
13074 				       struct cfg80211_registered_device **rdev,
13075 				       struct wireless_dev **wdev)
13076 {
13077 	struct nlattr **attrbuf;
13078 	u32 vid, subcmd;
13079 	unsigned int i;
13080 	int vcmd_idx = -1;
13081 	int err;
13082 	void *data = NULL;
13083 	unsigned int data_len = 0;
13084 
13085 	if (cb->args[0]) {
13086 		/* subtract the 1 again here */
13087 		struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
13088 		struct wireless_dev *tmp;
13089 
13090 		if (!wiphy)
13091 			return -ENODEV;
13092 		*rdev = wiphy_to_rdev(wiphy);
13093 		*wdev = NULL;
13094 
13095 		if (cb->args[1]) {
13096 			list_for_each_entry(tmp, &wiphy->wdev_list, list) {
13097 				if (tmp->identifier == cb->args[1] - 1) {
13098 					*wdev = tmp;
13099 					break;
13100 				}
13101 			}
13102 		}
13103 
13104 		/* keep rtnl locked in successful case */
13105 		return 0;
13106 	}
13107 
13108 	attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
13109 	if (!attrbuf)
13110 		return -ENOMEM;
13111 
13112 	err = nlmsg_parse_deprecated(cb->nlh,
13113 				     GENL_HDRLEN + nl80211_fam.hdrsize,
13114 				     attrbuf, nl80211_fam.maxattr,
13115 				     nl80211_policy, NULL);
13116 	if (err)
13117 		goto out;
13118 
13119 	if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
13120 	    !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) {
13121 		err = -EINVAL;
13122 		goto out;
13123 	}
13124 
13125 	*wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk), attrbuf);
13126 	if (IS_ERR(*wdev))
13127 		*wdev = NULL;
13128 
13129 	*rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
13130 	if (IS_ERR(*rdev)) {
13131 		err = PTR_ERR(*rdev);
13132 		goto out;
13133 	}
13134 
13135 	vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
13136 	subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
13137 
13138 	for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
13139 		const struct wiphy_vendor_command *vcmd;
13140 
13141 		vcmd = &(*rdev)->wiphy.vendor_commands[i];
13142 
13143 		if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
13144 			continue;
13145 
13146 		if (!vcmd->dumpit) {
13147 			err = -EOPNOTSUPP;
13148 			goto out;
13149 		}
13150 
13151 		vcmd_idx = i;
13152 		break;
13153 	}
13154 
13155 	if (vcmd_idx < 0) {
13156 		err = -EOPNOTSUPP;
13157 		goto out;
13158 	}
13159 
13160 	if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
13161 		data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
13162 		data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
13163 
13164 		err = nl80211_vendor_check_policy(
13165 				&(*rdev)->wiphy.vendor_commands[vcmd_idx],
13166 				attrbuf[NL80211_ATTR_VENDOR_DATA],
13167 				cb->extack);
13168 		if (err)
13169 			goto out;
13170 	}
13171 
13172 	/* 0 is the first index - add 1 to parse only once */
13173 	cb->args[0] = (*rdev)->wiphy_idx + 1;
13174 	/* add 1 to know if it was NULL */
13175 	cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
13176 	cb->args[2] = vcmd_idx;
13177 	cb->args[3] = (unsigned long)data;
13178 	cb->args[4] = data_len;
13179 
13180 	/* keep rtnl locked in successful case */
13181 	err = 0;
13182 out:
13183 	kfree(attrbuf);
13184 	return err;
13185 }
13186 
13187 static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
13188 				   struct netlink_callback *cb)
13189 {
13190 	struct cfg80211_registered_device *rdev;
13191 	struct wireless_dev *wdev;
13192 	unsigned int vcmd_idx;
13193 	const struct wiphy_vendor_command *vcmd;
13194 	void *data;
13195 	int data_len;
13196 	int err;
13197 	struct nlattr *vendor_data;
13198 
13199 	rtnl_lock();
13200 	err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
13201 	if (err)
13202 		goto out;
13203 
13204 	vcmd_idx = cb->args[2];
13205 	data = (void *)cb->args[3];
13206 	data_len = cb->args[4];
13207 	vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
13208 
13209 	if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
13210 			   WIPHY_VENDOR_CMD_NEED_NETDEV)) {
13211 		if (!wdev) {
13212 			err = -EINVAL;
13213 			goto out;
13214 		}
13215 		if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
13216 		    !wdev->netdev) {
13217 			err = -EINVAL;
13218 			goto out;
13219 		}
13220 
13221 		if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
13222 			if (!wdev_running(wdev)) {
13223 				err = -ENETDOWN;
13224 				goto out;
13225 			}
13226 		}
13227 	}
13228 
13229 	while (1) {
13230 		void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
13231 					   cb->nlh->nlmsg_seq, NLM_F_MULTI,
13232 					   NL80211_CMD_VENDOR);
13233 		if (!hdr)
13234 			break;
13235 
13236 		if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13237 		    (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
13238 					       wdev_id(wdev),
13239 					       NL80211_ATTR_PAD))) {
13240 			genlmsg_cancel(skb, hdr);
13241 			break;
13242 		}
13243 
13244 		vendor_data = nla_nest_start_noflag(skb,
13245 						    NL80211_ATTR_VENDOR_DATA);
13246 		if (!vendor_data) {
13247 			genlmsg_cancel(skb, hdr);
13248 			break;
13249 		}
13250 
13251 		err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
13252 				   (unsigned long *)&cb->args[5]);
13253 		nla_nest_end(skb, vendor_data);
13254 
13255 		if (err == -ENOBUFS || err == -ENOENT) {
13256 			genlmsg_cancel(skb, hdr);
13257 			break;
13258 		} else if (err) {
13259 			genlmsg_cancel(skb, hdr);
13260 			goto out;
13261 		}
13262 
13263 		genlmsg_end(skb, hdr);
13264 	}
13265 
13266 	err = skb->len;
13267  out:
13268 	rtnl_unlock();
13269 	return err;
13270 }
13271 
13272 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
13273 					   enum nl80211_commands cmd,
13274 					   enum nl80211_attrs attr,
13275 					   int approxlen)
13276 {
13277 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13278 
13279 	if (WARN_ON(!rdev->cur_cmd_info))
13280 		return NULL;
13281 
13282 	return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
13283 					   rdev->cur_cmd_info->snd_portid,
13284 					   rdev->cur_cmd_info->snd_seq,
13285 					   cmd, attr, NULL, GFP_KERNEL);
13286 }
13287 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
13288 
13289 int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
13290 {
13291 	struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
13292 	void *hdr = ((void **)skb->cb)[1];
13293 	struct nlattr *data = ((void **)skb->cb)[2];
13294 
13295 	/* clear CB data for netlink core to own from now on */
13296 	memset(skb->cb, 0, sizeof(skb->cb));
13297 
13298 	if (WARN_ON(!rdev->cur_cmd_info)) {
13299 		kfree_skb(skb);
13300 		return -EINVAL;
13301 	}
13302 
13303 	nla_nest_end(skb, data);
13304 	genlmsg_end(skb, hdr);
13305 	return genlmsg_reply(skb, rdev->cur_cmd_info);
13306 }
13307 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
13308 
13309 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy)
13310 {
13311 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13312 
13313 	if (WARN_ON(!rdev->cur_cmd_info))
13314 		return 0;
13315 
13316 	return rdev->cur_cmd_info->snd_portid;
13317 }
13318 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender);
13319 
13320 static int nl80211_set_qos_map(struct sk_buff *skb,
13321 			       struct genl_info *info)
13322 {
13323 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13324 	struct cfg80211_qos_map *qos_map = NULL;
13325 	struct net_device *dev = info->user_ptr[1];
13326 	u8 *pos, len, num_des, des_len, des;
13327 	int ret;
13328 
13329 	if (!rdev->ops->set_qos_map)
13330 		return -EOPNOTSUPP;
13331 
13332 	if (info->attrs[NL80211_ATTR_QOS_MAP]) {
13333 		pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
13334 		len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
13335 
13336 		if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
13337 		    len > IEEE80211_QOS_MAP_LEN_MAX)
13338 			return -EINVAL;
13339 
13340 		qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
13341 		if (!qos_map)
13342 			return -ENOMEM;
13343 
13344 		num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
13345 		if (num_des) {
13346 			des_len = num_des *
13347 				sizeof(struct cfg80211_dscp_exception);
13348 			memcpy(qos_map->dscp_exception, pos, des_len);
13349 			qos_map->num_des = num_des;
13350 			for (des = 0; des < num_des; des++) {
13351 				if (qos_map->dscp_exception[des].up > 7) {
13352 					kfree(qos_map);
13353 					return -EINVAL;
13354 				}
13355 			}
13356 			pos += des_len;
13357 		}
13358 		memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
13359 	}
13360 
13361 	wdev_lock(dev->ieee80211_ptr);
13362 	ret = nl80211_key_allowed(dev->ieee80211_ptr);
13363 	if (!ret)
13364 		ret = rdev_set_qos_map(rdev, dev, qos_map);
13365 	wdev_unlock(dev->ieee80211_ptr);
13366 
13367 	kfree(qos_map);
13368 	return ret;
13369 }
13370 
13371 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
13372 {
13373 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13374 	struct net_device *dev = info->user_ptr[1];
13375 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13376 	const u8 *peer;
13377 	u8 tsid, up;
13378 	u16 admitted_time = 0;
13379 	int err;
13380 
13381 	if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
13382 		return -EOPNOTSUPP;
13383 
13384 	if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
13385 	    !info->attrs[NL80211_ATTR_USER_PRIO])
13386 		return -EINVAL;
13387 
13388 	tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
13389 	up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
13390 
13391 	/* WMM uses TIDs 0-7 even for TSPEC */
13392 	if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
13393 		/* TODO: handle 802.11 TSPEC/admission control
13394 		 * need more attributes for that (e.g. BA session requirement);
13395 		 * change the WMM adminssion test above to allow both then
13396 		 */
13397 		return -EINVAL;
13398 	}
13399 
13400 	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
13401 
13402 	if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
13403 		admitted_time =
13404 			nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
13405 		if (!admitted_time)
13406 			return -EINVAL;
13407 	}
13408 
13409 	wdev_lock(wdev);
13410 	switch (wdev->iftype) {
13411 	case NL80211_IFTYPE_STATION:
13412 	case NL80211_IFTYPE_P2P_CLIENT:
13413 		if (wdev->current_bss)
13414 			break;
13415 		err = -ENOTCONN;
13416 		goto out;
13417 	default:
13418 		err = -EOPNOTSUPP;
13419 		goto out;
13420 	}
13421 
13422 	err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
13423 
13424  out:
13425 	wdev_unlock(wdev);
13426 	return err;
13427 }
13428 
13429 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
13430 {
13431 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13432 	struct net_device *dev = info->user_ptr[1];
13433 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13434 	const u8 *peer;
13435 	u8 tsid;
13436 	int err;
13437 
13438 	if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
13439 		return -EINVAL;
13440 
13441 	tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
13442 	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
13443 
13444 	wdev_lock(wdev);
13445 	err = rdev_del_tx_ts(rdev, dev, tsid, peer);
13446 	wdev_unlock(wdev);
13447 
13448 	return err;
13449 }
13450 
13451 static int nl80211_tdls_channel_switch(struct sk_buff *skb,
13452 				       struct genl_info *info)
13453 {
13454 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13455 	struct net_device *dev = info->user_ptr[1];
13456 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13457 	struct cfg80211_chan_def chandef = {};
13458 	const u8 *addr;
13459 	u8 oper_class;
13460 	int err;
13461 
13462 	if (!rdev->ops->tdls_channel_switch ||
13463 	    !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
13464 		return -EOPNOTSUPP;
13465 
13466 	switch (dev->ieee80211_ptr->iftype) {
13467 	case NL80211_IFTYPE_STATION:
13468 	case NL80211_IFTYPE_P2P_CLIENT:
13469 		break;
13470 	default:
13471 		return -EOPNOTSUPP;
13472 	}
13473 
13474 	if (!info->attrs[NL80211_ATTR_MAC] ||
13475 	    !info->attrs[NL80211_ATTR_OPER_CLASS])
13476 		return -EINVAL;
13477 
13478 	err = nl80211_parse_chandef(rdev, info, &chandef);
13479 	if (err)
13480 		return err;
13481 
13482 	/*
13483 	 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
13484 	 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
13485 	 * specification is not defined for them.
13486 	 */
13487 	if (chandef.chan->band == NL80211_BAND_2GHZ &&
13488 	    chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
13489 	    chandef.width != NL80211_CHAN_WIDTH_20)
13490 		return -EINVAL;
13491 
13492 	/* we will be active on the TDLS link */
13493 	if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
13494 					   wdev->iftype))
13495 		return -EINVAL;
13496 
13497 	/* don't allow switching to DFS channels */
13498 	if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
13499 		return -EINVAL;
13500 
13501 	addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
13502 	oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
13503 
13504 	wdev_lock(wdev);
13505 	err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
13506 	wdev_unlock(wdev);
13507 
13508 	return err;
13509 }
13510 
13511 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
13512 					      struct genl_info *info)
13513 {
13514 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13515 	struct net_device *dev = info->user_ptr[1];
13516 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13517 	const u8 *addr;
13518 
13519 	if (!rdev->ops->tdls_channel_switch ||
13520 	    !rdev->ops->tdls_cancel_channel_switch ||
13521 	    !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
13522 		return -EOPNOTSUPP;
13523 
13524 	switch (dev->ieee80211_ptr->iftype) {
13525 	case NL80211_IFTYPE_STATION:
13526 	case NL80211_IFTYPE_P2P_CLIENT:
13527 		break;
13528 	default:
13529 		return -EOPNOTSUPP;
13530 	}
13531 
13532 	if (!info->attrs[NL80211_ATTR_MAC])
13533 		return -EINVAL;
13534 
13535 	addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
13536 
13537 	wdev_lock(wdev);
13538 	rdev_tdls_cancel_channel_switch(rdev, dev, addr);
13539 	wdev_unlock(wdev);
13540 
13541 	return 0;
13542 }
13543 
13544 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
13545 					    struct genl_info *info)
13546 {
13547 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13548 	struct net_device *dev = info->user_ptr[1];
13549 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13550 	const struct nlattr *nla;
13551 	bool enabled;
13552 
13553 	if (!rdev->ops->set_multicast_to_unicast)
13554 		return -EOPNOTSUPP;
13555 
13556 	if (wdev->iftype != NL80211_IFTYPE_AP &&
13557 	    wdev->iftype != NL80211_IFTYPE_P2P_GO)
13558 		return -EOPNOTSUPP;
13559 
13560 	nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
13561 	enabled = nla_get_flag(nla);
13562 
13563 	return rdev_set_multicast_to_unicast(rdev, dev, enabled);
13564 }
13565 
13566 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info)
13567 {
13568 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13569 	struct net_device *dev = info->user_ptr[1];
13570 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13571 	struct cfg80211_pmk_conf pmk_conf = {};
13572 	int ret;
13573 
13574 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
13575 	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
13576 		return -EOPNOTSUPP;
13577 
13578 	if (!wiphy_ext_feature_isset(&rdev->wiphy,
13579 				     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
13580 		return -EOPNOTSUPP;
13581 
13582 	if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK])
13583 		return -EINVAL;
13584 
13585 	wdev_lock(wdev);
13586 	if (!wdev->current_bss) {
13587 		ret = -ENOTCONN;
13588 		goto out;
13589 	}
13590 
13591 	pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
13592 	if (memcmp(pmk_conf.aa, wdev->current_bss->pub.bssid, ETH_ALEN)) {
13593 		ret = -EINVAL;
13594 		goto out;
13595 	}
13596 
13597 	pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
13598 	pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
13599 	if (pmk_conf.pmk_len != WLAN_PMK_LEN &&
13600 	    pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) {
13601 		ret = -EINVAL;
13602 		goto out;
13603 	}
13604 
13605 	if (info->attrs[NL80211_ATTR_PMKR0_NAME]) {
13606 		int r0_name_len = nla_len(info->attrs[NL80211_ATTR_PMKR0_NAME]);
13607 
13608 		if (r0_name_len != WLAN_PMK_NAME_LEN) {
13609 			ret = -EINVAL;
13610 			goto out;
13611 		}
13612 
13613 		pmk_conf.pmk_r0_name =
13614 			nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]);
13615 	}
13616 
13617 	ret = rdev_set_pmk(rdev, dev, &pmk_conf);
13618 out:
13619 	wdev_unlock(wdev);
13620 	return ret;
13621 }
13622 
13623 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info)
13624 {
13625 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13626 	struct net_device *dev = info->user_ptr[1];
13627 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13628 	const u8 *aa;
13629 	int ret;
13630 
13631 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
13632 	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
13633 		return -EOPNOTSUPP;
13634 
13635 	if (!wiphy_ext_feature_isset(&rdev->wiphy,
13636 				     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
13637 		return -EOPNOTSUPP;
13638 
13639 	if (!info->attrs[NL80211_ATTR_MAC])
13640 		return -EINVAL;
13641 
13642 	wdev_lock(wdev);
13643 	aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
13644 	ret = rdev_del_pmk(rdev, dev, aa);
13645 	wdev_unlock(wdev);
13646 
13647 	return ret;
13648 }
13649 
13650 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info)
13651 {
13652 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13653 	struct net_device *dev = info->user_ptr[1];
13654 	struct cfg80211_external_auth_params params;
13655 
13656 	if (!rdev->ops->external_auth)
13657 		return -EOPNOTSUPP;
13658 
13659 	if (!info->attrs[NL80211_ATTR_SSID] &&
13660 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
13661 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
13662 		return -EINVAL;
13663 
13664 	if (!info->attrs[NL80211_ATTR_BSSID])
13665 		return -EINVAL;
13666 
13667 	if (!info->attrs[NL80211_ATTR_STATUS_CODE])
13668 		return -EINVAL;
13669 
13670 	memset(&params, 0, sizeof(params));
13671 
13672 	if (info->attrs[NL80211_ATTR_SSID]) {
13673 		params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
13674 		if (params.ssid.ssid_len == 0 ||
13675 		    params.ssid.ssid_len > IEEE80211_MAX_SSID_LEN)
13676 			return -EINVAL;
13677 		memcpy(params.ssid.ssid,
13678 		       nla_data(info->attrs[NL80211_ATTR_SSID]),
13679 		       params.ssid.ssid_len);
13680 	}
13681 
13682 	memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]),
13683 	       ETH_ALEN);
13684 
13685 	params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
13686 
13687 	if (info->attrs[NL80211_ATTR_PMKID])
13688 		params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
13689 
13690 	return rdev_external_auth(rdev, dev, &params);
13691 }
13692 
13693 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info)
13694 {
13695 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13696 	struct net_device *dev = info->user_ptr[1];
13697 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13698 	const u8 *buf;
13699 	size_t len;
13700 	u8 *dest;
13701 	u8 src[ETH_ALEN];
13702 	u16 proto;
13703 	bool noencrypt;
13704 	int err;
13705 
13706 	if (!wiphy_ext_feature_isset(&rdev->wiphy,
13707 				     NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
13708 		return -EOPNOTSUPP;
13709 
13710 	if (!rdev->ops->tx_control_port)
13711 		return -EOPNOTSUPP;
13712 
13713 	if (!info->attrs[NL80211_ATTR_FRAME] ||
13714 	    !info->attrs[NL80211_ATTR_MAC] ||
13715 	    !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
13716 		GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing");
13717 		return -EINVAL;
13718 	}
13719 
13720 	wdev_lock(wdev);
13721 
13722 	switch (wdev->iftype) {
13723 	case NL80211_IFTYPE_AP:
13724 	case NL80211_IFTYPE_P2P_GO:
13725 	case NL80211_IFTYPE_MESH_POINT:
13726 		break;
13727 	case NL80211_IFTYPE_ADHOC:
13728 	case NL80211_IFTYPE_STATION:
13729 	case NL80211_IFTYPE_P2P_CLIENT:
13730 		if (wdev->current_bss)
13731 			break;
13732 		err = -ENOTCONN;
13733 		goto out;
13734 	default:
13735 		err = -EOPNOTSUPP;
13736 		goto out;
13737 	}
13738 
13739 	/* copy src address under wdev_lock, as we may copy wdev_address */
13740 	if (info->attrs[NL80211_ATTR_SRC_MAC])
13741 		ether_addr_copy(src,
13742 				nla_data(info->attrs[NL80211_ATTR_SRC_MAC]));
13743 	else
13744 		ether_addr_copy(src, wdev_address(wdev));
13745 
13746 	wdev_unlock(wdev);
13747 
13748 	buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
13749 	len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
13750 	dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
13751 	proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
13752 	noencrypt =
13753 		nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]);
13754 
13755 	return rdev_tx_control_port(rdev, dev, buf, len,
13756 				    dest, src, cpu_to_be16(proto), noencrypt);
13757 
13758  out:
13759 	wdev_unlock(wdev);
13760 	return err;
13761 }
13762 
13763 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb,
13764 					   struct genl_info *info)
13765 {
13766 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13767 	struct net_device *dev = info->user_ptr[1];
13768 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13769 	struct cfg80211_ftm_responder_stats ftm_stats = {};
13770 	struct sk_buff *msg;
13771 	void *hdr;
13772 	struct nlattr *ftm_stats_attr;
13773 	int err;
13774 
13775 	if (wdev->iftype != NL80211_IFTYPE_AP || !wdev->beacon_interval)
13776 		return -EOPNOTSUPP;
13777 
13778 	err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats);
13779 	if (err)
13780 		return err;
13781 
13782 	if (!ftm_stats.filled)
13783 		return -ENODATA;
13784 
13785 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13786 	if (!msg)
13787 		return -ENOMEM;
13788 
13789 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
13790 			     NL80211_CMD_GET_FTM_RESPONDER_STATS);
13791 	if (!hdr)
13792 		goto nla_put_failure;
13793 
13794 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
13795 		goto nla_put_failure;
13796 
13797 	ftm_stats_attr = nla_nest_start_noflag(msg,
13798 					       NL80211_ATTR_FTM_RESPONDER_STATS);
13799 	if (!ftm_stats_attr)
13800 		goto nla_put_failure;
13801 
13802 #define SET_FTM(field, name, type)					 \
13803 	do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
13804 	    nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name,		 \
13805 			     ftm_stats.field))				 \
13806 		goto nla_put_failure; } while (0)
13807 #define SET_FTM_U64(field, name)					 \
13808 	do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
13809 	    nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name,		 \
13810 			      ftm_stats.field, NL80211_FTM_STATS_PAD))	 \
13811 		goto nla_put_failure; } while (0)
13812 
13813 	SET_FTM(success_num, SUCCESS_NUM, u32);
13814 	SET_FTM(partial_num, PARTIAL_NUM, u32);
13815 	SET_FTM(failed_num, FAILED_NUM, u32);
13816 	SET_FTM(asap_num, ASAP_NUM, u32);
13817 	SET_FTM(non_asap_num, NON_ASAP_NUM, u32);
13818 	SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC);
13819 	SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32);
13820 	SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32);
13821 	SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32);
13822 #undef SET_FTM
13823 
13824 	nla_nest_end(msg, ftm_stats_attr);
13825 
13826 	genlmsg_end(msg, hdr);
13827 	return genlmsg_reply(msg, info);
13828 
13829 nla_put_failure:
13830 	nlmsg_free(msg);
13831 	return -ENOBUFS;
13832 }
13833 
13834 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info)
13835 {
13836 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13837 	struct cfg80211_update_owe_info owe_info;
13838 	struct net_device *dev = info->user_ptr[1];
13839 
13840 	if (!rdev->ops->update_owe_info)
13841 		return -EOPNOTSUPP;
13842 
13843 	if (!info->attrs[NL80211_ATTR_STATUS_CODE] ||
13844 	    !info->attrs[NL80211_ATTR_MAC])
13845 		return -EINVAL;
13846 
13847 	memset(&owe_info, 0, sizeof(owe_info));
13848 	owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
13849 	nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN);
13850 
13851 	if (info->attrs[NL80211_ATTR_IE]) {
13852 		owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
13853 		owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
13854 	}
13855 
13856 	return rdev_update_owe_info(rdev, dev, &owe_info);
13857 }
13858 
13859 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info)
13860 {
13861 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13862 	struct net_device *dev = info->user_ptr[1];
13863 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13864 	struct station_info sinfo = {};
13865 	const u8 *buf;
13866 	size_t len;
13867 	u8 *dest;
13868 	int err;
13869 
13870 	if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station)
13871 		return -EOPNOTSUPP;
13872 
13873 	if (!info->attrs[NL80211_ATTR_MAC] ||
13874 	    !info->attrs[NL80211_ATTR_FRAME]) {
13875 		GENL_SET_ERR_MSG(info, "Frame or MAC missing");
13876 		return -EINVAL;
13877 	}
13878 
13879 	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
13880 		return -EOPNOTSUPP;
13881 
13882 	dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
13883 	buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
13884 	len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
13885 
13886 	if (len < sizeof(struct ethhdr))
13887 		return -EINVAL;
13888 
13889 	if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) ||
13890 	    !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr))
13891 		return -EINVAL;
13892 
13893 	err = rdev_get_station(rdev, dev, dest, &sinfo);
13894 	if (err)
13895 		return err;
13896 
13897 	cfg80211_sinfo_release_content(&sinfo);
13898 
13899 	return rdev_probe_mesh_link(rdev, dev, dest, buf, len);
13900 }
13901 
13902 #define NL80211_FLAG_NEED_WIPHY		0x01
13903 #define NL80211_FLAG_NEED_NETDEV	0x02
13904 #define NL80211_FLAG_NEED_RTNL		0x04
13905 #define NL80211_FLAG_CHECK_NETDEV_UP	0x08
13906 #define NL80211_FLAG_NEED_NETDEV_UP	(NL80211_FLAG_NEED_NETDEV |\
13907 					 NL80211_FLAG_CHECK_NETDEV_UP)
13908 #define NL80211_FLAG_NEED_WDEV		0x10
13909 /* If a netdev is associated, it must be UP, P2P must be started */
13910 #define NL80211_FLAG_NEED_WDEV_UP	(NL80211_FLAG_NEED_WDEV |\
13911 					 NL80211_FLAG_CHECK_NETDEV_UP)
13912 #define NL80211_FLAG_CLEAR_SKB		0x20
13913 
13914 static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
13915 			    struct genl_info *info)
13916 {
13917 	struct cfg80211_registered_device *rdev;
13918 	struct wireless_dev *wdev;
13919 	struct net_device *dev;
13920 	bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
13921 
13922 	if (rtnl)
13923 		rtnl_lock();
13924 
13925 	if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
13926 		rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
13927 		if (IS_ERR(rdev)) {
13928 			if (rtnl)
13929 				rtnl_unlock();
13930 			return PTR_ERR(rdev);
13931 		}
13932 		info->user_ptr[0] = rdev;
13933 	} else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
13934 		   ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
13935 		ASSERT_RTNL();
13936 
13937 		wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
13938 						  info->attrs);
13939 		if (IS_ERR(wdev)) {
13940 			if (rtnl)
13941 				rtnl_unlock();
13942 			return PTR_ERR(wdev);
13943 		}
13944 
13945 		dev = wdev->netdev;
13946 		rdev = wiphy_to_rdev(wdev->wiphy);
13947 
13948 		if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
13949 			if (!dev) {
13950 				if (rtnl)
13951 					rtnl_unlock();
13952 				return -EINVAL;
13953 			}
13954 
13955 			info->user_ptr[1] = dev;
13956 		} else {
13957 			info->user_ptr[1] = wdev;
13958 		}
13959 
13960 		if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
13961 		    !wdev_running(wdev)) {
13962 			if (rtnl)
13963 				rtnl_unlock();
13964 			return -ENETDOWN;
13965 		}
13966 
13967 		if (dev)
13968 			dev_hold(dev);
13969 
13970 		info->user_ptr[0] = rdev;
13971 	}
13972 
13973 	return 0;
13974 }
13975 
13976 static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
13977 			      struct genl_info *info)
13978 {
13979 	if (info->user_ptr[1]) {
13980 		if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
13981 			struct wireless_dev *wdev = info->user_ptr[1];
13982 
13983 			if (wdev->netdev)
13984 				dev_put(wdev->netdev);
13985 		} else {
13986 			dev_put(info->user_ptr[1]);
13987 		}
13988 	}
13989 
13990 	if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
13991 		rtnl_unlock();
13992 
13993 	/* If needed, clear the netlink message payload from the SKB
13994 	 * as it might contain key data that shouldn't stick around on
13995 	 * the heap after the SKB is freed. The netlink message header
13996 	 * is still needed for further processing, so leave it intact.
13997 	 */
13998 	if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
13999 		struct nlmsghdr *nlh = nlmsg_hdr(skb);
14000 
14001 		memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
14002 	}
14003 }
14004 
14005 static const struct genl_ops nl80211_ops[] = {
14006 	{
14007 		.cmd = NL80211_CMD_GET_WIPHY,
14008 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14009 		.doit = nl80211_get_wiphy,
14010 		.dumpit = nl80211_dump_wiphy,
14011 		.done = nl80211_dump_wiphy_done,
14012 		/* can be retrieved by unprivileged users */
14013 		.internal_flags = NL80211_FLAG_NEED_WIPHY |
14014 				  NL80211_FLAG_NEED_RTNL,
14015 	},
14016 	{
14017 		.cmd = NL80211_CMD_SET_WIPHY,
14018 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14019 		.doit = nl80211_set_wiphy,
14020 		.flags = GENL_UNS_ADMIN_PERM,
14021 		.internal_flags = NL80211_FLAG_NEED_RTNL,
14022 	},
14023 	{
14024 		.cmd = NL80211_CMD_GET_INTERFACE,
14025 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14026 		.doit = nl80211_get_interface,
14027 		.dumpit = nl80211_dump_interface,
14028 		/* can be retrieved by unprivileged users */
14029 		.internal_flags = NL80211_FLAG_NEED_WDEV |
14030 				  NL80211_FLAG_NEED_RTNL,
14031 	},
14032 	{
14033 		.cmd = NL80211_CMD_SET_INTERFACE,
14034 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14035 		.doit = nl80211_set_interface,
14036 		.flags = GENL_UNS_ADMIN_PERM,
14037 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14038 				  NL80211_FLAG_NEED_RTNL,
14039 	},
14040 	{
14041 		.cmd = NL80211_CMD_NEW_INTERFACE,
14042 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14043 		.doit = nl80211_new_interface,
14044 		.flags = GENL_UNS_ADMIN_PERM,
14045 		.internal_flags = NL80211_FLAG_NEED_WIPHY |
14046 				  NL80211_FLAG_NEED_RTNL,
14047 	},
14048 	{
14049 		.cmd = NL80211_CMD_DEL_INTERFACE,
14050 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14051 		.doit = nl80211_del_interface,
14052 		.flags = GENL_UNS_ADMIN_PERM,
14053 		.internal_flags = NL80211_FLAG_NEED_WDEV |
14054 				  NL80211_FLAG_NEED_RTNL,
14055 	},
14056 	{
14057 		.cmd = NL80211_CMD_GET_KEY,
14058 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14059 		.doit = nl80211_get_key,
14060 		.flags = GENL_UNS_ADMIN_PERM,
14061 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14062 				  NL80211_FLAG_NEED_RTNL,
14063 	},
14064 	{
14065 		.cmd = NL80211_CMD_SET_KEY,
14066 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14067 		.doit = nl80211_set_key,
14068 		.flags = GENL_UNS_ADMIN_PERM,
14069 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14070 				  NL80211_FLAG_NEED_RTNL |
14071 				  NL80211_FLAG_CLEAR_SKB,
14072 	},
14073 	{
14074 		.cmd = NL80211_CMD_NEW_KEY,
14075 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14076 		.doit = nl80211_new_key,
14077 		.flags = GENL_UNS_ADMIN_PERM,
14078 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14079 				  NL80211_FLAG_NEED_RTNL |
14080 				  NL80211_FLAG_CLEAR_SKB,
14081 	},
14082 	{
14083 		.cmd = NL80211_CMD_DEL_KEY,
14084 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14085 		.doit = nl80211_del_key,
14086 		.flags = GENL_UNS_ADMIN_PERM,
14087 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14088 				  NL80211_FLAG_NEED_RTNL,
14089 	},
14090 	{
14091 		.cmd = NL80211_CMD_SET_BEACON,
14092 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14093 		.flags = GENL_UNS_ADMIN_PERM,
14094 		.doit = nl80211_set_beacon,
14095 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14096 				  NL80211_FLAG_NEED_RTNL,
14097 	},
14098 	{
14099 		.cmd = NL80211_CMD_START_AP,
14100 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14101 		.flags = GENL_UNS_ADMIN_PERM,
14102 		.doit = nl80211_start_ap,
14103 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14104 				  NL80211_FLAG_NEED_RTNL,
14105 	},
14106 	{
14107 		.cmd = NL80211_CMD_STOP_AP,
14108 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14109 		.flags = GENL_UNS_ADMIN_PERM,
14110 		.doit = nl80211_stop_ap,
14111 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14112 				  NL80211_FLAG_NEED_RTNL,
14113 	},
14114 	{
14115 		.cmd = NL80211_CMD_GET_STATION,
14116 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14117 		.doit = nl80211_get_station,
14118 		.dumpit = nl80211_dump_station,
14119 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14120 				  NL80211_FLAG_NEED_RTNL,
14121 	},
14122 	{
14123 		.cmd = NL80211_CMD_SET_STATION,
14124 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14125 		.doit = nl80211_set_station,
14126 		.flags = GENL_UNS_ADMIN_PERM,
14127 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14128 				  NL80211_FLAG_NEED_RTNL,
14129 	},
14130 	{
14131 		.cmd = NL80211_CMD_NEW_STATION,
14132 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14133 		.doit = nl80211_new_station,
14134 		.flags = GENL_UNS_ADMIN_PERM,
14135 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14136 				  NL80211_FLAG_NEED_RTNL,
14137 	},
14138 	{
14139 		.cmd = NL80211_CMD_DEL_STATION,
14140 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14141 		.doit = nl80211_del_station,
14142 		.flags = GENL_UNS_ADMIN_PERM,
14143 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14144 				  NL80211_FLAG_NEED_RTNL,
14145 	},
14146 	{
14147 		.cmd = NL80211_CMD_GET_MPATH,
14148 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14149 		.doit = nl80211_get_mpath,
14150 		.dumpit = nl80211_dump_mpath,
14151 		.flags = GENL_UNS_ADMIN_PERM,
14152 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14153 				  NL80211_FLAG_NEED_RTNL,
14154 	},
14155 	{
14156 		.cmd = NL80211_CMD_GET_MPP,
14157 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14158 		.doit = nl80211_get_mpp,
14159 		.dumpit = nl80211_dump_mpp,
14160 		.flags = GENL_UNS_ADMIN_PERM,
14161 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14162 				  NL80211_FLAG_NEED_RTNL,
14163 	},
14164 	{
14165 		.cmd = NL80211_CMD_SET_MPATH,
14166 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14167 		.doit = nl80211_set_mpath,
14168 		.flags = GENL_UNS_ADMIN_PERM,
14169 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14170 				  NL80211_FLAG_NEED_RTNL,
14171 	},
14172 	{
14173 		.cmd = NL80211_CMD_NEW_MPATH,
14174 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14175 		.doit = nl80211_new_mpath,
14176 		.flags = GENL_UNS_ADMIN_PERM,
14177 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14178 				  NL80211_FLAG_NEED_RTNL,
14179 	},
14180 	{
14181 		.cmd = NL80211_CMD_DEL_MPATH,
14182 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14183 		.doit = nl80211_del_mpath,
14184 		.flags = GENL_UNS_ADMIN_PERM,
14185 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14186 				  NL80211_FLAG_NEED_RTNL,
14187 	},
14188 	{
14189 		.cmd = NL80211_CMD_SET_BSS,
14190 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14191 		.doit = nl80211_set_bss,
14192 		.flags = GENL_UNS_ADMIN_PERM,
14193 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14194 				  NL80211_FLAG_NEED_RTNL,
14195 	},
14196 	{
14197 		.cmd = NL80211_CMD_GET_REG,
14198 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14199 		.doit = nl80211_get_reg_do,
14200 		.dumpit = nl80211_get_reg_dump,
14201 		.internal_flags = NL80211_FLAG_NEED_RTNL,
14202 		/* can be retrieved by unprivileged users */
14203 	},
14204 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
14205 	{
14206 		.cmd = NL80211_CMD_SET_REG,
14207 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14208 		.doit = nl80211_set_reg,
14209 		.flags = GENL_ADMIN_PERM,
14210 		.internal_flags = NL80211_FLAG_NEED_RTNL,
14211 	},
14212 #endif
14213 	{
14214 		.cmd = NL80211_CMD_REQ_SET_REG,
14215 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14216 		.doit = nl80211_req_set_reg,
14217 		.flags = GENL_ADMIN_PERM,
14218 	},
14219 	{
14220 		.cmd = NL80211_CMD_RELOAD_REGDB,
14221 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14222 		.doit = nl80211_reload_regdb,
14223 		.flags = GENL_ADMIN_PERM,
14224 	},
14225 	{
14226 		.cmd = NL80211_CMD_GET_MESH_CONFIG,
14227 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14228 		.doit = nl80211_get_mesh_config,
14229 		/* can be retrieved by unprivileged users */
14230 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14231 				  NL80211_FLAG_NEED_RTNL,
14232 	},
14233 	{
14234 		.cmd = NL80211_CMD_SET_MESH_CONFIG,
14235 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14236 		.doit = nl80211_update_mesh_config,
14237 		.flags = GENL_UNS_ADMIN_PERM,
14238 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14239 				  NL80211_FLAG_NEED_RTNL,
14240 	},
14241 	{
14242 		.cmd = NL80211_CMD_TRIGGER_SCAN,
14243 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14244 		.doit = nl80211_trigger_scan,
14245 		.flags = GENL_UNS_ADMIN_PERM,
14246 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14247 				  NL80211_FLAG_NEED_RTNL,
14248 	},
14249 	{
14250 		.cmd = NL80211_CMD_ABORT_SCAN,
14251 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14252 		.doit = nl80211_abort_scan,
14253 		.flags = GENL_UNS_ADMIN_PERM,
14254 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14255 				  NL80211_FLAG_NEED_RTNL,
14256 	},
14257 	{
14258 		.cmd = NL80211_CMD_GET_SCAN,
14259 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14260 		.dumpit = nl80211_dump_scan,
14261 	},
14262 	{
14263 		.cmd = NL80211_CMD_START_SCHED_SCAN,
14264 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14265 		.doit = nl80211_start_sched_scan,
14266 		.flags = GENL_UNS_ADMIN_PERM,
14267 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14268 				  NL80211_FLAG_NEED_RTNL,
14269 	},
14270 	{
14271 		.cmd = NL80211_CMD_STOP_SCHED_SCAN,
14272 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14273 		.doit = nl80211_stop_sched_scan,
14274 		.flags = GENL_UNS_ADMIN_PERM,
14275 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14276 				  NL80211_FLAG_NEED_RTNL,
14277 	},
14278 	{
14279 		.cmd = NL80211_CMD_AUTHENTICATE,
14280 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14281 		.doit = nl80211_authenticate,
14282 		.flags = GENL_UNS_ADMIN_PERM,
14283 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14284 				  NL80211_FLAG_NEED_RTNL |
14285 				  NL80211_FLAG_CLEAR_SKB,
14286 	},
14287 	{
14288 		.cmd = NL80211_CMD_ASSOCIATE,
14289 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14290 		.doit = nl80211_associate,
14291 		.flags = GENL_UNS_ADMIN_PERM,
14292 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14293 				  NL80211_FLAG_NEED_RTNL |
14294 				  NL80211_FLAG_CLEAR_SKB,
14295 	},
14296 	{
14297 		.cmd = NL80211_CMD_DEAUTHENTICATE,
14298 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14299 		.doit = nl80211_deauthenticate,
14300 		.flags = GENL_UNS_ADMIN_PERM,
14301 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14302 				  NL80211_FLAG_NEED_RTNL,
14303 	},
14304 	{
14305 		.cmd = NL80211_CMD_DISASSOCIATE,
14306 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14307 		.doit = nl80211_disassociate,
14308 		.flags = GENL_UNS_ADMIN_PERM,
14309 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14310 				  NL80211_FLAG_NEED_RTNL,
14311 	},
14312 	{
14313 		.cmd = NL80211_CMD_JOIN_IBSS,
14314 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14315 		.doit = nl80211_join_ibss,
14316 		.flags = GENL_UNS_ADMIN_PERM,
14317 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14318 				  NL80211_FLAG_NEED_RTNL,
14319 	},
14320 	{
14321 		.cmd = NL80211_CMD_LEAVE_IBSS,
14322 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14323 		.doit = nl80211_leave_ibss,
14324 		.flags = GENL_UNS_ADMIN_PERM,
14325 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14326 				  NL80211_FLAG_NEED_RTNL,
14327 	},
14328 #ifdef CONFIG_NL80211_TESTMODE
14329 	{
14330 		.cmd = NL80211_CMD_TESTMODE,
14331 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14332 		.doit = nl80211_testmode_do,
14333 		.dumpit = nl80211_testmode_dump,
14334 		.flags = GENL_UNS_ADMIN_PERM,
14335 		.internal_flags = NL80211_FLAG_NEED_WIPHY |
14336 				  NL80211_FLAG_NEED_RTNL,
14337 	},
14338 #endif
14339 	{
14340 		.cmd = NL80211_CMD_CONNECT,
14341 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14342 		.doit = nl80211_connect,
14343 		.flags = GENL_UNS_ADMIN_PERM,
14344 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14345 				  NL80211_FLAG_NEED_RTNL |
14346 				  NL80211_FLAG_CLEAR_SKB,
14347 	},
14348 	{
14349 		.cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
14350 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14351 		.doit = nl80211_update_connect_params,
14352 		.flags = GENL_ADMIN_PERM,
14353 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14354 				  NL80211_FLAG_NEED_RTNL |
14355 				  NL80211_FLAG_CLEAR_SKB,
14356 	},
14357 	{
14358 		.cmd = NL80211_CMD_DISCONNECT,
14359 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14360 		.doit = nl80211_disconnect,
14361 		.flags = GENL_UNS_ADMIN_PERM,
14362 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14363 				  NL80211_FLAG_NEED_RTNL,
14364 	},
14365 	{
14366 		.cmd = NL80211_CMD_SET_WIPHY_NETNS,
14367 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14368 		.doit = nl80211_wiphy_netns,
14369 		.flags = GENL_UNS_ADMIN_PERM,
14370 		.internal_flags = NL80211_FLAG_NEED_WIPHY |
14371 				  NL80211_FLAG_NEED_RTNL,
14372 	},
14373 	{
14374 		.cmd = NL80211_CMD_GET_SURVEY,
14375 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14376 		.dumpit = nl80211_dump_survey,
14377 	},
14378 	{
14379 		.cmd = NL80211_CMD_SET_PMKSA,
14380 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14381 		.doit = nl80211_setdel_pmksa,
14382 		.flags = GENL_UNS_ADMIN_PERM,
14383 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14384 				  NL80211_FLAG_NEED_RTNL |
14385 				  NL80211_FLAG_CLEAR_SKB,
14386 	},
14387 	{
14388 		.cmd = NL80211_CMD_DEL_PMKSA,
14389 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14390 		.doit = nl80211_setdel_pmksa,
14391 		.flags = GENL_UNS_ADMIN_PERM,
14392 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14393 				  NL80211_FLAG_NEED_RTNL,
14394 	},
14395 	{
14396 		.cmd = NL80211_CMD_FLUSH_PMKSA,
14397 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14398 		.doit = nl80211_flush_pmksa,
14399 		.flags = GENL_UNS_ADMIN_PERM,
14400 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14401 				  NL80211_FLAG_NEED_RTNL,
14402 	},
14403 	{
14404 		.cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
14405 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14406 		.doit = nl80211_remain_on_channel,
14407 		.flags = GENL_UNS_ADMIN_PERM,
14408 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14409 				  NL80211_FLAG_NEED_RTNL,
14410 	},
14411 	{
14412 		.cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
14413 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14414 		.doit = nl80211_cancel_remain_on_channel,
14415 		.flags = GENL_UNS_ADMIN_PERM,
14416 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14417 				  NL80211_FLAG_NEED_RTNL,
14418 	},
14419 	{
14420 		.cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
14421 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14422 		.doit = nl80211_set_tx_bitrate_mask,
14423 		.flags = GENL_UNS_ADMIN_PERM,
14424 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14425 				  NL80211_FLAG_NEED_RTNL,
14426 	},
14427 	{
14428 		.cmd = NL80211_CMD_REGISTER_FRAME,
14429 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14430 		.doit = nl80211_register_mgmt,
14431 		.flags = GENL_UNS_ADMIN_PERM,
14432 		.internal_flags = NL80211_FLAG_NEED_WDEV |
14433 				  NL80211_FLAG_NEED_RTNL,
14434 	},
14435 	{
14436 		.cmd = NL80211_CMD_FRAME,
14437 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14438 		.doit = nl80211_tx_mgmt,
14439 		.flags = GENL_UNS_ADMIN_PERM,
14440 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14441 				  NL80211_FLAG_NEED_RTNL,
14442 	},
14443 	{
14444 		.cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
14445 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14446 		.doit = nl80211_tx_mgmt_cancel_wait,
14447 		.flags = GENL_UNS_ADMIN_PERM,
14448 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14449 				  NL80211_FLAG_NEED_RTNL,
14450 	},
14451 	{
14452 		.cmd = NL80211_CMD_SET_POWER_SAVE,
14453 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14454 		.doit = nl80211_set_power_save,
14455 		.flags = GENL_UNS_ADMIN_PERM,
14456 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14457 				  NL80211_FLAG_NEED_RTNL,
14458 	},
14459 	{
14460 		.cmd = NL80211_CMD_GET_POWER_SAVE,
14461 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14462 		.doit = nl80211_get_power_save,
14463 		/* can be retrieved by unprivileged users */
14464 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14465 				  NL80211_FLAG_NEED_RTNL,
14466 	},
14467 	{
14468 		.cmd = NL80211_CMD_SET_CQM,
14469 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14470 		.doit = nl80211_set_cqm,
14471 		.flags = GENL_UNS_ADMIN_PERM,
14472 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14473 				  NL80211_FLAG_NEED_RTNL,
14474 	},
14475 	{
14476 		.cmd = NL80211_CMD_SET_CHANNEL,
14477 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14478 		.doit = nl80211_set_channel,
14479 		.flags = GENL_UNS_ADMIN_PERM,
14480 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14481 				  NL80211_FLAG_NEED_RTNL,
14482 	},
14483 	{
14484 		.cmd = NL80211_CMD_SET_WDS_PEER,
14485 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14486 		.doit = nl80211_set_wds_peer,
14487 		.flags = GENL_UNS_ADMIN_PERM,
14488 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14489 				  NL80211_FLAG_NEED_RTNL,
14490 	},
14491 	{
14492 		.cmd = NL80211_CMD_JOIN_MESH,
14493 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14494 		.doit = nl80211_join_mesh,
14495 		.flags = GENL_UNS_ADMIN_PERM,
14496 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14497 				  NL80211_FLAG_NEED_RTNL,
14498 	},
14499 	{
14500 		.cmd = NL80211_CMD_LEAVE_MESH,
14501 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14502 		.doit = nl80211_leave_mesh,
14503 		.flags = GENL_UNS_ADMIN_PERM,
14504 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14505 				  NL80211_FLAG_NEED_RTNL,
14506 	},
14507 	{
14508 		.cmd = NL80211_CMD_JOIN_OCB,
14509 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14510 		.doit = nl80211_join_ocb,
14511 		.flags = GENL_UNS_ADMIN_PERM,
14512 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14513 				  NL80211_FLAG_NEED_RTNL,
14514 	},
14515 	{
14516 		.cmd = NL80211_CMD_LEAVE_OCB,
14517 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14518 		.doit = nl80211_leave_ocb,
14519 		.flags = GENL_UNS_ADMIN_PERM,
14520 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14521 				  NL80211_FLAG_NEED_RTNL,
14522 	},
14523 #ifdef CONFIG_PM
14524 	{
14525 		.cmd = NL80211_CMD_GET_WOWLAN,
14526 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14527 		.doit = nl80211_get_wowlan,
14528 		/* can be retrieved by unprivileged users */
14529 		.internal_flags = NL80211_FLAG_NEED_WIPHY |
14530 				  NL80211_FLAG_NEED_RTNL,
14531 	},
14532 	{
14533 		.cmd = NL80211_CMD_SET_WOWLAN,
14534 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14535 		.doit = nl80211_set_wowlan,
14536 		.flags = GENL_UNS_ADMIN_PERM,
14537 		.internal_flags = NL80211_FLAG_NEED_WIPHY |
14538 				  NL80211_FLAG_NEED_RTNL,
14539 	},
14540 #endif
14541 	{
14542 		.cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
14543 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14544 		.doit = nl80211_set_rekey_data,
14545 		.flags = GENL_UNS_ADMIN_PERM,
14546 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14547 				  NL80211_FLAG_NEED_RTNL |
14548 				  NL80211_FLAG_CLEAR_SKB,
14549 	},
14550 	{
14551 		.cmd = NL80211_CMD_TDLS_MGMT,
14552 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14553 		.doit = nl80211_tdls_mgmt,
14554 		.flags = GENL_UNS_ADMIN_PERM,
14555 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14556 				  NL80211_FLAG_NEED_RTNL,
14557 	},
14558 	{
14559 		.cmd = NL80211_CMD_TDLS_OPER,
14560 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14561 		.doit = nl80211_tdls_oper,
14562 		.flags = GENL_UNS_ADMIN_PERM,
14563 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14564 				  NL80211_FLAG_NEED_RTNL,
14565 	},
14566 	{
14567 		.cmd = NL80211_CMD_UNEXPECTED_FRAME,
14568 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14569 		.doit = nl80211_register_unexpected_frame,
14570 		.flags = GENL_UNS_ADMIN_PERM,
14571 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14572 				  NL80211_FLAG_NEED_RTNL,
14573 	},
14574 	{
14575 		.cmd = NL80211_CMD_PROBE_CLIENT,
14576 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14577 		.doit = nl80211_probe_client,
14578 		.flags = GENL_UNS_ADMIN_PERM,
14579 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14580 				  NL80211_FLAG_NEED_RTNL,
14581 	},
14582 	{
14583 		.cmd = NL80211_CMD_REGISTER_BEACONS,
14584 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14585 		.doit = nl80211_register_beacons,
14586 		.flags = GENL_UNS_ADMIN_PERM,
14587 		.internal_flags = NL80211_FLAG_NEED_WIPHY |
14588 				  NL80211_FLAG_NEED_RTNL,
14589 	},
14590 	{
14591 		.cmd = NL80211_CMD_SET_NOACK_MAP,
14592 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14593 		.doit = nl80211_set_noack_map,
14594 		.flags = GENL_UNS_ADMIN_PERM,
14595 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14596 				  NL80211_FLAG_NEED_RTNL,
14597 	},
14598 	{
14599 		.cmd = NL80211_CMD_START_P2P_DEVICE,
14600 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14601 		.doit = nl80211_start_p2p_device,
14602 		.flags = GENL_UNS_ADMIN_PERM,
14603 		.internal_flags = NL80211_FLAG_NEED_WDEV |
14604 				  NL80211_FLAG_NEED_RTNL,
14605 	},
14606 	{
14607 		.cmd = NL80211_CMD_STOP_P2P_DEVICE,
14608 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14609 		.doit = nl80211_stop_p2p_device,
14610 		.flags = GENL_UNS_ADMIN_PERM,
14611 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14612 				  NL80211_FLAG_NEED_RTNL,
14613 	},
14614 	{
14615 		.cmd = NL80211_CMD_START_NAN,
14616 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14617 		.doit = nl80211_start_nan,
14618 		.flags = GENL_ADMIN_PERM,
14619 		.internal_flags = NL80211_FLAG_NEED_WDEV |
14620 				  NL80211_FLAG_NEED_RTNL,
14621 	},
14622 	{
14623 		.cmd = NL80211_CMD_STOP_NAN,
14624 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14625 		.doit = nl80211_stop_nan,
14626 		.flags = GENL_ADMIN_PERM,
14627 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14628 				  NL80211_FLAG_NEED_RTNL,
14629 	},
14630 	{
14631 		.cmd = NL80211_CMD_ADD_NAN_FUNCTION,
14632 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14633 		.doit = nl80211_nan_add_func,
14634 		.flags = GENL_ADMIN_PERM,
14635 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14636 				  NL80211_FLAG_NEED_RTNL,
14637 	},
14638 	{
14639 		.cmd = NL80211_CMD_DEL_NAN_FUNCTION,
14640 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14641 		.doit = nl80211_nan_del_func,
14642 		.flags = GENL_ADMIN_PERM,
14643 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14644 				  NL80211_FLAG_NEED_RTNL,
14645 	},
14646 	{
14647 		.cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
14648 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14649 		.doit = nl80211_nan_change_config,
14650 		.flags = GENL_ADMIN_PERM,
14651 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14652 				  NL80211_FLAG_NEED_RTNL,
14653 	},
14654 	{
14655 		.cmd = NL80211_CMD_SET_MCAST_RATE,
14656 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14657 		.doit = nl80211_set_mcast_rate,
14658 		.flags = GENL_UNS_ADMIN_PERM,
14659 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14660 				  NL80211_FLAG_NEED_RTNL,
14661 	},
14662 	{
14663 		.cmd = NL80211_CMD_SET_MAC_ACL,
14664 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14665 		.doit = nl80211_set_mac_acl,
14666 		.flags = GENL_UNS_ADMIN_PERM,
14667 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14668 				  NL80211_FLAG_NEED_RTNL,
14669 	},
14670 	{
14671 		.cmd = NL80211_CMD_RADAR_DETECT,
14672 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14673 		.doit = nl80211_start_radar_detection,
14674 		.flags = GENL_UNS_ADMIN_PERM,
14675 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14676 				  NL80211_FLAG_NEED_RTNL,
14677 	},
14678 	{
14679 		.cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
14680 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14681 		.doit = nl80211_get_protocol_features,
14682 	},
14683 	{
14684 		.cmd = NL80211_CMD_UPDATE_FT_IES,
14685 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14686 		.doit = nl80211_update_ft_ies,
14687 		.flags = GENL_UNS_ADMIN_PERM,
14688 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14689 				  NL80211_FLAG_NEED_RTNL,
14690 	},
14691 	{
14692 		.cmd = NL80211_CMD_CRIT_PROTOCOL_START,
14693 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14694 		.doit = nl80211_crit_protocol_start,
14695 		.flags = GENL_UNS_ADMIN_PERM,
14696 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14697 				  NL80211_FLAG_NEED_RTNL,
14698 	},
14699 	{
14700 		.cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
14701 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14702 		.doit = nl80211_crit_protocol_stop,
14703 		.flags = GENL_UNS_ADMIN_PERM,
14704 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14705 				  NL80211_FLAG_NEED_RTNL,
14706 	},
14707 	{
14708 		.cmd = NL80211_CMD_GET_COALESCE,
14709 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14710 		.doit = nl80211_get_coalesce,
14711 		.internal_flags = NL80211_FLAG_NEED_WIPHY |
14712 				  NL80211_FLAG_NEED_RTNL,
14713 	},
14714 	{
14715 		.cmd = NL80211_CMD_SET_COALESCE,
14716 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14717 		.doit = nl80211_set_coalesce,
14718 		.flags = GENL_UNS_ADMIN_PERM,
14719 		.internal_flags = NL80211_FLAG_NEED_WIPHY |
14720 				  NL80211_FLAG_NEED_RTNL,
14721 	},
14722 	{
14723 		.cmd = NL80211_CMD_CHANNEL_SWITCH,
14724 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14725 		.doit = nl80211_channel_switch,
14726 		.flags = GENL_UNS_ADMIN_PERM,
14727 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14728 				  NL80211_FLAG_NEED_RTNL,
14729 	},
14730 	{
14731 		.cmd = NL80211_CMD_VENDOR,
14732 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14733 		.doit = nl80211_vendor_cmd,
14734 		.dumpit = nl80211_vendor_cmd_dump,
14735 		.flags = GENL_UNS_ADMIN_PERM,
14736 		.internal_flags = NL80211_FLAG_NEED_WIPHY |
14737 				  NL80211_FLAG_NEED_RTNL |
14738 				  NL80211_FLAG_CLEAR_SKB,
14739 	},
14740 	{
14741 		.cmd = NL80211_CMD_SET_QOS_MAP,
14742 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14743 		.doit = nl80211_set_qos_map,
14744 		.flags = GENL_UNS_ADMIN_PERM,
14745 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14746 				  NL80211_FLAG_NEED_RTNL,
14747 	},
14748 	{
14749 		.cmd = NL80211_CMD_ADD_TX_TS,
14750 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14751 		.doit = nl80211_add_tx_ts,
14752 		.flags = GENL_UNS_ADMIN_PERM,
14753 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14754 				  NL80211_FLAG_NEED_RTNL,
14755 	},
14756 	{
14757 		.cmd = NL80211_CMD_DEL_TX_TS,
14758 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14759 		.doit = nl80211_del_tx_ts,
14760 		.flags = GENL_UNS_ADMIN_PERM,
14761 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14762 				  NL80211_FLAG_NEED_RTNL,
14763 	},
14764 	{
14765 		.cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
14766 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14767 		.doit = nl80211_tdls_channel_switch,
14768 		.flags = GENL_UNS_ADMIN_PERM,
14769 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14770 				  NL80211_FLAG_NEED_RTNL,
14771 	},
14772 	{
14773 		.cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
14774 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14775 		.doit = nl80211_tdls_cancel_channel_switch,
14776 		.flags = GENL_UNS_ADMIN_PERM,
14777 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14778 				  NL80211_FLAG_NEED_RTNL,
14779 	},
14780 	{
14781 		.cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
14782 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14783 		.doit = nl80211_set_multicast_to_unicast,
14784 		.flags = GENL_UNS_ADMIN_PERM,
14785 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14786 				  NL80211_FLAG_NEED_RTNL,
14787 	},
14788 	{
14789 		.cmd = NL80211_CMD_SET_PMK,
14790 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14791 		.doit = nl80211_set_pmk,
14792 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14793 				  NL80211_FLAG_NEED_RTNL |
14794 				  NL80211_FLAG_CLEAR_SKB,
14795 	},
14796 	{
14797 		.cmd = NL80211_CMD_DEL_PMK,
14798 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14799 		.doit = nl80211_del_pmk,
14800 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14801 				  NL80211_FLAG_NEED_RTNL,
14802 	},
14803 	{
14804 		.cmd = NL80211_CMD_EXTERNAL_AUTH,
14805 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14806 		.doit = nl80211_external_auth,
14807 		.flags = GENL_ADMIN_PERM,
14808 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14809 				  NL80211_FLAG_NEED_RTNL,
14810 	},
14811 	{
14812 		.cmd = NL80211_CMD_CONTROL_PORT_FRAME,
14813 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14814 		.doit = nl80211_tx_control_port,
14815 		.flags = GENL_UNS_ADMIN_PERM,
14816 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14817 				  NL80211_FLAG_NEED_RTNL,
14818 	},
14819 	{
14820 		.cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS,
14821 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14822 		.doit = nl80211_get_ftm_responder_stats,
14823 		.internal_flags = NL80211_FLAG_NEED_NETDEV |
14824 				  NL80211_FLAG_NEED_RTNL,
14825 	},
14826 	{
14827 		.cmd = NL80211_CMD_PEER_MEASUREMENT_START,
14828 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14829 		.doit = nl80211_pmsr_start,
14830 		.flags = GENL_UNS_ADMIN_PERM,
14831 		.internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14832 				  NL80211_FLAG_NEED_RTNL,
14833 	},
14834 	{
14835 		.cmd = NL80211_CMD_NOTIFY_RADAR,
14836 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14837 		.doit = nl80211_notify_radar_detection,
14838 		.flags = GENL_UNS_ADMIN_PERM,
14839 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14840 				  NL80211_FLAG_NEED_RTNL,
14841 	},
14842 	{
14843 		.cmd = NL80211_CMD_UPDATE_OWE_INFO,
14844 		.doit = nl80211_update_owe_info,
14845 		.flags = GENL_ADMIN_PERM,
14846 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14847 				  NL80211_FLAG_NEED_RTNL,
14848 	},
14849 	{
14850 		.cmd = NL80211_CMD_PROBE_MESH_LINK,
14851 		.doit = nl80211_probe_mesh_link,
14852 		.flags = GENL_UNS_ADMIN_PERM,
14853 		.internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14854 				  NL80211_FLAG_NEED_RTNL,
14855 	},
14856 };
14857 
14858 static struct genl_family nl80211_fam __ro_after_init = {
14859 	.name = NL80211_GENL_NAME,	/* have users key off the name instead */
14860 	.hdrsize = 0,			/* no private header */
14861 	.version = 1,			/* no particular meaning now */
14862 	.maxattr = NL80211_ATTR_MAX,
14863 	.policy = nl80211_policy,
14864 	.netnsok = true,
14865 	.pre_doit = nl80211_pre_doit,
14866 	.post_doit = nl80211_post_doit,
14867 	.module = THIS_MODULE,
14868 	.ops = nl80211_ops,
14869 	.n_ops = ARRAY_SIZE(nl80211_ops),
14870 	.mcgrps = nl80211_mcgrps,
14871 	.n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
14872 	.parallel_ops = true,
14873 };
14874 
14875 /* notification functions */
14876 
14877 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
14878 			  enum nl80211_commands cmd)
14879 {
14880 	struct sk_buff *msg;
14881 	struct nl80211_dump_wiphy_state state = {};
14882 
14883 	WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
14884 		cmd != NL80211_CMD_DEL_WIPHY);
14885 
14886 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14887 	if (!msg)
14888 		return;
14889 
14890 	if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
14891 		nlmsg_free(msg);
14892 		return;
14893 	}
14894 
14895 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14896 				NL80211_MCGRP_CONFIG, GFP_KERNEL);
14897 }
14898 
14899 void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
14900 				struct wireless_dev *wdev,
14901 				enum nl80211_commands cmd)
14902 {
14903 	struct sk_buff *msg;
14904 
14905 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14906 	if (!msg)
14907 		return;
14908 
14909 	if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) {
14910 		nlmsg_free(msg);
14911 		return;
14912 	}
14913 
14914 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14915 				NL80211_MCGRP_CONFIG, GFP_KERNEL);
14916 }
14917 
14918 static int nl80211_add_scan_req(struct sk_buff *msg,
14919 				struct cfg80211_registered_device *rdev)
14920 {
14921 	struct cfg80211_scan_request *req = rdev->scan_req;
14922 	struct nlattr *nest;
14923 	int i;
14924 
14925 	if (WARN_ON(!req))
14926 		return 0;
14927 
14928 	nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS);
14929 	if (!nest)
14930 		goto nla_put_failure;
14931 	for (i = 0; i < req->n_ssids; i++) {
14932 		if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
14933 			goto nla_put_failure;
14934 	}
14935 	nla_nest_end(msg, nest);
14936 
14937 	nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES);
14938 	if (!nest)
14939 		goto nla_put_failure;
14940 	for (i = 0; i < req->n_channels; i++) {
14941 		if (nla_put_u32(msg, i, req->channels[i]->center_freq))
14942 			goto nla_put_failure;
14943 	}
14944 	nla_nest_end(msg, nest);
14945 
14946 	if (req->ie &&
14947 	    nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
14948 		goto nla_put_failure;
14949 
14950 	if (req->flags &&
14951 	    nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
14952 		goto nla_put_failure;
14953 
14954 	if (req->info.scan_start_tsf &&
14955 	    (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
14956 			       req->info.scan_start_tsf, NL80211_BSS_PAD) ||
14957 	     nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
14958 		     req->info.tsf_bssid)))
14959 		goto nla_put_failure;
14960 
14961 	return 0;
14962  nla_put_failure:
14963 	return -ENOBUFS;
14964 }
14965 
14966 static int nl80211_prep_scan_msg(struct sk_buff *msg,
14967 				 struct cfg80211_registered_device *rdev,
14968 				 struct wireless_dev *wdev,
14969 				 u32 portid, u32 seq, int flags,
14970 				 u32 cmd)
14971 {
14972 	void *hdr;
14973 
14974 	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
14975 	if (!hdr)
14976 		return -1;
14977 
14978 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14979 	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14980 					 wdev->netdev->ifindex)) ||
14981 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14982 			      NL80211_ATTR_PAD))
14983 		goto nla_put_failure;
14984 
14985 	/* ignore errors and send incomplete event anyway */
14986 	nl80211_add_scan_req(msg, rdev);
14987 
14988 	genlmsg_end(msg, hdr);
14989 	return 0;
14990 
14991  nla_put_failure:
14992 	genlmsg_cancel(msg, hdr);
14993 	return -EMSGSIZE;
14994 }
14995 
14996 static int
14997 nl80211_prep_sched_scan_msg(struct sk_buff *msg,
14998 			    struct cfg80211_sched_scan_request *req, u32 cmd)
14999 {
15000 	void *hdr;
15001 
15002 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15003 	if (!hdr)
15004 		return -1;
15005 
15006 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
15007 			wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
15008 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
15009 	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
15010 			      NL80211_ATTR_PAD))
15011 		goto nla_put_failure;
15012 
15013 	genlmsg_end(msg, hdr);
15014 	return 0;
15015 
15016  nla_put_failure:
15017 	genlmsg_cancel(msg, hdr);
15018 	return -EMSGSIZE;
15019 }
15020 
15021 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
15022 			     struct wireless_dev *wdev)
15023 {
15024 	struct sk_buff *msg;
15025 
15026 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15027 	if (!msg)
15028 		return;
15029 
15030 	if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
15031 				  NL80211_CMD_TRIGGER_SCAN) < 0) {
15032 		nlmsg_free(msg);
15033 		return;
15034 	}
15035 
15036 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15037 				NL80211_MCGRP_SCAN, GFP_KERNEL);
15038 }
15039 
15040 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
15041 				       struct wireless_dev *wdev, bool aborted)
15042 {
15043 	struct sk_buff *msg;
15044 
15045 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15046 	if (!msg)
15047 		return NULL;
15048 
15049 	if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
15050 				  aborted ? NL80211_CMD_SCAN_ABORTED :
15051 					    NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
15052 		nlmsg_free(msg);
15053 		return NULL;
15054 	}
15055 
15056 	return msg;
15057 }
15058 
15059 /* send message created by nl80211_build_scan_msg() */
15060 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
15061 			   struct sk_buff *msg)
15062 {
15063 	if (!msg)
15064 		return;
15065 
15066 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15067 				NL80211_MCGRP_SCAN, GFP_KERNEL);
15068 }
15069 
15070 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
15071 {
15072 	struct sk_buff *msg;
15073 
15074 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15075 	if (!msg)
15076 		return;
15077 
15078 	if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
15079 		nlmsg_free(msg);
15080 		return;
15081 	}
15082 
15083 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
15084 				NL80211_MCGRP_SCAN, GFP_KERNEL);
15085 }
15086 
15087 static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
15088 					  struct regulatory_request *request)
15089 {
15090 	/* Userspace can always count this one always being set */
15091 	if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
15092 		goto nla_put_failure;
15093 
15094 	if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
15095 		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
15096 			       NL80211_REGDOM_TYPE_WORLD))
15097 			goto nla_put_failure;
15098 	} else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
15099 		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
15100 			       NL80211_REGDOM_TYPE_CUSTOM_WORLD))
15101 			goto nla_put_failure;
15102 	} else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
15103 		   request->intersect) {
15104 		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
15105 			       NL80211_REGDOM_TYPE_INTERSECTION))
15106 			goto nla_put_failure;
15107 	} else {
15108 		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
15109 			       NL80211_REGDOM_TYPE_COUNTRY) ||
15110 		    nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
15111 				   request->alpha2))
15112 			goto nla_put_failure;
15113 	}
15114 
15115 	if (request->wiphy_idx != WIPHY_IDX_INVALID) {
15116 		struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
15117 
15118 		if (wiphy &&
15119 		    nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
15120 			goto nla_put_failure;
15121 
15122 		if (wiphy &&
15123 		    wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
15124 		    nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
15125 			goto nla_put_failure;
15126 	}
15127 
15128 	return true;
15129 
15130 nla_put_failure:
15131 	return false;
15132 }
15133 
15134 /*
15135  * This can happen on global regulatory changes or device specific settings
15136  * based on custom regulatory domains.
15137  */
15138 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
15139 				     struct regulatory_request *request)
15140 {
15141 	struct sk_buff *msg;
15142 	void *hdr;
15143 
15144 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15145 	if (!msg)
15146 		return;
15147 
15148 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
15149 	if (!hdr)
15150 		goto nla_put_failure;
15151 
15152 	if (!nl80211_reg_change_event_fill(msg, request))
15153 		goto nla_put_failure;
15154 
15155 	genlmsg_end(msg, hdr);
15156 
15157 	rcu_read_lock();
15158 	genlmsg_multicast_allns(&nl80211_fam, msg, 0,
15159 				NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
15160 	rcu_read_unlock();
15161 
15162 	return;
15163 
15164 nla_put_failure:
15165 	nlmsg_free(msg);
15166 }
15167 
15168 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
15169 				    struct net_device *netdev,
15170 				    const u8 *buf, size_t len,
15171 				    enum nl80211_commands cmd, gfp_t gfp,
15172 				    int uapsd_queues, const u8 *req_ies,
15173 				    size_t req_ies_len)
15174 {
15175 	struct sk_buff *msg;
15176 	void *hdr;
15177 
15178 	msg = nlmsg_new(100 + len + req_ies_len, gfp);
15179 	if (!msg)
15180 		return;
15181 
15182 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15183 	if (!hdr) {
15184 		nlmsg_free(msg);
15185 		return;
15186 	}
15187 
15188 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15189 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15190 	    nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
15191 	    (req_ies &&
15192 	     nla_put(msg, NL80211_ATTR_REQ_IE, req_ies_len, req_ies)))
15193 		goto nla_put_failure;
15194 
15195 	if (uapsd_queues >= 0) {
15196 		struct nlattr *nla_wmm =
15197 			nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME);
15198 		if (!nla_wmm)
15199 			goto nla_put_failure;
15200 
15201 		if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
15202 			       uapsd_queues))
15203 			goto nla_put_failure;
15204 
15205 		nla_nest_end(msg, nla_wmm);
15206 	}
15207 
15208 	genlmsg_end(msg, hdr);
15209 
15210 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15211 				NL80211_MCGRP_MLME, gfp);
15212 	return;
15213 
15214  nla_put_failure:
15215 	nlmsg_free(msg);
15216 }
15217 
15218 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
15219 			  struct net_device *netdev, const u8 *buf,
15220 			  size_t len, gfp_t gfp)
15221 {
15222 	nl80211_send_mlme_event(rdev, netdev, buf, len,
15223 				NL80211_CMD_AUTHENTICATE, gfp, -1, NULL, 0);
15224 }
15225 
15226 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
15227 			   struct net_device *netdev, const u8 *buf,
15228 			   size_t len, gfp_t gfp, int uapsd_queues,
15229 			   const u8 *req_ies, size_t req_ies_len)
15230 {
15231 	nl80211_send_mlme_event(rdev, netdev, buf, len,
15232 				NL80211_CMD_ASSOCIATE, gfp, uapsd_queues,
15233 				req_ies, req_ies_len);
15234 }
15235 
15236 void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
15237 			 struct net_device *netdev, const u8 *buf,
15238 			 size_t len, gfp_t gfp)
15239 {
15240 	nl80211_send_mlme_event(rdev, netdev, buf, len,
15241 				NL80211_CMD_DEAUTHENTICATE, gfp, -1, NULL, 0);
15242 }
15243 
15244 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
15245 			   struct net_device *netdev, const u8 *buf,
15246 			   size_t len, gfp_t gfp)
15247 {
15248 	nl80211_send_mlme_event(rdev, netdev, buf, len,
15249 				NL80211_CMD_DISASSOCIATE, gfp, -1, NULL, 0);
15250 }
15251 
15252 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
15253 				  size_t len)
15254 {
15255 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15256 	struct wiphy *wiphy = wdev->wiphy;
15257 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15258 	const struct ieee80211_mgmt *mgmt = (void *)buf;
15259 	u32 cmd;
15260 
15261 	if (WARN_ON(len < 2))
15262 		return;
15263 
15264 	if (ieee80211_is_deauth(mgmt->frame_control))
15265 		cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
15266 	else
15267 		cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
15268 
15269 	trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
15270 	nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1,
15271 				NULL, 0);
15272 }
15273 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
15274 
15275 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
15276 				      struct net_device *netdev, int cmd,
15277 				      const u8 *addr, gfp_t gfp)
15278 {
15279 	struct sk_buff *msg;
15280 	void *hdr;
15281 
15282 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15283 	if (!msg)
15284 		return;
15285 
15286 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15287 	if (!hdr) {
15288 		nlmsg_free(msg);
15289 		return;
15290 	}
15291 
15292 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15293 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15294 	    nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
15295 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
15296 		goto nla_put_failure;
15297 
15298 	genlmsg_end(msg, hdr);
15299 
15300 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15301 				NL80211_MCGRP_MLME, gfp);
15302 	return;
15303 
15304  nla_put_failure:
15305 	nlmsg_free(msg);
15306 }
15307 
15308 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
15309 			       struct net_device *netdev, const u8 *addr,
15310 			       gfp_t gfp)
15311 {
15312 	nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
15313 				  addr, gfp);
15314 }
15315 
15316 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
15317 				struct net_device *netdev, const u8 *addr,
15318 				gfp_t gfp)
15319 {
15320 	nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
15321 				  addr, gfp);
15322 }
15323 
15324 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
15325 				 struct net_device *netdev,
15326 				 struct cfg80211_connect_resp_params *cr,
15327 				 gfp_t gfp)
15328 {
15329 	struct sk_buff *msg;
15330 	void *hdr;
15331 
15332 	msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
15333 			cr->fils.kek_len + cr->fils.pmk_len +
15334 			(cr->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp);
15335 	if (!msg)
15336 		return;
15337 
15338 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
15339 	if (!hdr) {
15340 		nlmsg_free(msg);
15341 		return;
15342 	}
15343 
15344 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15345 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15346 	    (cr->bssid &&
15347 	     nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cr->bssid)) ||
15348 	    nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
15349 			cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
15350 			cr->status) ||
15351 	    (cr->status < 0 &&
15352 	     (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
15353 	      nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
15354 			  cr->timeout_reason))) ||
15355 	    (cr->req_ie &&
15356 	     nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
15357 	    (cr->resp_ie &&
15358 	     nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
15359 		     cr->resp_ie)) ||
15360 	    (cr->fils.update_erp_next_seq_num &&
15361 	     nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
15362 			 cr->fils.erp_next_seq_num)) ||
15363 	    (cr->status == WLAN_STATUS_SUCCESS &&
15364 	     ((cr->fils.kek &&
15365 	       nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len,
15366 		       cr->fils.kek)) ||
15367 	      (cr->fils.pmk &&
15368 	       nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) ||
15369 	      (cr->fils.pmkid &&
15370 	       nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid)))))
15371 		goto nla_put_failure;
15372 
15373 	genlmsg_end(msg, hdr);
15374 
15375 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15376 				NL80211_MCGRP_MLME, gfp);
15377 	return;
15378 
15379  nla_put_failure:
15380 	nlmsg_free(msg);
15381 }
15382 
15383 void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
15384 			 struct net_device *netdev,
15385 			 struct cfg80211_roam_info *info, gfp_t gfp)
15386 {
15387 	struct sk_buff *msg;
15388 	void *hdr;
15389 	const u8 *bssid = info->bss ? info->bss->bssid : info->bssid;
15390 
15391 	msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len +
15392 			info->fils.kek_len + info->fils.pmk_len +
15393 			(info->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp);
15394 	if (!msg)
15395 		return;
15396 
15397 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
15398 	if (!hdr) {
15399 		nlmsg_free(msg);
15400 		return;
15401 	}
15402 
15403 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15404 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15405 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
15406 	    (info->req_ie &&
15407 	     nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
15408 		     info->req_ie)) ||
15409 	    (info->resp_ie &&
15410 	     nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
15411 		     info->resp_ie)) ||
15412 	    (info->fils.update_erp_next_seq_num &&
15413 	     nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
15414 			 info->fils.erp_next_seq_num)) ||
15415 	    (info->fils.kek &&
15416 	     nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len,
15417 		     info->fils.kek)) ||
15418 	    (info->fils.pmk &&
15419 	     nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) ||
15420 	    (info->fils.pmkid &&
15421 	     nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid)))
15422 		goto nla_put_failure;
15423 
15424 	genlmsg_end(msg, hdr);
15425 
15426 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15427 				NL80211_MCGRP_MLME, gfp);
15428 	return;
15429 
15430  nla_put_failure:
15431 	nlmsg_free(msg);
15432 }
15433 
15434 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev,
15435 				  struct net_device *netdev, const u8 *bssid)
15436 {
15437 	struct sk_buff *msg;
15438 	void *hdr;
15439 
15440 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15441 	if (!msg)
15442 		return;
15443 
15444 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED);
15445 	if (!hdr) {
15446 		nlmsg_free(msg);
15447 		return;
15448 	}
15449 
15450 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15451 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15452 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
15453 		goto nla_put_failure;
15454 
15455 	genlmsg_end(msg, hdr);
15456 
15457 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15458 				NL80211_MCGRP_MLME, GFP_KERNEL);
15459 	return;
15460 
15461  nla_put_failure:
15462 	nlmsg_free(msg);
15463 }
15464 
15465 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
15466 			       struct net_device *netdev, u16 reason,
15467 			       const u8 *ie, size_t ie_len, bool from_ap)
15468 {
15469 	struct sk_buff *msg;
15470 	void *hdr;
15471 
15472 	msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
15473 	if (!msg)
15474 		return;
15475 
15476 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
15477 	if (!hdr) {
15478 		nlmsg_free(msg);
15479 		return;
15480 	}
15481 
15482 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15483 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15484 	    (reason &&
15485 	     nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
15486 	    (from_ap &&
15487 	     nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
15488 	    (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
15489 		goto nla_put_failure;
15490 
15491 	genlmsg_end(msg, hdr);
15492 
15493 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15494 				NL80211_MCGRP_MLME, GFP_KERNEL);
15495 	return;
15496 
15497  nla_put_failure:
15498 	nlmsg_free(msg);
15499 }
15500 
15501 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
15502 			     struct net_device *netdev, const u8 *bssid,
15503 			     gfp_t gfp)
15504 {
15505 	struct sk_buff *msg;
15506 	void *hdr;
15507 
15508 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15509 	if (!msg)
15510 		return;
15511 
15512 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
15513 	if (!hdr) {
15514 		nlmsg_free(msg);
15515 		return;
15516 	}
15517 
15518 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15519 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15520 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
15521 		goto nla_put_failure;
15522 
15523 	genlmsg_end(msg, hdr);
15524 
15525 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15526 				NL80211_MCGRP_MLME, gfp);
15527 	return;
15528 
15529  nla_put_failure:
15530 	nlmsg_free(msg);
15531 }
15532 
15533 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
15534 					const u8 *ie, u8 ie_len,
15535 					int sig_dbm, gfp_t gfp)
15536 {
15537 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15538 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15539 	struct sk_buff *msg;
15540 	void *hdr;
15541 
15542 	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
15543 		return;
15544 
15545 	trace_cfg80211_notify_new_peer_candidate(dev, addr);
15546 
15547 	msg = nlmsg_new(100 + ie_len, gfp);
15548 	if (!msg)
15549 		return;
15550 
15551 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
15552 	if (!hdr) {
15553 		nlmsg_free(msg);
15554 		return;
15555 	}
15556 
15557 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15558 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15559 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
15560 	    (ie_len && ie &&
15561 	     nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) ||
15562 	    (sig_dbm &&
15563 	     nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)))
15564 		goto nla_put_failure;
15565 
15566 	genlmsg_end(msg, hdr);
15567 
15568 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15569 				NL80211_MCGRP_MLME, gfp);
15570 	return;
15571 
15572  nla_put_failure:
15573 	nlmsg_free(msg);
15574 }
15575 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
15576 
15577 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
15578 				 struct net_device *netdev, const u8 *addr,
15579 				 enum nl80211_key_type key_type, int key_id,
15580 				 const u8 *tsc, gfp_t gfp)
15581 {
15582 	struct sk_buff *msg;
15583 	void *hdr;
15584 
15585 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15586 	if (!msg)
15587 		return;
15588 
15589 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
15590 	if (!hdr) {
15591 		nlmsg_free(msg);
15592 		return;
15593 	}
15594 
15595 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15596 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15597 	    (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
15598 	    nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
15599 	    (key_id != -1 &&
15600 	     nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
15601 	    (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
15602 		goto nla_put_failure;
15603 
15604 	genlmsg_end(msg, hdr);
15605 
15606 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15607 				NL80211_MCGRP_MLME, gfp);
15608 	return;
15609 
15610  nla_put_failure:
15611 	nlmsg_free(msg);
15612 }
15613 
15614 void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
15615 				    struct ieee80211_channel *channel_before,
15616 				    struct ieee80211_channel *channel_after)
15617 {
15618 	struct sk_buff *msg;
15619 	void *hdr;
15620 	struct nlattr *nl_freq;
15621 
15622 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
15623 	if (!msg)
15624 		return;
15625 
15626 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
15627 	if (!hdr) {
15628 		nlmsg_free(msg);
15629 		return;
15630 	}
15631 
15632 	/*
15633 	 * Since we are applying the beacon hint to a wiphy we know its
15634 	 * wiphy_idx is valid
15635 	 */
15636 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
15637 		goto nla_put_failure;
15638 
15639 	/* Before */
15640 	nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE);
15641 	if (!nl_freq)
15642 		goto nla_put_failure;
15643 
15644 	if (nl80211_msg_put_channel(msg, wiphy, channel_before, false))
15645 		goto nla_put_failure;
15646 	nla_nest_end(msg, nl_freq);
15647 
15648 	/* After */
15649 	nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER);
15650 	if (!nl_freq)
15651 		goto nla_put_failure;
15652 
15653 	if (nl80211_msg_put_channel(msg, wiphy, channel_after, false))
15654 		goto nla_put_failure;
15655 	nla_nest_end(msg, nl_freq);
15656 
15657 	genlmsg_end(msg, hdr);
15658 
15659 	rcu_read_lock();
15660 	genlmsg_multicast_allns(&nl80211_fam, msg, 0,
15661 				NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
15662 	rcu_read_unlock();
15663 
15664 	return;
15665 
15666 nla_put_failure:
15667 	nlmsg_free(msg);
15668 }
15669 
15670 static void nl80211_send_remain_on_chan_event(
15671 	int cmd, struct cfg80211_registered_device *rdev,
15672 	struct wireless_dev *wdev, u64 cookie,
15673 	struct ieee80211_channel *chan,
15674 	unsigned int duration, gfp_t gfp)
15675 {
15676 	struct sk_buff *msg;
15677 	void *hdr;
15678 
15679 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15680 	if (!msg)
15681 		return;
15682 
15683 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15684 	if (!hdr) {
15685 		nlmsg_free(msg);
15686 		return;
15687 	}
15688 
15689 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15690 	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15691 					 wdev->netdev->ifindex)) ||
15692 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15693 			      NL80211_ATTR_PAD) ||
15694 	    nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
15695 	    nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
15696 			NL80211_CHAN_NO_HT) ||
15697 	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
15698 			      NL80211_ATTR_PAD))
15699 		goto nla_put_failure;
15700 
15701 	if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
15702 	    nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
15703 		goto nla_put_failure;
15704 
15705 	genlmsg_end(msg, hdr);
15706 
15707 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15708 				NL80211_MCGRP_MLME, gfp);
15709 	return;
15710 
15711  nla_put_failure:
15712 	nlmsg_free(msg);
15713 }
15714 
15715 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
15716 			       struct ieee80211_channel *chan,
15717 			       unsigned int duration, gfp_t gfp)
15718 {
15719 	struct wiphy *wiphy = wdev->wiphy;
15720 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15721 
15722 	trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
15723 	nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
15724 					  rdev, wdev, cookie, chan,
15725 					  duration, gfp);
15726 }
15727 EXPORT_SYMBOL(cfg80211_ready_on_channel);
15728 
15729 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
15730 					struct ieee80211_channel *chan,
15731 					gfp_t gfp)
15732 {
15733 	struct wiphy *wiphy = wdev->wiphy;
15734 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15735 
15736 	trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
15737 	nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
15738 					  rdev, wdev, cookie, chan, 0, gfp);
15739 }
15740 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
15741 
15742 void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie,
15743 					struct ieee80211_channel *chan,
15744 					gfp_t gfp)
15745 {
15746 	struct wiphy *wiphy = wdev->wiphy;
15747 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15748 
15749 	trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan);
15750 	nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL,
15751 					  rdev, wdev, cookie, chan, 0, gfp);
15752 }
15753 EXPORT_SYMBOL(cfg80211_tx_mgmt_expired);
15754 
15755 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
15756 		      struct station_info *sinfo, gfp_t gfp)
15757 {
15758 	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
15759 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15760 	struct sk_buff *msg;
15761 
15762 	trace_cfg80211_new_sta(dev, mac_addr, sinfo);
15763 
15764 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15765 	if (!msg)
15766 		return;
15767 
15768 	if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
15769 				 rdev, dev, mac_addr, sinfo) < 0) {
15770 		nlmsg_free(msg);
15771 		return;
15772 	}
15773 
15774 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15775 				NL80211_MCGRP_MLME, gfp);
15776 }
15777 EXPORT_SYMBOL(cfg80211_new_sta);
15778 
15779 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
15780 			    struct station_info *sinfo, gfp_t gfp)
15781 {
15782 	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
15783 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15784 	struct sk_buff *msg;
15785 	struct station_info empty_sinfo = {};
15786 
15787 	if (!sinfo)
15788 		sinfo = &empty_sinfo;
15789 
15790 	trace_cfg80211_del_sta(dev, mac_addr);
15791 
15792 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15793 	if (!msg) {
15794 		cfg80211_sinfo_release_content(sinfo);
15795 		return;
15796 	}
15797 
15798 	if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
15799 				 rdev, dev, mac_addr, sinfo) < 0) {
15800 		nlmsg_free(msg);
15801 		return;
15802 	}
15803 
15804 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15805 				NL80211_MCGRP_MLME, gfp);
15806 }
15807 EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
15808 
15809 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
15810 			  enum nl80211_connect_failed_reason reason,
15811 			  gfp_t gfp)
15812 {
15813 	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
15814 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15815 	struct sk_buff *msg;
15816 	void *hdr;
15817 
15818 	msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
15819 	if (!msg)
15820 		return;
15821 
15822 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
15823 	if (!hdr) {
15824 		nlmsg_free(msg);
15825 		return;
15826 	}
15827 
15828 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15829 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
15830 	    nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
15831 		goto nla_put_failure;
15832 
15833 	genlmsg_end(msg, hdr);
15834 
15835 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15836 				NL80211_MCGRP_MLME, gfp);
15837 	return;
15838 
15839  nla_put_failure:
15840 	nlmsg_free(msg);
15841 }
15842 EXPORT_SYMBOL(cfg80211_conn_failed);
15843 
15844 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
15845 				       const u8 *addr, gfp_t gfp)
15846 {
15847 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15848 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15849 	struct sk_buff *msg;
15850 	void *hdr;
15851 	u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid);
15852 
15853 	if (!nlportid)
15854 		return false;
15855 
15856 	msg = nlmsg_new(100, gfp);
15857 	if (!msg)
15858 		return true;
15859 
15860 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15861 	if (!hdr) {
15862 		nlmsg_free(msg);
15863 		return true;
15864 	}
15865 
15866 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15867 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15868 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
15869 		goto nla_put_failure;
15870 
15871 	genlmsg_end(msg, hdr);
15872 	genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15873 	return true;
15874 
15875  nla_put_failure:
15876 	nlmsg_free(msg);
15877 	return true;
15878 }
15879 
15880 bool cfg80211_rx_spurious_frame(struct net_device *dev,
15881 				const u8 *addr, gfp_t gfp)
15882 {
15883 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15884 	bool ret;
15885 
15886 	trace_cfg80211_rx_spurious_frame(dev, addr);
15887 
15888 	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
15889 		    wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
15890 		trace_cfg80211_return_bool(false);
15891 		return false;
15892 	}
15893 	ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
15894 					 addr, gfp);
15895 	trace_cfg80211_return_bool(ret);
15896 	return ret;
15897 }
15898 EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
15899 
15900 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
15901 					const u8 *addr, gfp_t gfp)
15902 {
15903 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15904 	bool ret;
15905 
15906 	trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
15907 
15908 	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
15909 		    wdev->iftype != NL80211_IFTYPE_P2P_GO &&
15910 		    wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
15911 		trace_cfg80211_return_bool(false);
15912 		return false;
15913 	}
15914 	ret = __nl80211_unexpected_frame(dev,
15915 					 NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
15916 					 addr, gfp);
15917 	trace_cfg80211_return_bool(ret);
15918 	return ret;
15919 }
15920 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
15921 
15922 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
15923 		      struct wireless_dev *wdev, u32 nlportid,
15924 		      int freq, int sig_dbm,
15925 		      const u8 *buf, size_t len, u32 flags, gfp_t gfp)
15926 {
15927 	struct net_device *netdev = wdev->netdev;
15928 	struct sk_buff *msg;
15929 	void *hdr;
15930 
15931 	msg = nlmsg_new(100 + len, gfp);
15932 	if (!msg)
15933 		return -ENOMEM;
15934 
15935 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
15936 	if (!hdr) {
15937 		nlmsg_free(msg);
15938 		return -ENOMEM;
15939 	}
15940 
15941 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15942 	    (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15943 					netdev->ifindex)) ||
15944 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15945 			      NL80211_ATTR_PAD) ||
15946 	    nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
15947 	    (sig_dbm &&
15948 	     nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
15949 	    nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
15950 	    (flags &&
15951 	     nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
15952 		goto nla_put_failure;
15953 
15954 	genlmsg_end(msg, hdr);
15955 
15956 	return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15957 
15958  nla_put_failure:
15959 	nlmsg_free(msg);
15960 	return -ENOBUFS;
15961 }
15962 
15963 void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
15964 			     const u8 *buf, size_t len, bool ack, gfp_t gfp)
15965 {
15966 	struct wiphy *wiphy = wdev->wiphy;
15967 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15968 	struct net_device *netdev = wdev->netdev;
15969 	struct sk_buff *msg;
15970 	void *hdr;
15971 
15972 	trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
15973 
15974 	msg = nlmsg_new(100 + len, gfp);
15975 	if (!msg)
15976 		return;
15977 
15978 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
15979 	if (!hdr) {
15980 		nlmsg_free(msg);
15981 		return;
15982 	}
15983 
15984 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15985 	    (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15986 				   netdev->ifindex)) ||
15987 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15988 			      NL80211_ATTR_PAD) ||
15989 	    nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
15990 	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
15991 			      NL80211_ATTR_PAD) ||
15992 	    (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
15993 		goto nla_put_failure;
15994 
15995 	genlmsg_end(msg, hdr);
15996 
15997 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15998 				NL80211_MCGRP_MLME, gfp);
15999 	return;
16000 
16001  nla_put_failure:
16002 	nlmsg_free(msg);
16003 }
16004 EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
16005 
16006 static int __nl80211_rx_control_port(struct net_device *dev,
16007 				     struct sk_buff *skb,
16008 				     bool unencrypted, gfp_t gfp)
16009 {
16010 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16011 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16012 	struct ethhdr *ehdr = eth_hdr(skb);
16013 	const u8 *daddr = ehdr->h_dest;
16014 	const u8 *saddr = ehdr->h_source;
16015 	u16 proto = be16_to_cpu(skb->protocol);
16016 	struct sk_buff *msg;
16017 	void *hdr;
16018 	struct nlattr *frame;
16019 
16020 	u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid);
16021 
16022 	if (!nlportid)
16023 		return -ENOENT;
16024 
16025 	msg = nlmsg_new(100 + skb->len, gfp);
16026 	if (!msg)
16027 		return -ENOMEM;
16028 
16029 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME);
16030 	if (!hdr) {
16031 		nlmsg_free(msg);
16032 		return -ENOBUFS;
16033 	}
16034 
16035 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16036 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
16037 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16038 			      NL80211_ATTR_PAD) ||
16039 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, saddr) ||
16040 	    nla_put(msg, NL80211_ATTR_DST_MAC, ETH_ALEN, daddr) ||
16041 	    nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) ||
16042 	    (unencrypted && nla_put_flag(msg,
16043 					 NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT)))
16044 		goto nla_put_failure;
16045 
16046 	frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len);
16047 	if (!frame)
16048 		goto nla_put_failure;
16049 
16050 	skb_copy_bits(skb, 0, nla_data(frame), skb->len);
16051 	genlmsg_end(msg, hdr);
16052 
16053 	return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
16054 
16055  nla_put_failure:
16056 	nlmsg_free(msg);
16057 	return -ENOBUFS;
16058 }
16059 
16060 bool cfg80211_rx_control_port(struct net_device *dev,
16061 			      struct sk_buff *skb, bool unencrypted)
16062 {
16063 	int ret;
16064 
16065 	trace_cfg80211_rx_control_port(dev, skb, unencrypted);
16066 	ret = __nl80211_rx_control_port(dev, skb, unencrypted, GFP_ATOMIC);
16067 	trace_cfg80211_return_bool(ret == 0);
16068 	return ret == 0;
16069 }
16070 EXPORT_SYMBOL(cfg80211_rx_control_port);
16071 
16072 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
16073 					    const char *mac, gfp_t gfp)
16074 {
16075 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16076 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16077 	struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16078 	void **cb;
16079 
16080 	if (!msg)
16081 		return NULL;
16082 
16083 	cb = (void **)msg->cb;
16084 
16085 	cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
16086 	if (!cb[0]) {
16087 		nlmsg_free(msg);
16088 		return NULL;
16089 	}
16090 
16091 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16092 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
16093 		goto nla_put_failure;
16094 
16095 	if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
16096 		goto nla_put_failure;
16097 
16098 	cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM);
16099 	if (!cb[1])
16100 		goto nla_put_failure;
16101 
16102 	cb[2] = rdev;
16103 
16104 	return msg;
16105  nla_put_failure:
16106 	nlmsg_free(msg);
16107 	return NULL;
16108 }
16109 
16110 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
16111 {
16112 	void **cb = (void **)msg->cb;
16113 	struct cfg80211_registered_device *rdev = cb[2];
16114 
16115 	nla_nest_end(msg, cb[1]);
16116 	genlmsg_end(msg, cb[0]);
16117 
16118 	memset(msg->cb, 0, sizeof(msg->cb));
16119 
16120 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16121 				NL80211_MCGRP_MLME, gfp);
16122 }
16123 
16124 void cfg80211_cqm_rssi_notify(struct net_device *dev,
16125 			      enum nl80211_cqm_rssi_threshold_event rssi_event,
16126 			      s32 rssi_level, gfp_t gfp)
16127 {
16128 	struct sk_buff *msg;
16129 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16130 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16131 
16132 	trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
16133 
16134 	if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
16135 		    rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
16136 		return;
16137 
16138 	if (wdev->cqm_config) {
16139 		wdev->cqm_config->last_rssi_event_value = rssi_level;
16140 
16141 		cfg80211_cqm_rssi_update(rdev, dev);
16142 
16143 		if (rssi_level == 0)
16144 			rssi_level = wdev->cqm_config->last_rssi_event_value;
16145 	}
16146 
16147 	msg = cfg80211_prepare_cqm(dev, NULL, gfp);
16148 	if (!msg)
16149 		return;
16150 
16151 	if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
16152 			rssi_event))
16153 		goto nla_put_failure;
16154 
16155 	if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
16156 				      rssi_level))
16157 		goto nla_put_failure;
16158 
16159 	cfg80211_send_cqm(msg, gfp);
16160 
16161 	return;
16162 
16163  nla_put_failure:
16164 	nlmsg_free(msg);
16165 }
16166 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
16167 
16168 void cfg80211_cqm_txe_notify(struct net_device *dev,
16169 			     const u8 *peer, u32 num_packets,
16170 			     u32 rate, u32 intvl, gfp_t gfp)
16171 {
16172 	struct sk_buff *msg;
16173 
16174 	msg = cfg80211_prepare_cqm(dev, peer, gfp);
16175 	if (!msg)
16176 		return;
16177 
16178 	if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
16179 		goto nla_put_failure;
16180 
16181 	if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
16182 		goto nla_put_failure;
16183 
16184 	if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
16185 		goto nla_put_failure;
16186 
16187 	cfg80211_send_cqm(msg, gfp);
16188 	return;
16189 
16190  nla_put_failure:
16191 	nlmsg_free(msg);
16192 }
16193 EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
16194 
16195 void cfg80211_cqm_pktloss_notify(struct net_device *dev,
16196 				 const u8 *peer, u32 num_packets, gfp_t gfp)
16197 {
16198 	struct sk_buff *msg;
16199 
16200 	trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
16201 
16202 	msg = cfg80211_prepare_cqm(dev, peer, gfp);
16203 	if (!msg)
16204 		return;
16205 
16206 	if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
16207 		goto nla_put_failure;
16208 
16209 	cfg80211_send_cqm(msg, gfp);
16210 	return;
16211 
16212  nla_put_failure:
16213 	nlmsg_free(msg);
16214 }
16215 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
16216 
16217 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
16218 {
16219 	struct sk_buff *msg;
16220 
16221 	msg = cfg80211_prepare_cqm(dev, NULL, gfp);
16222 	if (!msg)
16223 		return;
16224 
16225 	if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
16226 		goto nla_put_failure;
16227 
16228 	cfg80211_send_cqm(msg, gfp);
16229 	return;
16230 
16231  nla_put_failure:
16232 	nlmsg_free(msg);
16233 }
16234 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
16235 
16236 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
16237 				     struct net_device *netdev, const u8 *bssid,
16238 				     const u8 *replay_ctr, gfp_t gfp)
16239 {
16240 	struct sk_buff *msg;
16241 	struct nlattr *rekey_attr;
16242 	void *hdr;
16243 
16244 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16245 	if (!msg)
16246 		return;
16247 
16248 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
16249 	if (!hdr) {
16250 		nlmsg_free(msg);
16251 		return;
16252 	}
16253 
16254 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16255 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
16256 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
16257 		goto nla_put_failure;
16258 
16259 	rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA);
16260 	if (!rekey_attr)
16261 		goto nla_put_failure;
16262 
16263 	if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
16264 		    NL80211_REPLAY_CTR_LEN, replay_ctr))
16265 		goto nla_put_failure;
16266 
16267 	nla_nest_end(msg, rekey_attr);
16268 
16269 	genlmsg_end(msg, hdr);
16270 
16271 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16272 				NL80211_MCGRP_MLME, gfp);
16273 	return;
16274 
16275  nla_put_failure:
16276 	nlmsg_free(msg);
16277 }
16278 
16279 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
16280 			       const u8 *replay_ctr, gfp_t gfp)
16281 {
16282 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16283 	struct wiphy *wiphy = wdev->wiphy;
16284 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16285 
16286 	trace_cfg80211_gtk_rekey_notify(dev, bssid);
16287 	nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
16288 }
16289 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
16290 
16291 static void
16292 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
16293 			       struct net_device *netdev, int index,
16294 			       const u8 *bssid, bool preauth, gfp_t gfp)
16295 {
16296 	struct sk_buff *msg;
16297 	struct nlattr *attr;
16298 	void *hdr;
16299 
16300 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16301 	if (!msg)
16302 		return;
16303 
16304 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
16305 	if (!hdr) {
16306 		nlmsg_free(msg);
16307 		return;
16308 	}
16309 
16310 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16311 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
16312 		goto nla_put_failure;
16313 
16314 	attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE);
16315 	if (!attr)
16316 		goto nla_put_failure;
16317 
16318 	if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
16319 	    nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
16320 	    (preauth &&
16321 	     nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
16322 		goto nla_put_failure;
16323 
16324 	nla_nest_end(msg, attr);
16325 
16326 	genlmsg_end(msg, hdr);
16327 
16328 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16329 				NL80211_MCGRP_MLME, gfp);
16330 	return;
16331 
16332  nla_put_failure:
16333 	nlmsg_free(msg);
16334 }
16335 
16336 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
16337 				     const u8 *bssid, bool preauth, gfp_t gfp)
16338 {
16339 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16340 	struct wiphy *wiphy = wdev->wiphy;
16341 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16342 
16343 	trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
16344 	nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
16345 }
16346 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
16347 
16348 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
16349 				     struct net_device *netdev,
16350 				     struct cfg80211_chan_def *chandef,
16351 				     gfp_t gfp,
16352 				     enum nl80211_commands notif,
16353 				     u8 count)
16354 {
16355 	struct sk_buff *msg;
16356 	void *hdr;
16357 
16358 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16359 	if (!msg)
16360 		return;
16361 
16362 	hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
16363 	if (!hdr) {
16364 		nlmsg_free(msg);
16365 		return;
16366 	}
16367 
16368 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
16369 		goto nla_put_failure;
16370 
16371 	if (nl80211_send_chandef(msg, chandef))
16372 		goto nla_put_failure;
16373 
16374 	if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
16375 	    (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
16376 			goto nla_put_failure;
16377 
16378 	genlmsg_end(msg, hdr);
16379 
16380 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16381 				NL80211_MCGRP_MLME, gfp);
16382 	return;
16383 
16384  nla_put_failure:
16385 	nlmsg_free(msg);
16386 }
16387 
16388 void cfg80211_ch_switch_notify(struct net_device *dev,
16389 			       struct cfg80211_chan_def *chandef)
16390 {
16391 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16392 	struct wiphy *wiphy = wdev->wiphy;
16393 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16394 
16395 	ASSERT_WDEV_LOCK(wdev);
16396 
16397 	trace_cfg80211_ch_switch_notify(dev, chandef);
16398 
16399 	wdev->chandef = *chandef;
16400 	wdev->preset_chandef = *chandef;
16401 
16402 	if (wdev->iftype == NL80211_IFTYPE_STATION &&
16403 	    !WARN_ON(!wdev->current_bss))
16404 		cfg80211_update_assoc_bss_entry(wdev, chandef->chan);
16405 
16406 	cfg80211_sched_dfs_chan_update(rdev);
16407 
16408 	nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
16409 				 NL80211_CMD_CH_SWITCH_NOTIFY, 0);
16410 }
16411 EXPORT_SYMBOL(cfg80211_ch_switch_notify);
16412 
16413 void cfg80211_ch_switch_started_notify(struct net_device *dev,
16414 				       struct cfg80211_chan_def *chandef,
16415 				       u8 count)
16416 {
16417 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16418 	struct wiphy *wiphy = wdev->wiphy;
16419 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16420 
16421 	trace_cfg80211_ch_switch_started_notify(dev, chandef);
16422 
16423 	nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
16424 				 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
16425 }
16426 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
16427 
16428 void
16429 nl80211_radar_notify(struct cfg80211_registered_device *rdev,
16430 		     const struct cfg80211_chan_def *chandef,
16431 		     enum nl80211_radar_event event,
16432 		     struct net_device *netdev, gfp_t gfp)
16433 {
16434 	struct sk_buff *msg;
16435 	void *hdr;
16436 
16437 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16438 	if (!msg)
16439 		return;
16440 
16441 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
16442 	if (!hdr) {
16443 		nlmsg_free(msg);
16444 		return;
16445 	}
16446 
16447 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
16448 		goto nla_put_failure;
16449 
16450 	/* NOP and radar events don't need a netdev parameter */
16451 	if (netdev) {
16452 		struct wireless_dev *wdev = netdev->ieee80211_ptr;
16453 
16454 		if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
16455 		    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16456 				      NL80211_ATTR_PAD))
16457 			goto nla_put_failure;
16458 	}
16459 
16460 	if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
16461 		goto nla_put_failure;
16462 
16463 	if (nl80211_send_chandef(msg, chandef))
16464 		goto nla_put_failure;
16465 
16466 	genlmsg_end(msg, hdr);
16467 
16468 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16469 				NL80211_MCGRP_MLME, gfp);
16470 	return;
16471 
16472  nla_put_failure:
16473 	nlmsg_free(msg);
16474 }
16475 
16476 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac,
16477 				       struct sta_opmode_info *sta_opmode,
16478 				       gfp_t gfp)
16479 {
16480 	struct sk_buff *msg;
16481 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16482 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16483 	void *hdr;
16484 
16485 	if (WARN_ON(!mac))
16486 		return;
16487 
16488 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16489 	if (!msg)
16490 		return;
16491 
16492 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED);
16493 	if (!hdr) {
16494 		nlmsg_free(msg);
16495 		return;
16496 	}
16497 
16498 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
16499 		goto nla_put_failure;
16500 
16501 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
16502 		goto nla_put_failure;
16503 
16504 	if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
16505 		goto nla_put_failure;
16506 
16507 	if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) &&
16508 	    nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode))
16509 		goto nla_put_failure;
16510 
16511 	if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) &&
16512 	    nla_put_u8(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw))
16513 		goto nla_put_failure;
16514 
16515 	if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) &&
16516 	    nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss))
16517 		goto nla_put_failure;
16518 
16519 	genlmsg_end(msg, hdr);
16520 
16521 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16522 				NL80211_MCGRP_MLME, gfp);
16523 
16524 	return;
16525 
16526 nla_put_failure:
16527 	nlmsg_free(msg);
16528 }
16529 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify);
16530 
16531 void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
16532 			   u64 cookie, bool acked, s32 ack_signal,
16533 			   bool is_valid_ack_signal, gfp_t gfp)
16534 {
16535 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16536 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16537 	struct sk_buff *msg;
16538 	void *hdr;
16539 
16540 	trace_cfg80211_probe_status(dev, addr, cookie, acked);
16541 
16542 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16543 
16544 	if (!msg)
16545 		return;
16546 
16547 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
16548 	if (!hdr) {
16549 		nlmsg_free(msg);
16550 		return;
16551 	}
16552 
16553 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16554 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
16555 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
16556 	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
16557 			      NL80211_ATTR_PAD) ||
16558 	    (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
16559 	    (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL,
16560 						ack_signal)))
16561 		goto nla_put_failure;
16562 
16563 	genlmsg_end(msg, hdr);
16564 
16565 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16566 				NL80211_MCGRP_MLME, gfp);
16567 	return;
16568 
16569  nla_put_failure:
16570 	nlmsg_free(msg);
16571 }
16572 EXPORT_SYMBOL(cfg80211_probe_status);
16573 
16574 void cfg80211_report_obss_beacon(struct wiphy *wiphy,
16575 				 const u8 *frame, size_t len,
16576 				 int freq, int sig_dbm)
16577 {
16578 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16579 	struct sk_buff *msg;
16580 	void *hdr;
16581 	struct cfg80211_beacon_registration *reg;
16582 
16583 	trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
16584 
16585 	spin_lock_bh(&rdev->beacon_registrations_lock);
16586 	list_for_each_entry(reg, &rdev->beacon_registrations, list) {
16587 		msg = nlmsg_new(len + 100, GFP_ATOMIC);
16588 		if (!msg) {
16589 			spin_unlock_bh(&rdev->beacon_registrations_lock);
16590 			return;
16591 		}
16592 
16593 		hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
16594 		if (!hdr)
16595 			goto nla_put_failure;
16596 
16597 		if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16598 		    (freq &&
16599 		     nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
16600 		    (sig_dbm &&
16601 		     nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
16602 		    nla_put(msg, NL80211_ATTR_FRAME, len, frame))
16603 			goto nla_put_failure;
16604 
16605 		genlmsg_end(msg, hdr);
16606 
16607 		genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
16608 	}
16609 	spin_unlock_bh(&rdev->beacon_registrations_lock);
16610 	return;
16611 
16612  nla_put_failure:
16613 	spin_unlock_bh(&rdev->beacon_registrations_lock);
16614 	nlmsg_free(msg);
16615 }
16616 EXPORT_SYMBOL(cfg80211_report_obss_beacon);
16617 
16618 #ifdef CONFIG_PM
16619 static int cfg80211_net_detect_results(struct sk_buff *msg,
16620 				       struct cfg80211_wowlan_wakeup *wakeup)
16621 {
16622 	struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
16623 	struct nlattr *nl_results, *nl_match, *nl_freqs;
16624 	int i, j;
16625 
16626 	nl_results = nla_nest_start_noflag(msg,
16627 					   NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
16628 	if (!nl_results)
16629 		return -EMSGSIZE;
16630 
16631 	for (i = 0; i < nd->n_matches; i++) {
16632 		struct cfg80211_wowlan_nd_match *match = nd->matches[i];
16633 
16634 		nl_match = nla_nest_start_noflag(msg, i);
16635 		if (!nl_match)
16636 			break;
16637 
16638 		/* The SSID attribute is optional in nl80211, but for
16639 		 * simplicity reasons it's always present in the
16640 		 * cfg80211 structure.  If a driver can't pass the
16641 		 * SSID, that needs to be changed.  A zero length SSID
16642 		 * is still a valid SSID (wildcard), so it cannot be
16643 		 * used for this purpose.
16644 		 */
16645 		if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
16646 			    match->ssid.ssid)) {
16647 			nla_nest_cancel(msg, nl_match);
16648 			goto out;
16649 		}
16650 
16651 		if (match->n_channels) {
16652 			nl_freqs = nla_nest_start_noflag(msg,
16653 							 NL80211_ATTR_SCAN_FREQUENCIES);
16654 			if (!nl_freqs) {
16655 				nla_nest_cancel(msg, nl_match);
16656 				goto out;
16657 			}
16658 
16659 			for (j = 0; j < match->n_channels; j++) {
16660 				if (nla_put_u32(msg, j, match->channels[j])) {
16661 					nla_nest_cancel(msg, nl_freqs);
16662 					nla_nest_cancel(msg, nl_match);
16663 					goto out;
16664 				}
16665 			}
16666 
16667 			nla_nest_end(msg, nl_freqs);
16668 		}
16669 
16670 		nla_nest_end(msg, nl_match);
16671 	}
16672 
16673 out:
16674 	nla_nest_end(msg, nl_results);
16675 	return 0;
16676 }
16677 
16678 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
16679 				   struct cfg80211_wowlan_wakeup *wakeup,
16680 				   gfp_t gfp)
16681 {
16682 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16683 	struct sk_buff *msg;
16684 	void *hdr;
16685 	int size = 200;
16686 
16687 	trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
16688 
16689 	if (wakeup)
16690 		size += wakeup->packet_present_len;
16691 
16692 	msg = nlmsg_new(size, gfp);
16693 	if (!msg)
16694 		return;
16695 
16696 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
16697 	if (!hdr)
16698 		goto free_msg;
16699 
16700 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16701 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16702 			      NL80211_ATTR_PAD))
16703 		goto free_msg;
16704 
16705 	if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
16706 					wdev->netdev->ifindex))
16707 		goto free_msg;
16708 
16709 	if (wakeup) {
16710 		struct nlattr *reasons;
16711 
16712 		reasons = nla_nest_start_noflag(msg,
16713 						NL80211_ATTR_WOWLAN_TRIGGERS);
16714 		if (!reasons)
16715 			goto free_msg;
16716 
16717 		if (wakeup->disconnect &&
16718 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
16719 			goto free_msg;
16720 		if (wakeup->magic_pkt &&
16721 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
16722 			goto free_msg;
16723 		if (wakeup->gtk_rekey_failure &&
16724 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
16725 			goto free_msg;
16726 		if (wakeup->eap_identity_req &&
16727 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
16728 			goto free_msg;
16729 		if (wakeup->four_way_handshake &&
16730 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
16731 			goto free_msg;
16732 		if (wakeup->rfkill_release &&
16733 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
16734 			goto free_msg;
16735 
16736 		if (wakeup->pattern_idx >= 0 &&
16737 		    nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
16738 				wakeup->pattern_idx))
16739 			goto free_msg;
16740 
16741 		if (wakeup->tcp_match &&
16742 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
16743 			goto free_msg;
16744 
16745 		if (wakeup->tcp_connlost &&
16746 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
16747 			goto free_msg;
16748 
16749 		if (wakeup->tcp_nomoretokens &&
16750 		    nla_put_flag(msg,
16751 				 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
16752 			goto free_msg;
16753 
16754 		if (wakeup->packet) {
16755 			u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
16756 			u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
16757 
16758 			if (!wakeup->packet_80211) {
16759 				pkt_attr =
16760 					NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
16761 				len_attr =
16762 					NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
16763 			}
16764 
16765 			if (wakeup->packet_len &&
16766 			    nla_put_u32(msg, len_attr, wakeup->packet_len))
16767 				goto free_msg;
16768 
16769 			if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
16770 				    wakeup->packet))
16771 				goto free_msg;
16772 		}
16773 
16774 		if (wakeup->net_detect &&
16775 		    cfg80211_net_detect_results(msg, wakeup))
16776 				goto free_msg;
16777 
16778 		nla_nest_end(msg, reasons);
16779 	}
16780 
16781 	genlmsg_end(msg, hdr);
16782 
16783 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16784 				NL80211_MCGRP_MLME, gfp);
16785 	return;
16786 
16787  free_msg:
16788 	nlmsg_free(msg);
16789 }
16790 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
16791 #endif
16792 
16793 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
16794 				enum nl80211_tdls_operation oper,
16795 				u16 reason_code, gfp_t gfp)
16796 {
16797 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16798 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16799 	struct sk_buff *msg;
16800 	void *hdr;
16801 
16802 	trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
16803 					 reason_code);
16804 
16805 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16806 	if (!msg)
16807 		return;
16808 
16809 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
16810 	if (!hdr) {
16811 		nlmsg_free(msg);
16812 		return;
16813 	}
16814 
16815 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16816 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
16817 	    nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
16818 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
16819 	    (reason_code > 0 &&
16820 	     nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
16821 		goto nla_put_failure;
16822 
16823 	genlmsg_end(msg, hdr);
16824 
16825 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16826 				NL80211_MCGRP_MLME, gfp);
16827 	return;
16828 
16829  nla_put_failure:
16830 	nlmsg_free(msg);
16831 }
16832 EXPORT_SYMBOL(cfg80211_tdls_oper_request);
16833 
16834 static int nl80211_netlink_notify(struct notifier_block * nb,
16835 				  unsigned long state,
16836 				  void *_notify)
16837 {
16838 	struct netlink_notify *notify = _notify;
16839 	struct cfg80211_registered_device *rdev;
16840 	struct wireless_dev *wdev;
16841 	struct cfg80211_beacon_registration *reg, *tmp;
16842 
16843 	if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
16844 		return NOTIFY_DONE;
16845 
16846 	rcu_read_lock();
16847 
16848 	list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
16849 		struct cfg80211_sched_scan_request *sched_scan_req;
16850 
16851 		list_for_each_entry_rcu(sched_scan_req,
16852 					&rdev->sched_scan_req_list,
16853 					list) {
16854 			if (sched_scan_req->owner_nlportid == notify->portid) {
16855 				sched_scan_req->nl_owner_dead = true;
16856 				schedule_work(&rdev->sched_scan_stop_wk);
16857 			}
16858 		}
16859 
16860 		list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
16861 			cfg80211_mlme_unregister_socket(wdev, notify->portid);
16862 
16863 			if (wdev->owner_nlportid == notify->portid) {
16864 				wdev->nl_owner_dead = true;
16865 				schedule_work(&rdev->destroy_work);
16866 			} else if (wdev->conn_owner_nlportid == notify->portid) {
16867 				schedule_work(&wdev->disconnect_wk);
16868 			}
16869 
16870 			cfg80211_release_pmsr(wdev, notify->portid);
16871 		}
16872 
16873 		spin_lock_bh(&rdev->beacon_registrations_lock);
16874 		list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
16875 					 list) {
16876 			if (reg->nlportid == notify->portid) {
16877 				list_del(&reg->list);
16878 				kfree(reg);
16879 				break;
16880 			}
16881 		}
16882 		spin_unlock_bh(&rdev->beacon_registrations_lock);
16883 	}
16884 
16885 	rcu_read_unlock();
16886 
16887 	/*
16888 	 * It is possible that the user space process that is controlling the
16889 	 * indoor setting disappeared, so notify the regulatory core.
16890 	 */
16891 	regulatory_netlink_notify(notify->portid);
16892 	return NOTIFY_OK;
16893 }
16894 
16895 static struct notifier_block nl80211_netlink_notifier = {
16896 	.notifier_call = nl80211_netlink_notify,
16897 };
16898 
16899 void cfg80211_ft_event(struct net_device *netdev,
16900 		       struct cfg80211_ft_event_params *ft_event)
16901 {
16902 	struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
16903 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16904 	struct sk_buff *msg;
16905 	void *hdr;
16906 
16907 	trace_cfg80211_ft_event(wiphy, netdev, ft_event);
16908 
16909 	if (!ft_event->target_ap)
16910 		return;
16911 
16912 	msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len,
16913 			GFP_KERNEL);
16914 	if (!msg)
16915 		return;
16916 
16917 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
16918 	if (!hdr)
16919 		goto out;
16920 
16921 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16922 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
16923 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
16924 		goto out;
16925 
16926 	if (ft_event->ies &&
16927 	    nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
16928 		goto out;
16929 	if (ft_event->ric_ies &&
16930 	    nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
16931 		    ft_event->ric_ies))
16932 		goto out;
16933 
16934 	genlmsg_end(msg, hdr);
16935 
16936 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16937 				NL80211_MCGRP_MLME, GFP_KERNEL);
16938 	return;
16939  out:
16940 	nlmsg_free(msg);
16941 }
16942 EXPORT_SYMBOL(cfg80211_ft_event);
16943 
16944 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
16945 {
16946 	struct cfg80211_registered_device *rdev;
16947 	struct sk_buff *msg;
16948 	void *hdr;
16949 	u32 nlportid;
16950 
16951 	rdev = wiphy_to_rdev(wdev->wiphy);
16952 	if (!rdev->crit_proto_nlportid)
16953 		return;
16954 
16955 	nlportid = rdev->crit_proto_nlportid;
16956 	rdev->crit_proto_nlportid = 0;
16957 
16958 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16959 	if (!msg)
16960 		return;
16961 
16962 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
16963 	if (!hdr)
16964 		goto nla_put_failure;
16965 
16966 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16967 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16968 			      NL80211_ATTR_PAD))
16969 		goto nla_put_failure;
16970 
16971 	genlmsg_end(msg, hdr);
16972 
16973 	genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
16974 	return;
16975 
16976  nla_put_failure:
16977 	nlmsg_free(msg);
16978 }
16979 EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
16980 
16981 void nl80211_send_ap_stopped(struct wireless_dev *wdev)
16982 {
16983 	struct wiphy *wiphy = wdev->wiphy;
16984 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16985 	struct sk_buff *msg;
16986 	void *hdr;
16987 
16988 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
16989 	if (!msg)
16990 		return;
16991 
16992 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
16993 	if (!hdr)
16994 		goto out;
16995 
16996 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16997 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
16998 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16999 			      NL80211_ATTR_PAD))
17000 		goto out;
17001 
17002 	genlmsg_end(msg, hdr);
17003 
17004 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
17005 				NL80211_MCGRP_MLME, GFP_KERNEL);
17006 	return;
17007  out:
17008 	nlmsg_free(msg);
17009 }
17010 
17011 int cfg80211_external_auth_request(struct net_device *dev,
17012 				   struct cfg80211_external_auth_params *params,
17013 				   gfp_t gfp)
17014 {
17015 	struct wireless_dev *wdev = dev->ieee80211_ptr;
17016 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
17017 	struct sk_buff *msg;
17018 	void *hdr;
17019 
17020 	if (!wdev->conn_owner_nlportid)
17021 		return -EINVAL;
17022 
17023 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
17024 	if (!msg)
17025 		return -ENOMEM;
17026 
17027 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH);
17028 	if (!hdr)
17029 		goto nla_put_failure;
17030 
17031 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
17032 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
17033 	    nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) ||
17034 	    nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION,
17035 			params->action) ||
17036 	    nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) ||
17037 	    nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len,
17038 		    params->ssid.ssid))
17039 		goto nla_put_failure;
17040 
17041 	genlmsg_end(msg, hdr);
17042 	genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
17043 			wdev->conn_owner_nlportid);
17044 	return 0;
17045 
17046  nla_put_failure:
17047 	nlmsg_free(msg);
17048 	return -ENOBUFS;
17049 }
17050 EXPORT_SYMBOL(cfg80211_external_auth_request);
17051 
17052 void cfg80211_update_owe_info_event(struct net_device *netdev,
17053 				    struct cfg80211_update_owe_info *owe_info,
17054 				    gfp_t gfp)
17055 {
17056 	struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
17057 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
17058 	struct sk_buff *msg;
17059 	void *hdr;
17060 
17061 	trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info);
17062 
17063 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
17064 	if (!msg)
17065 		return;
17066 
17067 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO);
17068 	if (!hdr)
17069 		goto nla_put_failure;
17070 
17071 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
17072 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
17073 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer))
17074 		goto nla_put_failure;
17075 
17076 	if (!owe_info->ie_len ||
17077 	    nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie))
17078 		goto nla_put_failure;
17079 
17080 	genlmsg_end(msg, hdr);
17081 
17082 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
17083 				NL80211_MCGRP_MLME, gfp);
17084 	return;
17085 
17086 nla_put_failure:
17087 	genlmsg_cancel(msg, hdr);
17088 	nlmsg_free(msg);
17089 }
17090 EXPORT_SYMBOL(cfg80211_update_owe_info_event);
17091 
17092 /* initialisation/exit functions */
17093 
17094 int __init nl80211_init(void)
17095 {
17096 	int err;
17097 
17098 	err = genl_register_family(&nl80211_fam);
17099 	if (err)
17100 		return err;
17101 
17102 	err = netlink_register_notifier(&nl80211_netlink_notifier);
17103 	if (err)
17104 		goto err_out;
17105 
17106 	return 0;
17107  err_out:
17108 	genl_unregister_family(&nl80211_fam);
17109 	return err;
17110 }
17111 
17112 void nl80211_exit(void)
17113 {
17114 	netlink_unregister_notifier(&nl80211_netlink_notifier);
17115 	genl_unregister_family(&nl80211_fam);
17116 }
17117