xref: /linux/net/wireless/nl80211.c (revision 95f68e06b41b9e88291796efa3969409d13fdd4c)
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-2024 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 <linux/if_vlan.h>
24 #include <net/net_namespace.h>
25 #include <net/genetlink.h>
26 #include <net/cfg80211.h>
27 #include <net/sock.h>
28 #include <net/inet_connection_sock.h>
29 #include "core.h"
30 #include "nl80211.h"
31 #include "reg.h"
32 #include "rdev-ops.h"
33 
34 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
35 				   struct genl_info *info,
36 				   struct cfg80211_crypto_settings *settings,
37 				   int cipher_limit);
38 
39 /* the netlink family */
40 static struct genl_family nl80211_fam;
41 
42 /* multicast groups */
43 enum nl80211_multicast_groups {
44 	NL80211_MCGRP_CONFIG,
45 	NL80211_MCGRP_SCAN,
46 	NL80211_MCGRP_REGULATORY,
47 	NL80211_MCGRP_MLME,
48 	NL80211_MCGRP_VENDOR,
49 	NL80211_MCGRP_NAN,
50 	NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
51 };
52 
53 static const struct genl_multicast_group nl80211_mcgrps[] = {
54 	[NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
55 	[NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
56 	[NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
57 	[NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
58 	[NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
59 	[NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
60 #ifdef CONFIG_NL80211_TESTMODE
61 	[NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
62 #endif
63 };
64 
65 /* returns ERR_PTR values */
66 static struct wireless_dev *
67 __cfg80211_wdev_from_attrs(struct cfg80211_registered_device *rdev,
68 			   struct net *netns, struct nlattr **attrs)
69 {
70 	struct wireless_dev *result = NULL;
71 	bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
72 	bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
73 	u64 wdev_id = 0;
74 	int wiphy_idx = -1;
75 	int ifidx = -1;
76 
77 	if (!have_ifidx && !have_wdev_id)
78 		return ERR_PTR(-EINVAL);
79 
80 	if (have_ifidx)
81 		ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
82 	if (have_wdev_id) {
83 		wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
84 		wiphy_idx = wdev_id >> 32;
85 	}
86 
87 	if (rdev) {
88 		struct wireless_dev *wdev;
89 
90 		lockdep_assert_held(&rdev->wiphy.mtx);
91 
92 		list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
93 			if (have_ifidx && wdev->netdev &&
94 			    wdev->netdev->ifindex == ifidx) {
95 				result = wdev;
96 				break;
97 			}
98 			if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
99 				result = wdev;
100 				break;
101 			}
102 		}
103 
104 		return result ?: ERR_PTR(-ENODEV);
105 	}
106 
107 	ASSERT_RTNL();
108 
109 	for_each_rdev(rdev) {
110 		struct wireless_dev *wdev;
111 
112 		if (wiphy_net(&rdev->wiphy) != netns)
113 			continue;
114 
115 		if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
116 			continue;
117 
118 		list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
119 			if (have_ifidx && wdev->netdev &&
120 			    wdev->netdev->ifindex == ifidx) {
121 				result = wdev;
122 				break;
123 			}
124 			if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
125 				result = wdev;
126 				break;
127 			}
128 		}
129 
130 		if (result)
131 			break;
132 	}
133 
134 	if (result)
135 		return result;
136 	return ERR_PTR(-ENODEV);
137 }
138 
139 static struct cfg80211_registered_device *
140 __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
141 {
142 	struct cfg80211_registered_device *rdev = NULL, *tmp;
143 	struct net_device *netdev;
144 
145 	ASSERT_RTNL();
146 
147 	if (!attrs[NL80211_ATTR_WIPHY] &&
148 	    !attrs[NL80211_ATTR_IFINDEX] &&
149 	    !attrs[NL80211_ATTR_WDEV])
150 		return ERR_PTR(-EINVAL);
151 
152 	if (attrs[NL80211_ATTR_WIPHY])
153 		rdev = cfg80211_rdev_by_wiphy_idx(
154 				nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
155 
156 	if (attrs[NL80211_ATTR_WDEV]) {
157 		u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
158 		struct wireless_dev *wdev;
159 		bool found = false;
160 
161 		tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
162 		if (tmp) {
163 			/* make sure wdev exists */
164 			list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
165 				if (wdev->identifier != (u32)wdev_id)
166 					continue;
167 				found = true;
168 				break;
169 			}
170 
171 			if (!found)
172 				tmp = NULL;
173 
174 			if (rdev && tmp != rdev)
175 				return ERR_PTR(-EINVAL);
176 			rdev = tmp;
177 		}
178 	}
179 
180 	if (attrs[NL80211_ATTR_IFINDEX]) {
181 		int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
182 
183 		netdev = __dev_get_by_index(netns, ifindex);
184 		if (netdev) {
185 			if (netdev->ieee80211_ptr)
186 				tmp = wiphy_to_rdev(
187 					netdev->ieee80211_ptr->wiphy);
188 			else
189 				tmp = NULL;
190 
191 			/* not wireless device -- return error */
192 			if (!tmp)
193 				return ERR_PTR(-EINVAL);
194 
195 			/* mismatch -- return error */
196 			if (rdev && tmp != rdev)
197 				return ERR_PTR(-EINVAL);
198 
199 			rdev = tmp;
200 		}
201 	}
202 
203 	if (!rdev)
204 		return ERR_PTR(-ENODEV);
205 
206 	if (netns != wiphy_net(&rdev->wiphy))
207 		return ERR_PTR(-ENODEV);
208 
209 	return rdev;
210 }
211 
212 /*
213  * This function returns a pointer to the driver
214  * that the genl_info item that is passed refers to.
215  *
216  * The result of this can be a PTR_ERR and hence must
217  * be checked with IS_ERR() for errors.
218  */
219 static struct cfg80211_registered_device *
220 cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
221 {
222 	return __cfg80211_rdev_from_attrs(netns, info->attrs);
223 }
224 
225 static int validate_beacon_head(const struct nlattr *attr,
226 				struct netlink_ext_ack *extack)
227 {
228 	const u8 *data = nla_data(attr);
229 	unsigned int len = nla_len(attr);
230 	const struct element *elem;
231 	const struct ieee80211_mgmt *mgmt = (void *)data;
232 	unsigned int fixedlen, hdrlen;
233 	bool s1g_bcn;
234 
235 	if (len < offsetofend(typeof(*mgmt), frame_control))
236 		goto err;
237 
238 	s1g_bcn = ieee80211_is_s1g_beacon(mgmt->frame_control);
239 	if (s1g_bcn) {
240 		fixedlen = offsetof(struct ieee80211_ext,
241 				    u.s1g_beacon.variable);
242 		hdrlen = offsetof(struct ieee80211_ext, u.s1g_beacon);
243 	} else {
244 		fixedlen = offsetof(struct ieee80211_mgmt,
245 				    u.beacon.variable);
246 		hdrlen = offsetof(struct ieee80211_mgmt, u.beacon);
247 	}
248 
249 	if (len < fixedlen)
250 		goto err;
251 
252 	if (ieee80211_hdrlen(mgmt->frame_control) != hdrlen)
253 		goto err;
254 
255 	data += fixedlen;
256 	len -= fixedlen;
257 
258 	for_each_element(elem, data, len) {
259 		/* nothing */
260 	}
261 
262 	if (for_each_element_completed(elem, data, len))
263 		return 0;
264 
265 err:
266 	NL_SET_ERR_MSG_ATTR(extack, attr, "malformed beacon head");
267 	return -EINVAL;
268 }
269 
270 static int validate_ie_attr(const struct nlattr *attr,
271 			    struct netlink_ext_ack *extack)
272 {
273 	const u8 *data = nla_data(attr);
274 	unsigned int len = nla_len(attr);
275 	const struct element *elem;
276 
277 	for_each_element(elem, data, len) {
278 		/* nothing */
279 	}
280 
281 	if (for_each_element_completed(elem, data, len))
282 		return 0;
283 
284 	NL_SET_ERR_MSG_ATTR(extack, attr, "malformed information elements");
285 	return -EINVAL;
286 }
287 
288 static int validate_he_capa(const struct nlattr *attr,
289 			    struct netlink_ext_ack *extack)
290 {
291 	if (!ieee80211_he_capa_size_ok(nla_data(attr), nla_len(attr)))
292 		return -EINVAL;
293 
294 	return 0;
295 }
296 
297 /* policy for the attributes */
298 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR];
299 
300 static const struct nla_policy
301 nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = {
302 	[NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, },
303 	[NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY,
304 					.len = U8_MAX },
305 	[NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY,
306 					     .len = U8_MAX },
307 };
308 
309 static const struct nla_policy
310 nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = {
311 	[NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG },
312 	[NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 },
313 	[NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] =
314 		NLA_POLICY_MAX(NLA_U8, 15),
315 	[NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 },
316 	[NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] =
317 		NLA_POLICY_MAX(NLA_U8, 15),
318 	[NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] = { .type = NLA_U8 },
319 	[NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 },
320 	[NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG },
321 	[NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG },
322 	[NL80211_PMSR_FTM_REQ_ATTR_TRIGGER_BASED] = { .type = NLA_FLAG },
323 	[NL80211_PMSR_FTM_REQ_ATTR_NON_TRIGGER_BASED] = { .type = NLA_FLAG },
324 	[NL80211_PMSR_FTM_REQ_ATTR_LMR_FEEDBACK] = { .type = NLA_FLAG },
325 	[NL80211_PMSR_FTM_REQ_ATTR_BSS_COLOR] = { .type = NLA_U8 },
326 };
327 
328 static const struct nla_policy
329 nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = {
330 	[NL80211_PMSR_TYPE_FTM] =
331 		NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy),
332 };
333 
334 static const struct nla_policy
335 nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = {
336 	[NL80211_PMSR_REQ_ATTR_DATA] =
337 		NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy),
338 	[NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG },
339 };
340 
341 static const struct nla_policy
342 nl80211_pmsr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = {
343 	[NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR,
344 	[NL80211_PMSR_PEER_ATTR_CHAN] = NLA_POLICY_NESTED(nl80211_policy),
345 	[NL80211_PMSR_PEER_ATTR_REQ] =
346 		NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy),
347 	[NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT },
348 };
349 
350 static const struct nla_policy
351 nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = {
352 	[NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT },
353 	[NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT },
354 	[NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT },
355 	[NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT },
356 	[NL80211_PMSR_ATTR_PEERS] =
357 		NLA_POLICY_NESTED_ARRAY(nl80211_pmsr_peer_attr_policy),
358 };
359 
360 static const struct nla_policy
361 he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = {
362 	[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] =
363 		NLA_POLICY_RANGE(NLA_U8, 1, 20),
364 	[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] =
365 		NLA_POLICY_RANGE(NLA_U8, 1, 20),
366 	[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET] =
367 		NLA_POLICY_RANGE(NLA_U8, 1, 20),
368 	[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP] =
369 		NLA_POLICY_EXACT_LEN(8),
370 	[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP] =
371 		NLA_POLICY_EXACT_LEN(8),
372 	[NL80211_HE_OBSS_PD_ATTR_SR_CTRL] = { .type = NLA_U8 },
373 };
374 
375 static const struct nla_policy
376 he_bss_color_policy[NL80211_HE_BSS_COLOR_ATTR_MAX + 1] = {
377 	[NL80211_HE_BSS_COLOR_ATTR_COLOR] = NLA_POLICY_RANGE(NLA_U8, 1, 63),
378 	[NL80211_HE_BSS_COLOR_ATTR_DISABLED] = { .type = NLA_FLAG },
379 	[NL80211_HE_BSS_COLOR_ATTR_PARTIAL] = { .type = NLA_FLAG },
380 };
381 
382 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
383 	[NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
384 				    .len = NL80211_MAX_SUPP_RATES },
385 	[NL80211_TXRATE_HT] = { .type = NLA_BINARY,
386 				.len = NL80211_MAX_SUPP_HT_RATES },
387 	[NL80211_TXRATE_VHT] = NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_txrate_vht)),
388 	[NL80211_TXRATE_GI] = { .type = NLA_U8 },
389 	[NL80211_TXRATE_HE] = NLA_POLICY_EXACT_LEN(sizeof(struct nl80211_txrate_he)),
390 	[NL80211_TXRATE_HE_GI] =  NLA_POLICY_RANGE(NLA_U8,
391 						   NL80211_RATE_INFO_HE_GI_0_8,
392 						   NL80211_RATE_INFO_HE_GI_3_2),
393 	[NL80211_TXRATE_HE_LTF] = NLA_POLICY_RANGE(NLA_U8,
394 						   NL80211_RATE_INFO_HE_1XLTF,
395 						   NL80211_RATE_INFO_HE_4XLTF),
396 };
397 
398 static const struct nla_policy
399 nl80211_tid_config_attr_policy[NL80211_TID_CONFIG_ATTR_MAX + 1] = {
400 	[NL80211_TID_CONFIG_ATTR_VIF_SUPP] = { .type = NLA_U64 },
401 	[NL80211_TID_CONFIG_ATTR_PEER_SUPP] = { .type = NLA_U64 },
402 	[NL80211_TID_CONFIG_ATTR_OVERRIDE] = { .type = NLA_FLAG },
403 	[NL80211_TID_CONFIG_ATTR_TIDS] = NLA_POLICY_RANGE(NLA_U16, 1, 0xff),
404 	[NL80211_TID_CONFIG_ATTR_NOACK] =
405 			NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
406 	[NL80211_TID_CONFIG_ATTR_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1),
407 	[NL80211_TID_CONFIG_ATTR_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1),
408 	[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL] =
409 			NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
410 	[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL] =
411 			NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
412 	[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL] =
413 			NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
414 	[NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE] =
415 			NLA_POLICY_MAX(NLA_U8, NL80211_TX_RATE_FIXED),
416 	[NL80211_TID_CONFIG_ATTR_TX_RATE] =
417 			NLA_POLICY_NESTED(nl80211_txattr_policy),
418 };
419 
420 static const struct nla_policy
421 nl80211_fils_discovery_policy[NL80211_FILS_DISCOVERY_ATTR_MAX + 1] = {
422 	[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] = NLA_POLICY_MAX(NLA_U32, 10000),
423 	[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] = NLA_POLICY_MAX(NLA_U32, 10000),
424 	[NL80211_FILS_DISCOVERY_ATTR_TMPL] =
425 			NLA_POLICY_RANGE(NLA_BINARY,
426 					 NL80211_FILS_DISCOVERY_TMPL_MIN_LEN,
427 					 IEEE80211_MAX_DATA_LEN),
428 };
429 
430 static const struct nla_policy
431 nl80211_unsol_bcast_probe_resp_policy[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1] = {
432 	[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] = NLA_POLICY_MAX(NLA_U32, 20),
433 	[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL] = { .type = NLA_BINARY,
434 						       .len = IEEE80211_MAX_DATA_LEN }
435 };
436 
437 static const struct nla_policy
438 sar_specs_policy[NL80211_SAR_ATTR_SPECS_MAX + 1] = {
439 	[NL80211_SAR_ATTR_SPECS_POWER] = { .type = NLA_S32 },
440 	[NL80211_SAR_ATTR_SPECS_RANGE_INDEX] = {.type = NLA_U32 },
441 };
442 
443 static const struct nla_policy
444 sar_policy[NL80211_SAR_ATTR_MAX + 1] = {
445 	[NL80211_SAR_ATTR_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_SAR_TYPE),
446 	[NL80211_SAR_ATTR_SPECS] = NLA_POLICY_NESTED_ARRAY(sar_specs_policy),
447 };
448 
449 static const struct nla_policy
450 nl80211_mbssid_config_policy[NL80211_MBSSID_CONFIG_ATTR_MAX + 1] = {
451 	[NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES] = NLA_POLICY_MIN(NLA_U8, 2),
452 	[NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY] =
453 						NLA_POLICY_MIN(NLA_U8, 1),
454 	[NL80211_MBSSID_CONFIG_ATTR_INDEX] = { .type = NLA_U8 },
455 	[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX] = { .type = NLA_U32 },
456 	[NL80211_MBSSID_CONFIG_ATTR_EMA] = { .type = NLA_FLAG },
457 };
458 
459 static const struct nla_policy
460 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
461 	[NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
462 	[NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
463 };
464 
465 static const struct netlink_range_validation nl80211_punct_bitmap_range = {
466 	.min = 0,
467 	.max = 0xffff,
468 };
469 
470 static const struct netlink_range_validation q_range = {
471 	.max = INT_MAX,
472 };
473 
474 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
475 	[0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD },
476 	[NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
477 	[NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
478 				      .len = 20-1 },
479 	[NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
480 
481 	[NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
482 	[NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
483 	[NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8,
484 						NL80211_EDMG_CHANNELS_MIN,
485 						NL80211_EDMG_CHANNELS_MAX),
486 	[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8,
487 						NL80211_EDMG_BW_CONFIG_MIN,
488 						NL80211_EDMG_BW_CONFIG_MAX),
489 
490 	[NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
491 	[NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
492 	[NL80211_ATTR_CENTER_FREQ1_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999),
493 	[NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
494 
495 	[NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1),
496 	[NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1),
497 	[NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
498 	[NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
499 	[NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
500 	[NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
501 
502 	[NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX),
503 	[NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
504 	[NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
505 
506 	[NL80211_ATTR_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
507 	[NL80211_ATTR_PREV_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
508 
509 	[NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
510 	[NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
511 				    .len = WLAN_MAX_KEY_LEN },
512 	[NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 7),
513 	[NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
514 	[NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
515 	[NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
516 	[NL80211_ATTR_KEY_TYPE] =
517 		NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES),
518 
519 	[NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
520 	[NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
521 	[NL80211_ATTR_BEACON_HEAD] =
522 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head,
523 				       IEEE80211_MAX_DATA_LEN),
524 	[NL80211_ATTR_BEACON_TAIL] =
525 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
526 				       IEEE80211_MAX_DATA_LEN),
527 	[NL80211_ATTR_STA_AID] =
528 		NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
529 	[NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
530 	[NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
531 	[NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
532 					       .len = NL80211_MAX_SUPP_RATES },
533 	[NL80211_ATTR_STA_PLINK_ACTION] =
534 		NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1),
535 	[NL80211_ATTR_STA_TX_POWER_SETTING] =
536 		NLA_POLICY_RANGE(NLA_U8,
537 				 NL80211_TX_POWER_AUTOMATIC,
538 				 NL80211_TX_POWER_FIXED),
539 	[NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 },
540 	[NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
541 	[NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
542 	[NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
543 				   .len = IEEE80211_MAX_MESH_ID_LEN },
544 	[NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT,
545 
546 	/* allow 3 for NUL-termination, we used to declare this NLA_STRING */
547 	[NL80211_ATTR_REG_ALPHA2] = NLA_POLICY_RANGE(NLA_BINARY, 2, 3),
548 	[NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
549 
550 	[NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
551 	[NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
552 	[NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
553 	[NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
554 					   .len = NL80211_MAX_SUPP_RATES },
555 	[NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
556 
557 	[NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
558 	[NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
559 
560 	[NL80211_ATTR_HT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_HT_CAPABILITY_LEN),
561 
562 	[NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
563 	[NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY,
564 						   validate_ie_attr,
565 						   IEEE80211_MAX_DATA_LEN),
566 	[NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
567 	[NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
568 
569 	[NL80211_ATTR_SSID] = { .type = NLA_BINARY,
570 				.len = IEEE80211_MAX_SSID_LEN },
571 	[NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
572 	[NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
573 	[NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
574 	[NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
575 	[NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32,
576 						  NL80211_MFP_NO,
577 						  NL80211_MFP_OPTIONAL),
578 	[NL80211_ATTR_STA_FLAGS2] =
579 		NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_sta_flag_update)),
580 	[NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
581 	[NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
582 	[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
583 	[NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG },
584 	[NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
585 	[NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 },
586 	[NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
587 	[NL80211_ATTR_WPA_VERSIONS] =
588 		NLA_POLICY_RANGE(NLA_U32, 0,
589 				 NL80211_WPA_VERSION_1 |
590 				 NL80211_WPA_VERSION_2 |
591 				 NL80211_WPA_VERSION_3),
592 	[NL80211_ATTR_PID] = { .type = NLA_U32 },
593 	[NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
594 	[NL80211_ATTR_PMKID] = NLA_POLICY_EXACT_LEN_WARN(WLAN_PMKID_LEN),
595 	[NL80211_ATTR_DURATION] = { .type = NLA_U32 },
596 	[NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
597 	[NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
598 	[NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
599 				 .len = IEEE80211_MAX_DATA_LEN },
600 	[NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
601 	[NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32,
602 						   NL80211_PS_DISABLED,
603 						   NL80211_PS_ENABLED),
604 	[NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
605 	[NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
606 	[NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
607 	[NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
608 	[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
609 	[NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
610 	[NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
611 	[NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
612 	[NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
613 	[NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
614 	[NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
615 	[NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
616 	[NL80211_ATTR_STA_PLINK_STATE] =
617 		NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1),
618 	[NL80211_ATTR_MEASUREMENT_DURATION] = { .type = NLA_U16 },
619 	[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY] = { .type = NLA_FLAG },
620 	[NL80211_ATTR_MESH_PEER_AID] =
621 		NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
622 	[NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
623 	[NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
624 	[NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
625 	[NL80211_ATTR_HIDDEN_SSID] =
626 		NLA_POLICY_RANGE(NLA_U32,
627 				 NL80211_HIDDEN_SSID_NOT_IN_USE,
628 				 NL80211_HIDDEN_SSID_ZERO_CONTENTS),
629 	[NL80211_ATTR_IE_PROBE_RESP] =
630 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
631 				       IEEE80211_MAX_DATA_LEN),
632 	[NL80211_ATTR_IE_ASSOC_RESP] =
633 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
634 				       IEEE80211_MAX_DATA_LEN),
635 	[NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
636 	[NL80211_ATTR_STA_WME] = NLA_POLICY_NESTED(nl80211_sta_wme_policy),
637 	[NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
638 	[NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
639 	[NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
640 	[NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
641 	[NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
642 	[NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
643 	[NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
644 	[NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
645 	[NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
646 	[NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
647 				      .len = IEEE80211_MAX_DATA_LEN },
648 	[NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
649 	[NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
650 	[NL80211_ATTR_HT_CAPABILITY_MASK] = {
651 		.len = NL80211_HT_CAPABILITY_LEN
652 	},
653 	[NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
654 	[NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
655 	[NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
656 	[NL80211_ATTR_WDEV] = { .type = NLA_U64 },
657 	[NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
658 
659 	/* need to include at least Auth Transaction and Status Code */
660 	[NL80211_ATTR_AUTH_DATA] = NLA_POLICY_MIN_LEN(4),
661 
662 	[NL80211_ATTR_VHT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_VHT_CAPABILITY_LEN),
663 	[NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
664 	[NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127),
665 	[NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1),
666 	[NL80211_ATTR_LOCAL_MESH_POWER_MODE] =
667 		NLA_POLICY_RANGE(NLA_U32,
668 				 NL80211_MESH_POWER_UNKNOWN + 1,
669 				 NL80211_MESH_POWER_MAX),
670 	[NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
671 	[NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
672 	[NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
673 	[NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
674 	[NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
675 	[NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
676 	[NL80211_ATTR_VHT_CAPABILITY_MASK] = {
677 		.len = NL80211_VHT_CAPABILITY_LEN,
678 	},
679 	[NL80211_ATTR_MDID] = { .type = NLA_U16 },
680 	[NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
681 				  .len = IEEE80211_MAX_DATA_LEN },
682 	[NL80211_ATTR_CRIT_PROT_ID] = { .type = NLA_U16 },
683 	[NL80211_ATTR_MAX_CRIT_PROT_DURATION] =
684 		NLA_POLICY_MAX(NLA_U16, NL80211_CRIT_PROTO_MAX_DURATION),
685 	[NL80211_ATTR_PEER_AID] =
686 		NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
687 	[NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
688 	[NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
689 	[NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
690 	[NL80211_ATTR_CNTDWN_OFFS_BEACON] = { .type = NLA_BINARY },
691 	[NL80211_ATTR_CNTDWN_OFFS_PRESP] = { .type = NLA_BINARY },
692 	[NL80211_ATTR_STA_SUPPORTED_CHANNELS] = NLA_POLICY_MIN_LEN(2),
693 	/*
694 	 * The value of the Length field of the Supported Operating
695 	 * Classes element is between 2 and 253.
696 	 */
697 	[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] =
698 		NLA_POLICY_RANGE(NLA_BINARY, 2, 253),
699 	[NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
700 	[NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
701 	[NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
702 	[NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
703 	[NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
704 	[NL80211_ATTR_QOS_MAP] = NLA_POLICY_RANGE(NLA_BINARY,
705 						  IEEE80211_QOS_MAP_LEN_MIN,
706 						  IEEE80211_QOS_MAP_LEN_MAX),
707 	[NL80211_ATTR_MAC_HINT] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
708 	[NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
709 	[NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
710 	[NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
711 	[NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
712 	[NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
713 	[NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1),
714 	[NL80211_ATTR_USER_PRIO] =
715 		NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1),
716 	[NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
717 	[NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
718 	[NL80211_ATTR_OPER_CLASS] = { .type = NLA_U8 },
719 	[NL80211_ATTR_MAC_MASK] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
720 	[NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
721 	[NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
722 	[NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
723 	[NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
724 	[NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
725 	[NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
726 	[NL80211_ATTR_STA_SUPPORT_P2P_PS] =
727 		NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1),
728 	[NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
729 		.len = VHT_MUMIMO_GROUPS_DATA_LEN
730 	},
731 	[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
732 	[NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1),
733 	[NL80211_ATTR_BANDS] = { .type = NLA_U32 },
734 	[NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
735 	[NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
736 				    .len = FILS_MAX_KEK_LEN },
737 	[NL80211_ATTR_FILS_NONCES] = NLA_POLICY_EXACT_LEN_WARN(2 * FILS_NONCE_LEN),
738 	[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
739 	[NL80211_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
740 	[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
741 	[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
742 		.len = sizeof(struct nl80211_bss_select_rssi_adjust)
743 	},
744 	[NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
745 	[NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
746 					     .len = FILS_ERP_MAX_USERNAME_LEN },
747 	[NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
748 					  .len = FILS_ERP_MAX_REALM_LEN },
749 	[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
750 	[NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
751 					.len = FILS_ERP_MAX_RRK_LEN },
752 	[NL80211_ATTR_FILS_CACHE_ID] = NLA_POLICY_EXACT_LEN_WARN(2),
753 	[NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
754 	[NL80211_ATTR_PMKR0_NAME] = NLA_POLICY_EXACT_LEN(WLAN_PMK_NAME_LEN),
755 	[NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
756 	[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG },
757 
758 	[NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 },
759 	[NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 },
760 	[NL80211_ATTR_TXQ_QUANTUM] = NLA_POLICY_FULL_RANGE(NLA_U32, &q_range),
761 	[NL80211_ATTR_HE_CAPABILITY] =
762 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_he_capa,
763 				       NL80211_HE_MAX_CAPABILITY_LEN),
764 	[NL80211_ATTR_FTM_RESPONDER] =
765 		NLA_POLICY_NESTED(nl80211_ftm_responder_policy),
766 	[NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1),
767 	[NL80211_ATTR_PEER_MEASUREMENTS] =
768 		NLA_POLICY_NESTED(nl80211_pmsr_attr_policy),
769 	[NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1),
770 	[NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY,
771 					.len = SAE_PASSWORD_MAX_LEN },
772 	[NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG },
773 	[NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy),
774 	[NL80211_ATTR_VLAN_ID] = NLA_POLICY_RANGE(NLA_U16, 1, VLAN_N_VID - 2),
775 	[NL80211_ATTR_HE_BSS_COLOR] = NLA_POLICY_NESTED(he_bss_color_policy),
776 	[NL80211_ATTR_TID_CONFIG] =
777 		NLA_POLICY_NESTED_ARRAY(nl80211_tid_config_attr_policy),
778 	[NL80211_ATTR_CONTROL_PORT_NO_PREAUTH] = { .type = NLA_FLAG },
779 	[NL80211_ATTR_PMK_LIFETIME] = NLA_POLICY_MIN(NLA_U32, 1),
780 	[NL80211_ATTR_PMK_REAUTH_THRESHOLD] = NLA_POLICY_RANGE(NLA_U8, 1, 100),
781 	[NL80211_ATTR_RECEIVE_MULTICAST] = { .type = NLA_FLAG },
782 	[NL80211_ATTR_WIPHY_FREQ_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999),
783 	[NL80211_ATTR_SCAN_FREQ_KHZ] = { .type = NLA_NESTED },
784 	[NL80211_ATTR_HE_6GHZ_CAPABILITY] =
785 		NLA_POLICY_EXACT_LEN(sizeof(struct ieee80211_he_6ghz_capa)),
786 	[NL80211_ATTR_FILS_DISCOVERY] =
787 		NLA_POLICY_NESTED(nl80211_fils_discovery_policy),
788 	[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP] =
789 		NLA_POLICY_NESTED(nl80211_unsol_bcast_probe_resp_policy),
790 	[NL80211_ATTR_S1G_CAPABILITY] =
791 		NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN),
792 	[NL80211_ATTR_S1G_CAPABILITY_MASK] =
793 		NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN),
794 	[NL80211_ATTR_SAE_PWE] =
795 		NLA_POLICY_RANGE(NLA_U8, NL80211_SAE_PWE_HUNT_AND_PECK,
796 				 NL80211_SAE_PWE_BOTH),
797 	[NL80211_ATTR_RECONNECT_REQUESTED] = { .type = NLA_REJECT },
798 	[NL80211_ATTR_SAR_SPEC] = NLA_POLICY_NESTED(sar_policy),
799 	[NL80211_ATTR_DISABLE_HE] = { .type = NLA_FLAG },
800 	[NL80211_ATTR_OBSS_COLOR_BITMAP] = { .type = NLA_U64 },
801 	[NL80211_ATTR_COLOR_CHANGE_COUNT] = { .type = NLA_U8 },
802 	[NL80211_ATTR_COLOR_CHANGE_COLOR] = { .type = NLA_U8 },
803 	[NL80211_ATTR_COLOR_CHANGE_ELEMS] = NLA_POLICY_NESTED(nl80211_policy),
804 	[NL80211_ATTR_MBSSID_CONFIG] =
805 			NLA_POLICY_NESTED(nl80211_mbssid_config_policy),
806 	[NL80211_ATTR_MBSSID_ELEMS] = { .type = NLA_NESTED },
807 	[NL80211_ATTR_RADAR_BACKGROUND] = { .type = NLA_FLAG },
808 	[NL80211_ATTR_AP_SETTINGS_FLAGS] = { .type = NLA_U32 },
809 	[NL80211_ATTR_EHT_CAPABILITY] =
810 		NLA_POLICY_RANGE(NLA_BINARY,
811 				 NL80211_EHT_MIN_CAPABILITY_LEN,
812 				 NL80211_EHT_MAX_CAPABILITY_LEN),
813 	[NL80211_ATTR_DISABLE_EHT] = { .type = NLA_FLAG },
814 	[NL80211_ATTR_MLO_LINKS] =
815 		NLA_POLICY_NESTED_ARRAY(nl80211_policy),
816 	[NL80211_ATTR_MLO_LINK_ID] =
817 		NLA_POLICY_RANGE(NLA_U8, 0, IEEE80211_MLD_MAX_NUM_LINKS - 1),
818 	[NL80211_ATTR_MLD_ADDR] = NLA_POLICY_EXACT_LEN(ETH_ALEN),
819 	[NL80211_ATTR_MLO_SUPPORT] = { .type = NLA_FLAG },
820 	[NL80211_ATTR_MAX_NUM_AKM_SUITES] = { .type = NLA_REJECT },
821 	[NL80211_ATTR_PUNCT_BITMAP] =
822 		NLA_POLICY_FULL_RANGE(NLA_U32, &nl80211_punct_bitmap_range),
823 
824 	[NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS] = { .type = NLA_U16 },
825 	[NL80211_ATTR_HW_TIMESTAMP_ENABLED] = { .type = NLA_FLAG },
826 	[NL80211_ATTR_EMA_RNR_ELEMS] = { .type = NLA_NESTED },
827 	[NL80211_ATTR_MLO_LINK_DISABLED] = { .type = NLA_FLAG },
828 	[NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA] = { .type = NLA_FLAG },
829 	[NL80211_ATTR_MLO_TTLM_DLINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8),
830 	[NL80211_ATTR_MLO_TTLM_ULINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8),
831 	[NL80211_ATTR_ASSOC_SPP_AMSDU] = { .type = NLA_FLAG },
832 	[NL80211_ATTR_VIF_RADIO_MASK] = { .type = NLA_U32 },
833 };
834 
835 /* policy for the key attributes */
836 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
837 	[NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
838 	[NL80211_KEY_IDX] = { .type = NLA_U8 },
839 	[NL80211_KEY_CIPHER] = { .type = NLA_U32 },
840 	[NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
841 	[NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
842 	[NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
843 	[NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1),
844 	[NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
845 	[NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX),
846 };
847 
848 /* policy for the key default flags */
849 static const struct nla_policy
850 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
851 	[NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
852 	[NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
853 };
854 
855 #ifdef CONFIG_PM
856 /* policy for WoWLAN attributes */
857 static const struct nla_policy
858 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
859 	[NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
860 	[NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
861 	[NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
862 	[NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
863 	[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
864 	[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
865 	[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
866 	[NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
867 	[NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
868 	[NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
869 };
870 
871 static const struct nla_policy
872 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
873 	[NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
874 	[NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
875 	[NL80211_WOWLAN_TCP_DST_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
876 	[NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
877 	[NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
878 	[NL80211_WOWLAN_TCP_DATA_PAYLOAD] = NLA_POLICY_MIN_LEN(1),
879 	[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
880 		.len = sizeof(struct nl80211_wowlan_tcp_data_seq)
881 	},
882 	[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
883 		.len = sizeof(struct nl80211_wowlan_tcp_data_token)
884 	},
885 	[NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
886 	[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = NLA_POLICY_MIN_LEN(1),
887 	[NL80211_WOWLAN_TCP_WAKE_MASK] = NLA_POLICY_MIN_LEN(1),
888 };
889 #endif /* CONFIG_PM */
890 
891 /* policy for coalesce rule attributes */
892 static const struct nla_policy
893 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
894 	[NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
895 	[NL80211_ATTR_COALESCE_RULE_CONDITION] =
896 		NLA_POLICY_RANGE(NLA_U32,
897 				 NL80211_COALESCE_CONDITION_MATCH,
898 				 NL80211_COALESCE_CONDITION_NO_MATCH),
899 	[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
900 };
901 
902 /* policy for GTK rekey offload attributes */
903 static const struct nla_policy
904 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
905 	[NL80211_REKEY_DATA_KEK] = {
906 		.type = NLA_BINARY,
907 		.len = NL80211_KEK_EXT_LEN
908 	},
909 	[NL80211_REKEY_DATA_KCK] = {
910 		.type = NLA_BINARY,
911 		.len = NL80211_KCK_EXT_LEN_32
912 	},
913 	[NL80211_REKEY_DATA_REPLAY_CTR] = NLA_POLICY_EXACT_LEN(NL80211_REPLAY_CTR_LEN),
914 	[NL80211_REKEY_DATA_AKM] = { .type = NLA_U32 },
915 };
916 
917 static const struct nla_policy
918 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
919 	[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
920 						 .len = IEEE80211_MAX_SSID_LEN },
921 	[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
922 	[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
923 };
924 
925 static const struct nla_policy
926 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
927 	[NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
928 	[NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
929 };
930 
931 static const struct nla_policy
932 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
933 	[NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
934 	[NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
935 	[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
936 		.len = sizeof(struct nl80211_bss_select_rssi_adjust)
937 	},
938 };
939 
940 /* policy for NAN function attributes */
941 static const struct nla_policy
942 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
943 	[NL80211_NAN_FUNC_TYPE] =
944 		NLA_POLICY_MAX(NLA_U8, NL80211_NAN_FUNC_MAX_TYPE),
945 	[NL80211_NAN_FUNC_SERVICE_ID] = {
946 				    .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
947 	[NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
948 	[NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
949 	[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
950 	[NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
951 	[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
952 	[NL80211_NAN_FUNC_FOLLOW_UP_DEST] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
953 	[NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
954 	[NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
955 	[NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
956 			.len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
957 	[NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
958 	[NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
959 	[NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
960 	[NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
961 	[NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
962 };
963 
964 /* policy for Service Response Filter attributes */
965 static const struct nla_policy
966 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
967 	[NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
968 	[NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
969 				 .len =  NL80211_NAN_FUNC_SRF_MAX_LEN },
970 	[NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
971 	[NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
972 };
973 
974 /* policy for packet pattern attributes */
975 static const struct nla_policy
976 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
977 	[NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
978 	[NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
979 	[NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
980 };
981 
982 static int nl80211_prepare_wdev_dump(struct netlink_callback *cb,
983 				     struct cfg80211_registered_device **rdev,
984 				     struct wireless_dev **wdev,
985 				     struct nlattr **attrbuf)
986 {
987 	int err;
988 
989 	if (!cb->args[0]) {
990 		struct nlattr **attrbuf_free = NULL;
991 
992 		if (!attrbuf) {
993 			attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf),
994 					  GFP_KERNEL);
995 			if (!attrbuf)
996 				return -ENOMEM;
997 			attrbuf_free = attrbuf;
998 		}
999 
1000 		err = nlmsg_parse_deprecated(cb->nlh,
1001 					     GENL_HDRLEN + nl80211_fam.hdrsize,
1002 					     attrbuf, nl80211_fam.maxattr,
1003 					     nl80211_policy, NULL);
1004 		if (err) {
1005 			kfree(attrbuf_free);
1006 			return err;
1007 		}
1008 
1009 		rtnl_lock();
1010 		*wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(cb->skb->sk),
1011 						   attrbuf);
1012 		kfree(attrbuf_free);
1013 		if (IS_ERR(*wdev)) {
1014 			rtnl_unlock();
1015 			return PTR_ERR(*wdev);
1016 		}
1017 		*rdev = wiphy_to_rdev((*wdev)->wiphy);
1018 		mutex_lock(&(*rdev)->wiphy.mtx);
1019 		rtnl_unlock();
1020 		/* 0 is the first index - add 1 to parse only once */
1021 		cb->args[0] = (*rdev)->wiphy_idx + 1;
1022 		cb->args[1] = (*wdev)->identifier;
1023 	} else {
1024 		/* subtract the 1 again here */
1025 		struct wiphy *wiphy;
1026 		struct wireless_dev *tmp;
1027 
1028 		rtnl_lock();
1029 		wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
1030 		if (!wiphy) {
1031 			rtnl_unlock();
1032 			return -ENODEV;
1033 		}
1034 		*rdev = wiphy_to_rdev(wiphy);
1035 		*wdev = NULL;
1036 
1037 		list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
1038 			if (tmp->identifier == cb->args[1]) {
1039 				*wdev = tmp;
1040 				break;
1041 			}
1042 		}
1043 
1044 		if (!*wdev) {
1045 			rtnl_unlock();
1046 			return -ENODEV;
1047 		}
1048 		mutex_lock(&(*rdev)->wiphy.mtx);
1049 		rtnl_unlock();
1050 	}
1051 
1052 	return 0;
1053 }
1054 
1055 /* message building helper */
1056 void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
1057 		     int flags, u8 cmd)
1058 {
1059 	/* since there is no private header just add the generic one */
1060 	return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
1061 }
1062 
1063 static int nl80211_msg_put_wmm_rules(struct sk_buff *msg,
1064 				     const struct ieee80211_reg_rule *rule)
1065 {
1066 	int j;
1067 	struct nlattr *nl_wmm_rules =
1068 		nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM);
1069 
1070 	if (!nl_wmm_rules)
1071 		goto nla_put_failure;
1072 
1073 	for (j = 0; j < IEEE80211_NUM_ACS; j++) {
1074 		struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j);
1075 
1076 		if (!nl_wmm_rule)
1077 			goto nla_put_failure;
1078 
1079 		if (nla_put_u16(msg, NL80211_WMMR_CW_MIN,
1080 				rule->wmm_rule.client[j].cw_min) ||
1081 		    nla_put_u16(msg, NL80211_WMMR_CW_MAX,
1082 				rule->wmm_rule.client[j].cw_max) ||
1083 		    nla_put_u8(msg, NL80211_WMMR_AIFSN,
1084 			       rule->wmm_rule.client[j].aifsn) ||
1085 		    nla_put_u16(msg, NL80211_WMMR_TXOP,
1086 			        rule->wmm_rule.client[j].cot))
1087 			goto nla_put_failure;
1088 
1089 		nla_nest_end(msg, nl_wmm_rule);
1090 	}
1091 	nla_nest_end(msg, nl_wmm_rules);
1092 
1093 	return 0;
1094 
1095 nla_put_failure:
1096 	return -ENOBUFS;
1097 }
1098 
1099 static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy,
1100 				   struct ieee80211_channel *chan,
1101 				   bool large)
1102 {
1103 	/* Some channels must be completely excluded from the
1104 	 * list to protect old user-space tools from breaking
1105 	 */
1106 	if (!large && chan->flags &
1107 	    (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
1108 		return 0;
1109 	if (!large && chan->freq_offset)
1110 		return 0;
1111 
1112 	if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
1113 			chan->center_freq))
1114 		goto nla_put_failure;
1115 
1116 	if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_OFFSET, chan->freq_offset))
1117 		goto nla_put_failure;
1118 
1119 	if ((chan->flags & IEEE80211_CHAN_PSD) &&
1120 	    nla_put_s8(msg, NL80211_FREQUENCY_ATTR_PSD, chan->psd))
1121 		goto nla_put_failure;
1122 
1123 	if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
1124 	    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
1125 		goto nla_put_failure;
1126 	if (chan->flags & IEEE80211_CHAN_NO_IR) {
1127 		if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
1128 			goto nla_put_failure;
1129 		if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
1130 			goto nla_put_failure;
1131 	}
1132 	if (chan->flags & IEEE80211_CHAN_RADAR) {
1133 		if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
1134 			goto nla_put_failure;
1135 		if (large) {
1136 			u32 time;
1137 
1138 			time = elapsed_jiffies_msecs(chan->dfs_state_entered);
1139 
1140 			if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
1141 					chan->dfs_state))
1142 				goto nla_put_failure;
1143 			if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
1144 					time))
1145 				goto nla_put_failure;
1146 			if (nla_put_u32(msg,
1147 					NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
1148 					chan->dfs_cac_ms))
1149 				goto nla_put_failure;
1150 		}
1151 	}
1152 
1153 	if (large) {
1154 		if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
1155 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
1156 			goto nla_put_failure;
1157 		if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
1158 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
1159 			goto nla_put_failure;
1160 		if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
1161 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
1162 			goto nla_put_failure;
1163 		if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
1164 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
1165 			goto nla_put_failure;
1166 		if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
1167 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
1168 			goto nla_put_failure;
1169 		if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
1170 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
1171 			goto nla_put_failure;
1172 		if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
1173 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
1174 			goto nla_put_failure;
1175 		if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
1176 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
1177 			goto nla_put_failure;
1178 		if ((chan->flags & IEEE80211_CHAN_NO_HE) &&
1179 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HE))
1180 			goto nla_put_failure;
1181 		if ((chan->flags & IEEE80211_CHAN_1MHZ) &&
1182 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_1MHZ))
1183 			goto nla_put_failure;
1184 		if ((chan->flags & IEEE80211_CHAN_2MHZ) &&
1185 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_2MHZ))
1186 			goto nla_put_failure;
1187 		if ((chan->flags & IEEE80211_CHAN_4MHZ) &&
1188 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_4MHZ))
1189 			goto nla_put_failure;
1190 		if ((chan->flags & IEEE80211_CHAN_8MHZ) &&
1191 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_8MHZ))
1192 			goto nla_put_failure;
1193 		if ((chan->flags & IEEE80211_CHAN_16MHZ) &&
1194 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_16MHZ))
1195 			goto nla_put_failure;
1196 		if ((chan->flags & IEEE80211_CHAN_NO_320MHZ) &&
1197 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_320MHZ))
1198 			goto nla_put_failure;
1199 		if ((chan->flags & IEEE80211_CHAN_NO_EHT) &&
1200 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_EHT))
1201 			goto nla_put_failure;
1202 		if ((chan->flags & IEEE80211_CHAN_DFS_CONCURRENT) &&
1203 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DFS_CONCURRENT))
1204 			goto nla_put_failure;
1205 		if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_VLP_CLIENT) &&
1206 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_VLP_CLIENT))
1207 			goto nla_put_failure;
1208 		if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_AFC_CLIENT) &&
1209 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_AFC_CLIENT))
1210 			goto nla_put_failure;
1211 		if ((chan->flags & IEEE80211_CHAN_CAN_MONITOR) &&
1212 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_CAN_MONITOR))
1213 			goto nla_put_failure;
1214 		if ((chan->flags & IEEE80211_CHAN_ALLOW_6GHZ_VLP_AP) &&
1215 		    nla_put_flag(msg, NL80211_FREQUENCY_ATTR_ALLOW_6GHZ_VLP_AP))
1216 			goto nla_put_failure;
1217 	}
1218 
1219 	if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
1220 			DBM_TO_MBM(chan->max_power)))
1221 		goto nla_put_failure;
1222 
1223 	if (large) {
1224 		const struct ieee80211_reg_rule *rule =
1225 			freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq));
1226 
1227 		if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) {
1228 			if (nl80211_msg_put_wmm_rules(msg, rule))
1229 				goto nla_put_failure;
1230 		}
1231 	}
1232 
1233 	return 0;
1234 
1235  nla_put_failure:
1236 	return -ENOBUFS;
1237 }
1238 
1239 static bool nl80211_put_txq_stats(struct sk_buff *msg,
1240 				  struct cfg80211_txq_stats *txqstats,
1241 				  int attrtype)
1242 {
1243 	struct nlattr *txqattr;
1244 
1245 #define PUT_TXQVAL_U32(attr, memb) do {					  \
1246 	if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) &&	  \
1247 	    nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \
1248 		return false;						  \
1249 	} while (0)
1250 
1251 	txqattr = nla_nest_start_noflag(msg, attrtype);
1252 	if (!txqattr)
1253 		return false;
1254 
1255 	PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes);
1256 	PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets);
1257 	PUT_TXQVAL_U32(FLOWS, flows);
1258 	PUT_TXQVAL_U32(DROPS, drops);
1259 	PUT_TXQVAL_U32(ECN_MARKS, ecn_marks);
1260 	PUT_TXQVAL_U32(OVERLIMIT, overlimit);
1261 	PUT_TXQVAL_U32(OVERMEMORY, overmemory);
1262 	PUT_TXQVAL_U32(COLLISIONS, collisions);
1263 	PUT_TXQVAL_U32(TX_BYTES, tx_bytes);
1264 	PUT_TXQVAL_U32(TX_PACKETS, tx_packets);
1265 	PUT_TXQVAL_U32(MAX_FLOWS, max_flows);
1266 	nla_nest_end(msg, txqattr);
1267 
1268 #undef PUT_TXQVAL_U32
1269 	return true;
1270 }
1271 
1272 /* netlink command implementations */
1273 
1274 /**
1275  * nl80211_link_id - return link ID
1276  * @attrs: attributes to look at
1277  *
1278  * Returns: the link ID or 0 if not given
1279  *
1280  * Note this function doesn't do any validation of the link
1281  * ID validity wrt. links that were actually added, so it must
1282  * be called only from ops with %NL80211_FLAG_MLO_VALID_LINK_ID
1283  * or if additional validation is done.
1284  */
1285 static unsigned int nl80211_link_id(struct nlattr **attrs)
1286 {
1287 	struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID];
1288 
1289 	return nla_get_u8_default(linkid, 0);
1290 }
1291 
1292 static int nl80211_link_id_or_invalid(struct nlattr **attrs)
1293 {
1294 	struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID];
1295 
1296 	if (!linkid)
1297 		return -1;
1298 
1299 	return nla_get_u8(linkid);
1300 }
1301 
1302 struct key_parse {
1303 	struct key_params p;
1304 	int idx;
1305 	int type;
1306 	bool def, defmgmt, defbeacon;
1307 	bool def_uni, def_multi;
1308 };
1309 
1310 static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key,
1311 				 struct key_parse *k)
1312 {
1313 	struct nlattr *tb[NL80211_KEY_MAX + 1];
1314 	int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key,
1315 					      nl80211_key_policy,
1316 					      info->extack);
1317 	if (err)
1318 		return err;
1319 
1320 	k->def = !!tb[NL80211_KEY_DEFAULT];
1321 	k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
1322 	k->defbeacon = !!tb[NL80211_KEY_DEFAULT_BEACON];
1323 
1324 	if (k->def) {
1325 		k->def_uni = true;
1326 		k->def_multi = true;
1327 	}
1328 	if (k->defmgmt || k->defbeacon)
1329 		k->def_multi = true;
1330 
1331 	if (tb[NL80211_KEY_IDX])
1332 		k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
1333 
1334 	if (tb[NL80211_KEY_DATA]) {
1335 		k->p.key = nla_data(tb[NL80211_KEY_DATA]);
1336 		k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
1337 	}
1338 
1339 	if (tb[NL80211_KEY_SEQ]) {
1340 		k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
1341 		k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
1342 	}
1343 
1344 	if (tb[NL80211_KEY_CIPHER])
1345 		k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
1346 
1347 	if (tb[NL80211_KEY_TYPE])
1348 		k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
1349 
1350 	if (tb[NL80211_KEY_DEFAULT_TYPES]) {
1351 		struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
1352 
1353 		err = nla_parse_nested_deprecated(kdt,
1354 						  NUM_NL80211_KEY_DEFAULT_TYPES - 1,
1355 						  tb[NL80211_KEY_DEFAULT_TYPES],
1356 						  nl80211_key_default_policy,
1357 						  info->extack);
1358 		if (err)
1359 			return err;
1360 
1361 		k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
1362 		k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
1363 	}
1364 
1365 	if (tb[NL80211_KEY_MODE])
1366 		k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]);
1367 
1368 	return 0;
1369 }
1370 
1371 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
1372 {
1373 	if (info->attrs[NL80211_ATTR_KEY_DATA]) {
1374 		k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
1375 		k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
1376 	}
1377 
1378 	if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
1379 		k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
1380 		k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
1381 	}
1382 
1383 	if (info->attrs[NL80211_ATTR_KEY_IDX])
1384 		k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
1385 
1386 	if (info->attrs[NL80211_ATTR_KEY_CIPHER])
1387 		k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
1388 
1389 	k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
1390 	k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
1391 
1392 	if (k->def) {
1393 		k->def_uni = true;
1394 		k->def_multi = true;
1395 	}
1396 	if (k->defmgmt)
1397 		k->def_multi = true;
1398 
1399 	if (info->attrs[NL80211_ATTR_KEY_TYPE])
1400 		k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
1401 
1402 	if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
1403 		struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
1404 		int err = nla_parse_nested_deprecated(kdt,
1405 						      NUM_NL80211_KEY_DEFAULT_TYPES - 1,
1406 						      info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
1407 						      nl80211_key_default_policy,
1408 						      info->extack);
1409 		if (err)
1410 			return err;
1411 
1412 		k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
1413 		k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
1414 	}
1415 
1416 	return 0;
1417 }
1418 
1419 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
1420 {
1421 	int err;
1422 
1423 	memset(k, 0, sizeof(*k));
1424 	k->idx = -1;
1425 	k->type = -1;
1426 
1427 	if (info->attrs[NL80211_ATTR_KEY])
1428 		err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k);
1429 	else
1430 		err = nl80211_parse_key_old(info, k);
1431 
1432 	if (err)
1433 		return err;
1434 
1435 	if ((k->def ? 1 : 0) + (k->defmgmt ? 1 : 0) +
1436 	    (k->defbeacon ? 1 : 0) > 1) {
1437 		GENL_SET_ERR_MSG(info,
1438 				 "key with multiple default flags is invalid");
1439 		return -EINVAL;
1440 	}
1441 
1442 	if (k->defmgmt || k->defbeacon) {
1443 		if (k->def_uni || !k->def_multi) {
1444 			GENL_SET_ERR_MSG(info,
1445 					 "defmgmt/defbeacon key must be mcast");
1446 			return -EINVAL;
1447 		}
1448 	}
1449 
1450 	if (k->idx != -1) {
1451 		if (k->defmgmt) {
1452 			if (k->idx < 4 || k->idx > 5) {
1453 				GENL_SET_ERR_MSG(info,
1454 						 "defmgmt key idx not 4 or 5");
1455 				return -EINVAL;
1456 			}
1457 		} else if (k->defbeacon) {
1458 			if (k->idx < 6 || k->idx > 7) {
1459 				GENL_SET_ERR_MSG(info,
1460 						 "defbeacon key idx not 6 or 7");
1461 				return -EINVAL;
1462 			}
1463 		} else if (k->def) {
1464 			if (k->idx < 0 || k->idx > 3) {
1465 				GENL_SET_ERR_MSG(info, "def key idx not 0-3");
1466 				return -EINVAL;
1467 			}
1468 		} else {
1469 			if (k->idx < 0 || k->idx > 7) {
1470 				GENL_SET_ERR_MSG(info, "key idx not 0-7");
1471 				return -EINVAL;
1472 			}
1473 		}
1474 	}
1475 
1476 	return 0;
1477 }
1478 
1479 static struct cfg80211_cached_keys *
1480 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
1481 		       struct genl_info *info, bool *no_ht)
1482 {
1483 	struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS];
1484 	struct key_parse parse;
1485 	struct nlattr *key;
1486 	struct cfg80211_cached_keys *result;
1487 	int rem, err, def = 0;
1488 	bool have_key = false;
1489 
1490 	nla_for_each_nested(key, keys, rem) {
1491 		have_key = true;
1492 		break;
1493 	}
1494 
1495 	if (!have_key)
1496 		return NULL;
1497 
1498 	result = kzalloc(sizeof(*result), GFP_KERNEL);
1499 	if (!result)
1500 		return ERR_PTR(-ENOMEM);
1501 
1502 	result->def = -1;
1503 
1504 	nla_for_each_nested(key, keys, rem) {
1505 		memset(&parse, 0, sizeof(parse));
1506 		parse.idx = -1;
1507 
1508 		err = nl80211_parse_key_new(info, key, &parse);
1509 		if (err)
1510 			goto error;
1511 		err = -EINVAL;
1512 		if (!parse.p.key)
1513 			goto error;
1514 		if (parse.idx < 0 || parse.idx > 3) {
1515 			GENL_SET_ERR_MSG(info, "key index out of range [0-3]");
1516 			goto error;
1517 		}
1518 		if (parse.def) {
1519 			if (def) {
1520 				GENL_SET_ERR_MSG(info,
1521 						 "only one key can be default");
1522 				goto error;
1523 			}
1524 			def = 1;
1525 			result->def = parse.idx;
1526 			if (!parse.def_uni || !parse.def_multi)
1527 				goto error;
1528 		} else if (parse.defmgmt)
1529 			goto error;
1530 		err = cfg80211_validate_key_settings(rdev, &parse.p,
1531 						     parse.idx, false, NULL);
1532 		if (err)
1533 			goto error;
1534 		if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
1535 		    parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
1536 			GENL_SET_ERR_MSG(info, "connect key must be WEP");
1537 			err = -EINVAL;
1538 			goto error;
1539 		}
1540 		result->params[parse.idx].cipher = parse.p.cipher;
1541 		result->params[parse.idx].key_len = parse.p.key_len;
1542 		result->params[parse.idx].key = result->data[parse.idx];
1543 		memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
1544 
1545 		/* must be WEP key if we got here */
1546 		if (no_ht)
1547 			*no_ht = true;
1548 	}
1549 
1550 	if (result->def < 0) {
1551 		err = -EINVAL;
1552 		GENL_SET_ERR_MSG(info, "need a default/TX key");
1553 		goto error;
1554 	}
1555 
1556 	return result;
1557  error:
1558 	kfree(result);
1559 	return ERR_PTR(err);
1560 }
1561 
1562 static int nl80211_key_allowed(struct wireless_dev *wdev)
1563 {
1564 	lockdep_assert_wiphy(wdev->wiphy);
1565 
1566 	switch (wdev->iftype) {
1567 	case NL80211_IFTYPE_AP:
1568 	case NL80211_IFTYPE_AP_VLAN:
1569 	case NL80211_IFTYPE_P2P_GO:
1570 	case NL80211_IFTYPE_MESH_POINT:
1571 		break;
1572 	case NL80211_IFTYPE_ADHOC:
1573 		if (wdev->u.ibss.current_bss)
1574 			return 0;
1575 		return -ENOLINK;
1576 	case NL80211_IFTYPE_STATION:
1577 	case NL80211_IFTYPE_P2P_CLIENT:
1578 		if (wdev->connected)
1579 			return 0;
1580 		return -ENOLINK;
1581 	case NL80211_IFTYPE_NAN:
1582 		if (wiphy_ext_feature_isset(wdev->wiphy,
1583 					    NL80211_EXT_FEATURE_SECURE_NAN))
1584 			return 0;
1585 		return -EINVAL;
1586 	case NL80211_IFTYPE_UNSPECIFIED:
1587 	case NL80211_IFTYPE_OCB:
1588 	case NL80211_IFTYPE_MONITOR:
1589 	case NL80211_IFTYPE_P2P_DEVICE:
1590 	case NL80211_IFTYPE_WDS:
1591 	case NUM_NL80211_IFTYPES:
1592 		return -EINVAL;
1593 	}
1594 
1595 	return 0;
1596 }
1597 
1598 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
1599 							u32 freq)
1600 {
1601 	struct ieee80211_channel *chan;
1602 
1603 	chan = ieee80211_get_channel_khz(wiphy, freq);
1604 	if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
1605 		return NULL;
1606 	return chan;
1607 }
1608 
1609 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
1610 {
1611 	struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr);
1612 	int i;
1613 
1614 	if (!nl_modes)
1615 		goto nla_put_failure;
1616 
1617 	i = 0;
1618 	while (ifmodes) {
1619 		if ((ifmodes & 1) && nla_put_flag(msg, i))
1620 			goto nla_put_failure;
1621 		ifmodes >>= 1;
1622 		i++;
1623 	}
1624 
1625 	nla_nest_end(msg, nl_modes);
1626 	return 0;
1627 
1628 nla_put_failure:
1629 	return -ENOBUFS;
1630 }
1631 
1632 static int nl80211_put_ifcomb_data(struct sk_buff *msg, bool large, int idx,
1633 				   const struct ieee80211_iface_combination *c,
1634 				   u16 nested)
1635 {
1636 	struct nlattr *nl_combi, *nl_limits;
1637 	int i;
1638 
1639 	nl_combi = nla_nest_start_noflag(msg, idx | nested);
1640 	if (!nl_combi)
1641 		goto nla_put_failure;
1642 
1643 	nl_limits = nla_nest_start_noflag(msg, NL80211_IFACE_COMB_LIMITS |
1644 					       nested);
1645 	if (!nl_limits)
1646 		goto nla_put_failure;
1647 
1648 	for (i = 0; i < c->n_limits; i++) {
1649 		struct nlattr *nl_limit;
1650 
1651 		nl_limit = nla_nest_start_noflag(msg, i + 1);
1652 		if (!nl_limit)
1653 			goto nla_put_failure;
1654 		if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX, c->limits[i].max))
1655 			goto nla_put_failure;
1656 		if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
1657 					c->limits[i].types))
1658 			goto nla_put_failure;
1659 		nla_nest_end(msg, nl_limit);
1660 	}
1661 
1662 	nla_nest_end(msg, nl_limits);
1663 
1664 	if (c->beacon_int_infra_match &&
1665 	    nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
1666 		goto nla_put_failure;
1667 	if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
1668 			c->num_different_channels) ||
1669 	    nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
1670 			c->max_interfaces))
1671 		goto nla_put_failure;
1672 	if (large &&
1673 	    (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
1674 			c->radar_detect_widths) ||
1675 	     nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
1676 			c->radar_detect_regions)))
1677 		goto nla_put_failure;
1678 	if (c->beacon_int_min_gcd &&
1679 	    nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
1680 			c->beacon_int_min_gcd))
1681 		goto nla_put_failure;
1682 
1683 	nla_nest_end(msg, nl_combi);
1684 
1685 	return 0;
1686 nla_put_failure:
1687 	return -ENOBUFS;
1688 }
1689 
1690 static int nl80211_put_iface_combinations(struct wiphy *wiphy,
1691 					  struct sk_buff *msg,
1692 					  int attr, int radio,
1693 					  bool large, u16 nested)
1694 {
1695 	const struct ieee80211_iface_combination *c;
1696 	struct nlattr *nl_combis;
1697 	int i, n;
1698 
1699 	nl_combis = nla_nest_start_noflag(msg, attr | nested);
1700 	if (!nl_combis)
1701 		goto nla_put_failure;
1702 
1703 	if (radio >= 0) {
1704 		c = wiphy->radio[0].iface_combinations;
1705 		n = wiphy->radio[0].n_iface_combinations;
1706 	} else {
1707 		c = wiphy->iface_combinations;
1708 		n = wiphy->n_iface_combinations;
1709 	}
1710 	for (i = 0; i < n; i++)
1711 		if (nl80211_put_ifcomb_data(msg, large, i + 1, &c[i], nested))
1712 			goto nla_put_failure;
1713 
1714 	nla_nest_end(msg, nl_combis);
1715 
1716 	return 0;
1717 nla_put_failure:
1718 	return -ENOBUFS;
1719 }
1720 
1721 #ifdef CONFIG_PM
1722 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
1723 					struct sk_buff *msg)
1724 {
1725 	const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
1726 	struct nlattr *nl_tcp;
1727 
1728 	if (!tcp)
1729 		return 0;
1730 
1731 	nl_tcp = nla_nest_start_noflag(msg,
1732 				       NL80211_WOWLAN_TRIG_TCP_CONNECTION);
1733 	if (!nl_tcp)
1734 		return -ENOBUFS;
1735 
1736 	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1737 			tcp->data_payload_max))
1738 		return -ENOBUFS;
1739 
1740 	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1741 			tcp->data_payload_max))
1742 		return -ENOBUFS;
1743 
1744 	if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
1745 		return -ENOBUFS;
1746 
1747 	if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
1748 				sizeof(*tcp->tok), tcp->tok))
1749 		return -ENOBUFS;
1750 
1751 	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
1752 			tcp->data_interval_max))
1753 		return -ENOBUFS;
1754 
1755 	if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
1756 			tcp->wake_payload_max))
1757 		return -ENOBUFS;
1758 
1759 	nla_nest_end(msg, nl_tcp);
1760 	return 0;
1761 }
1762 
1763 static int nl80211_send_wowlan(struct sk_buff *msg,
1764 			       struct cfg80211_registered_device *rdev,
1765 			       bool large)
1766 {
1767 	struct nlattr *nl_wowlan;
1768 
1769 	if (!rdev->wiphy.wowlan)
1770 		return 0;
1771 
1772 	nl_wowlan = nla_nest_start_noflag(msg,
1773 					  NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1774 	if (!nl_wowlan)
1775 		return -ENOBUFS;
1776 
1777 	if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
1778 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1779 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
1780 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1781 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
1782 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1783 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
1784 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1785 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
1786 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1787 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
1788 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1789 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
1790 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1791 	    ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
1792 	     nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1793 		return -ENOBUFS;
1794 
1795 	if (rdev->wiphy.wowlan->n_patterns) {
1796 		struct nl80211_pattern_support pat = {
1797 			.max_patterns = rdev->wiphy.wowlan->n_patterns,
1798 			.min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
1799 			.max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
1800 			.max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
1801 		};
1802 
1803 		if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1804 			    sizeof(pat), &pat))
1805 			return -ENOBUFS;
1806 	}
1807 
1808 	if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
1809 	    nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
1810 			rdev->wiphy.wowlan->max_nd_match_sets))
1811 		return -ENOBUFS;
1812 
1813 	if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
1814 		return -ENOBUFS;
1815 
1816 	nla_nest_end(msg, nl_wowlan);
1817 
1818 	return 0;
1819 }
1820 #endif
1821 
1822 static int nl80211_send_coalesce(struct sk_buff *msg,
1823 				 struct cfg80211_registered_device *rdev)
1824 {
1825 	struct nl80211_coalesce_rule_support rule;
1826 
1827 	if (!rdev->wiphy.coalesce)
1828 		return 0;
1829 
1830 	rule.max_rules = rdev->wiphy.coalesce->n_rules;
1831 	rule.max_delay = rdev->wiphy.coalesce->max_delay;
1832 	rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
1833 	rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
1834 	rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
1835 	rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
1836 
1837 	if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
1838 		return -ENOBUFS;
1839 
1840 	return 0;
1841 }
1842 
1843 static int
1844 nl80211_send_iftype_data(struct sk_buff *msg,
1845 			 const struct ieee80211_supported_band *sband,
1846 			 const struct ieee80211_sband_iftype_data *iftdata)
1847 {
1848 	const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap;
1849 	const struct ieee80211_sta_eht_cap *eht_cap = &iftdata->eht_cap;
1850 
1851 	if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES,
1852 				iftdata->types_mask))
1853 		return -ENOBUFS;
1854 
1855 	if (he_cap->has_he) {
1856 		if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC,
1857 			    sizeof(he_cap->he_cap_elem.mac_cap_info),
1858 			    he_cap->he_cap_elem.mac_cap_info) ||
1859 		    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY,
1860 			    sizeof(he_cap->he_cap_elem.phy_cap_info),
1861 			    he_cap->he_cap_elem.phy_cap_info) ||
1862 		    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET,
1863 			    sizeof(he_cap->he_mcs_nss_supp),
1864 			    &he_cap->he_mcs_nss_supp) ||
1865 		    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE,
1866 			    sizeof(he_cap->ppe_thres), he_cap->ppe_thres))
1867 			return -ENOBUFS;
1868 	}
1869 
1870 	if (eht_cap->has_eht && he_cap->has_he) {
1871 		u8 mcs_nss_size, ppe_thresh_size;
1872 		u16 ppe_thres_hdr;
1873 		bool is_ap;
1874 
1875 		is_ap = iftdata->types_mask & BIT(NL80211_IFTYPE_AP) ||
1876 			iftdata->types_mask & BIT(NL80211_IFTYPE_P2P_GO);
1877 
1878 		mcs_nss_size =
1879 			ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem,
1880 						   &eht_cap->eht_cap_elem,
1881 						   is_ap);
1882 
1883 		ppe_thres_hdr = get_unaligned_le16(&eht_cap->eht_ppe_thres[0]);
1884 		ppe_thresh_size =
1885 			ieee80211_eht_ppe_size(ppe_thres_hdr,
1886 					       eht_cap->eht_cap_elem.phy_cap_info);
1887 
1888 		if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MAC,
1889 			    sizeof(eht_cap->eht_cap_elem.mac_cap_info),
1890 			    eht_cap->eht_cap_elem.mac_cap_info) ||
1891 		    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PHY,
1892 			    sizeof(eht_cap->eht_cap_elem.phy_cap_info),
1893 			    eht_cap->eht_cap_elem.phy_cap_info) ||
1894 		    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MCS_SET,
1895 			    mcs_nss_size, &eht_cap->eht_mcs_nss_supp) ||
1896 		    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PPE,
1897 			    ppe_thresh_size, eht_cap->eht_ppe_thres))
1898 			return -ENOBUFS;
1899 	}
1900 
1901 	if (sband->band == NL80211_BAND_6GHZ &&
1902 	    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_6GHZ_CAPA,
1903 		    sizeof(iftdata->he_6ghz_capa),
1904 		    &iftdata->he_6ghz_capa))
1905 		return -ENOBUFS;
1906 
1907 	if (iftdata->vendor_elems.data && iftdata->vendor_elems.len &&
1908 	    nla_put(msg, NL80211_BAND_IFTYPE_ATTR_VENDOR_ELEMS,
1909 		    iftdata->vendor_elems.len, iftdata->vendor_elems.data))
1910 		return -ENOBUFS;
1911 
1912 	return 0;
1913 }
1914 
1915 static int nl80211_send_band_rateinfo(struct sk_buff *msg,
1916 				      struct ieee80211_supported_band *sband,
1917 				      bool large)
1918 {
1919 	struct nlattr *nl_rates, *nl_rate;
1920 	struct ieee80211_rate *rate;
1921 	int i;
1922 
1923 	/* add HT info */
1924 	if (sband->ht_cap.ht_supported &&
1925 	    (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
1926 		     sizeof(sband->ht_cap.mcs),
1927 		     &sband->ht_cap.mcs) ||
1928 	     nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
1929 			 sband->ht_cap.cap) ||
1930 	     nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1931 			sband->ht_cap.ampdu_factor) ||
1932 	     nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1933 			sband->ht_cap.ampdu_density)))
1934 		return -ENOBUFS;
1935 
1936 	/* add VHT info */
1937 	if (sband->vht_cap.vht_supported &&
1938 	    (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1939 		     sizeof(sband->vht_cap.vht_mcs),
1940 		     &sband->vht_cap.vht_mcs) ||
1941 	     nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1942 			 sband->vht_cap.cap)))
1943 		return -ENOBUFS;
1944 
1945 	if (large && sband->n_iftype_data) {
1946 		struct nlattr *nl_iftype_data =
1947 			nla_nest_start_noflag(msg,
1948 					      NL80211_BAND_ATTR_IFTYPE_DATA);
1949 		const struct ieee80211_sband_iftype_data *iftd;
1950 		int err;
1951 
1952 		if (!nl_iftype_data)
1953 			return -ENOBUFS;
1954 
1955 		for_each_sband_iftype_data(sband, i, iftd) {
1956 			struct nlattr *iftdata;
1957 
1958 			iftdata = nla_nest_start_noflag(msg, i + 1);
1959 			if (!iftdata)
1960 				return -ENOBUFS;
1961 
1962 			err = nl80211_send_iftype_data(msg, sband, iftd);
1963 			if (err)
1964 				return err;
1965 
1966 			nla_nest_end(msg, iftdata);
1967 		}
1968 
1969 		nla_nest_end(msg, nl_iftype_data);
1970 	}
1971 
1972 	/* add EDMG info */
1973 	if (large && sband->edmg_cap.channels &&
1974 	    (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS,
1975 		       sband->edmg_cap.channels) ||
1976 	    nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG,
1977 		       sband->edmg_cap.bw_config)))
1978 
1979 		return -ENOBUFS;
1980 
1981 	/* add bitrates */
1982 	nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES);
1983 	if (!nl_rates)
1984 		return -ENOBUFS;
1985 
1986 	for (i = 0; i < sband->n_bitrates; i++) {
1987 		nl_rate = nla_nest_start_noflag(msg, i);
1988 		if (!nl_rate)
1989 			return -ENOBUFS;
1990 
1991 		rate = &sband->bitrates[i];
1992 		if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1993 				rate->bitrate))
1994 			return -ENOBUFS;
1995 		if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1996 		    nla_put_flag(msg,
1997 				 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1998 			return -ENOBUFS;
1999 
2000 		nla_nest_end(msg, nl_rate);
2001 	}
2002 
2003 	nla_nest_end(msg, nl_rates);
2004 
2005 	/* S1G capabilities */
2006 	if (sband->band == NL80211_BAND_S1GHZ && sband->s1g_cap.s1g &&
2007 	    (nla_put(msg, NL80211_BAND_ATTR_S1G_CAPA,
2008 		     sizeof(sband->s1g_cap.cap),
2009 		     sband->s1g_cap.cap) ||
2010 	     nla_put(msg, NL80211_BAND_ATTR_S1G_MCS_NSS_SET,
2011 		     sizeof(sband->s1g_cap.nss_mcs),
2012 		     sband->s1g_cap.nss_mcs)))
2013 		return -ENOBUFS;
2014 
2015 	return 0;
2016 }
2017 
2018 static int
2019 nl80211_send_mgmt_stypes(struct sk_buff *msg,
2020 			 const struct ieee80211_txrx_stypes *mgmt_stypes)
2021 {
2022 	u16 stypes;
2023 	struct nlattr *nl_ftypes, *nl_ifs;
2024 	enum nl80211_iftype ift;
2025 	int i;
2026 
2027 	if (!mgmt_stypes)
2028 		return 0;
2029 
2030 	nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES);
2031 	if (!nl_ifs)
2032 		return -ENOBUFS;
2033 
2034 	for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
2035 		nl_ftypes = nla_nest_start_noflag(msg, ift);
2036 		if (!nl_ftypes)
2037 			return -ENOBUFS;
2038 		i = 0;
2039 		stypes = mgmt_stypes[ift].tx;
2040 		while (stypes) {
2041 			if ((stypes & 1) &&
2042 			    nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
2043 					(i << 4) | IEEE80211_FTYPE_MGMT))
2044 				return -ENOBUFS;
2045 			stypes >>= 1;
2046 			i++;
2047 		}
2048 		nla_nest_end(msg, nl_ftypes);
2049 	}
2050 
2051 	nla_nest_end(msg, nl_ifs);
2052 
2053 	nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES);
2054 	if (!nl_ifs)
2055 		return -ENOBUFS;
2056 
2057 	for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
2058 		nl_ftypes = nla_nest_start_noflag(msg, ift);
2059 		if (!nl_ftypes)
2060 			return -ENOBUFS;
2061 		i = 0;
2062 		stypes = mgmt_stypes[ift].rx;
2063 		while (stypes) {
2064 			if ((stypes & 1) &&
2065 			    nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
2066 					(i << 4) | IEEE80211_FTYPE_MGMT))
2067 				return -ENOBUFS;
2068 			stypes >>= 1;
2069 			i++;
2070 		}
2071 		nla_nest_end(msg, nl_ftypes);
2072 	}
2073 	nla_nest_end(msg, nl_ifs);
2074 
2075 	return 0;
2076 }
2077 
2078 #define CMD(op, n)							\
2079 	 do {								\
2080 		if (rdev->ops->op) {					\
2081 			i++;						\
2082 			if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) 	\
2083 				goto nla_put_failure;			\
2084 		}							\
2085 	} while (0)
2086 
2087 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
2088 					struct sk_buff *msg)
2089 {
2090 	int i = 0;
2091 
2092 	/*
2093 	 * do *NOT* add anything into this function, new things need to be
2094 	 * advertised only to new versions of userspace that can deal with
2095 	 * the split (and they can't possibly care about new features...
2096 	 */
2097 	CMD(add_virtual_intf, NEW_INTERFACE);
2098 	CMD(change_virtual_intf, SET_INTERFACE);
2099 	CMD(add_key, NEW_KEY);
2100 	CMD(start_ap, START_AP);
2101 	CMD(add_station, NEW_STATION);
2102 	CMD(add_mpath, NEW_MPATH);
2103 	CMD(update_mesh_config, SET_MESH_CONFIG);
2104 	CMD(change_bss, SET_BSS);
2105 	CMD(auth, AUTHENTICATE);
2106 	CMD(assoc, ASSOCIATE);
2107 	CMD(deauth, DEAUTHENTICATE);
2108 	CMD(disassoc, DISASSOCIATE);
2109 	CMD(join_ibss, JOIN_IBSS);
2110 	CMD(join_mesh, JOIN_MESH);
2111 	CMD(set_pmksa, SET_PMKSA);
2112 	CMD(del_pmksa, DEL_PMKSA);
2113 	CMD(flush_pmksa, FLUSH_PMKSA);
2114 	if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
2115 		CMD(remain_on_channel, REMAIN_ON_CHANNEL);
2116 	CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
2117 	CMD(mgmt_tx, FRAME);
2118 	CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
2119 	if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
2120 		i++;
2121 		if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
2122 			goto nla_put_failure;
2123 	}
2124 	if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
2125 	    rdev->ops->join_mesh) {
2126 		i++;
2127 		if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
2128 			goto nla_put_failure;
2129 	}
2130 	if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
2131 		CMD(tdls_mgmt, TDLS_MGMT);
2132 		CMD(tdls_oper, TDLS_OPER);
2133 	}
2134 	if (rdev->wiphy.max_sched_scan_reqs)
2135 		CMD(sched_scan_start, START_SCHED_SCAN);
2136 	CMD(probe_client, PROBE_CLIENT);
2137 	CMD(set_noack_map, SET_NOACK_MAP);
2138 	if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
2139 		i++;
2140 		if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
2141 			goto nla_put_failure;
2142 	}
2143 	CMD(start_p2p_device, START_P2P_DEVICE);
2144 	CMD(set_mcast_rate, SET_MCAST_RATE);
2145 #ifdef CONFIG_NL80211_TESTMODE
2146 	CMD(testmode_cmd, TESTMODE);
2147 #endif
2148 
2149 	if (rdev->ops->connect || rdev->ops->auth) {
2150 		i++;
2151 		if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
2152 			goto nla_put_failure;
2153 	}
2154 
2155 	if (rdev->ops->disconnect || rdev->ops->deauth) {
2156 		i++;
2157 		if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
2158 			goto nla_put_failure;
2159 	}
2160 
2161 	return i;
2162  nla_put_failure:
2163 	return -ENOBUFS;
2164 }
2165 
2166 static int
2167 nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap,
2168 			   struct sk_buff *msg)
2169 {
2170 	struct nlattr *ftm;
2171 
2172 	if (!cap->ftm.supported)
2173 		return 0;
2174 
2175 	ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM);
2176 	if (!ftm)
2177 		return -ENOBUFS;
2178 
2179 	if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP))
2180 		return -ENOBUFS;
2181 	if (cap->ftm.non_asap &&
2182 	    nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP))
2183 		return -ENOBUFS;
2184 	if (cap->ftm.request_lci &&
2185 	    nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI))
2186 		return -ENOBUFS;
2187 	if (cap->ftm.request_civicloc &&
2188 	    nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC))
2189 		return -ENOBUFS;
2190 	if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES,
2191 			cap->ftm.preambles))
2192 		return -ENOBUFS;
2193 	if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS,
2194 			cap->ftm.bandwidths))
2195 		return -ENOBUFS;
2196 	if (cap->ftm.max_bursts_exponent >= 0 &&
2197 	    nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT,
2198 			cap->ftm.max_bursts_exponent))
2199 		return -ENOBUFS;
2200 	if (cap->ftm.max_ftms_per_burst &&
2201 	    nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST,
2202 			cap->ftm.max_ftms_per_burst))
2203 		return -ENOBUFS;
2204 	if (cap->ftm.trigger_based &&
2205 	    nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_TRIGGER_BASED))
2206 		return -ENOBUFS;
2207 	if (cap->ftm.non_trigger_based &&
2208 	    nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_TRIGGER_BASED))
2209 		return -ENOBUFS;
2210 
2211 	nla_nest_end(msg, ftm);
2212 	return 0;
2213 }
2214 
2215 static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev,
2216 				  struct sk_buff *msg)
2217 {
2218 	const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa;
2219 	struct nlattr *pmsr, *caps;
2220 
2221 	if (!cap)
2222 		return 0;
2223 
2224 	/*
2225 	 * we don't need to clean up anything here since the caller
2226 	 * will genlmsg_cancel() if we fail
2227 	 */
2228 
2229 	pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS);
2230 	if (!pmsr)
2231 		return -ENOBUFS;
2232 
2233 	if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers))
2234 		return -ENOBUFS;
2235 
2236 	if (cap->report_ap_tsf &&
2237 	    nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF))
2238 		return -ENOBUFS;
2239 
2240 	if (cap->randomize_mac_addr &&
2241 	    nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR))
2242 		return -ENOBUFS;
2243 
2244 	caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA);
2245 	if (!caps)
2246 		return -ENOBUFS;
2247 
2248 	if (nl80211_send_pmsr_ftm_capa(cap, msg))
2249 		return -ENOBUFS;
2250 
2251 	nla_nest_end(msg, caps);
2252 	nla_nest_end(msg, pmsr);
2253 
2254 	return 0;
2255 }
2256 
2257 static int
2258 nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev,
2259 			      struct sk_buff *msg)
2260 {
2261 	int i;
2262 	struct nlattr *nested, *nested_akms;
2263 	const struct wiphy_iftype_akm_suites *iftype_akms;
2264 
2265 	if (!rdev->wiphy.num_iftype_akm_suites ||
2266 	    !rdev->wiphy.iftype_akm_suites)
2267 		return 0;
2268 
2269 	nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES);
2270 	if (!nested)
2271 		return -ENOBUFS;
2272 
2273 	for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) {
2274 		nested_akms = nla_nest_start(msg, i + 1);
2275 		if (!nested_akms)
2276 			return -ENOBUFS;
2277 
2278 		iftype_akms = &rdev->wiphy.iftype_akm_suites[i];
2279 
2280 		if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES,
2281 					iftype_akms->iftypes_mask))
2282 			return -ENOBUFS;
2283 
2284 		if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES,
2285 			    sizeof(u32) * iftype_akms->n_akm_suites,
2286 			    iftype_akms->akm_suites)) {
2287 			return -ENOBUFS;
2288 		}
2289 		nla_nest_end(msg, nested_akms);
2290 	}
2291 
2292 	nla_nest_end(msg, nested);
2293 
2294 	return 0;
2295 }
2296 
2297 static int
2298 nl80211_put_tid_config_support(struct cfg80211_registered_device *rdev,
2299 			       struct sk_buff *msg)
2300 {
2301 	struct nlattr *supp;
2302 
2303 	if (!rdev->wiphy.tid_config_support.vif &&
2304 	    !rdev->wiphy.tid_config_support.peer)
2305 		return 0;
2306 
2307 	supp = nla_nest_start(msg, NL80211_ATTR_TID_CONFIG);
2308 	if (!supp)
2309 		return -ENOSPC;
2310 
2311 	if (rdev->wiphy.tid_config_support.vif &&
2312 	    nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_VIF_SUPP,
2313 			      rdev->wiphy.tid_config_support.vif,
2314 			      NL80211_TID_CONFIG_ATTR_PAD))
2315 		goto fail;
2316 
2317 	if (rdev->wiphy.tid_config_support.peer &&
2318 	    nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_PEER_SUPP,
2319 			      rdev->wiphy.tid_config_support.peer,
2320 			      NL80211_TID_CONFIG_ATTR_PAD))
2321 		goto fail;
2322 
2323 	/* for now we just use the same value ... makes more sense */
2324 	if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_SHORT,
2325 		       rdev->wiphy.tid_config_support.max_retry))
2326 		goto fail;
2327 	if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_LONG,
2328 		       rdev->wiphy.tid_config_support.max_retry))
2329 		goto fail;
2330 
2331 	nla_nest_end(msg, supp);
2332 
2333 	return 0;
2334 fail:
2335 	nla_nest_cancel(msg, supp);
2336 	return -ENOBUFS;
2337 }
2338 
2339 static int
2340 nl80211_put_sar_specs(struct cfg80211_registered_device *rdev,
2341 		      struct sk_buff *msg)
2342 {
2343 	struct nlattr *sar_capa, *specs, *sub_freq_range;
2344 	u8 num_freq_ranges;
2345 	int i;
2346 
2347 	if (!rdev->wiphy.sar_capa)
2348 		return 0;
2349 
2350 	num_freq_ranges = rdev->wiphy.sar_capa->num_freq_ranges;
2351 
2352 	sar_capa = nla_nest_start(msg, NL80211_ATTR_SAR_SPEC);
2353 	if (!sar_capa)
2354 		return -ENOSPC;
2355 
2356 	if (nla_put_u32(msg, NL80211_SAR_ATTR_TYPE, rdev->wiphy.sar_capa->type))
2357 		goto fail;
2358 
2359 	specs = nla_nest_start(msg, NL80211_SAR_ATTR_SPECS);
2360 	if (!specs)
2361 		goto fail;
2362 
2363 	/* report supported freq_ranges */
2364 	for (i = 0; i < num_freq_ranges; i++) {
2365 		sub_freq_range = nla_nest_start(msg, i + 1);
2366 		if (!sub_freq_range)
2367 			goto fail;
2368 
2369 		if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_START_FREQ,
2370 				rdev->wiphy.sar_capa->freq_ranges[i].start_freq))
2371 			goto fail;
2372 
2373 		if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_END_FREQ,
2374 				rdev->wiphy.sar_capa->freq_ranges[i].end_freq))
2375 			goto fail;
2376 
2377 		nla_nest_end(msg, sub_freq_range);
2378 	}
2379 
2380 	nla_nest_end(msg, specs);
2381 	nla_nest_end(msg, sar_capa);
2382 
2383 	return 0;
2384 fail:
2385 	nla_nest_cancel(msg, sar_capa);
2386 	return -ENOBUFS;
2387 }
2388 
2389 static int nl80211_put_mbssid_support(struct wiphy *wiphy, struct sk_buff *msg)
2390 {
2391 	struct nlattr *config;
2392 
2393 	if (!wiphy->mbssid_max_interfaces)
2394 		return 0;
2395 
2396 	config = nla_nest_start(msg, NL80211_ATTR_MBSSID_CONFIG);
2397 	if (!config)
2398 		return -ENOBUFS;
2399 
2400 	if (nla_put_u8(msg, NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES,
2401 		       wiphy->mbssid_max_interfaces))
2402 		goto fail;
2403 
2404 	if (wiphy->ema_max_profile_periodicity &&
2405 	    nla_put_u8(msg,
2406 		       NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY,
2407 		       wiphy->ema_max_profile_periodicity))
2408 		goto fail;
2409 
2410 	nla_nest_end(msg, config);
2411 	return 0;
2412 
2413 fail:
2414 	nla_nest_cancel(msg, config);
2415 	return -ENOBUFS;
2416 }
2417 
2418 static int nl80211_put_radio(struct wiphy *wiphy, struct sk_buff *msg, int idx)
2419 {
2420 	const struct wiphy_radio *r = &wiphy->radio[idx];
2421 	struct nlattr *radio, *freq;
2422 	int i;
2423 
2424 	radio = nla_nest_start(msg, idx);
2425 	if (!radio)
2426 		return -ENOBUFS;
2427 
2428 	if (nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_INDEX, idx))
2429 		goto nla_put_failure;
2430 
2431 	if (r->antenna_mask &&
2432 	    nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_ANTENNA_MASK,
2433 			r->antenna_mask))
2434 		goto nla_put_failure;
2435 
2436 	for (i = 0; i < r->n_freq_range; i++) {
2437 		const struct wiphy_radio_freq_range *range = &r->freq_range[i];
2438 
2439 		freq = nla_nest_start(msg, NL80211_WIPHY_RADIO_ATTR_FREQ_RANGE);
2440 		if (!freq)
2441 			goto nla_put_failure;
2442 
2443 		if (nla_put_u32(msg, NL80211_WIPHY_RADIO_FREQ_ATTR_START,
2444 				range->start_freq) ||
2445 		    nla_put_u32(msg, NL80211_WIPHY_RADIO_FREQ_ATTR_END,
2446 				range->end_freq))
2447 			goto nla_put_failure;
2448 
2449 		nla_nest_end(msg, freq);
2450 	}
2451 
2452 	for (i = 0; i < r->n_iface_combinations; i++)
2453 		if (nl80211_put_ifcomb_data(msg, true,
2454 					    NL80211_WIPHY_RADIO_ATTR_INTERFACE_COMBINATION,
2455 					    &r->iface_combinations[i],
2456 					    NLA_F_NESTED))
2457 			goto nla_put_failure;
2458 
2459 	nla_nest_end(msg, radio);
2460 
2461 	return 0;
2462 
2463 nla_put_failure:
2464 	return -ENOBUFS;
2465 }
2466 
2467 static int nl80211_put_radios(struct wiphy *wiphy, struct sk_buff *msg)
2468 {
2469 	struct nlattr *radios;
2470 	int i;
2471 
2472 	if (!wiphy->n_radio)
2473 		return 0;
2474 
2475 	radios = nla_nest_start(msg, NL80211_ATTR_WIPHY_RADIOS);
2476 	if (!radios)
2477 		return -ENOBUFS;
2478 
2479 	for (i = 0; i < wiphy->n_radio; i++)
2480 		if (nl80211_put_radio(wiphy, msg, i))
2481 			goto fail;
2482 
2483 	nla_nest_end(msg, radios);
2484 
2485 	if (nl80211_put_iface_combinations(wiphy, msg,
2486 					   NL80211_ATTR_WIPHY_INTERFACE_COMBINATIONS,
2487 					   -1, true, NLA_F_NESTED))
2488 		return -ENOBUFS;
2489 
2490 	return 0;
2491 
2492 fail:
2493 	nla_nest_cancel(msg, radios);
2494 	return -ENOBUFS;
2495 }
2496 
2497 struct nl80211_dump_wiphy_state {
2498 	s64 filter_wiphy;
2499 	long start;
2500 	long split_start, band_start, chan_start, capa_start;
2501 	bool split;
2502 };
2503 
2504 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
2505 			      enum nl80211_commands cmd,
2506 			      struct sk_buff *msg, u32 portid, u32 seq,
2507 			      int flags, struct nl80211_dump_wiphy_state *state)
2508 {
2509 	void *hdr;
2510 	struct nlattr *nl_bands, *nl_band;
2511 	struct nlattr *nl_freqs, *nl_freq;
2512 	struct nlattr *nl_cmds;
2513 	enum nl80211_band band;
2514 	struct ieee80211_channel *chan;
2515 	int i;
2516 	const struct ieee80211_txrx_stypes *mgmt_stypes =
2517 				rdev->wiphy.mgmt_stypes;
2518 	u32 features;
2519 
2520 	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
2521 	if (!hdr)
2522 		return -ENOBUFS;
2523 
2524 	if (WARN_ON(!state))
2525 		return -EINVAL;
2526 
2527 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
2528 	    nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
2529 			   wiphy_name(&rdev->wiphy)) ||
2530 	    nla_put_u32(msg, NL80211_ATTR_GENERATION,
2531 			cfg80211_rdev_list_generation))
2532 		goto nla_put_failure;
2533 
2534 	if (cmd != NL80211_CMD_NEW_WIPHY)
2535 		goto finish;
2536 
2537 	switch (state->split_start) {
2538 	case 0:
2539 		if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
2540 			       rdev->wiphy.retry_short) ||
2541 		    nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
2542 			       rdev->wiphy.retry_long) ||
2543 		    nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
2544 				rdev->wiphy.frag_threshold) ||
2545 		    nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
2546 				rdev->wiphy.rts_threshold) ||
2547 		    nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
2548 			       rdev->wiphy.coverage_class) ||
2549 		    nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
2550 			       rdev->wiphy.max_scan_ssids) ||
2551 		    nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
2552 			       rdev->wiphy.max_sched_scan_ssids) ||
2553 		    nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
2554 				rdev->wiphy.max_scan_ie_len) ||
2555 		    nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
2556 				rdev->wiphy.max_sched_scan_ie_len) ||
2557 		    nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
2558 			       rdev->wiphy.max_match_sets))
2559 			goto nla_put_failure;
2560 
2561 		if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
2562 		    nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
2563 			goto nla_put_failure;
2564 		if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
2565 		    nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
2566 			goto nla_put_failure;
2567 		if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
2568 		    nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
2569 			goto nla_put_failure;
2570 		if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
2571 		    nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
2572 			goto nla_put_failure;
2573 		if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
2574 		    nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
2575 			goto nla_put_failure;
2576 		if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
2577 		    nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
2578 			goto nla_put_failure;
2579 		state->split_start++;
2580 		if (state->split)
2581 			break;
2582 		fallthrough;
2583 	case 1:
2584 		if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
2585 			    sizeof(u32) * rdev->wiphy.n_cipher_suites,
2586 			    rdev->wiphy.cipher_suites))
2587 			goto nla_put_failure;
2588 
2589 		if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
2590 			       rdev->wiphy.max_num_pmkids))
2591 			goto nla_put_failure;
2592 
2593 		if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
2594 		    nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
2595 			goto nla_put_failure;
2596 
2597 		if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
2598 				rdev->wiphy.available_antennas_tx) ||
2599 		    nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
2600 				rdev->wiphy.available_antennas_rx))
2601 			goto nla_put_failure;
2602 
2603 		if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
2604 		    nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
2605 				rdev->wiphy.probe_resp_offload))
2606 			goto nla_put_failure;
2607 
2608 		if ((rdev->wiphy.available_antennas_tx ||
2609 		     rdev->wiphy.available_antennas_rx) &&
2610 		    rdev->ops->get_antenna) {
2611 			u32 tx_ant = 0, rx_ant = 0;
2612 			int res;
2613 
2614 			res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
2615 			if (!res) {
2616 				if (nla_put_u32(msg,
2617 						NL80211_ATTR_WIPHY_ANTENNA_TX,
2618 						tx_ant) ||
2619 				    nla_put_u32(msg,
2620 						NL80211_ATTR_WIPHY_ANTENNA_RX,
2621 						rx_ant))
2622 					goto nla_put_failure;
2623 			}
2624 		}
2625 
2626 		state->split_start++;
2627 		if (state->split)
2628 			break;
2629 		fallthrough;
2630 	case 2:
2631 		if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
2632 					rdev->wiphy.interface_modes))
2633 				goto nla_put_failure;
2634 		state->split_start++;
2635 		if (state->split)
2636 			break;
2637 		fallthrough;
2638 	case 3:
2639 		nl_bands = nla_nest_start_noflag(msg,
2640 						 NL80211_ATTR_WIPHY_BANDS);
2641 		if (!nl_bands)
2642 			goto nla_put_failure;
2643 
2644 		for (band = state->band_start;
2645 		     band < (state->split ?
2646 				NUM_NL80211_BANDS :
2647 				NL80211_BAND_60GHZ + 1);
2648 		     band++) {
2649 			struct ieee80211_supported_band *sband;
2650 
2651 			/* omit higher bands for ancient software */
2652 			if (band > NL80211_BAND_5GHZ && !state->split)
2653 				break;
2654 
2655 			sband = rdev->wiphy.bands[band];
2656 
2657 			if (!sband)
2658 				continue;
2659 
2660 			nl_band = nla_nest_start_noflag(msg, band);
2661 			if (!nl_band)
2662 				goto nla_put_failure;
2663 
2664 			switch (state->chan_start) {
2665 			case 0:
2666 				if (nl80211_send_band_rateinfo(msg, sband,
2667 							       state->split))
2668 					goto nla_put_failure;
2669 				state->chan_start++;
2670 				if (state->split)
2671 					break;
2672 				fallthrough;
2673 			default:
2674 				/* add frequencies */
2675 				nl_freqs = nla_nest_start_noflag(msg,
2676 								 NL80211_BAND_ATTR_FREQS);
2677 				if (!nl_freqs)
2678 					goto nla_put_failure;
2679 
2680 				for (i = state->chan_start - 1;
2681 				     i < sband->n_channels;
2682 				     i++) {
2683 					nl_freq = nla_nest_start_noflag(msg,
2684 									i);
2685 					if (!nl_freq)
2686 						goto nla_put_failure;
2687 
2688 					chan = &sband->channels[i];
2689 
2690 					if (nl80211_msg_put_channel(
2691 							msg, &rdev->wiphy, chan,
2692 							state->split))
2693 						goto nla_put_failure;
2694 
2695 					nla_nest_end(msg, nl_freq);
2696 					if (state->split)
2697 						break;
2698 				}
2699 				if (i < sband->n_channels)
2700 					state->chan_start = i + 2;
2701 				else
2702 					state->chan_start = 0;
2703 				nla_nest_end(msg, nl_freqs);
2704 			}
2705 
2706 			nla_nest_end(msg, nl_band);
2707 
2708 			if (state->split) {
2709 				/* start again here */
2710 				if (state->chan_start)
2711 					band--;
2712 				break;
2713 			}
2714 		}
2715 		nla_nest_end(msg, nl_bands);
2716 
2717 		if (band < NUM_NL80211_BANDS)
2718 			state->band_start = band + 1;
2719 		else
2720 			state->band_start = 0;
2721 
2722 		/* if bands & channels are done, continue outside */
2723 		if (state->band_start == 0 && state->chan_start == 0)
2724 			state->split_start++;
2725 		if (state->split)
2726 			break;
2727 		fallthrough;
2728 	case 4:
2729 		nl_cmds = nla_nest_start_noflag(msg,
2730 						NL80211_ATTR_SUPPORTED_COMMANDS);
2731 		if (!nl_cmds)
2732 			goto nla_put_failure;
2733 
2734 		i = nl80211_add_commands_unsplit(rdev, msg);
2735 		if (i < 0)
2736 			goto nla_put_failure;
2737 		if (state->split) {
2738 			CMD(crit_proto_start, CRIT_PROTOCOL_START);
2739 			CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
2740 			if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
2741 				CMD(channel_switch, CHANNEL_SWITCH);
2742 			CMD(set_qos_map, SET_QOS_MAP);
2743 			if (rdev->wiphy.features &
2744 					NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
2745 				CMD(add_tx_ts, ADD_TX_TS);
2746 			CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
2747 			CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
2748 			CMD(update_ft_ies, UPDATE_FT_IES);
2749 			if (rdev->wiphy.sar_capa)
2750 				CMD(set_sar_specs, SET_SAR_SPECS);
2751 		}
2752 #undef CMD
2753 
2754 		nla_nest_end(msg, nl_cmds);
2755 		state->split_start++;
2756 		if (state->split)
2757 			break;
2758 		fallthrough;
2759 	case 5:
2760 		if (rdev->ops->remain_on_channel &&
2761 		    (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
2762 		    nla_put_u32(msg,
2763 				NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
2764 				rdev->wiphy.max_remain_on_channel_duration))
2765 			goto nla_put_failure;
2766 
2767 		if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
2768 		    nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
2769 			goto nla_put_failure;
2770 
2771 		state->split_start++;
2772 		if (state->split)
2773 			break;
2774 		fallthrough;
2775 	case 6:
2776 #ifdef CONFIG_PM
2777 		if (nl80211_send_wowlan(msg, rdev, state->split))
2778 			goto nla_put_failure;
2779 		state->split_start++;
2780 		if (state->split)
2781 			break;
2782 #else
2783 		state->split_start++;
2784 #endif
2785 		fallthrough;
2786 	case 7:
2787 		if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
2788 					rdev->wiphy.software_iftypes))
2789 			goto nla_put_failure;
2790 
2791 		if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
2792 						   NL80211_ATTR_INTERFACE_COMBINATIONS,
2793 						   rdev->wiphy.n_radio ? 0 : -1,
2794 						   state->split, 0))
2795 			goto nla_put_failure;
2796 
2797 		state->split_start++;
2798 		if (state->split)
2799 			break;
2800 		fallthrough;
2801 	case 8:
2802 		if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
2803 		    nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
2804 				rdev->wiphy.ap_sme_capa))
2805 			goto nla_put_failure;
2806 
2807 		features = rdev->wiphy.features;
2808 		/*
2809 		 * We can only add the per-channel limit information if the
2810 		 * dump is split, otherwise it makes it too big. Therefore
2811 		 * only advertise it in that case.
2812 		 */
2813 		if (state->split)
2814 			features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
2815 		if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
2816 			goto nla_put_failure;
2817 
2818 		if (rdev->wiphy.ht_capa_mod_mask &&
2819 		    nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
2820 			    sizeof(*rdev->wiphy.ht_capa_mod_mask),
2821 			    rdev->wiphy.ht_capa_mod_mask))
2822 			goto nla_put_failure;
2823 
2824 		if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
2825 		    rdev->wiphy.max_acl_mac_addrs &&
2826 		    nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
2827 				rdev->wiphy.max_acl_mac_addrs))
2828 			goto nla_put_failure;
2829 
2830 		/*
2831 		 * Any information below this point is only available to
2832 		 * applications that can deal with it being split. This
2833 		 * helps ensure that newly added capabilities don't break
2834 		 * older tools by overrunning their buffers.
2835 		 *
2836 		 * We still increment split_start so that in the split
2837 		 * case we'll continue with more data in the next round,
2838 		 * but break unconditionally so unsplit data stops here.
2839 		 */
2840 		if (state->split)
2841 			state->split_start++;
2842 		else
2843 			state->split_start = 0;
2844 		break;
2845 	case 9:
2846 		if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
2847 			goto nla_put_failure;
2848 
2849 		if (nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
2850 				rdev->wiphy.max_sched_scan_plans) ||
2851 		    nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
2852 				rdev->wiphy.max_sched_scan_plan_interval) ||
2853 		    nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
2854 				rdev->wiphy.max_sched_scan_plan_iterations))
2855 			goto nla_put_failure;
2856 
2857 		if (rdev->wiphy.extended_capabilities &&
2858 		    (nla_put(msg, NL80211_ATTR_EXT_CAPA,
2859 			     rdev->wiphy.extended_capabilities_len,
2860 			     rdev->wiphy.extended_capabilities) ||
2861 		     nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
2862 			     rdev->wiphy.extended_capabilities_len,
2863 			     rdev->wiphy.extended_capabilities_mask)))
2864 			goto nla_put_failure;
2865 
2866 		if (rdev->wiphy.vht_capa_mod_mask &&
2867 		    nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
2868 			    sizeof(*rdev->wiphy.vht_capa_mod_mask),
2869 			    rdev->wiphy.vht_capa_mod_mask))
2870 			goto nla_put_failure;
2871 
2872 		if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
2873 			    rdev->wiphy.perm_addr))
2874 			goto nla_put_failure;
2875 
2876 		if (!is_zero_ether_addr(rdev->wiphy.addr_mask) &&
2877 		    nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN,
2878 			    rdev->wiphy.addr_mask))
2879 			goto nla_put_failure;
2880 
2881 		if (rdev->wiphy.n_addresses > 1) {
2882 			void *attr;
2883 
2884 			attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS);
2885 			if (!attr)
2886 				goto nla_put_failure;
2887 
2888 			for (i = 0; i < rdev->wiphy.n_addresses; i++)
2889 				if (nla_put(msg, i + 1, ETH_ALEN,
2890 					    rdev->wiphy.addresses[i].addr))
2891 					goto nla_put_failure;
2892 
2893 			nla_nest_end(msg, attr);
2894 		}
2895 
2896 		state->split_start++;
2897 		break;
2898 	case 10:
2899 		if (nl80211_send_coalesce(msg, rdev))
2900 			goto nla_put_failure;
2901 
2902 		if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
2903 		    (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
2904 		     nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
2905 			goto nla_put_failure;
2906 
2907 		if (rdev->wiphy.max_ap_assoc_sta &&
2908 		    nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
2909 				rdev->wiphy.max_ap_assoc_sta))
2910 			goto nla_put_failure;
2911 
2912 		state->split_start++;
2913 		break;
2914 	case 11:
2915 		if (rdev->wiphy.n_vendor_commands) {
2916 			const struct nl80211_vendor_cmd_info *info;
2917 			struct nlattr *nested;
2918 
2919 			nested = nla_nest_start_noflag(msg,
2920 						       NL80211_ATTR_VENDOR_DATA);
2921 			if (!nested)
2922 				goto nla_put_failure;
2923 
2924 			for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
2925 				info = &rdev->wiphy.vendor_commands[i].info;
2926 				if (nla_put(msg, i + 1, sizeof(*info), info))
2927 					goto nla_put_failure;
2928 			}
2929 			nla_nest_end(msg, nested);
2930 		}
2931 
2932 		if (rdev->wiphy.n_vendor_events) {
2933 			const struct nl80211_vendor_cmd_info *info;
2934 			struct nlattr *nested;
2935 
2936 			nested = nla_nest_start_noflag(msg,
2937 						       NL80211_ATTR_VENDOR_EVENTS);
2938 			if (!nested)
2939 				goto nla_put_failure;
2940 
2941 			for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
2942 				info = &rdev->wiphy.vendor_events[i];
2943 				if (nla_put(msg, i + 1, sizeof(*info), info))
2944 					goto nla_put_failure;
2945 			}
2946 			nla_nest_end(msg, nested);
2947 		}
2948 		state->split_start++;
2949 		break;
2950 	case 12:
2951 		if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
2952 		    nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
2953 			       rdev->wiphy.max_num_csa_counters))
2954 			goto nla_put_failure;
2955 
2956 		if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
2957 		    nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
2958 			goto nla_put_failure;
2959 
2960 		if (rdev->wiphy.max_sched_scan_reqs &&
2961 		    nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
2962 				rdev->wiphy.max_sched_scan_reqs))
2963 			goto nla_put_failure;
2964 
2965 		if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
2966 			    sizeof(rdev->wiphy.ext_features),
2967 			    rdev->wiphy.ext_features))
2968 			goto nla_put_failure;
2969 
2970 		if (rdev->wiphy.bss_select_support) {
2971 			struct nlattr *nested;
2972 			u32 bss_select_support = rdev->wiphy.bss_select_support;
2973 
2974 			nested = nla_nest_start_noflag(msg,
2975 						       NL80211_ATTR_BSS_SELECT);
2976 			if (!nested)
2977 				goto nla_put_failure;
2978 
2979 			i = 0;
2980 			while (bss_select_support) {
2981 				if ((bss_select_support & 1) &&
2982 				    nla_put_flag(msg, i))
2983 					goto nla_put_failure;
2984 				i++;
2985 				bss_select_support >>= 1;
2986 			}
2987 			nla_nest_end(msg, nested);
2988 		}
2989 
2990 		state->split_start++;
2991 		break;
2992 	case 13:
2993 		if (rdev->wiphy.num_iftype_ext_capab &&
2994 		    rdev->wiphy.iftype_ext_capab) {
2995 			struct nlattr *nested_ext_capab, *nested;
2996 
2997 			nested = nla_nest_start_noflag(msg,
2998 						       NL80211_ATTR_IFTYPE_EXT_CAPA);
2999 			if (!nested)
3000 				goto nla_put_failure;
3001 
3002 			for (i = state->capa_start;
3003 			     i < rdev->wiphy.num_iftype_ext_capab; i++) {
3004 				const struct wiphy_iftype_ext_capab *capab;
3005 
3006 				capab = &rdev->wiphy.iftype_ext_capab[i];
3007 
3008 				nested_ext_capab = nla_nest_start_noflag(msg,
3009 									 i);
3010 				if (!nested_ext_capab ||
3011 				    nla_put_u32(msg, NL80211_ATTR_IFTYPE,
3012 						capab->iftype) ||
3013 				    nla_put(msg, NL80211_ATTR_EXT_CAPA,
3014 					    capab->extended_capabilities_len,
3015 					    capab->extended_capabilities) ||
3016 				    nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
3017 					    capab->extended_capabilities_len,
3018 					    capab->extended_capabilities_mask))
3019 					goto nla_put_failure;
3020 
3021 				if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO &&
3022 				    (nla_put_u16(msg,
3023 						 NL80211_ATTR_EML_CAPABILITY,
3024 						 capab->eml_capabilities) ||
3025 				     nla_put_u16(msg,
3026 						 NL80211_ATTR_MLD_CAPA_AND_OPS,
3027 						 capab->mld_capa_and_ops)))
3028 					goto nla_put_failure;
3029 
3030 				nla_nest_end(msg, nested_ext_capab);
3031 				if (state->split)
3032 					break;
3033 			}
3034 			nla_nest_end(msg, nested);
3035 			if (i < rdev->wiphy.num_iftype_ext_capab) {
3036 				state->capa_start = i + 1;
3037 				break;
3038 			}
3039 		}
3040 
3041 		if (nla_put_u32(msg, NL80211_ATTR_BANDS,
3042 				rdev->wiphy.nan_supported_bands))
3043 			goto nla_put_failure;
3044 
3045 		if (wiphy_ext_feature_isset(&rdev->wiphy,
3046 					    NL80211_EXT_FEATURE_TXQS)) {
3047 			struct cfg80211_txq_stats txqstats = {};
3048 			int res;
3049 
3050 			res = rdev_get_txq_stats(rdev, NULL, &txqstats);
3051 			if (!res &&
3052 			    !nl80211_put_txq_stats(msg, &txqstats,
3053 						   NL80211_ATTR_TXQ_STATS))
3054 				goto nla_put_failure;
3055 
3056 			if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT,
3057 					rdev->wiphy.txq_limit))
3058 				goto nla_put_failure;
3059 			if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT,
3060 					rdev->wiphy.txq_memory_limit))
3061 				goto nla_put_failure;
3062 			if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM,
3063 					rdev->wiphy.txq_quantum))
3064 				goto nla_put_failure;
3065 		}
3066 
3067 		state->split_start++;
3068 		break;
3069 	case 14:
3070 		if (nl80211_send_pmsr_capa(rdev, msg))
3071 			goto nla_put_failure;
3072 
3073 		state->split_start++;
3074 		break;
3075 	case 15:
3076 		if (rdev->wiphy.akm_suites &&
3077 		    nla_put(msg, NL80211_ATTR_AKM_SUITES,
3078 			    sizeof(u32) * rdev->wiphy.n_akm_suites,
3079 			    rdev->wiphy.akm_suites))
3080 			goto nla_put_failure;
3081 
3082 		if (nl80211_put_iftype_akm_suites(rdev, msg))
3083 			goto nla_put_failure;
3084 
3085 		if (nl80211_put_tid_config_support(rdev, msg))
3086 			goto nla_put_failure;
3087 		state->split_start++;
3088 		break;
3089 	case 16:
3090 		if (nl80211_put_sar_specs(rdev, msg))
3091 			goto nla_put_failure;
3092 
3093 		if (nl80211_put_mbssid_support(&rdev->wiphy, msg))
3094 			goto nla_put_failure;
3095 
3096 		if (nla_put_u16(msg, NL80211_ATTR_MAX_NUM_AKM_SUITES,
3097 				rdev->wiphy.max_num_akm_suites))
3098 			goto nla_put_failure;
3099 
3100 		if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)
3101 			nla_put_flag(msg, NL80211_ATTR_MLO_SUPPORT);
3102 
3103 		if (rdev->wiphy.hw_timestamp_max_peers &&
3104 		    nla_put_u16(msg, NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS,
3105 				rdev->wiphy.hw_timestamp_max_peers))
3106 			goto nla_put_failure;
3107 
3108 		state->split_start++;
3109 		break;
3110 	case 17:
3111 		if (nl80211_put_radios(&rdev->wiphy, msg))
3112 			goto nla_put_failure;
3113 
3114 		/* done */
3115 		state->split_start = 0;
3116 		break;
3117 	}
3118  finish:
3119 	genlmsg_end(msg, hdr);
3120 	return 0;
3121 
3122  nla_put_failure:
3123 	genlmsg_cancel(msg, hdr);
3124 	return -EMSGSIZE;
3125 }
3126 
3127 static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
3128 				    struct netlink_callback *cb,
3129 				    struct nl80211_dump_wiphy_state *state)
3130 {
3131 	struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
3132 	int ret;
3133 
3134 	if (!tb)
3135 		return -ENOMEM;
3136 
3137 	ret = nlmsg_parse_deprecated(cb->nlh,
3138 				     GENL_HDRLEN + nl80211_fam.hdrsize,
3139 				     tb, nl80211_fam.maxattr,
3140 				     nl80211_policy, NULL);
3141 	/* ignore parse errors for backward compatibility */
3142 	if (ret) {
3143 		ret = 0;
3144 		goto out;
3145 	}
3146 
3147 	state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
3148 	if (tb[NL80211_ATTR_WIPHY])
3149 		state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
3150 	if (tb[NL80211_ATTR_WDEV])
3151 		state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
3152 	if (tb[NL80211_ATTR_IFINDEX]) {
3153 		struct net_device *netdev;
3154 		struct cfg80211_registered_device *rdev;
3155 		int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
3156 
3157 		netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
3158 		if (!netdev) {
3159 			ret = -ENODEV;
3160 			goto out;
3161 		}
3162 		if (netdev->ieee80211_ptr) {
3163 			rdev = wiphy_to_rdev(
3164 				netdev->ieee80211_ptr->wiphy);
3165 			state->filter_wiphy = rdev->wiphy_idx;
3166 		}
3167 	}
3168 
3169 	ret = 0;
3170 out:
3171 	kfree(tb);
3172 	return ret;
3173 }
3174 
3175 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
3176 {
3177 	int idx = 0, ret;
3178 	struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
3179 	struct cfg80211_registered_device *rdev;
3180 
3181 	rtnl_lock();
3182 	if (!state) {
3183 		state = kzalloc(sizeof(*state), GFP_KERNEL);
3184 		if (!state) {
3185 			rtnl_unlock();
3186 			return -ENOMEM;
3187 		}
3188 		state->filter_wiphy = -1;
3189 		ret = nl80211_dump_wiphy_parse(skb, cb, state);
3190 		if (ret) {
3191 			kfree(state);
3192 			rtnl_unlock();
3193 			return ret;
3194 		}
3195 		cb->args[0] = (long)state;
3196 	}
3197 
3198 	for_each_rdev(rdev) {
3199 		if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
3200 			continue;
3201 		if (++idx <= state->start)
3202 			continue;
3203 		if (state->filter_wiphy != -1 &&
3204 		    state->filter_wiphy != rdev->wiphy_idx)
3205 			continue;
3206 		wiphy_lock(&rdev->wiphy);
3207 		/* attempt to fit multiple wiphy data chunks into the skb */
3208 		do {
3209 			ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
3210 						 skb,
3211 						 NETLINK_CB(cb->skb).portid,
3212 						 cb->nlh->nlmsg_seq,
3213 						 NLM_F_MULTI, state);
3214 			if (ret < 0) {
3215 				/*
3216 				 * If sending the wiphy data didn't fit (ENOBUFS
3217 				 * or EMSGSIZE returned), this SKB is still
3218 				 * empty (so it's not too big because another
3219 				 * wiphy dataset is already in the skb) and
3220 				 * we've not tried to adjust the dump allocation
3221 				 * yet ... then adjust the alloc size to be
3222 				 * bigger, and return 1 but with the empty skb.
3223 				 * This results in an empty message being RX'ed
3224 				 * in userspace, but that is ignored.
3225 				 *
3226 				 * We can then retry with the larger buffer.
3227 				 */
3228 				if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
3229 				    !skb->len && !state->split &&
3230 				    cb->min_dump_alloc < 4096) {
3231 					cb->min_dump_alloc = 4096;
3232 					state->split_start = 0;
3233 					wiphy_unlock(&rdev->wiphy);
3234 					rtnl_unlock();
3235 					return 1;
3236 				}
3237 				idx--;
3238 				break;
3239 			}
3240 		} while (state->split_start > 0);
3241 		wiphy_unlock(&rdev->wiphy);
3242 		break;
3243 	}
3244 	rtnl_unlock();
3245 
3246 	state->start = idx;
3247 
3248 	return skb->len;
3249 }
3250 
3251 static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
3252 {
3253 	kfree((void *)cb->args[0]);
3254 	return 0;
3255 }
3256 
3257 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
3258 {
3259 	struct sk_buff *msg;
3260 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3261 	struct nl80211_dump_wiphy_state state = {};
3262 
3263 	msg = nlmsg_new(4096, GFP_KERNEL);
3264 	if (!msg)
3265 		return -ENOMEM;
3266 
3267 	if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
3268 			       info->snd_portid, info->snd_seq, 0,
3269 			       &state) < 0) {
3270 		nlmsg_free(msg);
3271 		return -ENOBUFS;
3272 	}
3273 
3274 	return genlmsg_reply(msg, info);
3275 }
3276 
3277 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
3278 	[NL80211_TXQ_ATTR_QUEUE]		= { .type = NLA_U8 },
3279 	[NL80211_TXQ_ATTR_TXOP]			= { .type = NLA_U16 },
3280 	[NL80211_TXQ_ATTR_CWMIN]		= { .type = NLA_U16 },
3281 	[NL80211_TXQ_ATTR_CWMAX]		= { .type = NLA_U16 },
3282 	[NL80211_TXQ_ATTR_AIFS]			= { .type = NLA_U8 },
3283 };
3284 
3285 static int parse_txq_params(struct nlattr *tb[],
3286 			    struct ieee80211_txq_params *txq_params)
3287 {
3288 	u8 ac;
3289 
3290 	if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
3291 	    !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
3292 	    !tb[NL80211_TXQ_ATTR_AIFS])
3293 		return -EINVAL;
3294 
3295 	ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
3296 	txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
3297 	txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
3298 	txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
3299 	txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
3300 
3301 	if (ac >= NL80211_NUM_ACS)
3302 		return -EINVAL;
3303 	txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS);
3304 	return 0;
3305 }
3306 
3307 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
3308 {
3309 	/*
3310 	 * You can only set the channel explicitly for some interfaces,
3311 	 * most have their channel managed via their respective
3312 	 * "establish a connection" command (connect, join, ...)
3313 	 *
3314 	 * For AP/GO and mesh mode, the channel can be set with the
3315 	 * channel userspace API, but is only stored and passed to the
3316 	 * low-level driver when the AP starts or the mesh is joined.
3317 	 * This is for backward compatibility, userspace can also give
3318 	 * the channel in the start-ap or join-mesh commands instead.
3319 	 *
3320 	 * Monitors are special as they are normally slaved to
3321 	 * whatever else is going on, so they have their own special
3322 	 * operation to set the monitor channel if possible.
3323 	 */
3324 	return !wdev ||
3325 		wdev->iftype == NL80211_IFTYPE_AP ||
3326 		wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
3327 		wdev->iftype == NL80211_IFTYPE_MONITOR ||
3328 		wdev->iftype == NL80211_IFTYPE_P2P_GO;
3329 }
3330 
3331 static int _nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
3332 				  struct genl_info *info, bool monitor,
3333 				  struct cfg80211_chan_def *chandef)
3334 {
3335 	struct netlink_ext_ack *extack = info->extack;
3336 	struct nlattr **attrs = info->attrs;
3337 	u32 control_freq;
3338 
3339 	if (!attrs[NL80211_ATTR_WIPHY_FREQ]) {
3340 		NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ],
3341 				    "Frequency is missing");
3342 		return -EINVAL;
3343 	}
3344 
3345 	control_freq = MHZ_TO_KHZ(
3346 			nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
3347 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
3348 		control_freq +=
3349 		    nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
3350 
3351 	memset(chandef, 0, sizeof(*chandef));
3352 	chandef->chan = ieee80211_get_channel_khz(&rdev->wiphy, control_freq);
3353 	chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
3354 	chandef->center_freq1 = KHZ_TO_MHZ(control_freq);
3355 	chandef->freq1_offset = control_freq % 1000;
3356 	chandef->center_freq2 = 0;
3357 
3358 	if (!chandef->chan) {
3359 		NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ],
3360 				    "Unknown channel");
3361 		return -EINVAL;
3362 	}
3363 
3364 	if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
3365 		enum nl80211_channel_type chantype;
3366 
3367 		chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
3368 
3369 		switch (chantype) {
3370 		case NL80211_CHAN_NO_HT:
3371 		case NL80211_CHAN_HT20:
3372 		case NL80211_CHAN_HT40PLUS:
3373 		case NL80211_CHAN_HT40MINUS:
3374 			cfg80211_chandef_create(chandef, chandef->chan,
3375 						chantype);
3376 			/* user input for center_freq is incorrect */
3377 			if (attrs[NL80211_ATTR_CENTER_FREQ1] &&
3378 			    chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) {
3379 				NL_SET_ERR_MSG_ATTR(extack,
3380 						    attrs[NL80211_ATTR_CENTER_FREQ1],
3381 						    "bad center frequency 1");
3382 				return -EINVAL;
3383 			}
3384 			/* center_freq2 must be zero */
3385 			if (attrs[NL80211_ATTR_CENTER_FREQ2] &&
3386 			    nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) {
3387 				NL_SET_ERR_MSG_ATTR(extack,
3388 						    attrs[NL80211_ATTR_CENTER_FREQ2],
3389 						    "center frequency 2 can't be used");
3390 				return -EINVAL;
3391 			}
3392 			break;
3393 		default:
3394 			NL_SET_ERR_MSG_ATTR(extack,
3395 					    attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE],
3396 					    "invalid channel type");
3397 			return -EINVAL;
3398 		}
3399 	} else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
3400 		chandef->width =
3401 			nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]);
3402 		if (chandef->chan->band == NL80211_BAND_S1GHZ) {
3403 			/* User input error for channel width doesn't match channel  */
3404 			if (chandef->width != ieee80211_s1g_channel_width(chandef->chan)) {
3405 				NL_SET_ERR_MSG_ATTR(extack,
3406 						    attrs[NL80211_ATTR_CHANNEL_WIDTH],
3407 						    "bad channel width");
3408 				return -EINVAL;
3409 			}
3410 		}
3411 		if (attrs[NL80211_ATTR_CENTER_FREQ1]) {
3412 			chandef->center_freq1 =
3413 				nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]);
3414 			chandef->freq1_offset =
3415 				nla_get_u32_default(attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET],
3416 						    0);
3417 		}
3418 		if (attrs[NL80211_ATTR_CENTER_FREQ2])
3419 			chandef->center_freq2 =
3420 				nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]);
3421 	}
3422 
3423 	if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) {
3424 		chandef->edmg.channels =
3425 		      nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]);
3426 
3427 		if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG])
3428 			chandef->edmg.bw_config =
3429 		     nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]);
3430 	} else {
3431 		chandef->edmg.bw_config = 0;
3432 		chandef->edmg.channels = 0;
3433 	}
3434 
3435 	if (info->attrs[NL80211_ATTR_PUNCT_BITMAP]) {
3436 		chandef->punctured =
3437 			nla_get_u32(info->attrs[NL80211_ATTR_PUNCT_BITMAP]);
3438 
3439 		if (chandef->punctured &&
3440 		    !wiphy_ext_feature_isset(&rdev->wiphy,
3441 					     NL80211_EXT_FEATURE_PUNCT)) {
3442 			NL_SET_ERR_MSG(extack,
3443 				       "driver doesn't support puncturing");
3444 			return -EINVAL;
3445 		}
3446 	}
3447 
3448 	if (!cfg80211_chandef_valid(chandef)) {
3449 		NL_SET_ERR_MSG(extack, "invalid channel definition");
3450 		return -EINVAL;
3451 	}
3452 
3453 	if (!_cfg80211_chandef_usable(&rdev->wiphy, chandef,
3454 				      IEEE80211_CHAN_DISABLED,
3455 				      monitor ? IEEE80211_CHAN_CAN_MONITOR : 0)) {
3456 		NL_SET_ERR_MSG(extack, "(extension) channel is disabled");
3457 		return -EINVAL;
3458 	}
3459 
3460 	if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
3461 	     chandef->width == NL80211_CHAN_WIDTH_10) &&
3462 	    !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) {
3463 		NL_SET_ERR_MSG(extack, "5/10 MHz not supported");
3464 		return -EINVAL;
3465 	}
3466 
3467 	return 0;
3468 }
3469 
3470 int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
3471 			  struct genl_info *info,
3472 			  struct cfg80211_chan_def *chandef)
3473 {
3474 	return _nl80211_parse_chandef(rdev, info, false, chandef);
3475 }
3476 
3477 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
3478 				 struct net_device *dev,
3479 				 struct genl_info *info,
3480 				 int _link_id)
3481 {
3482 	struct cfg80211_chan_def chandef;
3483 	int result;
3484 	enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
3485 	struct wireless_dev *wdev = NULL;
3486 	int link_id = _link_id;
3487 
3488 	if (dev)
3489 		wdev = dev->ieee80211_ptr;
3490 	if (!nl80211_can_set_dev_channel(wdev))
3491 		return -EOPNOTSUPP;
3492 	if (wdev)
3493 		iftype = wdev->iftype;
3494 
3495 	if (link_id < 0) {
3496 		if (wdev && wdev->valid_links)
3497 			return -EINVAL;
3498 		link_id = 0;
3499 	}
3500 
3501 	result = _nl80211_parse_chandef(rdev, info,
3502 					iftype == NL80211_IFTYPE_MONITOR,
3503 					&chandef);
3504 	if (result)
3505 		return result;
3506 
3507 	switch (iftype) {
3508 	case NL80211_IFTYPE_AP:
3509 	case NL80211_IFTYPE_P2P_GO:
3510 		if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
3511 						   iftype))
3512 			return -EINVAL;
3513 		if (wdev->links[link_id].ap.beacon_interval) {
3514 			struct ieee80211_channel *cur_chan;
3515 
3516 			if (!dev || !rdev->ops->set_ap_chanwidth ||
3517 			    !(rdev->wiphy.features &
3518 			      NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE))
3519 				return -EBUSY;
3520 
3521 			/* Only allow dynamic channel width changes */
3522 			cur_chan = wdev->links[link_id].ap.chandef.chan;
3523 			if (chandef.chan != cur_chan)
3524 				return -EBUSY;
3525 
3526 			/* only allow this for regular channel widths */
3527 			switch (wdev->links[link_id].ap.chandef.width) {
3528 			case NL80211_CHAN_WIDTH_20_NOHT:
3529 			case NL80211_CHAN_WIDTH_20:
3530 			case NL80211_CHAN_WIDTH_40:
3531 			case NL80211_CHAN_WIDTH_80:
3532 			case NL80211_CHAN_WIDTH_80P80:
3533 			case NL80211_CHAN_WIDTH_160:
3534 			case NL80211_CHAN_WIDTH_320:
3535 				break;
3536 			default:
3537 				return -EINVAL;
3538 			}
3539 
3540 			switch (chandef.width) {
3541 			case NL80211_CHAN_WIDTH_20_NOHT:
3542 			case NL80211_CHAN_WIDTH_20:
3543 			case NL80211_CHAN_WIDTH_40:
3544 			case NL80211_CHAN_WIDTH_80:
3545 			case NL80211_CHAN_WIDTH_80P80:
3546 			case NL80211_CHAN_WIDTH_160:
3547 			case NL80211_CHAN_WIDTH_320:
3548 				break;
3549 			default:
3550 				return -EINVAL;
3551 			}
3552 
3553 			result = rdev_set_ap_chanwidth(rdev, dev, link_id,
3554 						       &chandef);
3555 			if (result)
3556 				return result;
3557 			wdev->links[link_id].ap.chandef = chandef;
3558 		} else {
3559 			wdev->u.ap.preset_chandef = chandef;
3560 		}
3561 		return 0;
3562 	case NL80211_IFTYPE_MESH_POINT:
3563 		return cfg80211_set_mesh_channel(rdev, wdev, &chandef);
3564 	case NL80211_IFTYPE_MONITOR:
3565 		return cfg80211_set_monitor_channel(rdev, dev, &chandef);
3566 	default:
3567 		break;
3568 	}
3569 
3570 	return -EINVAL;
3571 }
3572 
3573 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
3574 {
3575 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
3576 	int link_id = nl80211_link_id_or_invalid(info->attrs);
3577 	struct net_device *netdev = info->user_ptr[1];
3578 
3579 	return __nl80211_set_channel(rdev, netdev, info, link_id);
3580 }
3581 
3582 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
3583 {
3584 	struct cfg80211_registered_device *rdev = NULL;
3585 	struct net_device *netdev = NULL;
3586 	struct wireless_dev *wdev;
3587 	int result = 0, rem_txq_params = 0;
3588 	struct nlattr *nl_txq_params;
3589 	u32 changed;
3590 	u8 retry_short = 0, retry_long = 0;
3591 	u32 frag_threshold = 0, rts_threshold = 0;
3592 	u8 coverage_class = 0;
3593 	u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0;
3594 
3595 	rtnl_lock();
3596 	/*
3597 	 * Try to find the wiphy and netdev. Normally this
3598 	 * function shouldn't need the netdev, but this is
3599 	 * done for backward compatibility -- previously
3600 	 * setting the channel was done per wiphy, but now
3601 	 * it is per netdev. Previous userland like hostapd
3602 	 * also passed a netdev to set_wiphy, so that it is
3603 	 * possible to let that go to the right netdev!
3604 	 */
3605 
3606 	if (info->attrs[NL80211_ATTR_IFINDEX]) {
3607 		int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
3608 
3609 		netdev = __dev_get_by_index(genl_info_net(info), ifindex);
3610 		if (netdev && netdev->ieee80211_ptr)
3611 			rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
3612 		else
3613 			netdev = NULL;
3614 	}
3615 
3616 	if (!netdev) {
3617 		rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
3618 						  info->attrs);
3619 		if (IS_ERR(rdev)) {
3620 			rtnl_unlock();
3621 			return PTR_ERR(rdev);
3622 		}
3623 		wdev = NULL;
3624 		netdev = NULL;
3625 		result = 0;
3626 	} else
3627 		wdev = netdev->ieee80211_ptr;
3628 
3629 	guard(wiphy)(&rdev->wiphy);
3630 
3631 	/*
3632 	 * end workaround code, by now the rdev is available
3633 	 * and locked, and wdev may or may not be NULL.
3634 	 */
3635 
3636 	if (info->attrs[NL80211_ATTR_WIPHY_NAME])
3637 		result = cfg80211_dev_rename(
3638 			rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
3639 	rtnl_unlock();
3640 
3641 	if (result)
3642 		return result;
3643 
3644 	if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
3645 		struct ieee80211_txq_params txq_params;
3646 		struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
3647 
3648 		if (!rdev->ops->set_txq_params)
3649 			return -EOPNOTSUPP;
3650 
3651 		if (!netdev)
3652 			return -EINVAL;
3653 
3654 		if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3655 		    netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3656 			return -EINVAL;
3657 
3658 		if (!netif_running(netdev))
3659 			return -ENETDOWN;
3660 
3661 		nla_for_each_nested(nl_txq_params,
3662 				    info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
3663 				    rem_txq_params) {
3664 			result = nla_parse_nested_deprecated(tb,
3665 							     NL80211_TXQ_ATTR_MAX,
3666 							     nl_txq_params,
3667 							     txq_params_policy,
3668 							     info->extack);
3669 			if (result)
3670 				return result;
3671 
3672 			result = parse_txq_params(tb, &txq_params);
3673 			if (result)
3674 				return result;
3675 
3676 			txq_params.link_id =
3677 				nl80211_link_id_or_invalid(info->attrs);
3678 
3679 			if (txq_params.link_id >= 0 &&
3680 			    !(netdev->ieee80211_ptr->valid_links &
3681 			      BIT(txq_params.link_id)))
3682 				result = -ENOLINK;
3683 			else if (txq_params.link_id >= 0 &&
3684 				 !netdev->ieee80211_ptr->valid_links)
3685 				result = -EINVAL;
3686 			else
3687 				result = rdev_set_txq_params(rdev, netdev,
3688 							     &txq_params);
3689 			if (result)
3690 				return result;
3691 		}
3692 	}
3693 
3694 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
3695 		int link_id = nl80211_link_id_or_invalid(info->attrs);
3696 
3697 		if (wdev) {
3698 			result = __nl80211_set_channel(
3699 				rdev,
3700 				nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
3701 				info, link_id);
3702 		} else {
3703 			result = __nl80211_set_channel(rdev, netdev, info, link_id);
3704 		}
3705 
3706 		if (result)
3707 			return result;
3708 	}
3709 
3710 	if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
3711 		struct wireless_dev *txp_wdev = wdev;
3712 		enum nl80211_tx_power_setting type;
3713 		int idx, mbm = 0;
3714 
3715 		if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
3716 			txp_wdev = NULL;
3717 
3718 		if (!rdev->ops->set_tx_power)
3719 			return -EOPNOTSUPP;
3720 
3721 		idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
3722 		type = nla_get_u32(info->attrs[idx]);
3723 
3724 		if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
3725 		    (type != NL80211_TX_POWER_AUTOMATIC))
3726 			return -EINVAL;
3727 
3728 		if (type != NL80211_TX_POWER_AUTOMATIC) {
3729 			idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
3730 			mbm = nla_get_u32(info->attrs[idx]);
3731 		}
3732 
3733 		result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
3734 		if (result)
3735 			return result;
3736 	}
3737 
3738 	if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
3739 	    info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
3740 		u32 tx_ant, rx_ant;
3741 
3742 		if ((!rdev->wiphy.available_antennas_tx &&
3743 		     !rdev->wiphy.available_antennas_rx) ||
3744 		    !rdev->ops->set_antenna)
3745 			return -EOPNOTSUPP;
3746 
3747 		tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
3748 		rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
3749 
3750 		/* reject antenna configurations which don't match the
3751 		 * available antenna masks, except for the "all" mask */
3752 		if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
3753 		    (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
3754 			return -EINVAL;
3755 
3756 		tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
3757 		rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
3758 
3759 		result = rdev_set_antenna(rdev, tx_ant, rx_ant);
3760 		if (result)
3761 			return result;
3762 	}
3763 
3764 	changed = 0;
3765 
3766 	if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
3767 		retry_short = nla_get_u8(
3768 			info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
3769 
3770 		changed |= WIPHY_PARAM_RETRY_SHORT;
3771 	}
3772 
3773 	if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
3774 		retry_long = nla_get_u8(
3775 			info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
3776 
3777 		changed |= WIPHY_PARAM_RETRY_LONG;
3778 	}
3779 
3780 	if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
3781 		frag_threshold = nla_get_u32(
3782 			info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
3783 		if (frag_threshold < 256)
3784 			return -EINVAL;
3785 
3786 		if (frag_threshold != (u32) -1) {
3787 			/*
3788 			 * Fragments (apart from the last one) are required to
3789 			 * have even length. Make the fragmentation code
3790 			 * simpler by stripping LSB should someone try to use
3791 			 * odd threshold value.
3792 			 */
3793 			frag_threshold &= ~0x1;
3794 		}
3795 		changed |= WIPHY_PARAM_FRAG_THRESHOLD;
3796 	}
3797 
3798 	if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
3799 		rts_threshold = nla_get_u32(
3800 			info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
3801 		changed |= WIPHY_PARAM_RTS_THRESHOLD;
3802 	}
3803 
3804 	if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
3805 		if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
3806 			return -EINVAL;
3807 
3808 		coverage_class = nla_get_u8(
3809 			info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
3810 		changed |= WIPHY_PARAM_COVERAGE_CLASS;
3811 	}
3812 
3813 	if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
3814 		if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
3815 			return -EOPNOTSUPP;
3816 
3817 		changed |= WIPHY_PARAM_DYN_ACK;
3818 	}
3819 
3820 	if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) {
3821 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
3822 					     NL80211_EXT_FEATURE_TXQS))
3823 			return -EOPNOTSUPP;
3824 
3825 		txq_limit = nla_get_u32(
3826 			info->attrs[NL80211_ATTR_TXQ_LIMIT]);
3827 		changed |= WIPHY_PARAM_TXQ_LIMIT;
3828 	}
3829 
3830 	if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) {
3831 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
3832 					     NL80211_EXT_FEATURE_TXQS))
3833 			return -EOPNOTSUPP;
3834 
3835 		txq_memory_limit = nla_get_u32(
3836 			info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]);
3837 		changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT;
3838 	}
3839 
3840 	if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) {
3841 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
3842 					     NL80211_EXT_FEATURE_TXQS))
3843 			return -EOPNOTSUPP;
3844 
3845 		txq_quantum = nla_get_u32(
3846 			info->attrs[NL80211_ATTR_TXQ_QUANTUM]);
3847 		changed |= WIPHY_PARAM_TXQ_QUANTUM;
3848 	}
3849 
3850 	if (changed) {
3851 		u8 old_retry_short, old_retry_long;
3852 		u32 old_frag_threshold, old_rts_threshold;
3853 		u8 old_coverage_class;
3854 		u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum;
3855 
3856 		if (!rdev->ops->set_wiphy_params)
3857 			return -EOPNOTSUPP;
3858 
3859 		old_retry_short = rdev->wiphy.retry_short;
3860 		old_retry_long = rdev->wiphy.retry_long;
3861 		old_frag_threshold = rdev->wiphy.frag_threshold;
3862 		old_rts_threshold = rdev->wiphy.rts_threshold;
3863 		old_coverage_class = rdev->wiphy.coverage_class;
3864 		old_txq_limit = rdev->wiphy.txq_limit;
3865 		old_txq_memory_limit = rdev->wiphy.txq_memory_limit;
3866 		old_txq_quantum = rdev->wiphy.txq_quantum;
3867 
3868 		if (changed & WIPHY_PARAM_RETRY_SHORT)
3869 			rdev->wiphy.retry_short = retry_short;
3870 		if (changed & WIPHY_PARAM_RETRY_LONG)
3871 			rdev->wiphy.retry_long = retry_long;
3872 		if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
3873 			rdev->wiphy.frag_threshold = frag_threshold;
3874 		if (changed & WIPHY_PARAM_RTS_THRESHOLD)
3875 			rdev->wiphy.rts_threshold = rts_threshold;
3876 		if (changed & WIPHY_PARAM_COVERAGE_CLASS)
3877 			rdev->wiphy.coverage_class = coverage_class;
3878 		if (changed & WIPHY_PARAM_TXQ_LIMIT)
3879 			rdev->wiphy.txq_limit = txq_limit;
3880 		if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT)
3881 			rdev->wiphy.txq_memory_limit = txq_memory_limit;
3882 		if (changed & WIPHY_PARAM_TXQ_QUANTUM)
3883 			rdev->wiphy.txq_quantum = txq_quantum;
3884 
3885 		result = rdev_set_wiphy_params(rdev, changed);
3886 		if (result) {
3887 			rdev->wiphy.retry_short = old_retry_short;
3888 			rdev->wiphy.retry_long = old_retry_long;
3889 			rdev->wiphy.frag_threshold = old_frag_threshold;
3890 			rdev->wiphy.rts_threshold = old_rts_threshold;
3891 			rdev->wiphy.coverage_class = old_coverage_class;
3892 			rdev->wiphy.txq_limit = old_txq_limit;
3893 			rdev->wiphy.txq_memory_limit = old_txq_memory_limit;
3894 			rdev->wiphy.txq_quantum = old_txq_quantum;
3895 			return result;
3896 		}
3897 	}
3898 
3899 	return 0;
3900 }
3901 
3902 int nl80211_send_chandef(struct sk_buff *msg, const struct cfg80211_chan_def *chandef)
3903 {
3904 	if (WARN_ON(!cfg80211_chandef_valid(chandef)))
3905 		return -EINVAL;
3906 
3907 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
3908 			chandef->chan->center_freq))
3909 		return -ENOBUFS;
3910 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET,
3911 			chandef->chan->freq_offset))
3912 		return -ENOBUFS;
3913 	switch (chandef->width) {
3914 	case NL80211_CHAN_WIDTH_20_NOHT:
3915 	case NL80211_CHAN_WIDTH_20:
3916 	case NL80211_CHAN_WIDTH_40:
3917 		if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
3918 				cfg80211_get_chandef_type(chandef)))
3919 			return -ENOBUFS;
3920 		break;
3921 	default:
3922 		break;
3923 	}
3924 	if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
3925 		return -ENOBUFS;
3926 	if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
3927 		return -ENOBUFS;
3928 	if (chandef->center_freq2 &&
3929 	    nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
3930 		return -ENOBUFS;
3931 	if (chandef->punctured &&
3932 	    nla_put_u32(msg, NL80211_ATTR_PUNCT_BITMAP, chandef->punctured))
3933 		return -ENOBUFS;
3934 
3935 	return 0;
3936 }
3937 EXPORT_SYMBOL(nl80211_send_chandef);
3938 
3939 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
3940 			      struct cfg80211_registered_device *rdev,
3941 			      struct wireless_dev *wdev,
3942 			      enum nl80211_commands cmd)
3943 {
3944 	struct net_device *dev = wdev->netdev;
3945 	void *hdr;
3946 
3947 	lockdep_assert_wiphy(&rdev->wiphy);
3948 
3949 	WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
3950 		cmd != NL80211_CMD_DEL_INTERFACE &&
3951 		cmd != NL80211_CMD_SET_INTERFACE);
3952 
3953 	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
3954 	if (!hdr)
3955 		return -1;
3956 
3957 	if (dev &&
3958 	    (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3959 	     nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
3960 		goto nla_put_failure;
3961 
3962 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
3963 	    nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
3964 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
3965 			      NL80211_ATTR_PAD) ||
3966 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
3967 	    nla_put_u32(msg, NL80211_ATTR_GENERATION,
3968 			rdev->devlist_generation ^
3969 			(cfg80211_rdev_list_generation << 2)) ||
3970 	    nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr) ||
3971 	    nla_put_u32(msg, NL80211_ATTR_VIF_RADIO_MASK, wdev->radio_mask))
3972 		goto nla_put_failure;
3973 
3974 	if (rdev->ops->get_channel && !wdev->valid_links) {
3975 		struct cfg80211_chan_def chandef = {};
3976 		int ret;
3977 
3978 		ret = rdev_get_channel(rdev, wdev, 0, &chandef);
3979 		if (ret == 0 && nl80211_send_chandef(msg, &chandef))
3980 			goto nla_put_failure;
3981 	}
3982 
3983 	if (rdev->ops->get_tx_power && !wdev->valid_links) {
3984 		int dbm, ret;
3985 
3986 		ret = rdev_get_tx_power(rdev, wdev, 0, &dbm);
3987 		if (ret == 0 &&
3988 		    nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
3989 				DBM_TO_MBM(dbm)))
3990 			goto nla_put_failure;
3991 	}
3992 
3993 	switch (wdev->iftype) {
3994 	case NL80211_IFTYPE_AP:
3995 	case NL80211_IFTYPE_P2P_GO:
3996 		if (wdev->u.ap.ssid_len &&
3997 		    nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len,
3998 			    wdev->u.ap.ssid))
3999 			goto nla_put_failure;
4000 		break;
4001 	case NL80211_IFTYPE_STATION:
4002 	case NL80211_IFTYPE_P2P_CLIENT:
4003 		if (wdev->u.client.ssid_len &&
4004 		    nla_put(msg, NL80211_ATTR_SSID, wdev->u.client.ssid_len,
4005 			    wdev->u.client.ssid))
4006 			goto nla_put_failure;
4007 		break;
4008 	case NL80211_IFTYPE_ADHOC:
4009 		if (wdev->u.ibss.ssid_len &&
4010 		    nla_put(msg, NL80211_ATTR_SSID, wdev->u.ibss.ssid_len,
4011 			    wdev->u.ibss.ssid))
4012 			goto nla_put_failure;
4013 		break;
4014 	default:
4015 		/* nothing */
4016 		break;
4017 	}
4018 
4019 	if (rdev->ops->get_txq_stats) {
4020 		struct cfg80211_txq_stats txqstats = {};
4021 		int ret = rdev_get_txq_stats(rdev, wdev, &txqstats);
4022 
4023 		if (ret == 0 &&
4024 		    !nl80211_put_txq_stats(msg, &txqstats,
4025 					   NL80211_ATTR_TXQ_STATS))
4026 			goto nla_put_failure;
4027 	}
4028 
4029 	if (wdev->valid_links) {
4030 		unsigned int link_id;
4031 		struct nlattr *links = nla_nest_start(msg,
4032 						      NL80211_ATTR_MLO_LINKS);
4033 
4034 		if (!links)
4035 			goto nla_put_failure;
4036 
4037 		for_each_valid_link(wdev, link_id) {
4038 			struct nlattr *link = nla_nest_start(msg, link_id + 1);
4039 			struct cfg80211_chan_def chandef = {};
4040 			int ret;
4041 
4042 			if (!link)
4043 				goto nla_put_failure;
4044 
4045 			if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))
4046 				goto nla_put_failure;
4047 			if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
4048 				    wdev->links[link_id].addr))
4049 				goto nla_put_failure;
4050 
4051 			ret = rdev_get_channel(rdev, wdev, link_id, &chandef);
4052 			if (ret == 0 && nl80211_send_chandef(msg, &chandef))
4053 				goto nla_put_failure;
4054 
4055 			if (rdev->ops->get_tx_power) {
4056 				int dbm, ret;
4057 
4058 				ret = rdev_get_tx_power(rdev, wdev, link_id, &dbm);
4059 				if (ret == 0 &&
4060 				    nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
4061 						DBM_TO_MBM(dbm)))
4062 					goto nla_put_failure;
4063 			}
4064 			nla_nest_end(msg, link);
4065 		}
4066 
4067 		nla_nest_end(msg, links);
4068 	}
4069 
4070 	genlmsg_end(msg, hdr);
4071 	return 0;
4072 
4073  nla_put_failure:
4074 	genlmsg_cancel(msg, hdr);
4075 	return -EMSGSIZE;
4076 }
4077 
4078 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
4079 {
4080 	int wp_idx = 0;
4081 	int if_idx = 0;
4082 	int wp_start = cb->args[0];
4083 	int if_start = cb->args[1];
4084 	int filter_wiphy = -1;
4085 	struct cfg80211_registered_device *rdev;
4086 	struct wireless_dev *wdev;
4087 	int ret;
4088 
4089 	rtnl_lock();
4090 	if (!cb->args[2]) {
4091 		struct nl80211_dump_wiphy_state state = {
4092 			.filter_wiphy = -1,
4093 		};
4094 
4095 		ret = nl80211_dump_wiphy_parse(skb, cb, &state);
4096 		if (ret)
4097 			goto out_unlock;
4098 
4099 		filter_wiphy = state.filter_wiphy;
4100 
4101 		/*
4102 		 * if filtering, set cb->args[2] to +1 since 0 is the default
4103 		 * value needed to determine that parsing is necessary.
4104 		 */
4105 		if (filter_wiphy >= 0)
4106 			cb->args[2] = filter_wiphy + 1;
4107 		else
4108 			cb->args[2] = -1;
4109 	} else if (cb->args[2] > 0) {
4110 		filter_wiphy = cb->args[2] - 1;
4111 	}
4112 
4113 	for_each_rdev(rdev) {
4114 		if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
4115 			continue;
4116 		if (wp_idx < wp_start) {
4117 			wp_idx++;
4118 			continue;
4119 		}
4120 
4121 		if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
4122 			continue;
4123 
4124 		if_idx = 0;
4125 
4126 		guard(wiphy)(&rdev->wiphy);
4127 
4128 		list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
4129 			if (if_idx < if_start) {
4130 				if_idx++;
4131 				continue;
4132 			}
4133 
4134 			if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
4135 					       cb->nlh->nlmsg_seq, NLM_F_MULTI,
4136 					       rdev, wdev,
4137 					       NL80211_CMD_NEW_INTERFACE) < 0)
4138 				goto out;
4139 
4140 			if_idx++;
4141 		}
4142 
4143 		if_start = 0;
4144 		wp_idx++;
4145 	}
4146  out:
4147 	cb->args[0] = wp_idx;
4148 	cb->args[1] = if_idx;
4149 
4150 	ret = skb->len;
4151  out_unlock:
4152 	rtnl_unlock();
4153 
4154 	return ret;
4155 }
4156 
4157 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
4158 {
4159 	struct sk_buff *msg;
4160 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4161 	struct wireless_dev *wdev = info->user_ptr[1];
4162 
4163 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4164 	if (!msg)
4165 		return -ENOMEM;
4166 
4167 	if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
4168 			       rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
4169 		nlmsg_free(msg);
4170 		return -ENOBUFS;
4171 	}
4172 
4173 	return genlmsg_reply(msg, info);
4174 }
4175 
4176 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
4177 	[NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
4178 	[NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
4179 	[NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
4180 	[NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
4181 	[NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
4182 	[NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
4183 	[NL80211_MNTR_FLAG_SKIP_TX] = { .type = NLA_FLAG },
4184 };
4185 
4186 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
4187 {
4188 	struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
4189 	int flag;
4190 
4191 	*mntrflags = 0;
4192 
4193 	if (!nla)
4194 		return -EINVAL;
4195 
4196 	if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL))
4197 		return -EINVAL;
4198 
4199 	for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
4200 		if (flags[flag])
4201 			*mntrflags |= (1<<flag);
4202 
4203 	*mntrflags |= MONITOR_FLAG_CHANGED;
4204 
4205 	return 0;
4206 }
4207 
4208 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
4209 				     enum nl80211_iftype type,
4210 				     struct genl_info *info,
4211 				     struct vif_params *params)
4212 {
4213 	bool change = false;
4214 	int err;
4215 
4216 	if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
4217 		if (type != NL80211_IFTYPE_MONITOR)
4218 			return -EINVAL;
4219 
4220 		err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
4221 					  &params->flags);
4222 		if (err)
4223 			return err;
4224 
4225 		change = true;
4226 	}
4227 
4228 	if (params->flags & MONITOR_FLAG_ACTIVE &&
4229 	    !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
4230 		return -EOPNOTSUPP;
4231 
4232 	if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
4233 		const u8 *mumimo_groups;
4234 		u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
4235 
4236 		if (type != NL80211_IFTYPE_MONITOR)
4237 			return -EINVAL;
4238 
4239 		if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
4240 			return -EOPNOTSUPP;
4241 
4242 		mumimo_groups =
4243 			nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
4244 
4245 		/* bits 0 and 63 are reserved and must be zero */
4246 		if ((mumimo_groups[0] & BIT(0)) ||
4247 		    (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7)))
4248 			return -EINVAL;
4249 
4250 		params->vht_mumimo_groups = mumimo_groups;
4251 		change = true;
4252 	}
4253 
4254 	if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
4255 		u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
4256 
4257 		if (type != NL80211_IFTYPE_MONITOR)
4258 			return -EINVAL;
4259 
4260 		if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
4261 			return -EOPNOTSUPP;
4262 
4263 		params->vht_mumimo_follow_addr =
4264 			nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
4265 		change = true;
4266 	}
4267 
4268 	return change ? 1 : 0;
4269 }
4270 
4271 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
4272 			       struct net_device *netdev, u8 use_4addr,
4273 			       enum nl80211_iftype iftype)
4274 {
4275 	if (!use_4addr) {
4276 		if (netdev && netif_is_bridge_port(netdev))
4277 			return -EBUSY;
4278 		return 0;
4279 	}
4280 
4281 	switch (iftype) {
4282 	case NL80211_IFTYPE_AP_VLAN:
4283 		if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
4284 			return 0;
4285 		break;
4286 	case NL80211_IFTYPE_STATION:
4287 		if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
4288 			return 0;
4289 		break;
4290 	default:
4291 		break;
4292 	}
4293 
4294 	return -EOPNOTSUPP;
4295 }
4296 
4297 static int nl80211_parse_vif_radio_mask(struct genl_info *info,
4298 					u32 *radio_mask)
4299 {
4300 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4301 	struct nlattr *attr = info->attrs[NL80211_ATTR_VIF_RADIO_MASK];
4302 	u32 mask, allowed;
4303 
4304 	if (!attr) {
4305 		*radio_mask = 0;
4306 		return 0;
4307 	}
4308 
4309 	allowed = BIT(rdev->wiphy.n_radio) - 1;
4310 	mask = nla_get_u32(attr);
4311 	if (mask & ~allowed)
4312 		return -EINVAL;
4313 	if (!mask)
4314 		mask = allowed;
4315 	*radio_mask = mask;
4316 
4317 	return 1;
4318 }
4319 
4320 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
4321 {
4322 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4323 	struct vif_params params;
4324 	int err;
4325 	enum nl80211_iftype otype, ntype;
4326 	struct net_device *dev = info->user_ptr[1];
4327 	struct wireless_dev *wdev = dev->ieee80211_ptr;
4328 	u32 radio_mask = 0;
4329 	bool change = false;
4330 
4331 	memset(&params, 0, sizeof(params));
4332 
4333 	otype = ntype = dev->ieee80211_ptr->iftype;
4334 
4335 	if (info->attrs[NL80211_ATTR_IFTYPE]) {
4336 		ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
4337 		if (otype != ntype)
4338 			change = true;
4339 	}
4340 
4341 	if (info->attrs[NL80211_ATTR_MESH_ID]) {
4342 		if (ntype != NL80211_IFTYPE_MESH_POINT)
4343 			return -EINVAL;
4344 		if (otype != NL80211_IFTYPE_MESH_POINT)
4345 			return -EINVAL;
4346 		if (netif_running(dev))
4347 			return -EBUSY;
4348 
4349 		wdev->u.mesh.id_up_len =
4350 			nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
4351 		memcpy(wdev->u.mesh.id,
4352 		       nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
4353 		       wdev->u.mesh.id_up_len);
4354 	}
4355 
4356 	if (info->attrs[NL80211_ATTR_4ADDR]) {
4357 		params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
4358 		change = true;
4359 		err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
4360 		if (err)
4361 			return err;
4362 	} else {
4363 		params.use_4addr = -1;
4364 	}
4365 
4366 	err = nl80211_parse_mon_options(rdev, ntype, info, &params);
4367 	if (err < 0)
4368 		return err;
4369 	if (err > 0)
4370 		change = true;
4371 
4372 	err = nl80211_parse_vif_radio_mask(info, &radio_mask);
4373 	if (err < 0)
4374 		return err;
4375 	if (err && netif_running(dev))
4376 		return -EBUSY;
4377 
4378 	if (change)
4379 		err = cfg80211_change_iface(rdev, dev, ntype, &params);
4380 	else
4381 		err = 0;
4382 
4383 	if (!err && params.use_4addr != -1)
4384 		dev->ieee80211_ptr->use_4addr = params.use_4addr;
4385 
4386 	if (radio_mask)
4387 		wdev->radio_mask = radio_mask;
4388 
4389 	if (change && !err)
4390 		nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE);
4391 
4392 	return err;
4393 }
4394 
4395 static int _nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
4396 {
4397 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4398 	struct vif_params params;
4399 	struct wireless_dev *wdev;
4400 	struct sk_buff *msg;
4401 	u32 radio_mask;
4402 	int err;
4403 	enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
4404 
4405 	memset(&params, 0, sizeof(params));
4406 
4407 	if (!info->attrs[NL80211_ATTR_IFNAME])
4408 		return -EINVAL;
4409 
4410 	if (info->attrs[NL80211_ATTR_IFTYPE])
4411 		type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
4412 
4413 	if (!rdev->ops->add_virtual_intf)
4414 		return -EOPNOTSUPP;
4415 
4416 	if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
4417 	     rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
4418 	    info->attrs[NL80211_ATTR_MAC]) {
4419 		nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
4420 			   ETH_ALEN);
4421 		if (!is_valid_ether_addr(params.macaddr))
4422 			return -EADDRNOTAVAIL;
4423 	}
4424 
4425 	if (info->attrs[NL80211_ATTR_4ADDR]) {
4426 		params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
4427 		err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
4428 		if (err)
4429 			return err;
4430 	}
4431 
4432 	if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0))
4433 		return -EOPNOTSUPP;
4434 
4435 	err = nl80211_parse_mon_options(rdev, type, info, &params);
4436 	if (err < 0)
4437 		return err;
4438 
4439 	err = nl80211_parse_vif_radio_mask(info, &radio_mask);
4440 	if (err < 0)
4441 		return err;
4442 
4443 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4444 	if (!msg)
4445 		return -ENOMEM;
4446 
4447 	wdev = rdev_add_virtual_intf(rdev,
4448 				nla_data(info->attrs[NL80211_ATTR_IFNAME]),
4449 				NET_NAME_USER, type, &params);
4450 	if (WARN_ON(!wdev)) {
4451 		nlmsg_free(msg);
4452 		return -EPROTO;
4453 	} else if (IS_ERR(wdev)) {
4454 		nlmsg_free(msg);
4455 		return PTR_ERR(wdev);
4456 	}
4457 
4458 	if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
4459 		wdev->owner_nlportid = info->snd_portid;
4460 
4461 	switch (type) {
4462 	case NL80211_IFTYPE_MESH_POINT:
4463 		if (!info->attrs[NL80211_ATTR_MESH_ID])
4464 			break;
4465 		wdev->u.mesh.id_up_len =
4466 			nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
4467 		memcpy(wdev->u.mesh.id,
4468 		       nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
4469 		       wdev->u.mesh.id_up_len);
4470 		break;
4471 	case NL80211_IFTYPE_NAN:
4472 	case NL80211_IFTYPE_P2P_DEVICE:
4473 		/*
4474 		 * P2P Device and NAN do not have a netdev, so don't go
4475 		 * through the netdev notifier and must be added here
4476 		 */
4477 		cfg80211_init_wdev(wdev);
4478 		cfg80211_register_wdev(rdev, wdev);
4479 		break;
4480 	default:
4481 		break;
4482 	}
4483 
4484 	if (radio_mask)
4485 		wdev->radio_mask = radio_mask;
4486 
4487 	if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
4488 			       rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
4489 		nlmsg_free(msg);
4490 		return -ENOBUFS;
4491 	}
4492 
4493 	return genlmsg_reply(msg, info);
4494 }
4495 
4496 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
4497 {
4498 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4499 
4500 	/* to avoid failing a new interface creation due to pending removal */
4501 	cfg80211_destroy_ifaces(rdev);
4502 
4503 	guard(wiphy)(&rdev->wiphy);
4504 
4505 	return _nl80211_new_interface(skb, info);
4506 }
4507 
4508 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
4509 {
4510 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4511 	struct wireless_dev *wdev = info->user_ptr[1];
4512 
4513 	if (!rdev->ops->del_virtual_intf)
4514 		return -EOPNOTSUPP;
4515 
4516 	/*
4517 	 * We hold RTNL, so this is safe, without RTNL opencount cannot
4518 	 * reach 0, and thus the rdev cannot be deleted.
4519 	 *
4520 	 * We need to do it for the dev_close(), since that will call
4521 	 * the netdev notifiers, and we need to acquire the mutex there
4522 	 * but don't know if we get there from here or from some other
4523 	 * place (e.g. "ip link set ... down").
4524 	 */
4525 	mutex_unlock(&rdev->wiphy.mtx);
4526 
4527 	/*
4528 	 * If we remove a wireless device without a netdev then clear
4529 	 * user_ptr[1] so that nl80211_post_doit won't dereference it
4530 	 * to check if it needs to do dev_put(). Otherwise it crashes
4531 	 * since the wdev has been freed, unlike with a netdev where
4532 	 * we need the dev_put() for the netdev to really be freed.
4533 	 */
4534 	if (!wdev->netdev)
4535 		info->user_ptr[1] = NULL;
4536 	else
4537 		dev_close(wdev->netdev);
4538 
4539 	mutex_lock(&rdev->wiphy.mtx);
4540 
4541 	return cfg80211_remove_virtual_intf(rdev, wdev);
4542 }
4543 
4544 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
4545 {
4546 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4547 	struct net_device *dev = info->user_ptr[1];
4548 	u16 noack_map;
4549 
4550 	if (!info->attrs[NL80211_ATTR_NOACK_MAP])
4551 		return -EINVAL;
4552 
4553 	if (!rdev->ops->set_noack_map)
4554 		return -EOPNOTSUPP;
4555 
4556 	noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
4557 
4558 	return rdev_set_noack_map(rdev, dev, noack_map);
4559 }
4560 
4561 static int nl80211_validate_key_link_id(struct genl_info *info,
4562 					struct wireless_dev *wdev,
4563 					int link_id, bool pairwise)
4564 {
4565 	if (pairwise) {
4566 		if (link_id != -1) {
4567 			GENL_SET_ERR_MSG(info,
4568 					 "link ID not allowed for pairwise key");
4569 			return -EINVAL;
4570 		}
4571 
4572 		return 0;
4573 	}
4574 
4575 	if (wdev->valid_links) {
4576 		if (link_id == -1) {
4577 			GENL_SET_ERR_MSG(info,
4578 					 "link ID must for MLO group key");
4579 			return -EINVAL;
4580 		}
4581 		if (!(wdev->valid_links & BIT(link_id))) {
4582 			GENL_SET_ERR_MSG(info, "invalid link ID for MLO group key");
4583 			return -EINVAL;
4584 		}
4585 	} else if (link_id != -1) {
4586 		GENL_SET_ERR_MSG(info, "link ID not allowed for non-MLO group key");
4587 		return -EINVAL;
4588 	}
4589 
4590 	return 0;
4591 }
4592 
4593 struct get_key_cookie {
4594 	struct sk_buff *msg;
4595 	int error;
4596 	int idx;
4597 };
4598 
4599 static void get_key_callback(void *c, struct key_params *params)
4600 {
4601 	struct nlattr *key;
4602 	struct get_key_cookie *cookie = c;
4603 
4604 	if ((params->seq &&
4605 	     nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
4606 		     params->seq_len, params->seq)) ||
4607 	    (params->cipher &&
4608 	     nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
4609 			 params->cipher)))
4610 		goto nla_put_failure;
4611 
4612 	key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY);
4613 	if (!key)
4614 		goto nla_put_failure;
4615 
4616 	if ((params->seq &&
4617 	     nla_put(cookie->msg, NL80211_KEY_SEQ,
4618 		     params->seq_len, params->seq)) ||
4619 	    (params->cipher &&
4620 	     nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
4621 			 params->cipher)))
4622 		goto nla_put_failure;
4623 
4624 	if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx))
4625 		goto nla_put_failure;
4626 
4627 	nla_nest_end(cookie->msg, key);
4628 
4629 	return;
4630  nla_put_failure:
4631 	cookie->error = 1;
4632 }
4633 
4634 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
4635 {
4636 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4637 	int err;
4638 	struct net_device *dev = info->user_ptr[1];
4639 	u8 key_idx = 0;
4640 	const u8 *mac_addr = NULL;
4641 	bool pairwise;
4642 	struct get_key_cookie cookie = {
4643 		.error = 0,
4644 	};
4645 	void *hdr;
4646 	struct sk_buff *msg;
4647 	bool bigtk_support = false;
4648 	int link_id = nl80211_link_id_or_invalid(info->attrs);
4649 	struct wireless_dev *wdev = dev->ieee80211_ptr;
4650 
4651 	if (wiphy_ext_feature_isset(&rdev->wiphy,
4652 				    NL80211_EXT_FEATURE_BEACON_PROTECTION))
4653 		bigtk_support = true;
4654 
4655 	if ((wdev->iftype == NL80211_IFTYPE_STATION ||
4656 	     wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
4657 	    wiphy_ext_feature_isset(&rdev->wiphy,
4658 				    NL80211_EXT_FEATURE_BEACON_PROTECTION_CLIENT))
4659 		bigtk_support = true;
4660 
4661 	if (info->attrs[NL80211_ATTR_KEY_IDX]) {
4662 		key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
4663 
4664 		if (key_idx >= 6 && key_idx <= 7 && !bigtk_support) {
4665 			GENL_SET_ERR_MSG(info, "BIGTK not supported");
4666 			return -EINVAL;
4667 		}
4668 	}
4669 
4670 	if (info->attrs[NL80211_ATTR_MAC])
4671 		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4672 
4673 	pairwise = !!mac_addr;
4674 	if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
4675 		u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
4676 
4677 		if (kt != NL80211_KEYTYPE_GROUP &&
4678 		    kt != NL80211_KEYTYPE_PAIRWISE)
4679 			return -EINVAL;
4680 		pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
4681 	}
4682 
4683 	if (!rdev->ops->get_key)
4684 		return -EOPNOTSUPP;
4685 
4686 	if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
4687 		return -ENOENT;
4688 
4689 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4690 	if (!msg)
4691 		return -ENOMEM;
4692 
4693 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
4694 			     NL80211_CMD_NEW_KEY);
4695 	if (!hdr)
4696 		goto nla_put_failure;
4697 
4698 	cookie.msg = msg;
4699 	cookie.idx = key_idx;
4700 
4701 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
4702 	    nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
4703 		goto nla_put_failure;
4704 	if (mac_addr &&
4705 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
4706 		goto nla_put_failure;
4707 
4708 	err = nl80211_validate_key_link_id(info, wdev, link_id, pairwise);
4709 	if (err)
4710 		goto free_msg;
4711 
4712 	err = rdev_get_key(rdev, dev, link_id, key_idx, pairwise, mac_addr,
4713 			   &cookie, get_key_callback);
4714 
4715 	if (err)
4716 		goto free_msg;
4717 
4718 	if (cookie.error)
4719 		goto nla_put_failure;
4720 
4721 	genlmsg_end(msg, hdr);
4722 	return genlmsg_reply(msg, info);
4723 
4724  nla_put_failure:
4725 	err = -ENOBUFS;
4726  free_msg:
4727 	nlmsg_free(msg);
4728 	return err;
4729 }
4730 
4731 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
4732 {
4733 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4734 	struct key_parse key;
4735 	int err;
4736 	struct net_device *dev = info->user_ptr[1];
4737 	int link_id = nl80211_link_id_or_invalid(info->attrs);
4738 	struct wireless_dev *wdev = dev->ieee80211_ptr;
4739 
4740 	err = nl80211_parse_key(info, &key);
4741 	if (err)
4742 		return err;
4743 
4744 	if (key.idx < 0)
4745 		return -EINVAL;
4746 
4747 	/* Only support setting default key and
4748 	 * Extended Key ID action NL80211_KEY_SET_TX.
4749 	 */
4750 	if (!key.def && !key.defmgmt && !key.defbeacon &&
4751 	    !(key.p.mode == NL80211_KEY_SET_TX))
4752 		return -EINVAL;
4753 
4754 	if (key.def) {
4755 		if (!rdev->ops->set_default_key)
4756 			return -EOPNOTSUPP;
4757 
4758 		err = nl80211_key_allowed(wdev);
4759 		if (err)
4760 			return err;
4761 
4762 		err = nl80211_validate_key_link_id(info, wdev, link_id, false);
4763 		if (err)
4764 			return err;
4765 
4766 		err = rdev_set_default_key(rdev, dev, link_id, key.idx,
4767 					   key.def_uni, key.def_multi);
4768 
4769 		if (err)
4770 			return err;
4771 
4772 #ifdef CONFIG_CFG80211_WEXT
4773 		wdev->wext.default_key = key.idx;
4774 #endif
4775 		return 0;
4776 	} else if (key.defmgmt) {
4777 		if (key.def_uni || !key.def_multi)
4778 			return -EINVAL;
4779 
4780 		if (!rdev->ops->set_default_mgmt_key)
4781 			return -EOPNOTSUPP;
4782 
4783 		err = nl80211_key_allowed(wdev);
4784 		if (err)
4785 			return err;
4786 
4787 		err = nl80211_validate_key_link_id(info, wdev, link_id, false);
4788 		if (err)
4789 			return err;
4790 
4791 		err = rdev_set_default_mgmt_key(rdev, dev, link_id, key.idx);
4792 		if (err)
4793 			return err;
4794 
4795 #ifdef CONFIG_CFG80211_WEXT
4796 		wdev->wext.default_mgmt_key = key.idx;
4797 #endif
4798 		return 0;
4799 	} else if (key.defbeacon) {
4800 		if (key.def_uni || !key.def_multi)
4801 			return -EINVAL;
4802 
4803 		if (!rdev->ops->set_default_beacon_key)
4804 			return -EOPNOTSUPP;
4805 
4806 		err = nl80211_key_allowed(wdev);
4807 		if (err)
4808 			return err;
4809 
4810 		err = nl80211_validate_key_link_id(info, wdev, link_id, false);
4811 		if (err)
4812 			return err;
4813 
4814 		return rdev_set_default_beacon_key(rdev, dev, link_id, key.idx);
4815 	} else if (key.p.mode == NL80211_KEY_SET_TX &&
4816 		   wiphy_ext_feature_isset(&rdev->wiphy,
4817 					   NL80211_EXT_FEATURE_EXT_KEY_ID)) {
4818 		u8 *mac_addr = NULL;
4819 
4820 		if (info->attrs[NL80211_ATTR_MAC])
4821 			mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4822 
4823 		if (!mac_addr || key.idx < 0 || key.idx > 1)
4824 			return -EINVAL;
4825 
4826 		err = nl80211_validate_key_link_id(info, wdev, link_id, true);
4827 		if (err)
4828 			return err;
4829 
4830 		return rdev_add_key(rdev, dev, link_id, key.idx,
4831 				    NL80211_KEYTYPE_PAIRWISE,
4832 				    mac_addr, &key.p);
4833 	}
4834 
4835 	return -EINVAL;
4836 }
4837 
4838 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
4839 {
4840 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4841 	int err;
4842 	struct net_device *dev = info->user_ptr[1];
4843 	struct key_parse key;
4844 	const u8 *mac_addr = NULL;
4845 	int link_id = nl80211_link_id_or_invalid(info->attrs);
4846 	struct wireless_dev *wdev = dev->ieee80211_ptr;
4847 
4848 	err = nl80211_parse_key(info, &key);
4849 	if (err)
4850 		return err;
4851 
4852 	if (!key.p.key) {
4853 		GENL_SET_ERR_MSG(info, "no key");
4854 		return -EINVAL;
4855 	}
4856 
4857 	if (info->attrs[NL80211_ATTR_MAC])
4858 		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4859 
4860 	if (key.type == -1) {
4861 		if (mac_addr)
4862 			key.type = NL80211_KEYTYPE_PAIRWISE;
4863 		else
4864 			key.type = NL80211_KEYTYPE_GROUP;
4865 	}
4866 
4867 	/* for now */
4868 	if (key.type != NL80211_KEYTYPE_PAIRWISE &&
4869 	    key.type != NL80211_KEYTYPE_GROUP) {
4870 		GENL_SET_ERR_MSG(info, "key type not pairwise or group");
4871 		return -EINVAL;
4872 	}
4873 
4874 	if (key.type == NL80211_KEYTYPE_GROUP &&
4875 	    info->attrs[NL80211_ATTR_VLAN_ID])
4876 		key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
4877 
4878 	if (!rdev->ops->add_key)
4879 		return -EOPNOTSUPP;
4880 
4881 	if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
4882 					   key.type == NL80211_KEYTYPE_PAIRWISE,
4883 					   mac_addr)) {
4884 		GENL_SET_ERR_MSG(info, "key setting validation failed");
4885 		return -EINVAL;
4886 	}
4887 
4888 	err = nl80211_key_allowed(wdev);
4889 	if (err)
4890 		GENL_SET_ERR_MSG(info, "key not allowed");
4891 
4892 	if (!err)
4893 		err = nl80211_validate_key_link_id(info, wdev, link_id,
4894 				key.type == NL80211_KEYTYPE_PAIRWISE);
4895 
4896 	if (!err) {
4897 		err = rdev_add_key(rdev, dev, link_id, key.idx,
4898 				   key.type == NL80211_KEYTYPE_PAIRWISE,
4899 				    mac_addr, &key.p);
4900 		if (err)
4901 			GENL_SET_ERR_MSG(info, "key addition failed");
4902 	}
4903 
4904 	return err;
4905 }
4906 
4907 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
4908 {
4909 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
4910 	int err;
4911 	struct net_device *dev = info->user_ptr[1];
4912 	u8 *mac_addr = NULL;
4913 	struct key_parse key;
4914 	int link_id = nl80211_link_id_or_invalid(info->attrs);
4915 	struct wireless_dev *wdev = dev->ieee80211_ptr;
4916 
4917 	err = nl80211_parse_key(info, &key);
4918 	if (err)
4919 		return err;
4920 
4921 	if (info->attrs[NL80211_ATTR_MAC])
4922 		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4923 
4924 	if (key.type == -1) {
4925 		if (mac_addr)
4926 			key.type = NL80211_KEYTYPE_PAIRWISE;
4927 		else
4928 			key.type = NL80211_KEYTYPE_GROUP;
4929 	}
4930 
4931 	/* for now */
4932 	if (key.type != NL80211_KEYTYPE_PAIRWISE &&
4933 	    key.type != NL80211_KEYTYPE_GROUP)
4934 		return -EINVAL;
4935 
4936 	if (!cfg80211_valid_key_idx(rdev, key.idx,
4937 				    key.type == NL80211_KEYTYPE_PAIRWISE))
4938 		return -EINVAL;
4939 
4940 	if (!rdev->ops->del_key)
4941 		return -EOPNOTSUPP;
4942 
4943 	err = nl80211_key_allowed(wdev);
4944 
4945 	if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
4946 	    !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
4947 		err = -ENOENT;
4948 
4949 	if (!err)
4950 		err = nl80211_validate_key_link_id(info, wdev, link_id,
4951 				key.type == NL80211_KEYTYPE_PAIRWISE);
4952 
4953 	if (!err)
4954 		err = rdev_del_key(rdev, dev, link_id, key.idx,
4955 				   key.type == NL80211_KEYTYPE_PAIRWISE,
4956 				   mac_addr);
4957 
4958 #ifdef CONFIG_CFG80211_WEXT
4959 	if (!err) {
4960 		if (key.idx == wdev->wext.default_key)
4961 			wdev->wext.default_key = -1;
4962 		else if (key.idx == wdev->wext.default_mgmt_key)
4963 			wdev->wext.default_mgmt_key = -1;
4964 	}
4965 #endif
4966 
4967 	return err;
4968 }
4969 
4970 /* This function returns an error or the number of nested attributes */
4971 static int validate_acl_mac_addrs(struct nlattr *nl_attr)
4972 {
4973 	struct nlattr *attr;
4974 	int n_entries = 0, tmp;
4975 
4976 	nla_for_each_nested(attr, nl_attr, tmp) {
4977 		if (nla_len(attr) != ETH_ALEN)
4978 			return -EINVAL;
4979 
4980 		n_entries++;
4981 	}
4982 
4983 	return n_entries;
4984 }
4985 
4986 /*
4987  * This function parses ACL information and allocates memory for ACL data.
4988  * On successful return, the calling function is responsible to free the
4989  * ACL buffer returned by this function.
4990  */
4991 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
4992 						struct genl_info *info)
4993 {
4994 	enum nl80211_acl_policy acl_policy;
4995 	struct nlattr *attr;
4996 	struct cfg80211_acl_data *acl;
4997 	int i = 0, n_entries, tmp;
4998 
4999 	if (!wiphy->max_acl_mac_addrs)
5000 		return ERR_PTR(-EOPNOTSUPP);
5001 
5002 	if (!info->attrs[NL80211_ATTR_ACL_POLICY])
5003 		return ERR_PTR(-EINVAL);
5004 
5005 	acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
5006 	if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
5007 	    acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
5008 		return ERR_PTR(-EINVAL);
5009 
5010 	if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
5011 		return ERR_PTR(-EINVAL);
5012 
5013 	n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
5014 	if (n_entries < 0)
5015 		return ERR_PTR(n_entries);
5016 
5017 	if (n_entries > wiphy->max_acl_mac_addrs)
5018 		return ERR_PTR(-EOPNOTSUPP);
5019 
5020 	acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL);
5021 	if (!acl)
5022 		return ERR_PTR(-ENOMEM);
5023 	acl->n_acl_entries = n_entries;
5024 
5025 	nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
5026 		memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
5027 		i++;
5028 	}
5029 	acl->acl_policy = acl_policy;
5030 
5031 	return acl;
5032 }
5033 
5034 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
5035 {
5036 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
5037 	struct net_device *dev = info->user_ptr[1];
5038 	struct cfg80211_acl_data *acl;
5039 	int err;
5040 
5041 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5042 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5043 		return -EOPNOTSUPP;
5044 
5045 	if (!dev->ieee80211_ptr->links[0].ap.beacon_interval)
5046 		return -EINVAL;
5047 
5048 	acl = parse_acl_data(&rdev->wiphy, info);
5049 	if (IS_ERR(acl))
5050 		return PTR_ERR(acl);
5051 
5052 	err = rdev_set_mac_acl(rdev, dev, acl);
5053 
5054 	kfree(acl);
5055 
5056 	return err;
5057 }
5058 
5059 static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
5060 			   u8 *rates, u8 rates_len)
5061 {
5062 	u8 i;
5063 	u32 mask = 0;
5064 
5065 	for (i = 0; i < rates_len; i++) {
5066 		int rate = (rates[i] & 0x7f) * 5;
5067 		int ridx;
5068 
5069 		for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
5070 			struct ieee80211_rate *srate =
5071 				&sband->bitrates[ridx];
5072 			if (rate == srate->bitrate) {
5073 				mask |= 1 << ridx;
5074 				break;
5075 			}
5076 		}
5077 		if (ridx == sband->n_bitrates)
5078 			return 0; /* rate not found */
5079 	}
5080 
5081 	return mask;
5082 }
5083 
5084 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
5085 			       u8 *rates, u8 rates_len,
5086 			       u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
5087 {
5088 	u8 i;
5089 
5090 	memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
5091 
5092 	for (i = 0; i < rates_len; i++) {
5093 		int ridx, rbit;
5094 
5095 		ridx = rates[i] / 8;
5096 		rbit = BIT(rates[i] % 8);
5097 
5098 		/* check validity */
5099 		if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
5100 			return false;
5101 
5102 		/* check availability */
5103 		ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN);
5104 		if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
5105 			mcs[ridx] |= rbit;
5106 		else
5107 			return false;
5108 	}
5109 
5110 	return true;
5111 }
5112 
5113 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
5114 {
5115 	u16 mcs_mask = 0;
5116 
5117 	switch (vht_mcs_map) {
5118 	case IEEE80211_VHT_MCS_NOT_SUPPORTED:
5119 		break;
5120 	case IEEE80211_VHT_MCS_SUPPORT_0_7:
5121 		mcs_mask = 0x00FF;
5122 		break;
5123 	case IEEE80211_VHT_MCS_SUPPORT_0_8:
5124 		mcs_mask = 0x01FF;
5125 		break;
5126 	case IEEE80211_VHT_MCS_SUPPORT_0_9:
5127 		mcs_mask = 0x03FF;
5128 		break;
5129 	default:
5130 		break;
5131 	}
5132 
5133 	return mcs_mask;
5134 }
5135 
5136 static void vht_build_mcs_mask(u16 vht_mcs_map,
5137 			       u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
5138 {
5139 	u8 nss;
5140 
5141 	for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
5142 		vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
5143 		vht_mcs_map >>= 2;
5144 	}
5145 }
5146 
5147 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
5148 			     struct nl80211_txrate_vht *txrate,
5149 			     u16 mcs[NL80211_VHT_NSS_MAX])
5150 {
5151 	u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
5152 	u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
5153 	u8 i;
5154 
5155 	if (!sband->vht_cap.vht_supported)
5156 		return false;
5157 
5158 	memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
5159 
5160 	/* Build vht_mcs_mask from VHT capabilities */
5161 	vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
5162 
5163 	for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
5164 		if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
5165 			mcs[i] = txrate->mcs[i];
5166 		else
5167 			return false;
5168 	}
5169 
5170 	return true;
5171 }
5172 
5173 static u16 he_mcs_map_to_mcs_mask(u8 he_mcs_map)
5174 {
5175 	switch (he_mcs_map) {
5176 	case IEEE80211_HE_MCS_NOT_SUPPORTED:
5177 		return 0;
5178 	case IEEE80211_HE_MCS_SUPPORT_0_7:
5179 		return 0x00FF;
5180 	case IEEE80211_HE_MCS_SUPPORT_0_9:
5181 		return 0x03FF;
5182 	case IEEE80211_HE_MCS_SUPPORT_0_11:
5183 		return 0xFFF;
5184 	default:
5185 		break;
5186 	}
5187 	return 0;
5188 }
5189 
5190 static void he_build_mcs_mask(u16 he_mcs_map,
5191 			      u16 he_mcs_mask[NL80211_HE_NSS_MAX])
5192 {
5193 	u8 nss;
5194 
5195 	for (nss = 0; nss < NL80211_HE_NSS_MAX; nss++) {
5196 		he_mcs_mask[nss] = he_mcs_map_to_mcs_mask(he_mcs_map & 0x03);
5197 		he_mcs_map >>= 2;
5198 	}
5199 }
5200 
5201 static u16 he_get_txmcsmap(struct genl_info *info, unsigned int link_id,
5202 			   const struct ieee80211_sta_he_cap *he_cap)
5203 {
5204 	struct net_device *dev = info->user_ptr[1];
5205 	struct wireless_dev *wdev = dev->ieee80211_ptr;
5206 	struct cfg80211_chan_def *chandef;
5207 	__le16 tx_mcs;
5208 
5209 	chandef = wdev_chandef(wdev, link_id);
5210 	if (!chandef) {
5211 		/*
5212 		 * This is probably broken, but we never maintained
5213 		 * a chandef in these cases, so it always was.
5214 		 */
5215 		return le16_to_cpu(he_cap->he_mcs_nss_supp.tx_mcs_80);
5216 	}
5217 
5218 	switch (chandef->width) {
5219 	case NL80211_CHAN_WIDTH_80P80:
5220 		tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80p80;
5221 		break;
5222 	case NL80211_CHAN_WIDTH_160:
5223 		tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_160;
5224 		break;
5225 	default:
5226 		tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80;
5227 		break;
5228 	}
5229 
5230 	return le16_to_cpu(tx_mcs);
5231 }
5232 
5233 static bool he_set_mcs_mask(struct genl_info *info,
5234 			    struct wireless_dev *wdev,
5235 			    struct ieee80211_supported_band *sband,
5236 			    struct nl80211_txrate_he *txrate,
5237 			    u16 mcs[NL80211_HE_NSS_MAX],
5238 			    unsigned int link_id)
5239 {
5240 	const struct ieee80211_sta_he_cap *he_cap;
5241 	u16 tx_mcs_mask[NL80211_HE_NSS_MAX] = {};
5242 	u16 tx_mcs_map = 0;
5243 	u8 i;
5244 
5245 	he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype);
5246 	if (!he_cap)
5247 		return false;
5248 
5249 	memset(mcs, 0, sizeof(u16) * NL80211_HE_NSS_MAX);
5250 
5251 	tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap);
5252 
5253 	/* Build he_mcs_mask from HE capabilities */
5254 	he_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
5255 
5256 	for (i = 0; i < NL80211_HE_NSS_MAX; i++) {
5257 		if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
5258 			mcs[i] = txrate->mcs[i];
5259 		else
5260 			return false;
5261 	}
5262 
5263 	return true;
5264 }
5265 
5266 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
5267 					 struct nlattr *attrs[],
5268 					 enum nl80211_attrs attr,
5269 					 struct cfg80211_bitrate_mask *mask,
5270 					 struct net_device *dev,
5271 					 bool default_all_enabled,
5272 					 unsigned int link_id)
5273 {
5274 	struct nlattr *tb[NL80211_TXRATE_MAX + 1];
5275 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
5276 	struct wireless_dev *wdev = dev->ieee80211_ptr;
5277 	int rem, i;
5278 	struct nlattr *tx_rates;
5279 	struct ieee80211_supported_band *sband;
5280 	u16 vht_tx_mcs_map, he_tx_mcs_map;
5281 
5282 	memset(mask, 0, sizeof(*mask));
5283 	/* Default to all rates enabled */
5284 	for (i = 0; i < NUM_NL80211_BANDS; i++) {
5285 		const struct ieee80211_sta_he_cap *he_cap;
5286 
5287 		if (!default_all_enabled)
5288 			break;
5289 
5290 		sband = rdev->wiphy.bands[i];
5291 
5292 		if (!sband)
5293 			continue;
5294 
5295 		mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
5296 		memcpy(mask->control[i].ht_mcs,
5297 		       sband->ht_cap.mcs.rx_mask,
5298 		       sizeof(mask->control[i].ht_mcs));
5299 
5300 		if (sband->vht_cap.vht_supported) {
5301 			vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
5302 			vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
5303 		}
5304 
5305 		he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype);
5306 		if (!he_cap)
5307 			continue;
5308 
5309 		he_tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap);
5310 		he_build_mcs_mask(he_tx_mcs_map, mask->control[i].he_mcs);
5311 
5312 		mask->control[i].he_gi = 0xFF;
5313 		mask->control[i].he_ltf = 0xFF;
5314 	}
5315 
5316 	/* if no rates are given set it back to the defaults */
5317 	if (!attrs[attr])
5318 		goto out;
5319 
5320 	/* The nested attribute uses enum nl80211_band as the index. This maps
5321 	 * directly to the enum nl80211_band values used in cfg80211.
5322 	 */
5323 	BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
5324 	nla_for_each_nested(tx_rates, attrs[attr], rem) {
5325 		enum nl80211_band band = nla_type(tx_rates);
5326 		int err;
5327 
5328 		if (band < 0 || band >= NUM_NL80211_BANDS)
5329 			return -EINVAL;
5330 		sband = rdev->wiphy.bands[band];
5331 		if (sband == NULL)
5332 			return -EINVAL;
5333 		err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX,
5334 						  tx_rates,
5335 						  nl80211_txattr_policy,
5336 						  info->extack);
5337 		if (err)
5338 			return err;
5339 		if (tb[NL80211_TXRATE_LEGACY]) {
5340 			mask->control[band].legacy = rateset_to_mask(
5341 				sband,
5342 				nla_data(tb[NL80211_TXRATE_LEGACY]),
5343 				nla_len(tb[NL80211_TXRATE_LEGACY]));
5344 			if ((mask->control[band].legacy == 0) &&
5345 			    nla_len(tb[NL80211_TXRATE_LEGACY]))
5346 				return -EINVAL;
5347 		}
5348 		if (tb[NL80211_TXRATE_HT]) {
5349 			if (!ht_rateset_to_mask(
5350 					sband,
5351 					nla_data(tb[NL80211_TXRATE_HT]),
5352 					nla_len(tb[NL80211_TXRATE_HT]),
5353 					mask->control[band].ht_mcs))
5354 				return -EINVAL;
5355 		}
5356 
5357 		if (tb[NL80211_TXRATE_VHT]) {
5358 			if (!vht_set_mcs_mask(
5359 					sband,
5360 					nla_data(tb[NL80211_TXRATE_VHT]),
5361 					mask->control[band].vht_mcs))
5362 				return -EINVAL;
5363 		}
5364 
5365 		if (tb[NL80211_TXRATE_GI]) {
5366 			mask->control[band].gi =
5367 				nla_get_u8(tb[NL80211_TXRATE_GI]);
5368 			if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
5369 				return -EINVAL;
5370 		}
5371 		if (tb[NL80211_TXRATE_HE] &&
5372 		    !he_set_mcs_mask(info, wdev, sband,
5373 				     nla_data(tb[NL80211_TXRATE_HE]),
5374 				     mask->control[band].he_mcs,
5375 				     link_id))
5376 			return -EINVAL;
5377 
5378 		if (tb[NL80211_TXRATE_HE_GI])
5379 			mask->control[band].he_gi =
5380 				nla_get_u8(tb[NL80211_TXRATE_HE_GI]);
5381 		if (tb[NL80211_TXRATE_HE_LTF])
5382 			mask->control[band].he_ltf =
5383 				nla_get_u8(tb[NL80211_TXRATE_HE_LTF]);
5384 
5385 		if (mask->control[band].legacy == 0) {
5386 			/* don't allow empty legacy rates if HT, VHT or HE
5387 			 * are not even supported.
5388 			 */
5389 			if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
5390 			      rdev->wiphy.bands[band]->vht_cap.vht_supported ||
5391 			      ieee80211_get_he_iftype_cap(sband, wdev->iftype)))
5392 				return -EINVAL;
5393 
5394 			for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
5395 				if (mask->control[band].ht_mcs[i])
5396 					goto out;
5397 
5398 			for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
5399 				if (mask->control[band].vht_mcs[i])
5400 					goto out;
5401 
5402 			for (i = 0; i < NL80211_HE_NSS_MAX; i++)
5403 				if (mask->control[band].he_mcs[i])
5404 					goto out;
5405 
5406 			/* legacy and mcs rates may not be both empty */
5407 			return -EINVAL;
5408 		}
5409 	}
5410 
5411 out:
5412 	return 0;
5413 }
5414 
5415 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
5416 				   enum nl80211_band band,
5417 				   struct cfg80211_bitrate_mask *beacon_rate)
5418 {
5419 	u32 count_ht, count_vht, count_he, i;
5420 	u32 rate = beacon_rate->control[band].legacy;
5421 
5422 	/* Allow only one rate */
5423 	if (hweight32(rate) > 1)
5424 		return -EINVAL;
5425 
5426 	count_ht = 0;
5427 	for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
5428 		if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
5429 			return -EINVAL;
5430 		} else if (beacon_rate->control[band].ht_mcs[i]) {
5431 			count_ht++;
5432 			if (count_ht > 1)
5433 				return -EINVAL;
5434 		}
5435 		if (count_ht && rate)
5436 			return -EINVAL;
5437 	}
5438 
5439 	count_vht = 0;
5440 	for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
5441 		if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
5442 			return -EINVAL;
5443 		} else if (beacon_rate->control[band].vht_mcs[i]) {
5444 			count_vht++;
5445 			if (count_vht > 1)
5446 				return -EINVAL;
5447 		}
5448 		if (count_vht && rate)
5449 			return -EINVAL;
5450 	}
5451 
5452 	count_he = 0;
5453 	for (i = 0; i < NL80211_HE_NSS_MAX; i++) {
5454 		if (hweight16(beacon_rate->control[band].he_mcs[i]) > 1) {
5455 			return -EINVAL;
5456 		} else if (beacon_rate->control[band].he_mcs[i]) {
5457 			count_he++;
5458 			if (count_he > 1)
5459 				return -EINVAL;
5460 		}
5461 		if (count_he && rate)
5462 			return -EINVAL;
5463 	}
5464 
5465 	if ((count_ht && count_vht && count_he) ||
5466 	    (!rate && !count_ht && !count_vht && !count_he))
5467 		return -EINVAL;
5468 
5469 	if (rate &&
5470 	    !wiphy_ext_feature_isset(&rdev->wiphy,
5471 				     NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
5472 		return -EINVAL;
5473 	if (count_ht &&
5474 	    !wiphy_ext_feature_isset(&rdev->wiphy,
5475 				     NL80211_EXT_FEATURE_BEACON_RATE_HT))
5476 		return -EINVAL;
5477 	if (count_vht &&
5478 	    !wiphy_ext_feature_isset(&rdev->wiphy,
5479 				     NL80211_EXT_FEATURE_BEACON_RATE_VHT))
5480 		return -EINVAL;
5481 	if (count_he &&
5482 	    !wiphy_ext_feature_isset(&rdev->wiphy,
5483 				     NL80211_EXT_FEATURE_BEACON_RATE_HE))
5484 		return -EINVAL;
5485 
5486 	return 0;
5487 }
5488 
5489 static int nl80211_parse_mbssid_config(struct wiphy *wiphy,
5490 				       struct net_device *dev,
5491 				       struct nlattr *attrs,
5492 				       struct cfg80211_mbssid_config *config,
5493 				       u8 num_elems)
5494 {
5495 	struct nlattr *tb[NL80211_MBSSID_CONFIG_ATTR_MAX + 1];
5496 
5497 	if (!wiphy->mbssid_max_interfaces)
5498 		return -EOPNOTSUPP;
5499 
5500 	if (nla_parse_nested(tb, NL80211_MBSSID_CONFIG_ATTR_MAX, attrs, NULL,
5501 			     NULL) ||
5502 	    !tb[NL80211_MBSSID_CONFIG_ATTR_INDEX])
5503 		return -EINVAL;
5504 
5505 	config->ema = nla_get_flag(tb[NL80211_MBSSID_CONFIG_ATTR_EMA]);
5506 	if (config->ema) {
5507 		if (!wiphy->ema_max_profile_periodicity)
5508 			return -EOPNOTSUPP;
5509 
5510 		if (num_elems > wiphy->ema_max_profile_periodicity)
5511 			return -EINVAL;
5512 	}
5513 
5514 	config->index = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]);
5515 	if (config->index >= wiphy->mbssid_max_interfaces ||
5516 	    (!config->index && !num_elems))
5517 		return -EINVAL;
5518 
5519 	if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]) {
5520 		u32 tx_ifindex =
5521 			nla_get_u32(tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]);
5522 
5523 		if ((!config->index && tx_ifindex != dev->ifindex) ||
5524 		    (config->index && tx_ifindex == dev->ifindex))
5525 			return -EINVAL;
5526 
5527 		if (tx_ifindex != dev->ifindex) {
5528 			struct net_device *tx_netdev =
5529 				dev_get_by_index(wiphy_net(wiphy), tx_ifindex);
5530 
5531 			if (!tx_netdev || !tx_netdev->ieee80211_ptr ||
5532 			    tx_netdev->ieee80211_ptr->wiphy != wiphy ||
5533 			    tx_netdev->ieee80211_ptr->iftype !=
5534 							NL80211_IFTYPE_AP) {
5535 				dev_put(tx_netdev);
5536 				return -EINVAL;
5537 			}
5538 
5539 			config->tx_wdev = tx_netdev->ieee80211_ptr;
5540 		} else {
5541 			config->tx_wdev = dev->ieee80211_ptr;
5542 		}
5543 	} else if (!config->index) {
5544 		config->tx_wdev = dev->ieee80211_ptr;
5545 	} else {
5546 		return -EINVAL;
5547 	}
5548 
5549 	return 0;
5550 }
5551 
5552 static struct cfg80211_mbssid_elems *
5553 nl80211_parse_mbssid_elems(struct wiphy *wiphy, struct nlattr *attrs)
5554 {
5555 	struct nlattr *nl_elems;
5556 	struct cfg80211_mbssid_elems *elems;
5557 	int rem_elems;
5558 	u8 i = 0, num_elems = 0;
5559 
5560 	if (!wiphy->mbssid_max_interfaces)
5561 		return ERR_PTR(-EINVAL);
5562 
5563 	nla_for_each_nested(nl_elems, attrs, rem_elems) {
5564 		if (num_elems >= 255)
5565 			return ERR_PTR(-EINVAL);
5566 		num_elems++;
5567 	}
5568 
5569 	elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL);
5570 	if (!elems)
5571 		return ERR_PTR(-ENOMEM);
5572 	elems->cnt = num_elems;
5573 
5574 	nla_for_each_nested(nl_elems, attrs, rem_elems) {
5575 		elems->elem[i].data = nla_data(nl_elems);
5576 		elems->elem[i].len = nla_len(nl_elems);
5577 		i++;
5578 	}
5579 	return elems;
5580 }
5581 
5582 static struct cfg80211_rnr_elems *
5583 nl80211_parse_rnr_elems(struct wiphy *wiphy, struct nlattr *attrs,
5584 			struct netlink_ext_ack *extack)
5585 {
5586 	struct nlattr *nl_elems;
5587 	struct cfg80211_rnr_elems *elems;
5588 	int rem_elems;
5589 	u8 i = 0, num_elems = 0;
5590 
5591 	nla_for_each_nested(nl_elems, attrs, rem_elems) {
5592 		int ret;
5593 
5594 		ret = validate_ie_attr(nl_elems, extack);
5595 		if (ret)
5596 			return ERR_PTR(ret);
5597 
5598 		num_elems++;
5599 	}
5600 
5601 	elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL);
5602 	if (!elems)
5603 		return ERR_PTR(-ENOMEM);
5604 	elems->cnt = num_elems;
5605 
5606 	nla_for_each_nested(nl_elems, attrs, rem_elems) {
5607 		elems->elem[i].data = nla_data(nl_elems);
5608 		elems->elem[i].len = nla_len(nl_elems);
5609 		i++;
5610 	}
5611 	return elems;
5612 }
5613 
5614 static int nl80211_parse_he_bss_color(struct nlattr *attrs,
5615 				      struct cfg80211_he_bss_color *he_bss_color)
5616 {
5617 	struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1];
5618 	int err;
5619 
5620 	err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs,
5621 			       he_bss_color_policy, NULL);
5622 	if (err)
5623 		return err;
5624 
5625 	if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR])
5626 		return -EINVAL;
5627 
5628 	he_bss_color->color =
5629 		nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]);
5630 	he_bss_color->enabled =
5631 		!nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]);
5632 	he_bss_color->partial =
5633 		nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]);
5634 
5635 	return 0;
5636 }
5637 
5638 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev,
5639 				struct nlattr *attrs[],
5640 				struct cfg80211_beacon_data *bcn,
5641 				struct netlink_ext_ack *extack)
5642 {
5643 	bool haveinfo = false;
5644 	int err;
5645 
5646 	memset(bcn, 0, sizeof(*bcn));
5647 
5648 	bcn->link_id = nl80211_link_id(attrs);
5649 
5650 	if (attrs[NL80211_ATTR_BEACON_HEAD]) {
5651 		bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
5652 		bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
5653 		if (!bcn->head_len)
5654 			return -EINVAL;
5655 		haveinfo = true;
5656 	}
5657 
5658 	if (attrs[NL80211_ATTR_BEACON_TAIL]) {
5659 		bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
5660 		bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
5661 		haveinfo = true;
5662 	}
5663 
5664 	if (!haveinfo)
5665 		return -EINVAL;
5666 
5667 	if (attrs[NL80211_ATTR_IE]) {
5668 		bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
5669 		bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
5670 	}
5671 
5672 	if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
5673 		bcn->proberesp_ies =
5674 			nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
5675 		bcn->proberesp_ies_len =
5676 			nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
5677 	}
5678 
5679 	if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
5680 		bcn->assocresp_ies =
5681 			nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
5682 		bcn->assocresp_ies_len =
5683 			nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
5684 	}
5685 
5686 	if (attrs[NL80211_ATTR_PROBE_RESP]) {
5687 		bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
5688 		bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
5689 	}
5690 
5691 	if (attrs[NL80211_ATTR_FTM_RESPONDER]) {
5692 		struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1];
5693 
5694 		err = nla_parse_nested_deprecated(tb,
5695 						  NL80211_FTM_RESP_ATTR_MAX,
5696 						  attrs[NL80211_ATTR_FTM_RESPONDER],
5697 						  NULL, NULL);
5698 		if (err)
5699 			return err;
5700 
5701 		if (tb[NL80211_FTM_RESP_ATTR_ENABLED] &&
5702 		    wiphy_ext_feature_isset(&rdev->wiphy,
5703 					    NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER))
5704 			bcn->ftm_responder = 1;
5705 		else
5706 			return -EOPNOTSUPP;
5707 
5708 		if (tb[NL80211_FTM_RESP_ATTR_LCI]) {
5709 			bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]);
5710 			bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]);
5711 		}
5712 
5713 		if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) {
5714 			bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
5715 			bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
5716 		}
5717 	} else {
5718 		bcn->ftm_responder = -1;
5719 	}
5720 
5721 	if (attrs[NL80211_ATTR_HE_BSS_COLOR]) {
5722 		err = nl80211_parse_he_bss_color(attrs[NL80211_ATTR_HE_BSS_COLOR],
5723 						 &bcn->he_bss_color);
5724 		if (err)
5725 			return err;
5726 		bcn->he_bss_color_valid = true;
5727 	}
5728 
5729 	if (attrs[NL80211_ATTR_MBSSID_ELEMS]) {
5730 		struct cfg80211_mbssid_elems *mbssid =
5731 			nl80211_parse_mbssid_elems(&rdev->wiphy,
5732 						   attrs[NL80211_ATTR_MBSSID_ELEMS]);
5733 
5734 		if (IS_ERR(mbssid))
5735 			return PTR_ERR(mbssid);
5736 
5737 		bcn->mbssid_ies = mbssid;
5738 
5739 		if (bcn->mbssid_ies && attrs[NL80211_ATTR_EMA_RNR_ELEMS]) {
5740 			struct cfg80211_rnr_elems *rnr =
5741 				nl80211_parse_rnr_elems(&rdev->wiphy,
5742 							attrs[NL80211_ATTR_EMA_RNR_ELEMS],
5743 							extack);
5744 
5745 			if (IS_ERR(rnr))
5746 				return PTR_ERR(rnr);
5747 
5748 			if (rnr && rnr->cnt < bcn->mbssid_ies->cnt)
5749 				return -EINVAL;
5750 
5751 			bcn->rnr_ies = rnr;
5752 		}
5753 	}
5754 
5755 	return 0;
5756 }
5757 
5758 static int nl80211_parse_he_obss_pd(struct nlattr *attrs,
5759 				    struct ieee80211_he_obss_pd *he_obss_pd)
5760 {
5761 	struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1];
5762 	int err;
5763 
5764 	err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs,
5765 			       he_obss_pd_policy, NULL);
5766 	if (err)
5767 		return err;
5768 
5769 	if (!tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL])
5770 		return -EINVAL;
5771 
5772 	he_obss_pd->sr_ctrl = nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]);
5773 
5774 	if (tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET])
5775 		he_obss_pd->min_offset =
5776 			nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]);
5777 	if (tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET])
5778 		he_obss_pd->max_offset =
5779 			nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]);
5780 	if (tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET])
5781 		he_obss_pd->non_srg_max_offset =
5782 			nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]);
5783 
5784 	if (he_obss_pd->min_offset > he_obss_pd->max_offset)
5785 		return -EINVAL;
5786 
5787 	if (tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP])
5788 		memcpy(he_obss_pd->bss_color_bitmap,
5789 		       nla_data(tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]),
5790 		       sizeof(he_obss_pd->bss_color_bitmap));
5791 
5792 	if (tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP])
5793 		memcpy(he_obss_pd->partial_bssid_bitmap,
5794 		       nla_data(tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]),
5795 		       sizeof(he_obss_pd->partial_bssid_bitmap));
5796 
5797 	he_obss_pd->enable = true;
5798 
5799 	return 0;
5800 }
5801 
5802 static int nl80211_parse_fils_discovery(struct cfg80211_registered_device *rdev,
5803 					struct nlattr *attrs,
5804 					struct cfg80211_fils_discovery *fd)
5805 {
5806 	struct nlattr *tb[NL80211_FILS_DISCOVERY_ATTR_MAX + 1];
5807 	int ret;
5808 
5809 	if (!wiphy_ext_feature_isset(&rdev->wiphy,
5810 				     NL80211_EXT_FEATURE_FILS_DISCOVERY))
5811 		return -EINVAL;
5812 
5813 	ret = nla_parse_nested(tb, NL80211_FILS_DISCOVERY_ATTR_MAX, attrs,
5814 			       NULL, NULL);
5815 	if (ret)
5816 		return ret;
5817 
5818 	if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] &&
5819 	    !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] &&
5820 	    !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) {
5821 		fd->update = true;
5822 		return 0;
5823 	}
5824 
5825 	if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] ||
5826 	    !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] ||
5827 	    !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL])
5828 		return -EINVAL;
5829 
5830 	fd->tmpl_len = nla_len(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]);
5831 	fd->tmpl = nla_data(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]);
5832 	fd->min_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN]);
5833 	fd->max_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX]);
5834 	fd->update = true;
5835 	return 0;
5836 }
5837 
5838 static int
5839 nl80211_parse_unsol_bcast_probe_resp(struct cfg80211_registered_device *rdev,
5840 				     struct nlattr *attrs,
5841 				     struct cfg80211_unsol_bcast_probe_resp *presp)
5842 {
5843 	struct nlattr *tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1];
5844 	int ret;
5845 
5846 	if (!wiphy_ext_feature_isset(&rdev->wiphy,
5847 				     NL80211_EXT_FEATURE_UNSOL_BCAST_PROBE_RESP))
5848 		return -EINVAL;
5849 
5850 	ret = nla_parse_nested(tb, NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX,
5851 			       attrs, NULL, NULL);
5852 	if (ret)
5853 		return ret;
5854 
5855 	if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] &&
5856 	    !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) {
5857 		presp->update = true;
5858 		return 0;
5859 	}
5860 
5861 	if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] ||
5862 	    !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL])
5863 		return -EINVAL;
5864 
5865 	presp->tmpl = nla_data(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]);
5866 	presp->tmpl_len = nla_len(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]);
5867 	presp->interval = nla_get_u32(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT]);
5868 	presp->update = true;
5869 	return 0;
5870 }
5871 
5872 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
5873 					    const struct element *rates)
5874 {
5875 	int i;
5876 
5877 	if (!rates)
5878 		return;
5879 
5880 	for (i = 0; i < rates->datalen; i++) {
5881 		if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
5882 			params->ht_required = true;
5883 		if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
5884 			params->vht_required = true;
5885 		if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HE_PHY)
5886 			params->he_required = true;
5887 		if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_SAE_H2E)
5888 			params->sae_h2e_required = true;
5889 	}
5890 }
5891 
5892 /*
5893  * Since the nl80211 API didn't include, from the beginning, attributes about
5894  * HT/VHT requirements/capabilities, we parse them out of the IEs for the
5895  * benefit of drivers that rebuild IEs in the firmware.
5896  */
5897 static int nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
5898 {
5899 	const struct cfg80211_beacon_data *bcn = &params->beacon;
5900 	size_t ies_len = bcn->tail_len;
5901 	const u8 *ies = bcn->tail;
5902 	const struct element *rates;
5903 	const struct element *cap;
5904 
5905 	rates = cfg80211_find_elem(WLAN_EID_SUPP_RATES, ies, ies_len);
5906 	nl80211_check_ap_rate_selectors(params, rates);
5907 
5908 	rates = cfg80211_find_elem(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
5909 	nl80211_check_ap_rate_selectors(params, rates);
5910 
5911 	cap = cfg80211_find_elem(WLAN_EID_HT_CAPABILITY, ies, ies_len);
5912 	if (cap && cap->datalen >= sizeof(*params->ht_cap))
5913 		params->ht_cap = (void *)cap->data;
5914 	cap = cfg80211_find_elem(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
5915 	if (cap && cap->datalen >= sizeof(*params->vht_cap))
5916 		params->vht_cap = (void *)cap->data;
5917 	cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len);
5918 	if (cap && cap->datalen >= sizeof(*params->he_cap) + 1)
5919 		params->he_cap = (void *)(cap->data + 1);
5920 	cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_OPERATION, ies, ies_len);
5921 	if (cap && cap->datalen >= sizeof(*params->he_oper) + 1)
5922 		params->he_oper = (void *)(cap->data + 1);
5923 	cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_CAPABILITY, ies, ies_len);
5924 	if (cap) {
5925 		if (!cap->datalen)
5926 			return -EINVAL;
5927 		params->eht_cap = (void *)(cap->data + 1);
5928 		if (!ieee80211_eht_capa_size_ok((const u8 *)params->he_cap,
5929 						(const u8 *)params->eht_cap,
5930 						cap->datalen - 1, true))
5931 			return -EINVAL;
5932 	}
5933 	cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_OPERATION, ies, ies_len);
5934 	if (cap) {
5935 		if (!cap->datalen)
5936 			return -EINVAL;
5937 		params->eht_oper = (void *)(cap->data + 1);
5938 		if (!ieee80211_eht_oper_size_ok((const u8 *)params->eht_oper,
5939 						cap->datalen - 1))
5940 			return -EINVAL;
5941 	}
5942 	return 0;
5943 }
5944 
5945 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
5946 				   struct cfg80211_ap_settings *params)
5947 {
5948 	struct wireless_dev *wdev;
5949 
5950 	list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
5951 		if (wdev->iftype != NL80211_IFTYPE_AP &&
5952 		    wdev->iftype != NL80211_IFTYPE_P2P_GO)
5953 			continue;
5954 
5955 		if (!wdev->u.ap.preset_chandef.chan)
5956 			continue;
5957 
5958 		params->chandef = wdev->u.ap.preset_chandef;
5959 		return true;
5960 	}
5961 
5962 	return false;
5963 }
5964 
5965 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
5966 				    enum nl80211_auth_type auth_type,
5967 				    enum nl80211_commands cmd)
5968 {
5969 	if (auth_type > NL80211_AUTHTYPE_MAX)
5970 		return false;
5971 
5972 	switch (cmd) {
5973 	case NL80211_CMD_AUTHENTICATE:
5974 		if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
5975 		    auth_type == NL80211_AUTHTYPE_SAE)
5976 			return false;
5977 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
5978 					     NL80211_EXT_FEATURE_FILS_STA) &&
5979 		    (auth_type == NL80211_AUTHTYPE_FILS_SK ||
5980 		     auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
5981 		     auth_type == NL80211_AUTHTYPE_FILS_PK))
5982 			return false;
5983 		return true;
5984 	case NL80211_CMD_CONNECT:
5985 		if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
5986 		    !wiphy_ext_feature_isset(&rdev->wiphy,
5987 					     NL80211_EXT_FEATURE_SAE_OFFLOAD) &&
5988 		    auth_type == NL80211_AUTHTYPE_SAE)
5989 			return false;
5990 
5991 		/* FILS with SK PFS or PK not supported yet */
5992 		if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
5993 		    auth_type == NL80211_AUTHTYPE_FILS_PK)
5994 			return false;
5995 		if (!wiphy_ext_feature_isset(
5996 			    &rdev->wiphy,
5997 			    NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
5998 		    auth_type == NL80211_AUTHTYPE_FILS_SK)
5999 			return false;
6000 		return true;
6001 	case NL80211_CMD_START_AP:
6002 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
6003 					     NL80211_EXT_FEATURE_SAE_OFFLOAD_AP) &&
6004 		    auth_type == NL80211_AUTHTYPE_SAE)
6005 			return false;
6006 		/* FILS not supported yet */
6007 		if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
6008 		    auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
6009 		    auth_type == NL80211_AUTHTYPE_FILS_PK)
6010 			return false;
6011 		return true;
6012 	default:
6013 		return false;
6014 	}
6015 }
6016 
6017 static void nl80211_send_ap_started(struct wireless_dev *wdev,
6018 				    unsigned int link_id)
6019 {
6020 	struct wiphy *wiphy = wdev->wiphy;
6021 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
6022 	struct sk_buff *msg;
6023 	void *hdr;
6024 
6025 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6026 	if (!msg)
6027 		return;
6028 
6029 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_START_AP);
6030 	if (!hdr)
6031 		goto out;
6032 
6033 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
6034 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
6035 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
6036 			      NL80211_ATTR_PAD) ||
6037 	    (wdev->u.ap.ssid_len &&
6038 	     nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len,
6039 		     wdev->u.ap.ssid)) ||
6040 	    (wdev->valid_links &&
6041 	     nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)))
6042 		goto out;
6043 
6044 	genlmsg_end(msg, hdr);
6045 
6046 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
6047 				NL80211_MCGRP_MLME, GFP_KERNEL);
6048 	return;
6049 out:
6050 	nlmsg_free(msg);
6051 }
6052 
6053 static int nl80211_validate_ap_phy_operation(struct cfg80211_ap_settings *params)
6054 {
6055 	struct ieee80211_channel *channel = params->chandef.chan;
6056 
6057 	if ((params->he_cap ||  params->he_oper) &&
6058 	    (channel->flags & IEEE80211_CHAN_NO_HE))
6059 		return -EOPNOTSUPP;
6060 
6061 	if ((params->eht_cap || params->eht_oper) &&
6062 	    (channel->flags & IEEE80211_CHAN_NO_EHT))
6063 		return -EOPNOTSUPP;
6064 
6065 	return 0;
6066 }
6067 
6068 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
6069 {
6070 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6071 	struct cfg80211_beaconing_check_config beacon_check = {};
6072 	unsigned int link_id = nl80211_link_id(info->attrs);
6073 	struct net_device *dev = info->user_ptr[1];
6074 	struct wireless_dev *wdev = dev->ieee80211_ptr;
6075 	struct cfg80211_ap_settings *params;
6076 	int err;
6077 
6078 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
6079 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6080 		return -EOPNOTSUPP;
6081 
6082 	if (!rdev->ops->start_ap)
6083 		return -EOPNOTSUPP;
6084 
6085 	if (wdev->links[link_id].cac_started)
6086 		return -EBUSY;
6087 
6088 	if (wdev->links[link_id].ap.beacon_interval)
6089 		return -EALREADY;
6090 
6091 	/* these are required for START_AP */
6092 	if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
6093 	    !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
6094 	    !info->attrs[NL80211_ATTR_BEACON_HEAD])
6095 		return -EINVAL;
6096 
6097 	if (info->attrs[NL80211_ATTR_SMPS_MODE] &&
6098 	    nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]) != NL80211_SMPS_OFF)
6099 		return -EOPNOTSUPP;
6100 
6101 	params = kzalloc(sizeof(*params), GFP_KERNEL);
6102 	if (!params)
6103 		return -ENOMEM;
6104 
6105 	err = nl80211_parse_beacon(rdev, info->attrs, &params->beacon,
6106 				   info->extack);
6107 	if (err)
6108 		goto out;
6109 
6110 	params->beacon_interval =
6111 		nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
6112 	params->dtim_period =
6113 		nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
6114 
6115 	err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
6116 					   params->beacon_interval);
6117 	if (err)
6118 		goto out;
6119 
6120 	/*
6121 	 * In theory, some of these attributes should be required here
6122 	 * but since they were not used when the command was originally
6123 	 * added, keep them optional for old user space programs to let
6124 	 * them continue to work with drivers that do not need the
6125 	 * additional information -- drivers must check!
6126 	 */
6127 	if (info->attrs[NL80211_ATTR_SSID]) {
6128 		params->ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
6129 		params->ssid_len =
6130 			nla_len(info->attrs[NL80211_ATTR_SSID]);
6131 		if (params->ssid_len == 0) {
6132 			err = -EINVAL;
6133 			goto out;
6134 		}
6135 
6136 		if (wdev->u.ap.ssid_len &&
6137 		    (wdev->u.ap.ssid_len != params->ssid_len ||
6138 		     memcmp(wdev->u.ap.ssid, params->ssid, params->ssid_len))) {
6139 			/* require identical SSID for MLO */
6140 			err = -EINVAL;
6141 			goto out;
6142 		}
6143 	} else if (wdev->valid_links) {
6144 		/* require SSID for MLO */
6145 		err = -EINVAL;
6146 		goto out;
6147 	}
6148 
6149 	if (info->attrs[NL80211_ATTR_HIDDEN_SSID])
6150 		params->hidden_ssid = nla_get_u32(
6151 			info->attrs[NL80211_ATTR_HIDDEN_SSID]);
6152 
6153 	params->privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
6154 
6155 	if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
6156 		params->auth_type = nla_get_u32(
6157 			info->attrs[NL80211_ATTR_AUTH_TYPE]);
6158 		if (!nl80211_valid_auth_type(rdev, params->auth_type,
6159 					     NL80211_CMD_START_AP)) {
6160 			err = -EINVAL;
6161 			goto out;
6162 		}
6163 	} else
6164 		params->auth_type = NL80211_AUTHTYPE_AUTOMATIC;
6165 
6166 	err = nl80211_crypto_settings(rdev, info, &params->crypto,
6167 				      NL80211_MAX_NR_CIPHER_SUITES);
6168 	if (err)
6169 		goto out;
6170 
6171 	if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
6172 		if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER)) {
6173 			err = -EOPNOTSUPP;
6174 			goto out;
6175 		}
6176 		params->inactivity_timeout = nla_get_u16(
6177 			info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
6178 	}
6179 
6180 	if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
6181 		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
6182 			err = -EINVAL;
6183 			goto out;
6184 		}
6185 		params->p2p_ctwindow =
6186 			nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
6187 		if (params->p2p_ctwindow != 0 &&
6188 		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) {
6189 			err = -EINVAL;
6190 			goto out;
6191 		}
6192 	}
6193 
6194 	if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
6195 		u8 tmp;
6196 
6197 		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
6198 			err = -EINVAL;
6199 			goto out;
6200 		}
6201 		tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
6202 		params->p2p_opp_ps = tmp;
6203 		if (params->p2p_opp_ps != 0 &&
6204 		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) {
6205 			err = -EINVAL;
6206 			goto out;
6207 		}
6208 	}
6209 
6210 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
6211 		err = nl80211_parse_chandef(rdev, info, &params->chandef);
6212 		if (err)
6213 			goto out;
6214 	} else if (wdev->valid_links) {
6215 		/* with MLD need to specify the channel configuration */
6216 		err = -EINVAL;
6217 		goto out;
6218 	} else if (wdev->u.ap.preset_chandef.chan) {
6219 		params->chandef = wdev->u.ap.preset_chandef;
6220 	} else if (!nl80211_get_ap_channel(rdev, params)) {
6221 		err = -EINVAL;
6222 		goto out;
6223 	}
6224 
6225 	beacon_check.iftype = wdev->iftype;
6226 	beacon_check.relax = true;
6227 	beacon_check.reg_power =
6228 		cfg80211_get_6ghz_power_type(params->beacon.tail,
6229 					     params->beacon.tail_len);
6230 	if (!cfg80211_reg_check_beaconing(&rdev->wiphy, &params->chandef,
6231 					  &beacon_check)) {
6232 		err = -EINVAL;
6233 		goto out;
6234 	}
6235 
6236 	if (info->attrs[NL80211_ATTR_TX_RATES]) {
6237 		err = nl80211_parse_tx_bitrate_mask(info, info->attrs,
6238 						    NL80211_ATTR_TX_RATES,
6239 						    &params->beacon_rate,
6240 						    dev, false, link_id);
6241 		if (err)
6242 			goto out;
6243 
6244 		err = validate_beacon_tx_rate(rdev, params->chandef.chan->band,
6245 					      &params->beacon_rate);
6246 		if (err)
6247 			goto out;
6248 	}
6249 
6250 	params->pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
6251 	if (params->pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
6252 		err = -EOPNOTSUPP;
6253 		goto out;
6254 	}
6255 
6256 	if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
6257 		params->acl = parse_acl_data(&rdev->wiphy, info);
6258 		if (IS_ERR(params->acl)) {
6259 			err = PTR_ERR(params->acl);
6260 			params->acl = NULL;
6261 			goto out;
6262 		}
6263 	}
6264 
6265 	params->twt_responder =
6266 		    nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]);
6267 
6268 	if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) {
6269 		err = nl80211_parse_he_obss_pd(
6270 					info->attrs[NL80211_ATTR_HE_OBSS_PD],
6271 					&params->he_obss_pd);
6272 		if (err)
6273 			goto out;
6274 	}
6275 
6276 	if (info->attrs[NL80211_ATTR_FILS_DISCOVERY]) {
6277 		err = nl80211_parse_fils_discovery(rdev,
6278 						   info->attrs[NL80211_ATTR_FILS_DISCOVERY],
6279 						   &params->fils_discovery);
6280 		if (err)
6281 			goto out;
6282 	}
6283 
6284 	if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) {
6285 		err = nl80211_parse_unsol_bcast_probe_resp(
6286 			rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP],
6287 			&params->unsol_bcast_probe_resp);
6288 		if (err)
6289 			goto out;
6290 	}
6291 
6292 	if (info->attrs[NL80211_ATTR_MBSSID_CONFIG]) {
6293 		err = nl80211_parse_mbssid_config(&rdev->wiphy, dev,
6294 						  info->attrs[NL80211_ATTR_MBSSID_CONFIG],
6295 						  &params->mbssid_config,
6296 						  params->beacon.mbssid_ies ?
6297 							params->beacon.mbssid_ies->cnt :
6298 							0);
6299 		if (err)
6300 			goto out;
6301 	}
6302 
6303 	if (!params->mbssid_config.ema && params->beacon.rnr_ies) {
6304 		err = -EINVAL;
6305 		goto out;
6306 	}
6307 
6308 	err = nl80211_calculate_ap_params(params);
6309 	if (err)
6310 		goto out;
6311 
6312 	err = nl80211_validate_ap_phy_operation(params);
6313 	if (err)
6314 		goto out;
6315 
6316 	if (info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS])
6317 		params->flags = nla_get_u32(
6318 			info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]);
6319 	else if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])
6320 		params->flags |= NL80211_AP_SETTINGS_EXTERNAL_AUTH_SUPPORT;
6321 
6322 	if (wdev->conn_owner_nlportid &&
6323 	    info->attrs[NL80211_ATTR_SOCKET_OWNER] &&
6324 	    wdev->conn_owner_nlportid != info->snd_portid) {
6325 		err = -EINVAL;
6326 		goto out;
6327 	}
6328 
6329 	/* FIXME: validate MLO/link-id against driver capabilities */
6330 
6331 	err = rdev_start_ap(rdev, dev, params);
6332 	if (!err) {
6333 		wdev->links[link_id].ap.beacon_interval = params->beacon_interval;
6334 		wdev->links[link_id].ap.chandef = params->chandef;
6335 		wdev->u.ap.ssid_len = params->ssid_len;
6336 		memcpy(wdev->u.ap.ssid, params->ssid,
6337 		       params->ssid_len);
6338 
6339 		if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
6340 			wdev->conn_owner_nlportid = info->snd_portid;
6341 
6342 		nl80211_send_ap_started(wdev, link_id);
6343 	}
6344 out:
6345 	kfree(params->acl);
6346 	kfree(params->beacon.mbssid_ies);
6347 	if (params->mbssid_config.tx_wdev &&
6348 	    params->mbssid_config.tx_wdev->netdev &&
6349 	    params->mbssid_config.tx_wdev->netdev != dev)
6350 		dev_put(params->mbssid_config.tx_wdev->netdev);
6351 	kfree(params->beacon.rnr_ies);
6352 	kfree(params);
6353 
6354 	return err;
6355 }
6356 
6357 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
6358 {
6359 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6360 	struct cfg80211_beaconing_check_config beacon_check = {};
6361 	unsigned int link_id = nl80211_link_id(info->attrs);
6362 	struct net_device *dev = info->user_ptr[1];
6363 	struct wireless_dev *wdev = dev->ieee80211_ptr;
6364 	struct cfg80211_ap_update *params;
6365 	struct nlattr *attr;
6366 	int err;
6367 
6368 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
6369 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6370 		return -EOPNOTSUPP;
6371 
6372 	if (!rdev->ops->change_beacon)
6373 		return -EOPNOTSUPP;
6374 
6375 	if (!wdev->links[link_id].ap.beacon_interval)
6376 		return -EINVAL;
6377 
6378 	params = kzalloc(sizeof(*params), GFP_KERNEL);
6379 	if (!params)
6380 		return -ENOMEM;
6381 
6382 	err = nl80211_parse_beacon(rdev, info->attrs, &params->beacon,
6383 				   info->extack);
6384 	if (err)
6385 		goto out;
6386 
6387 	/* recheck beaconing is permitted with possibly changed power type */
6388 	beacon_check.iftype = wdev->iftype;
6389 	beacon_check.relax = true;
6390 	beacon_check.reg_power =
6391 		cfg80211_get_6ghz_power_type(params->beacon.tail,
6392 					     params->beacon.tail_len);
6393 	if (!cfg80211_reg_check_beaconing(&rdev->wiphy,
6394 					  &wdev->links[link_id].ap.chandef,
6395 					  &beacon_check)) {
6396 		err = -EINVAL;
6397 		goto out;
6398 	}
6399 
6400 	attr = info->attrs[NL80211_ATTR_FILS_DISCOVERY];
6401 	if (attr) {
6402 		err = nl80211_parse_fils_discovery(rdev, attr,
6403 						   &params->fils_discovery);
6404 		if (err)
6405 			goto out;
6406 	}
6407 
6408 	attr = info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP];
6409 	if (attr) {
6410 		err = nl80211_parse_unsol_bcast_probe_resp(rdev, attr,
6411 							   &params->unsol_bcast_probe_resp);
6412 		if (err)
6413 			goto out;
6414 	}
6415 
6416 	err = rdev_change_beacon(rdev, dev, params);
6417 
6418 out:
6419 	kfree(params->beacon.mbssid_ies);
6420 	kfree(params->beacon.rnr_ies);
6421 	kfree(params);
6422 	return err;
6423 }
6424 
6425 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
6426 {
6427 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6428 	unsigned int link_id = nl80211_link_id(info->attrs);
6429 	struct net_device *dev = info->user_ptr[1];
6430 
6431 	return cfg80211_stop_ap(rdev, dev, link_id, false);
6432 }
6433 
6434 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
6435 	[NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
6436 	[NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
6437 	[NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
6438 	[NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
6439 	[NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
6440 	[NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
6441 };
6442 
6443 static int parse_station_flags(struct genl_info *info,
6444 			       enum nl80211_iftype iftype,
6445 			       struct station_parameters *params)
6446 {
6447 	struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
6448 	struct nlattr *nla;
6449 	int flag;
6450 
6451 	/*
6452 	 * Try parsing the new attribute first so userspace
6453 	 * can specify both for older kernels.
6454 	 */
6455 	nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
6456 	if (nla) {
6457 		struct nl80211_sta_flag_update *sta_flags;
6458 
6459 		sta_flags = nla_data(nla);
6460 		params->sta_flags_mask = sta_flags->mask;
6461 		params->sta_flags_set = sta_flags->set;
6462 		params->sta_flags_set &= params->sta_flags_mask;
6463 		if ((params->sta_flags_mask |
6464 		     params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
6465 			return -EINVAL;
6466 		return 0;
6467 	}
6468 
6469 	/* if present, parse the old attribute */
6470 
6471 	nla = info->attrs[NL80211_ATTR_STA_FLAGS];
6472 	if (!nla)
6473 		return 0;
6474 
6475 	if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack))
6476 		return -EINVAL;
6477 
6478 	/*
6479 	 * Only allow certain flags for interface types so that
6480 	 * other attributes are silently ignored. Remember that
6481 	 * this is backward compatibility code with old userspace
6482 	 * and shouldn't be hit in other cases anyway.
6483 	 */
6484 	switch (iftype) {
6485 	case NL80211_IFTYPE_AP:
6486 	case NL80211_IFTYPE_AP_VLAN:
6487 	case NL80211_IFTYPE_P2P_GO:
6488 		params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
6489 					 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
6490 					 BIT(NL80211_STA_FLAG_WME) |
6491 					 BIT(NL80211_STA_FLAG_MFP);
6492 		break;
6493 	case NL80211_IFTYPE_P2P_CLIENT:
6494 	case NL80211_IFTYPE_STATION:
6495 		params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
6496 					 BIT(NL80211_STA_FLAG_TDLS_PEER);
6497 		break;
6498 	case NL80211_IFTYPE_MESH_POINT:
6499 		params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
6500 					 BIT(NL80211_STA_FLAG_MFP) |
6501 					 BIT(NL80211_STA_FLAG_AUTHORIZED);
6502 		break;
6503 	default:
6504 		return -EINVAL;
6505 	}
6506 
6507 	for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
6508 		if (flags[flag]) {
6509 			params->sta_flags_set |= (1<<flag);
6510 
6511 			/* no longer support new API additions in old API */
6512 			if (flag > NL80211_STA_FLAG_MAX_OLD_API)
6513 				return -EINVAL;
6514 		}
6515 	}
6516 
6517 	return 0;
6518 }
6519 
6520 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr)
6521 {
6522 	struct nlattr *rate;
6523 	u32 bitrate;
6524 	u16 bitrate_compat;
6525 	enum nl80211_rate_info rate_flg;
6526 
6527 	rate = nla_nest_start_noflag(msg, attr);
6528 	if (!rate)
6529 		return false;
6530 
6531 	/* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
6532 	bitrate = cfg80211_calculate_bitrate(info);
6533 	/* report 16-bit bitrate only if we can */
6534 	bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
6535 	if (bitrate > 0 &&
6536 	    nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
6537 		return false;
6538 	if (bitrate_compat > 0 &&
6539 	    nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
6540 		return false;
6541 
6542 	switch (info->bw) {
6543 	case RATE_INFO_BW_1:
6544 		rate_flg = NL80211_RATE_INFO_1_MHZ_WIDTH;
6545 		break;
6546 	case RATE_INFO_BW_2:
6547 		rate_flg = NL80211_RATE_INFO_2_MHZ_WIDTH;
6548 		break;
6549 	case RATE_INFO_BW_4:
6550 		rate_flg = NL80211_RATE_INFO_4_MHZ_WIDTH;
6551 		break;
6552 	case RATE_INFO_BW_5:
6553 		rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
6554 		break;
6555 	case RATE_INFO_BW_8:
6556 		rate_flg = NL80211_RATE_INFO_8_MHZ_WIDTH;
6557 		break;
6558 	case RATE_INFO_BW_10:
6559 		rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
6560 		break;
6561 	case RATE_INFO_BW_16:
6562 		rate_flg = NL80211_RATE_INFO_16_MHZ_WIDTH;
6563 		break;
6564 	default:
6565 		WARN_ON(1);
6566 		fallthrough;
6567 	case RATE_INFO_BW_20:
6568 		rate_flg = 0;
6569 		break;
6570 	case RATE_INFO_BW_40:
6571 		rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
6572 		break;
6573 	case RATE_INFO_BW_80:
6574 		rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
6575 		break;
6576 	case RATE_INFO_BW_160:
6577 		rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
6578 		break;
6579 	case RATE_INFO_BW_HE_RU:
6580 		rate_flg = 0;
6581 		WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS));
6582 		break;
6583 	case RATE_INFO_BW_320:
6584 		rate_flg = NL80211_RATE_INFO_320_MHZ_WIDTH;
6585 		break;
6586 	case RATE_INFO_BW_EHT_RU:
6587 		rate_flg = 0;
6588 		WARN_ON(!(info->flags & RATE_INFO_FLAGS_EHT_MCS));
6589 		break;
6590 	}
6591 
6592 	if (rate_flg && nla_put_flag(msg, rate_flg))
6593 		return false;
6594 
6595 	if (info->flags & RATE_INFO_FLAGS_MCS) {
6596 		if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
6597 			return false;
6598 		if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
6599 		    nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
6600 			return false;
6601 	} else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
6602 		if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
6603 			return false;
6604 		if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
6605 			return false;
6606 		if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
6607 		    nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
6608 			return false;
6609 	} else if (info->flags & RATE_INFO_FLAGS_HE_MCS) {
6610 		if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs))
6611 			return false;
6612 		if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss))
6613 			return false;
6614 		if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi))
6615 			return false;
6616 		if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm))
6617 			return false;
6618 		if (info->bw == RATE_INFO_BW_HE_RU &&
6619 		    nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC,
6620 			       info->he_ru_alloc))
6621 			return false;
6622 	} else if (info->flags & RATE_INFO_FLAGS_S1G_MCS) {
6623 		if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_MCS, info->mcs))
6624 			return false;
6625 		if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_NSS, info->nss))
6626 			return false;
6627 		if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
6628 		    nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
6629 			return false;
6630 	} else if (info->flags & RATE_INFO_FLAGS_EHT_MCS) {
6631 		if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_MCS, info->mcs))
6632 			return false;
6633 		if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_NSS, info->nss))
6634 			return false;
6635 		if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_GI, info->eht_gi))
6636 			return false;
6637 		if (info->bw == RATE_INFO_BW_EHT_RU &&
6638 		    nla_put_u8(msg, NL80211_RATE_INFO_EHT_RU_ALLOC,
6639 			       info->eht_ru_alloc))
6640 			return false;
6641 	}
6642 
6643 	nla_nest_end(msg, rate);
6644 	return true;
6645 }
6646 
6647 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
6648 			       int id)
6649 {
6650 	void *attr;
6651 	int i = 0;
6652 
6653 	if (!mask)
6654 		return true;
6655 
6656 	attr = nla_nest_start_noflag(msg, id);
6657 	if (!attr)
6658 		return false;
6659 
6660 	for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
6661 		if (!(mask & BIT(i)))
6662 			continue;
6663 
6664 		if (nla_put_u8(msg, i, signal[i]))
6665 			return false;
6666 	}
6667 
6668 	nla_nest_end(msg, attr);
6669 
6670 	return true;
6671 }
6672 
6673 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
6674 				u32 seq, int flags,
6675 				struct cfg80211_registered_device *rdev,
6676 				struct net_device *dev,
6677 				const u8 *mac_addr, struct station_info *sinfo)
6678 {
6679 	void *hdr;
6680 	struct nlattr *sinfoattr, *bss_param;
6681 
6682 	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
6683 	if (!hdr) {
6684 		cfg80211_sinfo_release_content(sinfo);
6685 		return -1;
6686 	}
6687 
6688 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
6689 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
6690 	    nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
6691 		goto nla_put_failure;
6692 
6693 	sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO);
6694 	if (!sinfoattr)
6695 		goto nla_put_failure;
6696 
6697 #define PUT_SINFO(attr, memb, type) do {				\
6698 	BUILD_BUG_ON(sizeof(type) == sizeof(u64));			\
6699 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) &&	\
6700 	    nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr,		\
6701 			     sinfo->memb))				\
6702 		goto nla_put_failure;					\
6703 	} while (0)
6704 #define PUT_SINFO_U64(attr, memb) do {					\
6705 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) &&	\
6706 	    nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr,		\
6707 			      sinfo->memb, NL80211_STA_INFO_PAD))	\
6708 		goto nla_put_failure;					\
6709 	} while (0)
6710 
6711 	PUT_SINFO(CONNECTED_TIME, connected_time, u32);
6712 	PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
6713 	PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at);
6714 
6715 	if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) |
6716 			     BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) &&
6717 	    nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
6718 			(u32)sinfo->rx_bytes))
6719 		goto nla_put_failure;
6720 
6721 	if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) |
6722 			     BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) &&
6723 	    nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
6724 			(u32)sinfo->tx_bytes))
6725 		goto nla_put_failure;
6726 
6727 	PUT_SINFO_U64(RX_BYTES64, rx_bytes);
6728 	PUT_SINFO_U64(TX_BYTES64, tx_bytes);
6729 	PUT_SINFO(LLID, llid, u16);
6730 	PUT_SINFO(PLID, plid, u16);
6731 	PUT_SINFO(PLINK_STATE, plink_state, u8);
6732 	PUT_SINFO_U64(RX_DURATION, rx_duration);
6733 	PUT_SINFO_U64(TX_DURATION, tx_duration);
6734 
6735 	if (wiphy_ext_feature_isset(&rdev->wiphy,
6736 				    NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
6737 		PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16);
6738 
6739 	switch (rdev->wiphy.signal_type) {
6740 	case CFG80211_SIGNAL_TYPE_MBM:
6741 		PUT_SINFO(SIGNAL, signal, u8);
6742 		PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
6743 		break;
6744 	default:
6745 		break;
6746 	}
6747 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) {
6748 		if (!nl80211_put_signal(msg, sinfo->chains,
6749 					sinfo->chain_signal,
6750 					NL80211_STA_INFO_CHAIN_SIGNAL))
6751 			goto nla_put_failure;
6752 	}
6753 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
6754 		if (!nl80211_put_signal(msg, sinfo->chains,
6755 					sinfo->chain_signal_avg,
6756 					NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
6757 			goto nla_put_failure;
6758 	}
6759 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) {
6760 		if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
6761 					  NL80211_STA_INFO_TX_BITRATE))
6762 			goto nla_put_failure;
6763 	}
6764 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) {
6765 		if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
6766 					  NL80211_STA_INFO_RX_BITRATE))
6767 			goto nla_put_failure;
6768 	}
6769 
6770 	PUT_SINFO(RX_PACKETS, rx_packets, u32);
6771 	PUT_SINFO(TX_PACKETS, tx_packets, u32);
6772 	PUT_SINFO(TX_RETRIES, tx_retries, u32);
6773 	PUT_SINFO(TX_FAILED, tx_failed, u32);
6774 	PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
6775 	PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32);
6776 	PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
6777 	PUT_SINFO(LOCAL_PM, local_pm, u32);
6778 	PUT_SINFO(PEER_PM, peer_pm, u32);
6779 	PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
6780 	PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8);
6781 	PUT_SINFO(CONNECTED_TO_AS, connected_to_as, u8);
6782 
6783 	if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) {
6784 		bss_param = nla_nest_start_noflag(msg,
6785 						  NL80211_STA_INFO_BSS_PARAM);
6786 		if (!bss_param)
6787 			goto nla_put_failure;
6788 
6789 		if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
6790 		     nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
6791 		    ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
6792 		     nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
6793 		    ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
6794 		     nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
6795 		    nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
6796 			       sinfo->bss_param.dtim_period) ||
6797 		    nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
6798 				sinfo->bss_param.beacon_interval))
6799 			goto nla_put_failure;
6800 
6801 		nla_nest_end(msg, bss_param);
6802 	}
6803 	if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) &&
6804 	    nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
6805 		    sizeof(struct nl80211_sta_flag_update),
6806 		    &sinfo->sta_flags))
6807 		goto nla_put_failure;
6808 
6809 	PUT_SINFO_U64(T_OFFSET, t_offset);
6810 	PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
6811 	PUT_SINFO_U64(BEACON_RX, rx_beacon);
6812 	PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
6813 	PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32);
6814 	PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32);
6815 	if (wiphy_ext_feature_isset(&rdev->wiphy,
6816 				    NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) {
6817 		PUT_SINFO(ACK_SIGNAL, ack_signal, u8);
6818 		PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8);
6819 	}
6820 
6821 #undef PUT_SINFO
6822 #undef PUT_SINFO_U64
6823 
6824 	if (sinfo->pertid) {
6825 		struct nlattr *tidsattr;
6826 		int tid;
6827 
6828 		tidsattr = nla_nest_start_noflag(msg,
6829 						 NL80211_STA_INFO_TID_STATS);
6830 		if (!tidsattr)
6831 			goto nla_put_failure;
6832 
6833 		for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
6834 			struct cfg80211_tid_stats *tidstats;
6835 			struct nlattr *tidattr;
6836 
6837 			tidstats = &sinfo->pertid[tid];
6838 
6839 			if (!tidstats->filled)
6840 				continue;
6841 
6842 			tidattr = nla_nest_start_noflag(msg, tid + 1);
6843 			if (!tidattr)
6844 				goto nla_put_failure;
6845 
6846 #define PUT_TIDVAL_U64(attr, memb) do {					\
6847 	if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) &&	\
6848 	    nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr,		\
6849 			      tidstats->memb, NL80211_TID_STATS_PAD))	\
6850 		goto nla_put_failure;					\
6851 	} while (0)
6852 
6853 			PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
6854 			PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
6855 			PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
6856 			PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
6857 
6858 #undef PUT_TIDVAL_U64
6859 			if ((tidstats->filled &
6860 			     BIT(NL80211_TID_STATS_TXQ_STATS)) &&
6861 			    !nl80211_put_txq_stats(msg, &tidstats->txq_stats,
6862 						   NL80211_TID_STATS_TXQ_STATS))
6863 				goto nla_put_failure;
6864 
6865 			nla_nest_end(msg, tidattr);
6866 		}
6867 
6868 		nla_nest_end(msg, tidsattr);
6869 	}
6870 
6871 	nla_nest_end(msg, sinfoattr);
6872 
6873 	if (sinfo->assoc_req_ies_len &&
6874 	    nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
6875 		    sinfo->assoc_req_ies))
6876 		goto nla_put_failure;
6877 
6878 	if (sinfo->assoc_resp_ies_len &&
6879 	    nla_put(msg, NL80211_ATTR_RESP_IE, sinfo->assoc_resp_ies_len,
6880 		    sinfo->assoc_resp_ies))
6881 		goto nla_put_failure;
6882 
6883 	if (sinfo->mlo_params_valid) {
6884 		if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID,
6885 			       sinfo->assoc_link_id))
6886 			goto nla_put_failure;
6887 
6888 		if (!is_zero_ether_addr(sinfo->mld_addr) &&
6889 		    nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN,
6890 			    sinfo->mld_addr))
6891 			goto nla_put_failure;
6892 	}
6893 
6894 	cfg80211_sinfo_release_content(sinfo);
6895 	genlmsg_end(msg, hdr);
6896 	return 0;
6897 
6898  nla_put_failure:
6899 	cfg80211_sinfo_release_content(sinfo);
6900 	genlmsg_cancel(msg, hdr);
6901 	return -EMSGSIZE;
6902 }
6903 
6904 static int nl80211_dump_station(struct sk_buff *skb,
6905 				struct netlink_callback *cb)
6906 {
6907 	struct station_info sinfo;
6908 	struct cfg80211_registered_device *rdev;
6909 	struct wireless_dev *wdev;
6910 	u8 mac_addr[ETH_ALEN];
6911 	int sta_idx = cb->args[2];
6912 	int err;
6913 
6914 	err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL);
6915 	if (err)
6916 		return err;
6917 	/* nl80211_prepare_wdev_dump acquired it in the successful case */
6918 	__acquire(&rdev->wiphy.mtx);
6919 
6920 	if (!wdev->netdev) {
6921 		err = -EINVAL;
6922 		goto out_err;
6923 	}
6924 
6925 	if (!rdev->ops->dump_station) {
6926 		err = -EOPNOTSUPP;
6927 		goto out_err;
6928 	}
6929 
6930 	while (1) {
6931 		memset(&sinfo, 0, sizeof(sinfo));
6932 		err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
6933 					mac_addr, &sinfo);
6934 		if (err == -ENOENT)
6935 			break;
6936 		if (err)
6937 			goto out_err;
6938 
6939 		if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
6940 				NETLINK_CB(cb->skb).portid,
6941 				cb->nlh->nlmsg_seq, NLM_F_MULTI,
6942 				rdev, wdev->netdev, mac_addr,
6943 				&sinfo) < 0)
6944 			goto out;
6945 
6946 		sta_idx++;
6947 	}
6948 
6949  out:
6950 	cb->args[2] = sta_idx;
6951 	err = skb->len;
6952  out_err:
6953 	wiphy_unlock(&rdev->wiphy);
6954 
6955 	return err;
6956 }
6957 
6958 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
6959 {
6960 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
6961 	struct net_device *dev = info->user_ptr[1];
6962 	struct station_info sinfo;
6963 	struct sk_buff *msg;
6964 	u8 *mac_addr = NULL;
6965 	int err;
6966 
6967 	memset(&sinfo, 0, sizeof(sinfo));
6968 
6969 	if (!info->attrs[NL80211_ATTR_MAC])
6970 		return -EINVAL;
6971 
6972 	mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
6973 
6974 	if (!rdev->ops->get_station)
6975 		return -EOPNOTSUPP;
6976 
6977 	err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
6978 	if (err)
6979 		return err;
6980 
6981 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6982 	if (!msg) {
6983 		cfg80211_sinfo_release_content(&sinfo);
6984 		return -ENOMEM;
6985 	}
6986 
6987 	if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
6988 				 info->snd_portid, info->snd_seq, 0,
6989 				 rdev, dev, mac_addr, &sinfo) < 0) {
6990 		nlmsg_free(msg);
6991 		return -ENOBUFS;
6992 	}
6993 
6994 	return genlmsg_reply(msg, info);
6995 }
6996 
6997 int cfg80211_check_station_change(struct wiphy *wiphy,
6998 				  struct station_parameters *params,
6999 				  enum cfg80211_station_type statype)
7000 {
7001 	if (params->listen_interval != -1 &&
7002 	    statype != CFG80211_STA_AP_CLIENT_UNASSOC)
7003 		return -EINVAL;
7004 
7005 	if (params->support_p2p_ps != -1 &&
7006 	    statype != CFG80211_STA_AP_CLIENT_UNASSOC)
7007 		return -EINVAL;
7008 
7009 	if (params->aid &&
7010 	    !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
7011 	    statype != CFG80211_STA_AP_CLIENT_UNASSOC)
7012 		return -EINVAL;
7013 
7014 	/* When you run into this, adjust the code below for the new flag */
7015 	BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8);
7016 
7017 	switch (statype) {
7018 	case CFG80211_STA_MESH_PEER_KERNEL:
7019 	case CFG80211_STA_MESH_PEER_USER:
7020 		/*
7021 		 * No ignoring the TDLS flag here -- the userspace mesh
7022 		 * code doesn't have the bug of including TDLS in the
7023 		 * mask everywhere.
7024 		 */
7025 		if (params->sta_flags_mask &
7026 				~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
7027 				  BIT(NL80211_STA_FLAG_MFP) |
7028 				  BIT(NL80211_STA_FLAG_AUTHORIZED)))
7029 			return -EINVAL;
7030 		break;
7031 	case CFG80211_STA_TDLS_PEER_SETUP:
7032 	case CFG80211_STA_TDLS_PEER_ACTIVE:
7033 		if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
7034 			return -EINVAL;
7035 		/* ignore since it can't change */
7036 		params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
7037 		break;
7038 	default:
7039 		/* disallow mesh-specific things */
7040 		if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
7041 			return -EINVAL;
7042 		if (params->local_pm)
7043 			return -EINVAL;
7044 		if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
7045 			return -EINVAL;
7046 	}
7047 
7048 	if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
7049 	    statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
7050 		/* TDLS can't be set, ... */
7051 		if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
7052 			return -EINVAL;
7053 		/*
7054 		 * ... but don't bother the driver with it. This works around
7055 		 * a hostapd/wpa_supplicant issue -- it always includes the
7056 		 * TLDS_PEER flag in the mask even for AP mode.
7057 		 */
7058 		params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
7059 	}
7060 
7061 	if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
7062 	    statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
7063 		/* reject other things that can't change */
7064 		if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
7065 			return -EINVAL;
7066 		if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
7067 			return -EINVAL;
7068 		if (params->link_sta_params.supported_rates)
7069 			return -EINVAL;
7070 		if (params->ext_capab || params->link_sta_params.ht_capa ||
7071 		    params->link_sta_params.vht_capa ||
7072 		    params->link_sta_params.he_capa ||
7073 		    params->link_sta_params.eht_capa)
7074 			return -EINVAL;
7075 		if (params->sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU))
7076 			return -EINVAL;
7077 	}
7078 
7079 	if (statype != CFG80211_STA_AP_CLIENT &&
7080 	    statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
7081 		if (params->vlan)
7082 			return -EINVAL;
7083 	}
7084 
7085 	switch (statype) {
7086 	case CFG80211_STA_AP_MLME_CLIENT:
7087 		/* Use this only for authorizing/unauthorizing a station */
7088 		if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
7089 			return -EOPNOTSUPP;
7090 		break;
7091 	case CFG80211_STA_AP_CLIENT:
7092 	case CFG80211_STA_AP_CLIENT_UNASSOC:
7093 		/* accept only the listed bits */
7094 		if (params->sta_flags_mask &
7095 				~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
7096 				  BIT(NL80211_STA_FLAG_AUTHENTICATED) |
7097 				  BIT(NL80211_STA_FLAG_ASSOCIATED) |
7098 				  BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
7099 				  BIT(NL80211_STA_FLAG_WME) |
7100 				  BIT(NL80211_STA_FLAG_MFP) |
7101 				  BIT(NL80211_STA_FLAG_SPP_AMSDU)))
7102 			return -EINVAL;
7103 
7104 		/* but authenticated/associated only if driver handles it */
7105 		if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
7106 		    params->sta_flags_mask &
7107 				(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
7108 				 BIT(NL80211_STA_FLAG_ASSOCIATED)))
7109 			return -EINVAL;
7110 		break;
7111 	case CFG80211_STA_IBSS:
7112 	case CFG80211_STA_AP_STA:
7113 		/* reject any changes other than AUTHORIZED */
7114 		if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
7115 			return -EINVAL;
7116 		break;
7117 	case CFG80211_STA_TDLS_PEER_SETUP:
7118 		/* reject any changes other than AUTHORIZED or WME */
7119 		if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
7120 					       BIT(NL80211_STA_FLAG_WME)))
7121 			return -EINVAL;
7122 		/* force (at least) rates when authorizing */
7123 		if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
7124 		    !params->link_sta_params.supported_rates)
7125 			return -EINVAL;
7126 		break;
7127 	case CFG80211_STA_TDLS_PEER_ACTIVE:
7128 		/* reject any changes */
7129 		return -EINVAL;
7130 	case CFG80211_STA_MESH_PEER_KERNEL:
7131 		if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
7132 			return -EINVAL;
7133 		break;
7134 	case CFG80211_STA_MESH_PEER_USER:
7135 		if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
7136 		    params->plink_action != NL80211_PLINK_ACTION_BLOCK)
7137 			return -EINVAL;
7138 		break;
7139 	}
7140 
7141 	/*
7142 	 * Older kernel versions ignored this attribute entirely, so don't
7143 	 * reject attempts to update it but mark it as unused instead so the
7144 	 * driver won't look at the data.
7145 	 */
7146 	if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
7147 	    statype != CFG80211_STA_TDLS_PEER_SETUP)
7148 		params->link_sta_params.opmode_notif_used = false;
7149 
7150 	return 0;
7151 }
7152 EXPORT_SYMBOL(cfg80211_check_station_change);
7153 
7154 /*
7155  * Get vlan interface making sure it is running and on the right wiphy.
7156  */
7157 static struct net_device *get_vlan(struct genl_info *info,
7158 				   struct cfg80211_registered_device *rdev)
7159 {
7160 	struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
7161 	struct net_device *v;
7162 	int ret;
7163 
7164 	if (!vlanattr)
7165 		return NULL;
7166 
7167 	v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
7168 	if (!v)
7169 		return ERR_PTR(-ENODEV);
7170 
7171 	if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
7172 		ret = -EINVAL;
7173 		goto error;
7174 	}
7175 
7176 	if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
7177 	    v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
7178 	    v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
7179 		ret = -EINVAL;
7180 		goto error;
7181 	}
7182 
7183 	if (!netif_running(v)) {
7184 		ret = -ENETDOWN;
7185 		goto error;
7186 	}
7187 
7188 	return v;
7189  error:
7190 	dev_put(v);
7191 	return ERR_PTR(ret);
7192 }
7193 
7194 static int nl80211_parse_sta_wme(struct genl_info *info,
7195 				 struct station_parameters *params)
7196 {
7197 	struct nlattr *tb[NL80211_STA_WME_MAX + 1];
7198 	struct nlattr *nla;
7199 	int err;
7200 
7201 	/* parse WME attributes if present */
7202 	if (!info->attrs[NL80211_ATTR_STA_WME])
7203 		return 0;
7204 
7205 	nla = info->attrs[NL80211_ATTR_STA_WME];
7206 	err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla,
7207 					  nl80211_sta_wme_policy,
7208 					  info->extack);
7209 	if (err)
7210 		return err;
7211 
7212 	if (tb[NL80211_STA_WME_UAPSD_QUEUES])
7213 		params->uapsd_queues = nla_get_u8(
7214 			tb[NL80211_STA_WME_UAPSD_QUEUES]);
7215 	if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
7216 		return -EINVAL;
7217 
7218 	if (tb[NL80211_STA_WME_MAX_SP])
7219 		params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
7220 
7221 	if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
7222 		return -EINVAL;
7223 
7224 	params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
7225 
7226 	return 0;
7227 }
7228 
7229 static int nl80211_parse_sta_channel_info(struct genl_info *info,
7230 				      struct station_parameters *params)
7231 {
7232 	if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
7233 		params->supported_channels =
7234 		     nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
7235 		params->supported_channels_len =
7236 		     nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
7237 		/*
7238 		 * Need to include at least one (first channel, number of
7239 		 * channels) tuple for each subband (checked in policy),
7240 		 * and must have proper tuples for the rest of the data as well.
7241 		 */
7242 		if (params->supported_channels_len % 2)
7243 			return -EINVAL;
7244 	}
7245 
7246 	if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
7247 		params->supported_oper_classes =
7248 		 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
7249 		params->supported_oper_classes_len =
7250 		  nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
7251 	}
7252 	return 0;
7253 }
7254 
7255 static int nl80211_set_station_tdls(struct genl_info *info,
7256 				    struct station_parameters *params)
7257 {
7258 	int err;
7259 	/* Dummy STA entry gets updated once the peer capabilities are known */
7260 	if (info->attrs[NL80211_ATTR_PEER_AID])
7261 		params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
7262 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
7263 		params->link_sta_params.ht_capa =
7264 			nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
7265 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
7266 		params->link_sta_params.vht_capa =
7267 			nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
7268 	if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
7269 		params->link_sta_params.he_capa =
7270 			nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
7271 		params->link_sta_params.he_capa_len =
7272 			nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
7273 
7274 		if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) {
7275 			params->link_sta_params.eht_capa =
7276 				nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
7277 			params->link_sta_params.eht_capa_len =
7278 				nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
7279 
7280 			if (!ieee80211_eht_capa_size_ok((const u8 *)params->link_sta_params.he_capa,
7281 							(const u8 *)params->link_sta_params.eht_capa,
7282 							params->link_sta_params.eht_capa_len,
7283 							false))
7284 				return -EINVAL;
7285 		}
7286 	}
7287 
7288 	err = nl80211_parse_sta_channel_info(info, params);
7289 	if (err)
7290 		return err;
7291 
7292 	return nl80211_parse_sta_wme(info, params);
7293 }
7294 
7295 static int nl80211_parse_sta_txpower_setting(struct genl_info *info,
7296 					     struct sta_txpwr *txpwr,
7297 					     bool *txpwr_set)
7298 {
7299 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
7300 	int idx;
7301 
7302 	if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) {
7303 		if (!rdev->ops->set_tx_power ||
7304 		    !wiphy_ext_feature_isset(&rdev->wiphy,
7305 					 NL80211_EXT_FEATURE_STA_TX_PWR))
7306 			return -EOPNOTSUPP;
7307 
7308 		idx = NL80211_ATTR_STA_TX_POWER_SETTING;
7309 		txpwr->type = nla_get_u8(info->attrs[idx]);
7310 
7311 		if (txpwr->type == NL80211_TX_POWER_LIMITED) {
7312 			idx = NL80211_ATTR_STA_TX_POWER;
7313 
7314 			if (info->attrs[idx])
7315 				txpwr->power = nla_get_s16(info->attrs[idx]);
7316 			else
7317 				return -EINVAL;
7318 		}
7319 
7320 		*txpwr_set = true;
7321 	} else {
7322 		*txpwr_set = false;
7323 	}
7324 
7325 	return 0;
7326 }
7327 
7328 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
7329 {
7330 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
7331 	struct net_device *dev = info->user_ptr[1];
7332 	struct station_parameters params;
7333 	u8 *mac_addr;
7334 	int err;
7335 
7336 	memset(&params, 0, sizeof(params));
7337 
7338 	if (!rdev->ops->change_station)
7339 		return -EOPNOTSUPP;
7340 
7341 	/*
7342 	 * AID and listen_interval properties can be set only for unassociated
7343 	 * station. Include these parameters here and will check them in
7344 	 * cfg80211_check_station_change().
7345 	 */
7346 	if (info->attrs[NL80211_ATTR_STA_AID])
7347 		params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
7348 
7349 	if (info->attrs[NL80211_ATTR_VLAN_ID])
7350 		params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
7351 
7352 	if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
7353 		params.listen_interval =
7354 		     nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
7355 	else
7356 		params.listen_interval = -1;
7357 
7358 	if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS])
7359 		params.support_p2p_ps =
7360 			nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
7361 	else
7362 		params.support_p2p_ps = -1;
7363 
7364 	if (!info->attrs[NL80211_ATTR_MAC])
7365 		return -EINVAL;
7366 
7367 	params.link_sta_params.link_id =
7368 		nl80211_link_id_or_invalid(info->attrs);
7369 
7370 	if (info->attrs[NL80211_ATTR_MLD_ADDR]) {
7371 		/* If MLD_ADDR attribute is set then this is an MLD station
7372 		 * and the MLD_ADDR attribute holds the MLD address and the
7373 		 * MAC attribute holds for the LINK address.
7374 		 * In that case, the link_id is also expected to be valid.
7375 		 */
7376 		if (params.link_sta_params.link_id < 0)
7377 			return -EINVAL;
7378 
7379 		mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
7380 		params.link_sta_params.mld_mac = mac_addr;
7381 		params.link_sta_params.link_mac =
7382 			nla_data(info->attrs[NL80211_ATTR_MAC]);
7383 		if (!is_valid_ether_addr(params.link_sta_params.link_mac))
7384 			return -EINVAL;
7385 	} else {
7386 		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
7387 	}
7388 
7389 
7390 	if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
7391 		params.link_sta_params.supported_rates =
7392 			nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
7393 		params.link_sta_params.supported_rates_len =
7394 			nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
7395 	}
7396 
7397 	if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
7398 		params.capability =
7399 			nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
7400 		params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
7401 	}
7402 
7403 	if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
7404 		params.ext_capab =
7405 			nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
7406 		params.ext_capab_len =
7407 			nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
7408 	}
7409 
7410 	if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
7411 		return -EINVAL;
7412 
7413 	if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
7414 		params.plink_action =
7415 			nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
7416 
7417 	if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
7418 		params.plink_state =
7419 			nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
7420 		if (info->attrs[NL80211_ATTR_MESH_PEER_AID])
7421 			params.peer_aid = nla_get_u16(
7422 				info->attrs[NL80211_ATTR_MESH_PEER_AID]);
7423 		params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
7424 	}
7425 
7426 	if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE])
7427 		params.local_pm = nla_get_u32(
7428 			info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
7429 
7430 	if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
7431 		params.link_sta_params.opmode_notif_used = true;
7432 		params.link_sta_params.opmode_notif =
7433 			nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
7434 	}
7435 
7436 	if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY])
7437 		params.link_sta_params.he_6ghz_capa =
7438 			nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]);
7439 
7440 	if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
7441 		params.airtime_weight =
7442 			nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
7443 
7444 	if (params.airtime_weight &&
7445 	    !wiphy_ext_feature_isset(&rdev->wiphy,
7446 				     NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
7447 		return -EOPNOTSUPP;
7448 
7449 	err = nl80211_parse_sta_txpower_setting(info,
7450 						&params.link_sta_params.txpwr,
7451 						&params.link_sta_params.txpwr_set);
7452 	if (err)
7453 		return err;
7454 
7455 	/* Include parameters for TDLS peer (will check later) */
7456 	err = nl80211_set_station_tdls(info, &params);
7457 	if (err)
7458 		return err;
7459 
7460 	params.vlan = get_vlan(info, rdev);
7461 	if (IS_ERR(params.vlan))
7462 		return PTR_ERR(params.vlan);
7463 
7464 	switch (dev->ieee80211_ptr->iftype) {
7465 	case NL80211_IFTYPE_AP:
7466 	case NL80211_IFTYPE_AP_VLAN:
7467 	case NL80211_IFTYPE_P2P_GO:
7468 	case NL80211_IFTYPE_P2P_CLIENT:
7469 	case NL80211_IFTYPE_STATION:
7470 	case NL80211_IFTYPE_ADHOC:
7471 	case NL80211_IFTYPE_MESH_POINT:
7472 		break;
7473 	default:
7474 		err = -EOPNOTSUPP;
7475 		goto out_put_vlan;
7476 	}
7477 
7478 	/* driver will call cfg80211_check_station_change() */
7479 	err = rdev_change_station(rdev, dev, mac_addr, &params);
7480 
7481  out_put_vlan:
7482 	dev_put(params.vlan);
7483 
7484 	return err;
7485 }
7486 
7487 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
7488 {
7489 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
7490 	int err;
7491 	struct net_device *dev = info->user_ptr[1];
7492 	struct wireless_dev *wdev = dev->ieee80211_ptr;
7493 	struct station_parameters params;
7494 	u8 *mac_addr = NULL;
7495 	u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
7496 			 BIT(NL80211_STA_FLAG_ASSOCIATED);
7497 
7498 	memset(&params, 0, sizeof(params));
7499 
7500 	if (!rdev->ops->add_station)
7501 		return -EOPNOTSUPP;
7502 
7503 	if (!info->attrs[NL80211_ATTR_MAC])
7504 		return -EINVAL;
7505 
7506 	if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
7507 		return -EINVAL;
7508 
7509 	if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
7510 		return -EINVAL;
7511 
7512 	if (!info->attrs[NL80211_ATTR_STA_AID] &&
7513 	    !info->attrs[NL80211_ATTR_PEER_AID])
7514 		return -EINVAL;
7515 
7516 	params.link_sta_params.link_id =
7517 		nl80211_link_id_or_invalid(info->attrs);
7518 
7519 	if (info->attrs[NL80211_ATTR_MLD_ADDR]) {
7520 		mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
7521 		params.link_sta_params.mld_mac = mac_addr;
7522 		params.link_sta_params.link_mac =
7523 			nla_data(info->attrs[NL80211_ATTR_MAC]);
7524 		if (!is_valid_ether_addr(params.link_sta_params.link_mac))
7525 			return -EINVAL;
7526 	} else {
7527 		mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
7528 	}
7529 
7530 	params.link_sta_params.supported_rates =
7531 		nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
7532 	params.link_sta_params.supported_rates_len =
7533 		nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
7534 	params.listen_interval =
7535 		nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
7536 
7537 	if (info->attrs[NL80211_ATTR_VLAN_ID])
7538 		params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
7539 
7540 	if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
7541 		params.support_p2p_ps =
7542 			nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
7543 	} else {
7544 		/*
7545 		 * if not specified, assume it's supported for P2P GO interface,
7546 		 * and is NOT supported for AP interface
7547 		 */
7548 		params.support_p2p_ps =
7549 			dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
7550 	}
7551 
7552 	if (info->attrs[NL80211_ATTR_PEER_AID])
7553 		params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
7554 	else
7555 		params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
7556 
7557 	if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
7558 		params.capability =
7559 			nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
7560 		params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
7561 	}
7562 
7563 	if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
7564 		params.ext_capab =
7565 			nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
7566 		params.ext_capab_len =
7567 			nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
7568 	}
7569 
7570 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
7571 		params.link_sta_params.ht_capa =
7572 			nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
7573 
7574 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
7575 		params.link_sta_params.vht_capa =
7576 			nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
7577 
7578 	if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
7579 		params.link_sta_params.he_capa =
7580 			nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
7581 		params.link_sta_params.he_capa_len =
7582 			nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
7583 
7584 		if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) {
7585 			params.link_sta_params.eht_capa =
7586 				nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
7587 			params.link_sta_params.eht_capa_len =
7588 				nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
7589 
7590 			if (!ieee80211_eht_capa_size_ok((const u8 *)params.link_sta_params.he_capa,
7591 							(const u8 *)params.link_sta_params.eht_capa,
7592 							params.link_sta_params.eht_capa_len,
7593 							false))
7594 				return -EINVAL;
7595 		}
7596 	}
7597 
7598 	if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY])
7599 		params.link_sta_params.he_6ghz_capa =
7600 			nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]);
7601 
7602 	if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
7603 		params.link_sta_params.opmode_notif_used = true;
7604 		params.link_sta_params.opmode_notif =
7605 			nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
7606 	}
7607 
7608 	if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
7609 		params.plink_action =
7610 			nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
7611 
7612 	if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
7613 		params.airtime_weight =
7614 			nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
7615 
7616 	if (params.airtime_weight &&
7617 	    !wiphy_ext_feature_isset(&rdev->wiphy,
7618 				     NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
7619 		return -EOPNOTSUPP;
7620 
7621 	err = nl80211_parse_sta_txpower_setting(info,
7622 						&params.link_sta_params.txpwr,
7623 						&params.link_sta_params.txpwr_set);
7624 	if (err)
7625 		return err;
7626 
7627 	err = nl80211_parse_sta_channel_info(info, &params);
7628 	if (err)
7629 		return err;
7630 
7631 	err = nl80211_parse_sta_wme(info, &params);
7632 	if (err)
7633 		return err;
7634 
7635 	if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
7636 		return -EINVAL;
7637 
7638 	/* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
7639 	 * as userspace might just pass through the capabilities from the IEs
7640 	 * directly, rather than enforcing this restriction and returning an
7641 	 * error in this case.
7642 	 */
7643 	if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
7644 		params.link_sta_params.ht_capa = NULL;
7645 		params.link_sta_params.vht_capa = NULL;
7646 
7647 		/* HE and EHT require WME */
7648 		if (params.link_sta_params.he_capa_len ||
7649 		    params.link_sta_params.he_6ghz_capa ||
7650 		    params.link_sta_params.eht_capa_len)
7651 			return -EINVAL;
7652 	}
7653 
7654 	/* Ensure that HT/VHT capabilities are not set for 6 GHz HE STA */
7655 	if (params.link_sta_params.he_6ghz_capa &&
7656 	    (params.link_sta_params.ht_capa || params.link_sta_params.vht_capa))
7657 		return -EINVAL;
7658 
7659 	/* When you run into this, adjust the code below for the new flag */
7660 	BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8);
7661 
7662 	switch (dev->ieee80211_ptr->iftype) {
7663 	case NL80211_IFTYPE_AP:
7664 	case NL80211_IFTYPE_AP_VLAN:
7665 	case NL80211_IFTYPE_P2P_GO:
7666 		/* ignore WME attributes if iface/sta is not capable */
7667 		if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
7668 		    !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
7669 			params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
7670 
7671 		/* TDLS peers cannot be added */
7672 		if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
7673 		    info->attrs[NL80211_ATTR_PEER_AID])
7674 			return -EINVAL;
7675 		/* but don't bother the driver with it */
7676 		params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
7677 
7678 		/* allow authenticated/associated only if driver handles it */
7679 		if (!(rdev->wiphy.features &
7680 				NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
7681 		    params.sta_flags_mask & auth_assoc)
7682 			return -EINVAL;
7683 
7684 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
7685 					     NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT) &&
7686 		    params.sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU))
7687 			return -EINVAL;
7688 
7689 		/* Older userspace, or userspace wanting to be compatible with
7690 		 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
7691 		 * and assoc flags in the mask, but assumes the station will be
7692 		 * added as associated anyway since this was the required driver
7693 		 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
7694 		 * introduced.
7695 		 * In order to not bother drivers with this quirk in the API
7696 		 * set the flags in both the mask and set for new stations in
7697 		 * this case.
7698 		 */
7699 		if (!(params.sta_flags_mask & auth_assoc)) {
7700 			params.sta_flags_mask |= auth_assoc;
7701 			params.sta_flags_set |= auth_assoc;
7702 		}
7703 
7704 		/* must be last in here for error handling */
7705 		params.vlan = get_vlan(info, rdev);
7706 		if (IS_ERR(params.vlan))
7707 			return PTR_ERR(params.vlan);
7708 		break;
7709 	case NL80211_IFTYPE_MESH_POINT:
7710 		/* ignore uAPSD data */
7711 		params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
7712 
7713 		/* associated is disallowed */
7714 		if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
7715 			return -EINVAL;
7716 		/* TDLS peers cannot be added */
7717 		if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
7718 		    info->attrs[NL80211_ATTR_PEER_AID])
7719 			return -EINVAL;
7720 		break;
7721 	case NL80211_IFTYPE_STATION:
7722 	case NL80211_IFTYPE_P2P_CLIENT:
7723 		/* ignore uAPSD data */
7724 		params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
7725 
7726 		/* these are disallowed */
7727 		if (params.sta_flags_mask &
7728 				(BIT(NL80211_STA_FLAG_ASSOCIATED) |
7729 				 BIT(NL80211_STA_FLAG_AUTHENTICATED)))
7730 			return -EINVAL;
7731 		/* Only TDLS peers can be added */
7732 		if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
7733 			return -EINVAL;
7734 		/* Can only add if TDLS ... */
7735 		if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
7736 			return -EOPNOTSUPP;
7737 		/* ... with external setup is supported */
7738 		if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
7739 			return -EOPNOTSUPP;
7740 		/*
7741 		 * Older wpa_supplicant versions always mark the TDLS peer
7742 		 * as authorized, but it shouldn't yet be.
7743 		 */
7744 		params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
7745 		break;
7746 	default:
7747 		return -EOPNOTSUPP;
7748 	}
7749 
7750 	/* be aware of params.vlan when changing code here */
7751 
7752 	if (wdev->valid_links) {
7753 		if (params.link_sta_params.link_id < 0) {
7754 			err = -EINVAL;
7755 			goto out;
7756 		}
7757 		if (!(wdev->valid_links & BIT(params.link_sta_params.link_id))) {
7758 			err = -ENOLINK;
7759 			goto out;
7760 		}
7761 	} else {
7762 		if (params.link_sta_params.link_id >= 0) {
7763 			err = -EINVAL;
7764 			goto out;
7765 		}
7766 	}
7767 	err = rdev_add_station(rdev, dev, mac_addr, &params);
7768 out:
7769 	dev_put(params.vlan);
7770 	return err;
7771 }
7772 
7773 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
7774 {
7775 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
7776 	struct net_device *dev = info->user_ptr[1];
7777 	struct wireless_dev *wdev = dev->ieee80211_ptr;
7778 	struct station_del_parameters params;
7779 	int link_id = nl80211_link_id_or_invalid(info->attrs);
7780 
7781 	memset(&params, 0, sizeof(params));
7782 
7783 	if (info->attrs[NL80211_ATTR_MAC])
7784 		params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
7785 
7786 	switch (wdev->iftype) {
7787 	case NL80211_IFTYPE_AP:
7788 	case NL80211_IFTYPE_AP_VLAN:
7789 	case NL80211_IFTYPE_MESH_POINT:
7790 	case NL80211_IFTYPE_P2P_GO:
7791 		/* always accept these */
7792 		break;
7793 	case NL80211_IFTYPE_ADHOC:
7794 		/* conditionally accept */
7795 		if (wiphy_ext_feature_isset(&rdev->wiphy,
7796 					    NL80211_EXT_FEATURE_DEL_IBSS_STA))
7797 			break;
7798 		return -EINVAL;
7799 	default:
7800 		return -EINVAL;
7801 	}
7802 
7803 	if (!rdev->ops->del_station)
7804 		return -EOPNOTSUPP;
7805 
7806 	if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
7807 		params.subtype =
7808 			nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
7809 		if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
7810 		    params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
7811 			return -EINVAL;
7812 	} else {
7813 		/* Default to Deauthentication frame */
7814 		params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
7815 	}
7816 
7817 	if (info->attrs[NL80211_ATTR_REASON_CODE]) {
7818 		params.reason_code =
7819 			nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
7820 		if (params.reason_code == 0)
7821 			return -EINVAL; /* 0 is reserved */
7822 	} else {
7823 		/* Default to reason code 2 */
7824 		params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
7825 	}
7826 
7827 	/* Link ID not expected in case of non-ML operation */
7828 	if (!wdev->valid_links && link_id != -1)
7829 		return -EINVAL;
7830 
7831 	/* If given, a valid link ID should be passed during MLO */
7832 	if (wdev->valid_links && link_id >= 0 &&
7833 	    !(wdev->valid_links & BIT(link_id)))
7834 		return -EINVAL;
7835 
7836 	params.link_id = link_id;
7837 
7838 	return rdev_del_station(rdev, dev, &params);
7839 }
7840 
7841 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
7842 				int flags, struct net_device *dev,
7843 				u8 *dst, u8 *next_hop,
7844 				struct mpath_info *pinfo)
7845 {
7846 	void *hdr;
7847 	struct nlattr *pinfoattr;
7848 
7849 	hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
7850 	if (!hdr)
7851 		return -1;
7852 
7853 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
7854 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
7855 	    nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
7856 	    nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
7857 		goto nla_put_failure;
7858 
7859 	pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO);
7860 	if (!pinfoattr)
7861 		goto nla_put_failure;
7862 	if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
7863 	    nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
7864 			pinfo->frame_qlen))
7865 		goto nla_put_failure;
7866 	if (((pinfo->filled & MPATH_INFO_SN) &&
7867 	     nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
7868 	    ((pinfo->filled & MPATH_INFO_METRIC) &&
7869 	     nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
7870 			 pinfo->metric)) ||
7871 	    ((pinfo->filled & MPATH_INFO_EXPTIME) &&
7872 	     nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
7873 			 pinfo->exptime)) ||
7874 	    ((pinfo->filled & MPATH_INFO_FLAGS) &&
7875 	     nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
7876 			pinfo->flags)) ||
7877 	    ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
7878 	     nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
7879 			 pinfo->discovery_timeout)) ||
7880 	    ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
7881 	     nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
7882 			pinfo->discovery_retries)) ||
7883 	    ((pinfo->filled & MPATH_INFO_HOP_COUNT) &&
7884 	     nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT,
7885 			pinfo->hop_count)) ||
7886 	    ((pinfo->filled & MPATH_INFO_PATH_CHANGE) &&
7887 	     nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE,
7888 			 pinfo->path_change_count)))
7889 		goto nla_put_failure;
7890 
7891 	nla_nest_end(msg, pinfoattr);
7892 
7893 	genlmsg_end(msg, hdr);
7894 	return 0;
7895 
7896  nla_put_failure:
7897 	genlmsg_cancel(msg, hdr);
7898 	return -EMSGSIZE;
7899 }
7900 
7901 static int nl80211_dump_mpath(struct sk_buff *skb,
7902 			      struct netlink_callback *cb)
7903 {
7904 	struct mpath_info pinfo;
7905 	struct cfg80211_registered_device *rdev;
7906 	struct wireless_dev *wdev;
7907 	u8 dst[ETH_ALEN];
7908 	u8 next_hop[ETH_ALEN];
7909 	int path_idx = cb->args[2];
7910 	int err;
7911 
7912 	err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL);
7913 	if (err)
7914 		return err;
7915 	/* nl80211_prepare_wdev_dump acquired it in the successful case */
7916 	__acquire(&rdev->wiphy.mtx);
7917 
7918 	if (!rdev->ops->dump_mpath) {
7919 		err = -EOPNOTSUPP;
7920 		goto out_err;
7921 	}
7922 
7923 	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
7924 		err = -EOPNOTSUPP;
7925 		goto out_err;
7926 	}
7927 
7928 	while (1) {
7929 		err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
7930 				      next_hop, &pinfo);
7931 		if (err == -ENOENT)
7932 			break;
7933 		if (err)
7934 			goto out_err;
7935 
7936 		if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
7937 				       cb->nlh->nlmsg_seq, NLM_F_MULTI,
7938 				       wdev->netdev, dst, next_hop,
7939 				       &pinfo) < 0)
7940 			goto out;
7941 
7942 		path_idx++;
7943 	}
7944 
7945  out:
7946 	cb->args[2] = path_idx;
7947 	err = skb->len;
7948  out_err:
7949 	wiphy_unlock(&rdev->wiphy);
7950 	return err;
7951 }
7952 
7953 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
7954 {
7955 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
7956 	int err;
7957 	struct net_device *dev = info->user_ptr[1];
7958 	struct mpath_info pinfo;
7959 	struct sk_buff *msg;
7960 	u8 *dst = NULL;
7961 	u8 next_hop[ETH_ALEN];
7962 
7963 	memset(&pinfo, 0, sizeof(pinfo));
7964 
7965 	if (!info->attrs[NL80211_ATTR_MAC])
7966 		return -EINVAL;
7967 
7968 	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
7969 
7970 	if (!rdev->ops->get_mpath)
7971 		return -EOPNOTSUPP;
7972 
7973 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
7974 		return -EOPNOTSUPP;
7975 
7976 	err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
7977 	if (err)
7978 		return err;
7979 
7980 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
7981 	if (!msg)
7982 		return -ENOMEM;
7983 
7984 	if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
7985 				 dev, dst, next_hop, &pinfo) < 0) {
7986 		nlmsg_free(msg);
7987 		return -ENOBUFS;
7988 	}
7989 
7990 	return genlmsg_reply(msg, info);
7991 }
7992 
7993 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
7994 {
7995 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
7996 	struct net_device *dev = info->user_ptr[1];
7997 	u8 *dst = NULL;
7998 	u8 *next_hop = NULL;
7999 
8000 	if (!info->attrs[NL80211_ATTR_MAC])
8001 		return -EINVAL;
8002 
8003 	if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
8004 		return -EINVAL;
8005 
8006 	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
8007 	next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
8008 
8009 	if (!rdev->ops->change_mpath)
8010 		return -EOPNOTSUPP;
8011 
8012 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
8013 		return -EOPNOTSUPP;
8014 
8015 	return rdev_change_mpath(rdev, dev, dst, next_hop);
8016 }
8017 
8018 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
8019 {
8020 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8021 	struct net_device *dev = info->user_ptr[1];
8022 	u8 *dst = NULL;
8023 	u8 *next_hop = NULL;
8024 
8025 	if (!info->attrs[NL80211_ATTR_MAC])
8026 		return -EINVAL;
8027 
8028 	if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
8029 		return -EINVAL;
8030 
8031 	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
8032 	next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
8033 
8034 	if (!rdev->ops->add_mpath)
8035 		return -EOPNOTSUPP;
8036 
8037 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
8038 		return -EOPNOTSUPP;
8039 
8040 	return rdev_add_mpath(rdev, dev, dst, next_hop);
8041 }
8042 
8043 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
8044 {
8045 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8046 	struct net_device *dev = info->user_ptr[1];
8047 	u8 *dst = NULL;
8048 
8049 	if (info->attrs[NL80211_ATTR_MAC])
8050 		dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
8051 
8052 	if (!rdev->ops->del_mpath)
8053 		return -EOPNOTSUPP;
8054 
8055 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
8056 		return -EOPNOTSUPP;
8057 
8058 	return rdev_del_mpath(rdev, dev, dst);
8059 }
8060 
8061 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
8062 {
8063 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8064 	int err;
8065 	struct net_device *dev = info->user_ptr[1];
8066 	struct mpath_info pinfo;
8067 	struct sk_buff *msg;
8068 	u8 *dst = NULL;
8069 	u8 mpp[ETH_ALEN];
8070 
8071 	memset(&pinfo, 0, sizeof(pinfo));
8072 
8073 	if (!info->attrs[NL80211_ATTR_MAC])
8074 		return -EINVAL;
8075 
8076 	dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
8077 
8078 	if (!rdev->ops->get_mpp)
8079 		return -EOPNOTSUPP;
8080 
8081 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
8082 		return -EOPNOTSUPP;
8083 
8084 	err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
8085 	if (err)
8086 		return err;
8087 
8088 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
8089 	if (!msg)
8090 		return -ENOMEM;
8091 
8092 	if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
8093 			       dev, dst, mpp, &pinfo) < 0) {
8094 		nlmsg_free(msg);
8095 		return -ENOBUFS;
8096 	}
8097 
8098 	return genlmsg_reply(msg, info);
8099 }
8100 
8101 static int nl80211_dump_mpp(struct sk_buff *skb,
8102 			    struct netlink_callback *cb)
8103 {
8104 	struct mpath_info pinfo;
8105 	struct cfg80211_registered_device *rdev;
8106 	struct wireless_dev *wdev;
8107 	u8 dst[ETH_ALEN];
8108 	u8 mpp[ETH_ALEN];
8109 	int path_idx = cb->args[2];
8110 	int err;
8111 
8112 	err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL);
8113 	if (err)
8114 		return err;
8115 	/* nl80211_prepare_wdev_dump acquired it in the successful case */
8116 	__acquire(&rdev->wiphy.mtx);
8117 
8118 	if (!rdev->ops->dump_mpp) {
8119 		err = -EOPNOTSUPP;
8120 		goto out_err;
8121 	}
8122 
8123 	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
8124 		err = -EOPNOTSUPP;
8125 		goto out_err;
8126 	}
8127 
8128 	while (1) {
8129 		err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
8130 				    mpp, &pinfo);
8131 		if (err == -ENOENT)
8132 			break;
8133 		if (err)
8134 			goto out_err;
8135 
8136 		if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
8137 				       cb->nlh->nlmsg_seq, NLM_F_MULTI,
8138 				       wdev->netdev, dst, mpp,
8139 				       &pinfo) < 0)
8140 			goto out;
8141 
8142 		path_idx++;
8143 	}
8144 
8145  out:
8146 	cb->args[2] = path_idx;
8147 	err = skb->len;
8148  out_err:
8149 	wiphy_unlock(&rdev->wiphy);
8150 	return err;
8151 }
8152 
8153 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
8154 {
8155 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8156 	struct net_device *dev = info->user_ptr[1];
8157 	struct bss_parameters params;
8158 
8159 	memset(&params, 0, sizeof(params));
8160 	params.link_id = nl80211_link_id_or_invalid(info->attrs);
8161 	/* default to not changing parameters */
8162 	params.use_cts_prot = -1;
8163 	params.use_short_preamble = -1;
8164 	params.use_short_slot_time = -1;
8165 	params.ap_isolate = -1;
8166 	params.ht_opmode = -1;
8167 	params.p2p_ctwindow = -1;
8168 	params.p2p_opp_ps = -1;
8169 
8170 	if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
8171 		params.use_cts_prot =
8172 		    nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
8173 	if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
8174 		params.use_short_preamble =
8175 		    nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
8176 	if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
8177 		params.use_short_slot_time =
8178 		    nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
8179 	if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
8180 		params.basic_rates =
8181 			nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8182 		params.basic_rates_len =
8183 			nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8184 	}
8185 	if (info->attrs[NL80211_ATTR_AP_ISOLATE])
8186 		params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
8187 	if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
8188 		params.ht_opmode =
8189 			nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
8190 
8191 	if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
8192 		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
8193 			return -EINVAL;
8194 		params.p2p_ctwindow =
8195 			nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
8196 		if (params.p2p_ctwindow != 0 &&
8197 		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
8198 			return -EINVAL;
8199 	}
8200 
8201 	if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
8202 		u8 tmp;
8203 
8204 		if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
8205 			return -EINVAL;
8206 		tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
8207 		params.p2p_opp_ps = tmp;
8208 		if (params.p2p_opp_ps &&
8209 		    !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
8210 			return -EINVAL;
8211 	}
8212 
8213 	if (!rdev->ops->change_bss)
8214 		return -EOPNOTSUPP;
8215 
8216 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
8217 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
8218 		return -EOPNOTSUPP;
8219 
8220 	return rdev_change_bss(rdev, dev, &params);
8221 }
8222 
8223 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
8224 {
8225 	char *data = NULL;
8226 	bool is_indoor;
8227 	enum nl80211_user_reg_hint_type user_reg_hint_type;
8228 	u32 owner_nlportid;
8229 
8230 	/*
8231 	 * You should only get this when cfg80211 hasn't yet initialized
8232 	 * completely when built-in to the kernel right between the time
8233 	 * window between nl80211_init() and regulatory_init(), if that is
8234 	 * even possible.
8235 	 */
8236 	if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
8237 		return -EINPROGRESS;
8238 
8239 	user_reg_hint_type =
8240 		nla_get_u32_default(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE],
8241 				    NL80211_USER_REG_HINT_USER);
8242 
8243 	switch (user_reg_hint_type) {
8244 	case NL80211_USER_REG_HINT_USER:
8245 	case NL80211_USER_REG_HINT_CELL_BASE:
8246 		if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
8247 			return -EINVAL;
8248 
8249 		data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
8250 		return regulatory_hint_user(data, user_reg_hint_type);
8251 	case NL80211_USER_REG_HINT_INDOOR:
8252 		if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
8253 			owner_nlportid = info->snd_portid;
8254 			is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
8255 		} else {
8256 			owner_nlportid = 0;
8257 			is_indoor = true;
8258 		}
8259 
8260 		regulatory_hint_indoor(is_indoor, owner_nlportid);
8261 		return 0;
8262 	default:
8263 		return -EINVAL;
8264 	}
8265 }
8266 
8267 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info)
8268 {
8269 	return reg_reload_regdb();
8270 }
8271 
8272 static int nl80211_get_mesh_config(struct sk_buff *skb,
8273 				   struct genl_info *info)
8274 {
8275 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8276 	struct net_device *dev = info->user_ptr[1];
8277 	struct wireless_dev *wdev = dev->ieee80211_ptr;
8278 	struct mesh_config cur_params;
8279 	int err = 0;
8280 	void *hdr;
8281 	struct nlattr *pinfoattr;
8282 	struct sk_buff *msg;
8283 
8284 	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
8285 		return -EOPNOTSUPP;
8286 
8287 	if (!rdev->ops->get_mesh_config)
8288 		return -EOPNOTSUPP;
8289 
8290 	/* If not connected, get default parameters */
8291 	if (!wdev->u.mesh.id_len)
8292 		memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
8293 	else
8294 		err = rdev_get_mesh_config(rdev, dev, &cur_params);
8295 
8296 	if (err)
8297 		return err;
8298 
8299 	/* Draw up a netlink message to send back */
8300 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
8301 	if (!msg)
8302 		return -ENOMEM;
8303 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
8304 			     NL80211_CMD_GET_MESH_CONFIG);
8305 	if (!hdr)
8306 		goto out;
8307 	pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG);
8308 	if (!pinfoattr)
8309 		goto nla_put_failure;
8310 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
8311 	    nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
8312 			cur_params.dot11MeshRetryTimeout) ||
8313 	    nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
8314 			cur_params.dot11MeshConfirmTimeout) ||
8315 	    nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
8316 			cur_params.dot11MeshHoldingTimeout) ||
8317 	    nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
8318 			cur_params.dot11MeshMaxPeerLinks) ||
8319 	    nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
8320 		       cur_params.dot11MeshMaxRetries) ||
8321 	    nla_put_u8(msg, NL80211_MESHCONF_TTL,
8322 		       cur_params.dot11MeshTTL) ||
8323 	    nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
8324 		       cur_params.element_ttl) ||
8325 	    nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
8326 		       cur_params.auto_open_plinks) ||
8327 	    nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
8328 			cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
8329 	    nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
8330 		       cur_params.dot11MeshHWMPmaxPREQretries) ||
8331 	    nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
8332 			cur_params.path_refresh_time) ||
8333 	    nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
8334 			cur_params.min_discovery_timeout) ||
8335 	    nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
8336 			cur_params.dot11MeshHWMPactivePathTimeout) ||
8337 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
8338 			cur_params.dot11MeshHWMPpreqMinInterval) ||
8339 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
8340 			cur_params.dot11MeshHWMPperrMinInterval) ||
8341 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
8342 			cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
8343 	    nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
8344 		       cur_params.dot11MeshHWMPRootMode) ||
8345 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
8346 			cur_params.dot11MeshHWMPRannInterval) ||
8347 	    nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
8348 		       cur_params.dot11MeshGateAnnouncementProtocol) ||
8349 	    nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
8350 		       cur_params.dot11MeshForwarding) ||
8351 	    nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
8352 			cur_params.rssi_threshold) ||
8353 	    nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
8354 			cur_params.ht_opmode) ||
8355 	    nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
8356 			cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
8357 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
8358 			cur_params.dot11MeshHWMProotInterval) ||
8359 	    nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
8360 			cur_params.dot11MeshHWMPconfirmationInterval) ||
8361 	    nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
8362 			cur_params.power_mode) ||
8363 	    nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
8364 			cur_params.dot11MeshAwakeWindowDuration) ||
8365 	    nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
8366 			cur_params.plink_timeout) ||
8367 	    nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE,
8368 		       cur_params.dot11MeshConnectedToMeshGate) ||
8369 	    nla_put_u8(msg, NL80211_MESHCONF_NOLEARN,
8370 		       cur_params.dot11MeshNolearn) ||
8371 	    nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_AS,
8372 		       cur_params.dot11MeshConnectedToAuthServer))
8373 		goto nla_put_failure;
8374 	nla_nest_end(msg, pinfoattr);
8375 	genlmsg_end(msg, hdr);
8376 	return genlmsg_reply(msg, info);
8377 
8378  nla_put_failure:
8379  out:
8380 	nlmsg_free(msg);
8381 	return -ENOBUFS;
8382 }
8383 
8384 static const struct nla_policy
8385 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
8386 	[NL80211_MESHCONF_RETRY_TIMEOUT] =
8387 		NLA_POLICY_RANGE(NLA_U16, 1, 255),
8388 	[NL80211_MESHCONF_CONFIRM_TIMEOUT] =
8389 		NLA_POLICY_RANGE(NLA_U16, 1, 255),
8390 	[NL80211_MESHCONF_HOLDING_TIMEOUT] =
8391 		NLA_POLICY_RANGE(NLA_U16, 1, 255),
8392 	[NL80211_MESHCONF_MAX_PEER_LINKS] =
8393 		NLA_POLICY_RANGE(NLA_U16, 0, 255),
8394 	[NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16),
8395 	[NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
8396 	[NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
8397 	[NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1),
8398 	[NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] =
8399 		NLA_POLICY_RANGE(NLA_U32, 1, 255),
8400 	[NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
8401 	[NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
8402 	[NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1),
8403 	[NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
8404 	[NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] =
8405 		NLA_POLICY_MIN(NLA_U16, 1),
8406 	[NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] =
8407 		NLA_POLICY_MIN(NLA_U16, 1),
8408 	[NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] =
8409 		NLA_POLICY_MIN(NLA_U16, 1),
8410 	[NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4),
8411 	[NL80211_MESHCONF_HWMP_RANN_INTERVAL] =
8412 		NLA_POLICY_MIN(NLA_U16, 1),
8413 	[NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1),
8414 	[NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1),
8415 	[NL80211_MESHCONF_RSSI_THRESHOLD] =
8416 		NLA_POLICY_RANGE(NLA_S32, -255, 0),
8417 	[NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
8418 	[NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
8419 	[NL80211_MESHCONF_HWMP_ROOT_INTERVAL] =
8420 		NLA_POLICY_MIN(NLA_U16, 1),
8421 	[NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] =
8422 		NLA_POLICY_MIN(NLA_U16, 1),
8423 	[NL80211_MESHCONF_POWER_MODE] =
8424 		NLA_POLICY_RANGE(NLA_U32,
8425 				 NL80211_MESH_POWER_ACTIVE,
8426 				 NL80211_MESH_POWER_MAX),
8427 	[NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
8428 	[NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
8429 	[NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
8430 	[NL80211_MESHCONF_NOLEARN] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
8431 	[NL80211_MESHCONF_CONNECTED_TO_AS] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
8432 };
8433 
8434 static const struct nla_policy
8435 	nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
8436 	[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
8437 	[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
8438 	[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
8439 	[NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
8440 	[NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
8441 	[NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
8442 	[NL80211_MESH_SETUP_IE] =
8443 		NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
8444 				       IEEE80211_MAX_DATA_LEN),
8445 	[NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
8446 };
8447 
8448 static int nl80211_parse_mesh_config(struct genl_info *info,
8449 				     struct mesh_config *cfg,
8450 				     u32 *mask_out)
8451 {
8452 	struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
8453 	u32 mask = 0;
8454 	u16 ht_opmode;
8455 
8456 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn)	\
8457 do {									\
8458 	if (tb[attr]) {							\
8459 		cfg->param = fn(tb[attr]);				\
8460 		mask |= BIT((attr) - 1);				\
8461 	}								\
8462 } while (0)
8463 
8464 	if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
8465 		return -EINVAL;
8466 	if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack))
8467 		return -EINVAL;
8468 
8469 	/* This makes sure that there aren't more than 32 mesh config
8470 	 * parameters (otherwise our bitfield scheme would not work.) */
8471 	BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
8472 
8473 	/* Fill in the params struct */
8474 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask,
8475 				  NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16);
8476 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask,
8477 				  NL80211_MESHCONF_CONFIRM_TIMEOUT,
8478 				  nla_get_u16);
8479 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask,
8480 				  NL80211_MESHCONF_HOLDING_TIMEOUT,
8481 				  nla_get_u16);
8482 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask,
8483 				  NL80211_MESHCONF_MAX_PEER_LINKS,
8484 				  nla_get_u16);
8485 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask,
8486 				  NL80211_MESHCONF_MAX_RETRIES, nla_get_u8);
8487 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask,
8488 				  NL80211_MESHCONF_TTL, nla_get_u8);
8489 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask,
8490 				  NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8);
8491 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask,
8492 				  NL80211_MESHCONF_AUTO_OPEN_PLINKS,
8493 				  nla_get_u8);
8494 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
8495 				  mask,
8496 				  NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
8497 				  nla_get_u32);
8498 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask,
8499 				  NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
8500 				  nla_get_u8);
8501 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask,
8502 				  NL80211_MESHCONF_PATH_REFRESH_TIME,
8503 				  nla_get_u32);
8504 	if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) &&
8505 	    (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535))
8506 		return -EINVAL;
8507 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask,
8508 				  NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
8509 				  nla_get_u16);
8510 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
8511 				  mask,
8512 				  NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
8513 				  nla_get_u32);
8514 	if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) &&
8515 	    (cfg->dot11MeshHWMPactivePathTimeout < 1 ||
8516 	     cfg->dot11MeshHWMPactivePathTimeout > 65535))
8517 		return -EINVAL;
8518 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask,
8519 				  NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
8520 				  nla_get_u16);
8521 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask,
8522 				  NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
8523 				  nla_get_u16);
8524 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
8525 				  dot11MeshHWMPnetDiameterTraversalTime, mask,
8526 				  NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
8527 				  nla_get_u16);
8528 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask,
8529 				  NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8);
8530 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask,
8531 				  NL80211_MESHCONF_HWMP_RANN_INTERVAL,
8532 				  nla_get_u16);
8533 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol,
8534 				  mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
8535 				  nla_get_u8);
8536 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask,
8537 				  NL80211_MESHCONF_FORWARDING, nla_get_u8);
8538 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask,
8539 				  NL80211_MESHCONF_RSSI_THRESHOLD,
8540 				  nla_get_s32);
8541 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask,
8542 				  NL80211_MESHCONF_CONNECTED_TO_GATE,
8543 				  nla_get_u8);
8544 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToAuthServer, mask,
8545 				  NL80211_MESHCONF_CONNECTED_TO_AS,
8546 				  nla_get_u8);
8547 	/*
8548 	 * Check HT operation mode based on
8549 	 * IEEE 802.11-2016 9.4.2.57 HT Operation element.
8550 	 */
8551 	if (tb[NL80211_MESHCONF_HT_OPMODE]) {
8552 		ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
8553 
8554 		if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
8555 				  IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
8556 				  IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
8557 			return -EINVAL;
8558 
8559 		/* NON_HT_STA bit is reserved, but some programs set it */
8560 		ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT;
8561 
8562 		cfg->ht_opmode = ht_opmode;
8563 		mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
8564 	}
8565 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
8566 				  dot11MeshHWMPactivePathToRootTimeout, mask,
8567 				  NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
8568 				  nla_get_u32);
8569 	if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) &&
8570 	    (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 ||
8571 	     cfg->dot11MeshHWMPactivePathToRootTimeout > 65535))
8572 		return -EINVAL;
8573 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask,
8574 				  NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
8575 				  nla_get_u16);
8576 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval,
8577 				  mask,
8578 				  NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
8579 				  nla_get_u16);
8580 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask,
8581 				  NL80211_MESHCONF_POWER_MODE, nla_get_u32);
8582 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask,
8583 				  NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16);
8584 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask,
8585 				  NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32);
8586 	FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNolearn, mask,
8587 				  NL80211_MESHCONF_NOLEARN, nla_get_u8);
8588 	if (mask_out)
8589 		*mask_out = mask;
8590 
8591 	return 0;
8592 
8593 #undef FILL_IN_MESH_PARAM_IF_SET
8594 }
8595 
8596 static int nl80211_parse_mesh_setup(struct genl_info *info,
8597 				     struct mesh_setup *setup)
8598 {
8599 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8600 	struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
8601 
8602 	if (!info->attrs[NL80211_ATTR_MESH_SETUP])
8603 		return -EINVAL;
8604 	if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack))
8605 		return -EINVAL;
8606 
8607 	if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
8608 		setup->sync_method =
8609 		(nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
8610 		 IEEE80211_SYNC_METHOD_VENDOR :
8611 		 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
8612 
8613 	if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
8614 		setup->path_sel_proto =
8615 		(nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
8616 		 IEEE80211_PATH_PROTOCOL_VENDOR :
8617 		 IEEE80211_PATH_PROTOCOL_HWMP;
8618 
8619 	if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
8620 		setup->path_metric =
8621 		(nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
8622 		 IEEE80211_PATH_METRIC_VENDOR :
8623 		 IEEE80211_PATH_METRIC_AIRTIME;
8624 
8625 	if (tb[NL80211_MESH_SETUP_IE]) {
8626 		struct nlattr *ieattr =
8627 			tb[NL80211_MESH_SETUP_IE];
8628 		setup->ie = nla_data(ieattr);
8629 		setup->ie_len = nla_len(ieattr);
8630 	}
8631 	if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
8632 	    !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
8633 		return -EINVAL;
8634 	setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
8635 	setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
8636 	setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
8637 	if (setup->is_secure)
8638 		setup->user_mpm = true;
8639 
8640 	if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
8641 		if (!setup->user_mpm)
8642 			return -EINVAL;
8643 		setup->auth_id =
8644 			nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
8645 	}
8646 
8647 	return 0;
8648 }
8649 
8650 static int nl80211_update_mesh_config(struct sk_buff *skb,
8651 				      struct genl_info *info)
8652 {
8653 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
8654 	struct net_device *dev = info->user_ptr[1];
8655 	struct wireless_dev *wdev = dev->ieee80211_ptr;
8656 	struct mesh_config cfg = {};
8657 	u32 mask;
8658 	int err;
8659 
8660 	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
8661 		return -EOPNOTSUPP;
8662 
8663 	if (!rdev->ops->update_mesh_config)
8664 		return -EOPNOTSUPP;
8665 
8666 	err = nl80211_parse_mesh_config(info, &cfg, &mask);
8667 	if (err)
8668 		return err;
8669 
8670 	if (!wdev->u.mesh.id_len)
8671 		err = -ENOLINK;
8672 
8673 	if (!err)
8674 		err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
8675 
8676 	return err;
8677 }
8678 
8679 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
8680 			      struct sk_buff *msg)
8681 {
8682 	struct nlattr *nl_reg_rules;
8683 	unsigned int i;
8684 
8685 	if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
8686 	    (regdom->dfs_region &&
8687 	     nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
8688 		goto nla_put_failure;
8689 
8690 	nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES);
8691 	if (!nl_reg_rules)
8692 		goto nla_put_failure;
8693 
8694 	for (i = 0; i < regdom->n_reg_rules; i++) {
8695 		struct nlattr *nl_reg_rule;
8696 		const struct ieee80211_reg_rule *reg_rule;
8697 		const struct ieee80211_freq_range *freq_range;
8698 		const struct ieee80211_power_rule *power_rule;
8699 		unsigned int max_bandwidth_khz;
8700 
8701 		reg_rule = &regdom->reg_rules[i];
8702 		freq_range = &reg_rule->freq_range;
8703 		power_rule = &reg_rule->power_rule;
8704 
8705 		nl_reg_rule = nla_nest_start_noflag(msg, i);
8706 		if (!nl_reg_rule)
8707 			goto nla_put_failure;
8708 
8709 		max_bandwidth_khz = freq_range->max_bandwidth_khz;
8710 		if (!max_bandwidth_khz)
8711 			max_bandwidth_khz = reg_get_max_bandwidth(regdom,
8712 								  reg_rule);
8713 
8714 		if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
8715 				reg_rule->flags) ||
8716 		    nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
8717 				freq_range->start_freq_khz) ||
8718 		    nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
8719 				freq_range->end_freq_khz) ||
8720 		    nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
8721 				max_bandwidth_khz) ||
8722 		    nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
8723 				power_rule->max_antenna_gain) ||
8724 		    nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
8725 				power_rule->max_eirp) ||
8726 		    nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
8727 				reg_rule->dfs_cac_ms))
8728 			goto nla_put_failure;
8729 
8730 		if ((reg_rule->flags & NL80211_RRF_PSD) &&
8731 		    nla_put_s8(msg, NL80211_ATTR_POWER_RULE_PSD,
8732 			       reg_rule->psd))
8733 			goto nla_put_failure;
8734 
8735 		nla_nest_end(msg, nl_reg_rule);
8736 	}
8737 
8738 	nla_nest_end(msg, nl_reg_rules);
8739 	return 0;
8740 
8741 nla_put_failure:
8742 	return -EMSGSIZE;
8743 }
8744 
8745 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
8746 {
8747 	const struct ieee80211_regdomain *regdom = NULL;
8748 	struct cfg80211_registered_device *rdev;
8749 	struct wiphy *wiphy = NULL;
8750 	struct sk_buff *msg;
8751 	int err = -EMSGSIZE;
8752 	void *hdr;
8753 
8754 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
8755 	if (!msg)
8756 		return -ENOBUFS;
8757 
8758 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
8759 			     NL80211_CMD_GET_REG);
8760 	if (!hdr)
8761 		goto put_failure;
8762 
8763 	rtnl_lock();
8764 
8765 	if (info->attrs[NL80211_ATTR_WIPHY]) {
8766 		bool self_managed;
8767 
8768 		rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
8769 		if (IS_ERR(rdev)) {
8770 			err = PTR_ERR(rdev);
8771 			goto nla_put_failure;
8772 		}
8773 
8774 		wiphy = &rdev->wiphy;
8775 		self_managed = wiphy->regulatory_flags &
8776 			       REGULATORY_WIPHY_SELF_MANAGED;
8777 
8778 		rcu_read_lock();
8779 
8780 		regdom = get_wiphy_regdom(wiphy);
8781 
8782 		/* a self-managed-reg device must have a private regdom */
8783 		if (WARN_ON(!regdom && self_managed)) {
8784 			err = -EINVAL;
8785 			goto nla_put_failure_rcu;
8786 		}
8787 
8788 		if (regdom &&
8789 		    nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
8790 			goto nla_put_failure_rcu;
8791 	} else {
8792 		rcu_read_lock();
8793 	}
8794 
8795 	if (!wiphy && reg_last_request_cell_base() &&
8796 	    nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
8797 			NL80211_USER_REG_HINT_CELL_BASE))
8798 		goto nla_put_failure_rcu;
8799 
8800 	if (!regdom)
8801 		regdom = rcu_dereference(cfg80211_regdomain);
8802 
8803 	if (nl80211_put_regdom(regdom, msg))
8804 		goto nla_put_failure_rcu;
8805 
8806 	rcu_read_unlock();
8807 
8808 	genlmsg_end(msg, hdr);
8809 	rtnl_unlock();
8810 	return genlmsg_reply(msg, info);
8811 
8812 nla_put_failure_rcu:
8813 	rcu_read_unlock();
8814 nla_put_failure:
8815 	rtnl_unlock();
8816 put_failure:
8817 	nlmsg_free(msg);
8818 	return err;
8819 }
8820 
8821 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
8822 			       u32 seq, int flags, struct wiphy *wiphy,
8823 			       const struct ieee80211_regdomain *regdom)
8824 {
8825 	void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
8826 				   NL80211_CMD_GET_REG);
8827 
8828 	if (!hdr)
8829 		return -1;
8830 
8831 	genl_dump_check_consistent(cb, hdr);
8832 
8833 	if (nl80211_put_regdom(regdom, msg))
8834 		goto nla_put_failure;
8835 
8836 	if (!wiphy && reg_last_request_cell_base() &&
8837 	    nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
8838 			NL80211_USER_REG_HINT_CELL_BASE))
8839 		goto nla_put_failure;
8840 
8841 	if (wiphy &&
8842 	    nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
8843 		goto nla_put_failure;
8844 
8845 	if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
8846 	    nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
8847 		goto nla_put_failure;
8848 
8849 	genlmsg_end(msg, hdr);
8850 	return 0;
8851 
8852 nla_put_failure:
8853 	genlmsg_cancel(msg, hdr);
8854 	return -EMSGSIZE;
8855 }
8856 
8857 static int nl80211_get_reg_dump(struct sk_buff *skb,
8858 				struct netlink_callback *cb)
8859 {
8860 	const struct ieee80211_regdomain *regdom = NULL;
8861 	struct cfg80211_registered_device *rdev;
8862 	int err, reg_idx, start = cb->args[2];
8863 
8864 	rcu_read_lock();
8865 
8866 	if (cfg80211_regdomain && start == 0) {
8867 		err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
8868 					  NLM_F_MULTI, NULL,
8869 					  rcu_dereference(cfg80211_regdomain));
8870 		if (err < 0)
8871 			goto out_err;
8872 	}
8873 
8874 	/* the global regdom is idx 0 */
8875 	reg_idx = 1;
8876 	list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
8877 		regdom = get_wiphy_regdom(&rdev->wiphy);
8878 		if (!regdom)
8879 			continue;
8880 
8881 		if (++reg_idx <= start)
8882 			continue;
8883 
8884 		err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
8885 					  NLM_F_MULTI, &rdev->wiphy, regdom);
8886 		if (err < 0) {
8887 			reg_idx--;
8888 			break;
8889 		}
8890 	}
8891 
8892 	cb->args[2] = reg_idx;
8893 	err = skb->len;
8894 out_err:
8895 	rcu_read_unlock();
8896 	return err;
8897 }
8898 
8899 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
8900 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
8901 	[NL80211_ATTR_REG_RULE_FLAGS]		= { .type = NLA_U32 },
8902 	[NL80211_ATTR_FREQ_RANGE_START]		= { .type = NLA_U32 },
8903 	[NL80211_ATTR_FREQ_RANGE_END]		= { .type = NLA_U32 },
8904 	[NL80211_ATTR_FREQ_RANGE_MAX_BW]	= { .type = NLA_U32 },
8905 	[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]	= { .type = NLA_U32 },
8906 	[NL80211_ATTR_POWER_RULE_MAX_EIRP]	= { .type = NLA_U32 },
8907 	[NL80211_ATTR_DFS_CAC_TIME]		= { .type = NLA_U32 },
8908 };
8909 
8910 static int parse_reg_rule(struct nlattr *tb[],
8911 	struct ieee80211_reg_rule *reg_rule)
8912 {
8913 	struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
8914 	struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
8915 
8916 	if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
8917 		return -EINVAL;
8918 	if (!tb[NL80211_ATTR_FREQ_RANGE_START])
8919 		return -EINVAL;
8920 	if (!tb[NL80211_ATTR_FREQ_RANGE_END])
8921 		return -EINVAL;
8922 	if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
8923 		return -EINVAL;
8924 	if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
8925 		return -EINVAL;
8926 
8927 	reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
8928 
8929 	freq_range->start_freq_khz =
8930 		nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
8931 	freq_range->end_freq_khz =
8932 		nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
8933 	freq_range->max_bandwidth_khz =
8934 		nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
8935 
8936 	power_rule->max_eirp =
8937 		nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
8938 
8939 	if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
8940 		power_rule->max_antenna_gain =
8941 			nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
8942 
8943 	if (tb[NL80211_ATTR_DFS_CAC_TIME])
8944 		reg_rule->dfs_cac_ms =
8945 			nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
8946 
8947 	return 0;
8948 }
8949 
8950 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
8951 {
8952 	struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
8953 	struct nlattr *nl_reg_rule;
8954 	char *alpha2;
8955 	int rem_reg_rules, r;
8956 	u32 num_rules = 0, rule_idx = 0;
8957 	enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
8958 	struct ieee80211_regdomain *rd;
8959 
8960 	if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
8961 		return -EINVAL;
8962 
8963 	if (!info->attrs[NL80211_ATTR_REG_RULES])
8964 		return -EINVAL;
8965 
8966 	alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
8967 
8968 	if (info->attrs[NL80211_ATTR_DFS_REGION])
8969 		dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
8970 
8971 	nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
8972 			    rem_reg_rules) {
8973 		num_rules++;
8974 		if (num_rules > NL80211_MAX_SUPP_REG_RULES)
8975 			return -EINVAL;
8976 	}
8977 
8978 	rtnl_lock();
8979 	if (!reg_is_valid_request(alpha2)) {
8980 		r = -EINVAL;
8981 		goto out;
8982 	}
8983 
8984 	rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL);
8985 	if (!rd) {
8986 		r = -ENOMEM;
8987 		goto out;
8988 	}
8989 
8990 	rd->n_reg_rules = num_rules;
8991 	rd->alpha2[0] = alpha2[0];
8992 	rd->alpha2[1] = alpha2[1];
8993 
8994 	/*
8995 	 * Disable DFS master mode if the DFS region was
8996 	 * not supported or known on this kernel.
8997 	 */
8998 	if (reg_supported_dfs_region(dfs_region))
8999 		rd->dfs_region = dfs_region;
9000 
9001 	nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
9002 			    rem_reg_rules) {
9003 		r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX,
9004 						nl_reg_rule, reg_rule_policy,
9005 						info->extack);
9006 		if (r)
9007 			goto bad_reg;
9008 		r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
9009 		if (r)
9010 			goto bad_reg;
9011 
9012 		rule_idx++;
9013 
9014 		if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
9015 			r = -EINVAL;
9016 			goto bad_reg;
9017 		}
9018 	}
9019 
9020 	r = set_regdom(rd, REGD_SOURCE_CRDA);
9021 	/* set_regdom takes ownership of rd */
9022 	rd = NULL;
9023  bad_reg:
9024 	kfree(rd);
9025  out:
9026 	rtnl_unlock();
9027 	return r;
9028 }
9029 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */
9030 
9031 static int validate_scan_freqs(struct nlattr *freqs)
9032 {
9033 	struct nlattr *attr1, *attr2;
9034 	int n_channels = 0, tmp1, tmp2;
9035 
9036 	nla_for_each_nested(attr1, freqs, tmp1)
9037 		if (nla_len(attr1) != sizeof(u32))
9038 			return 0;
9039 
9040 	nla_for_each_nested(attr1, freqs, tmp1) {
9041 		n_channels++;
9042 		/*
9043 		 * Some hardware has a limited channel list for
9044 		 * scanning, and it is pretty much nonsensical
9045 		 * to scan for a channel twice, so disallow that
9046 		 * and don't require drivers to check that the
9047 		 * channel list they get isn't longer than what
9048 		 * they can scan, as long as they can scan all
9049 		 * the channels they registered at once.
9050 		 */
9051 		nla_for_each_nested(attr2, freqs, tmp2)
9052 			if (attr1 != attr2 &&
9053 			    nla_get_u32(attr1) == nla_get_u32(attr2))
9054 				return 0;
9055 	}
9056 
9057 	return n_channels;
9058 }
9059 
9060 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
9061 {
9062 	return b < NUM_NL80211_BANDS && wiphy->bands[b];
9063 }
9064 
9065 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
9066 			    struct cfg80211_bss_selection *bss_select)
9067 {
9068 	struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
9069 	struct nlattr *nest;
9070 	int err;
9071 	bool found = false;
9072 	int i;
9073 
9074 	/* only process one nested attribute */
9075 	nest = nla_data(nla);
9076 	if (!nla_ok(nest, nla_len(nest)))
9077 		return -EINVAL;
9078 
9079 	err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX,
9080 					  nest, nl80211_bss_select_policy,
9081 					  NULL);
9082 	if (err)
9083 		return err;
9084 
9085 	/* only one attribute may be given */
9086 	for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
9087 		if (attr[i]) {
9088 			if (found)
9089 				return -EINVAL;
9090 			found = true;
9091 		}
9092 	}
9093 
9094 	bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
9095 
9096 	if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
9097 		bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
9098 
9099 	if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
9100 		bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
9101 		bss_select->param.band_pref =
9102 			nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
9103 		if (!is_band_valid(wiphy, bss_select->param.band_pref))
9104 			return -EINVAL;
9105 	}
9106 
9107 	if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
9108 		struct nl80211_bss_select_rssi_adjust *adj_param;
9109 
9110 		adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
9111 		bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
9112 		bss_select->param.adjust.band = adj_param->band;
9113 		bss_select->param.adjust.delta = adj_param->delta;
9114 		if (!is_band_valid(wiphy, bss_select->param.adjust.band))
9115 			return -EINVAL;
9116 	}
9117 
9118 	/* user-space did not provide behaviour attribute */
9119 	if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
9120 		return -EINVAL;
9121 
9122 	if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
9123 		return -EINVAL;
9124 
9125 	return 0;
9126 }
9127 
9128 int nl80211_parse_random_mac(struct nlattr **attrs,
9129 			     u8 *mac_addr, u8 *mac_addr_mask)
9130 {
9131 	int i;
9132 
9133 	if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
9134 		eth_zero_addr(mac_addr);
9135 		eth_zero_addr(mac_addr_mask);
9136 		mac_addr[0] = 0x2;
9137 		mac_addr_mask[0] = 0x3;
9138 
9139 		return 0;
9140 	}
9141 
9142 	/* need both or none */
9143 	if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
9144 		return -EINVAL;
9145 
9146 	memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
9147 	memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
9148 
9149 	/* don't allow or configure an mcast address */
9150 	if (!is_multicast_ether_addr(mac_addr_mask) ||
9151 	    is_multicast_ether_addr(mac_addr))
9152 		return -EINVAL;
9153 
9154 	/*
9155 	 * allow users to pass a MAC address that has bits set outside
9156 	 * of the mask, but don't bother drivers with having to deal
9157 	 * with such bits
9158 	 */
9159 	for (i = 0; i < ETH_ALEN; i++)
9160 		mac_addr[i] &= mac_addr_mask[i];
9161 
9162 	return 0;
9163 }
9164 
9165 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev,
9166 					      struct ieee80211_channel *chan)
9167 {
9168 	unsigned int link_id;
9169 	bool all_ok = true;
9170 
9171 	lockdep_assert_wiphy(wdev->wiphy);
9172 
9173 	if (!cfg80211_wdev_channel_allowed(wdev, chan))
9174 		return false;
9175 
9176 	if (!cfg80211_beaconing_iface_active(wdev))
9177 		return true;
9178 
9179 	/*
9180 	 * FIXME: check if we have a free HW resource/link for chan
9181 	 *
9182 	 * This, as well as the FIXME below, requires knowing the link
9183 	 * capabilities of the hardware.
9184 	 */
9185 
9186 	/* we cannot leave radar channels */
9187 	for_each_valid_link(wdev, link_id) {
9188 		struct cfg80211_chan_def *chandef;
9189 
9190 		chandef = wdev_chandef(wdev, link_id);
9191 		if (!chandef || !chandef->chan)
9192 			continue;
9193 
9194 		/*
9195 		 * FIXME: don't require all_ok, but rather check only the
9196 		 *	  correct HW resource/link onto which 'chan' falls,
9197 		 *	  as only that link leaves the channel for doing
9198 		 *	  the off-channel operation.
9199 		 */
9200 
9201 		if (chandef->chan->flags & IEEE80211_CHAN_RADAR)
9202 			all_ok = false;
9203 	}
9204 
9205 	if (all_ok)
9206 		return true;
9207 
9208 	return regulatory_pre_cac_allowed(wdev->wiphy);
9209 }
9210 
9211 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag,
9212 				    enum nl80211_ext_feature_index feat)
9213 {
9214 	if (!(flags & flag))
9215 		return true;
9216 	if (wiphy_ext_feature_isset(wiphy, feat))
9217 		return true;
9218 	return false;
9219 }
9220 
9221 static int
9222 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev,
9223 			 void *request, struct nlattr **attrs,
9224 			 bool is_sched_scan)
9225 {
9226 	u8 *mac_addr, *mac_addr_mask;
9227 	u32 *flags;
9228 	enum nl80211_feature_flags randomness_flag;
9229 
9230 	if (!attrs[NL80211_ATTR_SCAN_FLAGS])
9231 		return 0;
9232 
9233 	if (is_sched_scan) {
9234 		struct cfg80211_sched_scan_request *req = request;
9235 
9236 		randomness_flag = wdev ?
9237 				  NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR :
9238 				  NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
9239 		flags = &req->flags;
9240 		mac_addr = req->mac_addr;
9241 		mac_addr_mask = req->mac_addr_mask;
9242 	} else {
9243 		struct cfg80211_scan_request *req = request;
9244 
9245 		randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
9246 		flags = &req->flags;
9247 		mac_addr = req->mac_addr;
9248 		mac_addr_mask = req->mac_addr_mask;
9249 	}
9250 
9251 	*flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]);
9252 
9253 	if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
9254 	     !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
9255 	    !nl80211_check_scan_feat(wiphy, *flags,
9256 				     NL80211_SCAN_FLAG_LOW_SPAN,
9257 				     NL80211_EXT_FEATURE_LOW_SPAN_SCAN) ||
9258 	    !nl80211_check_scan_feat(wiphy, *flags,
9259 				     NL80211_SCAN_FLAG_LOW_POWER,
9260 				     NL80211_EXT_FEATURE_LOW_POWER_SCAN) ||
9261 	    !nl80211_check_scan_feat(wiphy, *flags,
9262 				     NL80211_SCAN_FLAG_HIGH_ACCURACY,
9263 				     NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) ||
9264 	    !nl80211_check_scan_feat(wiphy, *flags,
9265 				     NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME,
9266 				     NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) ||
9267 	    !nl80211_check_scan_feat(wiphy, *flags,
9268 				     NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP,
9269 				     NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) ||
9270 	    !nl80211_check_scan_feat(wiphy, *flags,
9271 				     NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION,
9272 				     NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) ||
9273 	    !nl80211_check_scan_feat(wiphy, *flags,
9274 				     NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE,
9275 				     NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) ||
9276 	    !nl80211_check_scan_feat(wiphy, *flags,
9277 				     NL80211_SCAN_FLAG_RANDOM_SN,
9278 				     NL80211_EXT_FEATURE_SCAN_RANDOM_SN) ||
9279 	    !nl80211_check_scan_feat(wiphy, *flags,
9280 				     NL80211_SCAN_FLAG_MIN_PREQ_CONTENT,
9281 				     NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT))
9282 		return -EOPNOTSUPP;
9283 
9284 	if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
9285 		int err;
9286 
9287 		if (!(wiphy->features & randomness_flag) ||
9288 		    (wdev && wdev->connected))
9289 			return -EOPNOTSUPP;
9290 
9291 		err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask);
9292 		if (err)
9293 			return err;
9294 	}
9295 
9296 	return 0;
9297 }
9298 
9299 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
9300 {
9301 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9302 	struct wireless_dev *wdev = info->user_ptr[1];
9303 	struct cfg80211_scan_request *request;
9304 	struct nlattr *scan_freqs = NULL;
9305 	bool scan_freqs_khz = false;
9306 	struct nlattr *attr;
9307 	struct wiphy *wiphy;
9308 	int err, tmp, n_ssids = 0, n_channels, i;
9309 	size_t ie_len, size;
9310 	size_t ssids_offset, ie_offset;
9311 
9312 	wiphy = &rdev->wiphy;
9313 
9314 	if (wdev->iftype == NL80211_IFTYPE_NAN)
9315 		return -EOPNOTSUPP;
9316 
9317 	if (!rdev->ops->scan)
9318 		return -EOPNOTSUPP;
9319 
9320 	if (rdev->scan_req || rdev->scan_msg)
9321 		return -EBUSY;
9322 
9323 	if (info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]) {
9324 		if (!wiphy_ext_feature_isset(wiphy,
9325 					     NL80211_EXT_FEATURE_SCAN_FREQ_KHZ))
9326 			return -EOPNOTSUPP;
9327 		scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ];
9328 		scan_freqs_khz = true;
9329 	} else if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES])
9330 		scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQUENCIES];
9331 
9332 	if (scan_freqs) {
9333 		n_channels = validate_scan_freqs(scan_freqs);
9334 		if (!n_channels)
9335 			return -EINVAL;
9336 	} else {
9337 		n_channels = ieee80211_get_num_supported_channels(wiphy);
9338 	}
9339 
9340 	if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
9341 		nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
9342 			n_ssids++;
9343 
9344 	if (n_ssids > wiphy->max_scan_ssids)
9345 		return -EINVAL;
9346 
9347 	if (info->attrs[NL80211_ATTR_IE])
9348 		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9349 	else
9350 		ie_len = 0;
9351 
9352 	if (ie_len > wiphy->max_scan_ie_len)
9353 		return -EINVAL;
9354 
9355 	size = struct_size(request, channels, n_channels);
9356 	ssids_offset = size;
9357 	size = size_add(size, array_size(sizeof(*request->ssids), n_ssids));
9358 	ie_offset = size;
9359 	size = size_add(size, ie_len);
9360 	request = kzalloc(size, GFP_KERNEL);
9361 	if (!request)
9362 		return -ENOMEM;
9363 	request->n_channels = n_channels;
9364 
9365 	if (n_ssids)
9366 		request->ssids = (void *)request + ssids_offset;
9367 	request->n_ssids = n_ssids;
9368 	if (ie_len)
9369 		request->ie = (void *)request + ie_offset;
9370 
9371 	i = 0;
9372 	if (scan_freqs) {
9373 		/* user specified, bail out if channel not found */
9374 		nla_for_each_nested(attr, scan_freqs, tmp) {
9375 			struct ieee80211_channel *chan;
9376 			int freq = nla_get_u32(attr);
9377 
9378 			if (!scan_freqs_khz)
9379 				freq = MHZ_TO_KHZ(freq);
9380 
9381 			chan = ieee80211_get_channel_khz(wiphy, freq);
9382 			if (!chan) {
9383 				err = -EINVAL;
9384 				goto out_free;
9385 			}
9386 
9387 			/* ignore disabled channels */
9388 			if (chan->flags & IEEE80211_CHAN_DISABLED ||
9389 			    !cfg80211_wdev_channel_allowed(wdev, chan))
9390 				continue;
9391 
9392 			request->channels[i] = chan;
9393 			i++;
9394 		}
9395 	} else {
9396 		enum nl80211_band band;
9397 
9398 		/* all channels */
9399 		for (band = 0; band < NUM_NL80211_BANDS; band++) {
9400 			int j;
9401 
9402 			if (!wiphy->bands[band])
9403 				continue;
9404 			for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
9405 				struct ieee80211_channel *chan;
9406 
9407 				chan = &wiphy->bands[band]->channels[j];
9408 
9409 				if (chan->flags & IEEE80211_CHAN_DISABLED ||
9410 				    !cfg80211_wdev_channel_allowed(wdev, chan))
9411 					continue;
9412 
9413 				request->channels[i] = chan;
9414 				i++;
9415 			}
9416 		}
9417 	}
9418 
9419 	if (!i) {
9420 		err = -EINVAL;
9421 		goto out_free;
9422 	}
9423 
9424 	request->n_channels = i;
9425 
9426 	for (i = 0; i < request->n_channels; i++) {
9427 		struct ieee80211_channel *chan = request->channels[i];
9428 
9429 		/* if we can go off-channel to the target channel we're good */
9430 		if (cfg80211_off_channel_oper_allowed(wdev, chan))
9431 			continue;
9432 
9433 		if (!cfg80211_wdev_on_sub_chan(wdev, chan, true)) {
9434 			err = -EBUSY;
9435 			goto out_free;
9436 		}
9437 	}
9438 
9439 	i = 0;
9440 	if (n_ssids) {
9441 		nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
9442 			if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
9443 				err = -EINVAL;
9444 				goto out_free;
9445 			}
9446 			request->ssids[i].ssid_len = nla_len(attr);
9447 			memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
9448 			i++;
9449 		}
9450 	}
9451 
9452 	if (info->attrs[NL80211_ATTR_IE]) {
9453 		request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9454 		memcpy((void *)request->ie,
9455 		       nla_data(info->attrs[NL80211_ATTR_IE]),
9456 		       request->ie_len);
9457 	}
9458 
9459 	for (i = 0; i < NUM_NL80211_BANDS; i++)
9460 		if (wiphy->bands[i])
9461 			request->rates[i] =
9462 				(1 << wiphy->bands[i]->n_bitrates) - 1;
9463 
9464 	if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
9465 		nla_for_each_nested(attr,
9466 				    info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
9467 				    tmp) {
9468 			enum nl80211_band band = nla_type(attr);
9469 
9470 			if (band < 0 || band >= NUM_NL80211_BANDS) {
9471 				err = -EINVAL;
9472 				goto out_free;
9473 			}
9474 
9475 			if (!wiphy->bands[band])
9476 				continue;
9477 
9478 			err = ieee80211_get_ratemask(wiphy->bands[band],
9479 						     nla_data(attr),
9480 						     nla_len(attr),
9481 						     &request->rates[band]);
9482 			if (err)
9483 				goto out_free;
9484 		}
9485 	}
9486 
9487 	if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
9488 		request->duration =
9489 			nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
9490 		request->duration_mandatory =
9491 			nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
9492 	}
9493 
9494 	err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs,
9495 				       false);
9496 	if (err)
9497 		goto out_free;
9498 
9499 	request->no_cck =
9500 		nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
9501 
9502 	/* Initial implementation used NL80211_ATTR_MAC to set the specific
9503 	 * BSSID to scan for. This was problematic because that same attribute
9504 	 * was already used for another purpose (local random MAC address). The
9505 	 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
9506 	 * compatibility with older userspace components, also use the
9507 	 * NL80211_ATTR_MAC value here if it can be determined to be used for
9508 	 * the specific BSSID use case instead of the random MAC address
9509 	 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
9510 	 */
9511 	if (info->attrs[NL80211_ATTR_BSSID])
9512 		memcpy(request->bssid,
9513 		       nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
9514 	else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
9515 		 info->attrs[NL80211_ATTR_MAC])
9516 		memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
9517 		       ETH_ALEN);
9518 	else
9519 		eth_broadcast_addr(request->bssid);
9520 
9521 	request->tsf_report_link_id = nl80211_link_id_or_invalid(info->attrs);
9522 	request->wdev = wdev;
9523 	request->wiphy = &rdev->wiphy;
9524 	request->scan_start = jiffies;
9525 
9526 	rdev->scan_req = request;
9527 	err = cfg80211_scan(rdev);
9528 
9529 	if (err)
9530 		goto out_free;
9531 
9532 	nl80211_send_scan_start(rdev, wdev);
9533 	dev_hold(wdev->netdev);
9534 
9535 	return 0;
9536 
9537  out_free:
9538 	rdev->scan_req = NULL;
9539 	kfree(request);
9540 
9541 	return err;
9542 }
9543 
9544 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
9545 {
9546 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9547 	struct wireless_dev *wdev = info->user_ptr[1];
9548 
9549 	if (!rdev->ops->abort_scan)
9550 		return -EOPNOTSUPP;
9551 
9552 	if (rdev->scan_msg)
9553 		return 0;
9554 
9555 	if (!rdev->scan_req)
9556 		return -ENOENT;
9557 
9558 	rdev_abort_scan(rdev, wdev);
9559 	return 0;
9560 }
9561 
9562 static int
9563 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
9564 			       struct cfg80211_sched_scan_request *request,
9565 			       struct nlattr **attrs)
9566 {
9567 	int tmp, err, i = 0;
9568 	struct nlattr *attr;
9569 
9570 	if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
9571 		u32 interval;
9572 
9573 		/*
9574 		 * If scan plans are not specified,
9575 		 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
9576 		 * case one scan plan will be set with the specified scan
9577 		 * interval and infinite number of iterations.
9578 		 */
9579 		interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
9580 		if (!interval)
9581 			return -EINVAL;
9582 
9583 		request->scan_plans[0].interval =
9584 			DIV_ROUND_UP(interval, MSEC_PER_SEC);
9585 		if (!request->scan_plans[0].interval)
9586 			return -EINVAL;
9587 
9588 		if (request->scan_plans[0].interval >
9589 		    wiphy->max_sched_scan_plan_interval)
9590 			request->scan_plans[0].interval =
9591 				wiphy->max_sched_scan_plan_interval;
9592 
9593 		return 0;
9594 	}
9595 
9596 	nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
9597 		struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
9598 
9599 		if (WARN_ON(i >= n_plans))
9600 			return -EINVAL;
9601 
9602 		err = nla_parse_nested_deprecated(plan,
9603 						  NL80211_SCHED_SCAN_PLAN_MAX,
9604 						  attr, nl80211_plan_policy,
9605 						  NULL);
9606 		if (err)
9607 			return err;
9608 
9609 		if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
9610 			return -EINVAL;
9611 
9612 		request->scan_plans[i].interval =
9613 			nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
9614 		if (!request->scan_plans[i].interval ||
9615 		    request->scan_plans[i].interval >
9616 		    wiphy->max_sched_scan_plan_interval)
9617 			return -EINVAL;
9618 
9619 		if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
9620 			request->scan_plans[i].iterations =
9621 				nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
9622 			if (!request->scan_plans[i].iterations ||
9623 			    (request->scan_plans[i].iterations >
9624 			     wiphy->max_sched_scan_plan_iterations))
9625 				return -EINVAL;
9626 		} else if (i < n_plans - 1) {
9627 			/*
9628 			 * All scan plans but the last one must specify
9629 			 * a finite number of iterations
9630 			 */
9631 			return -EINVAL;
9632 		}
9633 
9634 		i++;
9635 	}
9636 
9637 	/*
9638 	 * The last scan plan must not specify the number of
9639 	 * iterations, it is supposed to run infinitely
9640 	 */
9641 	if (request->scan_plans[n_plans - 1].iterations)
9642 		return  -EINVAL;
9643 
9644 	return 0;
9645 }
9646 
9647 static struct cfg80211_sched_scan_request *
9648 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
9649 			 struct nlattr **attrs, int max_match_sets)
9650 {
9651 	struct cfg80211_sched_scan_request *request;
9652 	struct nlattr *attr;
9653 	int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
9654 	enum nl80211_band band;
9655 	size_t ie_len, size;
9656 	struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
9657 	s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
9658 
9659 	if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
9660 		n_channels = validate_scan_freqs(
9661 				attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
9662 		if (!n_channels)
9663 			return ERR_PTR(-EINVAL);
9664 	} else {
9665 		n_channels = ieee80211_get_num_supported_channels(wiphy);
9666 	}
9667 
9668 	if (attrs[NL80211_ATTR_SCAN_SSIDS])
9669 		nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
9670 				    tmp)
9671 			n_ssids++;
9672 
9673 	if (n_ssids > wiphy->max_sched_scan_ssids)
9674 		return ERR_PTR(-EINVAL);
9675 
9676 	/*
9677 	 * First, count the number of 'real' matchsets. Due to an issue with
9678 	 * the old implementation, matchsets containing only the RSSI attribute
9679 	 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
9680 	 * RSSI for all matchsets, rather than their own matchset for reporting
9681 	 * all APs with a strong RSSI. This is needed to be compatible with
9682 	 * older userspace that treated a matchset with only the RSSI as the
9683 	 * global RSSI for all other matchsets - if there are other matchsets.
9684 	 */
9685 	if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
9686 		nla_for_each_nested(attr,
9687 				    attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
9688 				    tmp) {
9689 			struct nlattr *rssi;
9690 
9691 			err = nla_parse_nested_deprecated(tb,
9692 							  NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
9693 							  attr,
9694 							  nl80211_match_policy,
9695 							  NULL);
9696 			if (err)
9697 				return ERR_PTR(err);
9698 
9699 			/* SSID and BSSID are mutually exclusive */
9700 			if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] &&
9701 			    tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID])
9702 				return ERR_PTR(-EINVAL);
9703 
9704 			/* add other standalone attributes here */
9705 			if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] ||
9706 			    tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) {
9707 				n_match_sets++;
9708 				continue;
9709 			}
9710 			rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
9711 			if (rssi)
9712 				default_match_rssi = nla_get_s32(rssi);
9713 		}
9714 	}
9715 
9716 	/* However, if there's no other matchset, add the RSSI one */
9717 	if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
9718 		n_match_sets = 1;
9719 
9720 	if (n_match_sets > max_match_sets)
9721 		return ERR_PTR(-EINVAL);
9722 
9723 	if (attrs[NL80211_ATTR_IE])
9724 		ie_len = nla_len(attrs[NL80211_ATTR_IE]);
9725 	else
9726 		ie_len = 0;
9727 
9728 	if (ie_len > wiphy->max_sched_scan_ie_len)
9729 		return ERR_PTR(-EINVAL);
9730 
9731 	if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
9732 		/*
9733 		 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
9734 		 * each scan plan already specifies its own interval
9735 		 */
9736 		if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
9737 			return ERR_PTR(-EINVAL);
9738 
9739 		nla_for_each_nested(attr,
9740 				    attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
9741 			n_plans++;
9742 	} else {
9743 		/*
9744 		 * The scan interval attribute is kept for backward
9745 		 * compatibility. If no scan plans are specified and sched scan
9746 		 * interval is specified, one scan plan will be set with this
9747 		 * scan interval and infinite number of iterations.
9748 		 */
9749 		if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
9750 			return ERR_PTR(-EINVAL);
9751 
9752 		n_plans = 1;
9753 	}
9754 
9755 	if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
9756 		return ERR_PTR(-EINVAL);
9757 
9758 	if (!wiphy_ext_feature_isset(
9759 		    wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
9760 	    (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
9761 	     attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
9762 		return ERR_PTR(-EINVAL);
9763 
9764 	size = struct_size(request, channels, n_channels);
9765 	size = size_add(size, array_size(sizeof(*request->ssids), n_ssids));
9766 	size = size_add(size, array_size(sizeof(*request->match_sets),
9767 					 n_match_sets));
9768 	size = size_add(size, array_size(sizeof(*request->scan_plans),
9769 					 n_plans));
9770 	size = size_add(size, ie_len);
9771 	request = kzalloc(size, GFP_KERNEL);
9772 	if (!request)
9773 		return ERR_PTR(-ENOMEM);
9774 	request->n_channels = n_channels;
9775 
9776 	if (n_ssids)
9777 		request->ssids = (void *)request +
9778 			struct_size(request, channels, n_channels);
9779 	request->n_ssids = n_ssids;
9780 	if (ie_len) {
9781 		if (n_ssids)
9782 			request->ie = (void *)(request->ssids + n_ssids);
9783 		else
9784 			request->ie = (void *)(request->channels + n_channels);
9785 	}
9786 
9787 	if (n_match_sets) {
9788 		if (request->ie)
9789 			request->match_sets = (void *)(request->ie + ie_len);
9790 		else if (n_ssids)
9791 			request->match_sets =
9792 				(void *)(request->ssids + n_ssids);
9793 		else
9794 			request->match_sets =
9795 				(void *)(request->channels + n_channels);
9796 	}
9797 	request->n_match_sets = n_match_sets;
9798 
9799 	if (n_match_sets)
9800 		request->scan_plans = (void *)(request->match_sets +
9801 					       n_match_sets);
9802 	else if (request->ie)
9803 		request->scan_plans = (void *)(request->ie + ie_len);
9804 	else if (n_ssids)
9805 		request->scan_plans = (void *)(request->ssids + n_ssids);
9806 	else
9807 		request->scan_plans = (void *)(request->channels + n_channels);
9808 
9809 	request->n_scan_plans = n_plans;
9810 
9811 	i = 0;
9812 	if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
9813 		/* user specified, bail out if channel not found */
9814 		nla_for_each_nested(attr,
9815 				    attrs[NL80211_ATTR_SCAN_FREQUENCIES],
9816 				    tmp) {
9817 			struct ieee80211_channel *chan;
9818 
9819 			chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
9820 
9821 			if (!chan) {
9822 				err = -EINVAL;
9823 				goto out_free;
9824 			}
9825 
9826 			/* ignore disabled channels */
9827 			if (chan->flags & IEEE80211_CHAN_DISABLED)
9828 				continue;
9829 
9830 			request->channels[i] = chan;
9831 			i++;
9832 		}
9833 	} else {
9834 		/* all channels */
9835 		for (band = 0; band < NUM_NL80211_BANDS; band++) {
9836 			int j;
9837 
9838 			if (!wiphy->bands[band])
9839 				continue;
9840 			for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
9841 				struct ieee80211_channel *chan;
9842 
9843 				chan = &wiphy->bands[band]->channels[j];
9844 
9845 				if (chan->flags & IEEE80211_CHAN_DISABLED)
9846 					continue;
9847 
9848 				request->channels[i] = chan;
9849 				i++;
9850 			}
9851 		}
9852 	}
9853 
9854 	if (!i) {
9855 		err = -EINVAL;
9856 		goto out_free;
9857 	}
9858 
9859 	request->n_channels = i;
9860 
9861 	i = 0;
9862 	if (n_ssids) {
9863 		nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
9864 				    tmp) {
9865 			if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
9866 				err = -EINVAL;
9867 				goto out_free;
9868 			}
9869 			request->ssids[i].ssid_len = nla_len(attr);
9870 			memcpy(request->ssids[i].ssid, nla_data(attr),
9871 			       nla_len(attr));
9872 			i++;
9873 		}
9874 	}
9875 
9876 	i = 0;
9877 	if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
9878 		nla_for_each_nested(attr,
9879 				    attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
9880 				    tmp) {
9881 			struct nlattr *ssid, *bssid, *rssi;
9882 
9883 			err = nla_parse_nested_deprecated(tb,
9884 							  NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
9885 							  attr,
9886 							  nl80211_match_policy,
9887 							  NULL);
9888 			if (err)
9889 				goto out_free;
9890 			ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
9891 			bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID];
9892 
9893 			if (!ssid && !bssid) {
9894 				i++;
9895 				continue;
9896 			}
9897 
9898 			if (WARN_ON(i >= n_match_sets)) {
9899 				/* this indicates a programming error,
9900 				 * the loop above should have verified
9901 				 * things properly
9902 				 */
9903 				err = -EINVAL;
9904 				goto out_free;
9905 			}
9906 
9907 			if (ssid) {
9908 				memcpy(request->match_sets[i].ssid.ssid,
9909 				       nla_data(ssid), nla_len(ssid));
9910 				request->match_sets[i].ssid.ssid_len =
9911 					nla_len(ssid);
9912 			}
9913 			if (bssid)
9914 				memcpy(request->match_sets[i].bssid,
9915 				       nla_data(bssid), ETH_ALEN);
9916 
9917 			/* special attribute - old implementation w/a */
9918 			request->match_sets[i].rssi_thold = default_match_rssi;
9919 			rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
9920 			if (rssi)
9921 				request->match_sets[i].rssi_thold =
9922 					nla_get_s32(rssi);
9923 			i++;
9924 		}
9925 
9926 		/* there was no other matchset, so the RSSI one is alone */
9927 		if (i == 0 && n_match_sets)
9928 			request->match_sets[0].rssi_thold = default_match_rssi;
9929 
9930 		request->min_rssi_thold = INT_MAX;
9931 		for (i = 0; i < n_match_sets; i++)
9932 			request->min_rssi_thold =
9933 				min(request->match_sets[i].rssi_thold,
9934 				    request->min_rssi_thold);
9935 	} else {
9936 		request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
9937 	}
9938 
9939 	if (ie_len) {
9940 		request->ie_len = ie_len;
9941 		memcpy((void *)request->ie,
9942 		       nla_data(attrs[NL80211_ATTR_IE]),
9943 		       request->ie_len);
9944 	}
9945 
9946 	err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true);
9947 	if (err)
9948 		goto out_free;
9949 
9950 	if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
9951 		request->delay =
9952 			nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
9953 
9954 	if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
9955 		request->relative_rssi = nla_get_s8(
9956 			attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
9957 		request->relative_rssi_set = true;
9958 	}
9959 
9960 	if (request->relative_rssi_set &&
9961 	    attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
9962 		struct nl80211_bss_select_rssi_adjust *rssi_adjust;
9963 
9964 		rssi_adjust = nla_data(
9965 			attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
9966 		request->rssi_adjust.band = rssi_adjust->band;
9967 		request->rssi_adjust.delta = rssi_adjust->delta;
9968 		if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
9969 			err = -EINVAL;
9970 			goto out_free;
9971 		}
9972 	}
9973 
9974 	err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
9975 	if (err)
9976 		goto out_free;
9977 
9978 	request->scan_start = jiffies;
9979 
9980 	return request;
9981 
9982 out_free:
9983 	kfree(request);
9984 	return ERR_PTR(err);
9985 }
9986 
9987 static int nl80211_start_sched_scan(struct sk_buff *skb,
9988 				    struct genl_info *info)
9989 {
9990 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
9991 	struct net_device *dev = info->user_ptr[1];
9992 	struct wireless_dev *wdev = dev->ieee80211_ptr;
9993 	struct cfg80211_sched_scan_request *sched_scan_req;
9994 	bool want_multi;
9995 	int err;
9996 
9997 	if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
9998 		return -EOPNOTSUPP;
9999 
10000 	want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
10001 	err = cfg80211_sched_scan_req_possible(rdev, want_multi);
10002 	if (err)
10003 		return err;
10004 
10005 	sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
10006 						  info->attrs,
10007 						  rdev->wiphy.max_match_sets);
10008 
10009 	err = PTR_ERR_OR_ZERO(sched_scan_req);
10010 	if (err)
10011 		goto out_err;
10012 
10013 	/* leave request id zero for legacy request
10014 	 * or if driver does not support multi-scheduled scan
10015 	 */
10016 	if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1)
10017 		sched_scan_req->reqid = cfg80211_assign_cookie(rdev);
10018 
10019 	err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
10020 	if (err)
10021 		goto out_free;
10022 
10023 	sched_scan_req->dev = dev;
10024 	sched_scan_req->wiphy = &rdev->wiphy;
10025 
10026 	if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
10027 		sched_scan_req->owner_nlportid = info->snd_portid;
10028 
10029 	cfg80211_add_sched_scan_req(rdev, sched_scan_req);
10030 
10031 	nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
10032 	return 0;
10033 
10034 out_free:
10035 	kfree(sched_scan_req);
10036 out_err:
10037 	return err;
10038 }
10039 
10040 static int nl80211_stop_sched_scan(struct sk_buff *skb,
10041 				   struct genl_info *info)
10042 {
10043 	struct cfg80211_sched_scan_request *req;
10044 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10045 	u64 cookie;
10046 
10047 	if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
10048 		return -EOPNOTSUPP;
10049 
10050 	if (info->attrs[NL80211_ATTR_COOKIE]) {
10051 		cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
10052 		return __cfg80211_stop_sched_scan(rdev, cookie, false);
10053 	}
10054 
10055 	req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
10056 				     struct cfg80211_sched_scan_request,
10057 				     list);
10058 	if (!req || req->reqid ||
10059 	    (req->owner_nlportid &&
10060 	     req->owner_nlportid != info->snd_portid))
10061 		return -ENOENT;
10062 
10063 	return cfg80211_stop_sched_scan_req(rdev, req, false);
10064 }
10065 
10066 static int nl80211_start_radar_detection(struct sk_buff *skb,
10067 					 struct genl_info *info)
10068 {
10069 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10070 	struct net_device *dev = info->user_ptr[1];
10071 	struct wireless_dev *wdev = dev->ieee80211_ptr;
10072 	int link_id = nl80211_link_id(info->attrs);
10073 	struct wiphy *wiphy = wdev->wiphy;
10074 	struct cfg80211_chan_def chandef;
10075 	enum nl80211_dfs_regions dfs_region;
10076 	unsigned int cac_time_ms;
10077 	int err;
10078 
10079 	flush_delayed_work(&rdev->dfs_update_channels_wk);
10080 
10081 	switch (wdev->iftype) {
10082 	case NL80211_IFTYPE_AP:
10083 	case NL80211_IFTYPE_P2P_GO:
10084 	case NL80211_IFTYPE_MESH_POINT:
10085 	case NL80211_IFTYPE_ADHOC:
10086 		break;
10087 	default:
10088 		/* caution - see cfg80211_beaconing_iface_active() below */
10089 		return -EINVAL;
10090 	}
10091 
10092 	guard(wiphy)(wiphy);
10093 
10094 	dfs_region = reg_get_dfs_region(wiphy);
10095 	if (dfs_region == NL80211_DFS_UNSET)
10096 		return -EINVAL;
10097 
10098 	err = nl80211_parse_chandef(rdev, info, &chandef);
10099 	if (err)
10100 		return err;
10101 
10102 	err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
10103 	if (err < 0)
10104 		return err;
10105 
10106 	if (err == 0)
10107 		return -EINVAL;
10108 
10109 	if (!cfg80211_chandef_dfs_usable(wiphy, &chandef))
10110 		return -EINVAL;
10111 
10112 	if (nla_get_flag(info->attrs[NL80211_ATTR_RADAR_BACKGROUND]))
10113 		return cfg80211_start_background_radar_detection(rdev, wdev,
10114 								 &chandef);
10115 
10116 	if (cfg80211_beaconing_iface_active(wdev)) {
10117 		/* During MLO other link(s) can beacon, only the current link
10118 		 * can not already beacon
10119 		 */
10120 		if (wdev->valid_links &&
10121 		    !wdev->links[link_id].ap.beacon_interval) {
10122 			/* nothing */
10123 		} else {
10124 			return -EBUSY;
10125 		}
10126 	}
10127 
10128 	if (wdev->links[link_id].cac_started)
10129 		return -EBUSY;
10130 
10131 	/* CAC start is offloaded to HW and can't be started manually */
10132 	if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD))
10133 		return -EOPNOTSUPP;
10134 
10135 	if (!rdev->ops->start_radar_detection)
10136 		return -EOPNOTSUPP;
10137 
10138 	cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
10139 	if (WARN_ON(!cac_time_ms))
10140 		cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
10141 
10142 	err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms,
10143 					 link_id);
10144 	if (!err) {
10145 		switch (wdev->iftype) {
10146 		case NL80211_IFTYPE_AP:
10147 		case NL80211_IFTYPE_P2P_GO:
10148 			wdev->links[0].ap.chandef = chandef;
10149 			break;
10150 		case NL80211_IFTYPE_ADHOC:
10151 			wdev->u.ibss.chandef = chandef;
10152 			break;
10153 		case NL80211_IFTYPE_MESH_POINT:
10154 			wdev->u.mesh.chandef = chandef;
10155 			break;
10156 		default:
10157 			break;
10158 		}
10159 		wdev->links[link_id].cac_started = true;
10160 		wdev->links[link_id].cac_start_time = jiffies;
10161 		wdev->links[link_id].cac_time_ms = cac_time_ms;
10162 	}
10163 
10164 	return 0;
10165 }
10166 
10167 static int nl80211_notify_radar_detection(struct sk_buff *skb,
10168 					  struct genl_info *info)
10169 {
10170 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10171 	struct net_device *dev = info->user_ptr[1];
10172 	struct wireless_dev *wdev = dev->ieee80211_ptr;
10173 	struct wiphy *wiphy = wdev->wiphy;
10174 	struct cfg80211_chan_def chandef;
10175 	enum nl80211_dfs_regions dfs_region;
10176 	int err;
10177 
10178 	dfs_region = reg_get_dfs_region(wiphy);
10179 	if (dfs_region == NL80211_DFS_UNSET) {
10180 		GENL_SET_ERR_MSG(info,
10181 				 "DFS Region is not set. Unexpected Radar indication");
10182 		return -EINVAL;
10183 	}
10184 
10185 	err = nl80211_parse_chandef(rdev, info, &chandef);
10186 	if (err) {
10187 		GENL_SET_ERR_MSG(info, "Unable to extract chandef info");
10188 		return err;
10189 	}
10190 
10191 	err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
10192 	if (err < 0) {
10193 		GENL_SET_ERR_MSG(info, "chandef is invalid");
10194 		return err;
10195 	}
10196 
10197 	if (err == 0) {
10198 		GENL_SET_ERR_MSG(info,
10199 				 "Unexpected Radar indication for chandef/iftype");
10200 		return -EINVAL;
10201 	}
10202 
10203 	/* Do not process this notification if radar is already detected
10204 	 * by kernel on this channel, and return success.
10205 	 */
10206 	if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE)
10207 		return 0;
10208 
10209 	cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE);
10210 
10211 	cfg80211_sched_dfs_chan_update(rdev);
10212 
10213 	rdev->radar_chandef = chandef;
10214 
10215 	/* Propagate this notification to other radios as well */
10216 	queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk);
10217 
10218 	return 0;
10219 }
10220 
10221 static int nl80211_parse_counter_offsets(struct cfg80211_registered_device *rdev,
10222 					 const u8 *data, size_t datalen,
10223 					 int first_count, struct nlattr *attr,
10224 					 const u16 **offsets, unsigned int *n_offsets)
10225 {
10226 	int i;
10227 
10228 	*n_offsets = 0;
10229 
10230 	if (!attr)
10231 		return 0;
10232 
10233 	if (!nla_len(attr) || (nla_len(attr) % sizeof(u16)))
10234 		return -EINVAL;
10235 
10236 	*n_offsets = nla_len(attr) / sizeof(u16);
10237 	if (rdev->wiphy.max_num_csa_counters &&
10238 	    (*n_offsets > rdev->wiphy.max_num_csa_counters))
10239 		return -EINVAL;
10240 
10241 	*offsets = nla_data(attr);
10242 
10243 	/* sanity checks - counters should fit and be the same */
10244 	for (i = 0; i < *n_offsets; i++) {
10245 		u16 offset = (*offsets)[i];
10246 
10247 		if (offset >= datalen)
10248 			return -EINVAL;
10249 
10250 		if (first_count != -1 && data[offset] != first_count)
10251 			return -EINVAL;
10252 	}
10253 
10254 	return 0;
10255 }
10256 
10257 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
10258 {
10259 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10260 	unsigned int link_id = nl80211_link_id(info->attrs);
10261 	struct net_device *dev = info->user_ptr[1];
10262 	struct wireless_dev *wdev = dev->ieee80211_ptr;
10263 	struct cfg80211_csa_settings params;
10264 	struct nlattr **csa_attrs = NULL;
10265 	int err;
10266 	bool need_new_beacon = false;
10267 	bool need_handle_dfs_flag = true;
10268 	u32 cs_count;
10269 
10270 	if (!rdev->ops->channel_switch ||
10271 	    !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
10272 		return -EOPNOTSUPP;
10273 
10274 	switch (dev->ieee80211_ptr->iftype) {
10275 	case NL80211_IFTYPE_AP:
10276 	case NL80211_IFTYPE_P2P_GO:
10277 		need_new_beacon = true;
10278 		/* For all modes except AP the handle_dfs flag needs to be
10279 		 * supplied to tell the kernel that userspace will handle radar
10280 		 * events when they happen. Otherwise a switch to a channel
10281 		 * requiring DFS will be rejected.
10282 		 */
10283 		need_handle_dfs_flag = false;
10284 
10285 		/* useless if AP is not running */
10286 		if (!wdev->links[link_id].ap.beacon_interval)
10287 			return -ENOTCONN;
10288 		break;
10289 	case NL80211_IFTYPE_ADHOC:
10290 		if (!wdev->u.ibss.ssid_len)
10291 			return -ENOTCONN;
10292 		break;
10293 	case NL80211_IFTYPE_MESH_POINT:
10294 		if (!wdev->u.mesh.id_len)
10295 			return -ENOTCONN;
10296 		break;
10297 	default:
10298 		return -EOPNOTSUPP;
10299 	}
10300 
10301 	memset(&params, 0, sizeof(params));
10302 	params.beacon_csa.ftm_responder = -1;
10303 
10304 	if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
10305 	    !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
10306 		return -EINVAL;
10307 
10308 	/* only important for AP, IBSS and mesh create IEs internally */
10309 	if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
10310 		return -EINVAL;
10311 
10312 	/* Even though the attribute is u32, the specification says
10313 	 * u8, so let's make sure we don't overflow.
10314 	 */
10315 	cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
10316 	if (cs_count > 255)
10317 		return -EINVAL;
10318 
10319 	params.count = cs_count;
10320 
10321 	if (!need_new_beacon)
10322 		goto skip_beacons;
10323 
10324 	err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon_after,
10325 				   info->extack);
10326 	if (err)
10327 		goto free;
10328 
10329 	csa_attrs = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*csa_attrs),
10330 			    GFP_KERNEL);
10331 	if (!csa_attrs) {
10332 		err = -ENOMEM;
10333 		goto free;
10334 	}
10335 
10336 	err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX,
10337 					  info->attrs[NL80211_ATTR_CSA_IES],
10338 					  nl80211_policy, info->extack);
10339 	if (err)
10340 		goto free;
10341 
10342 	err = nl80211_parse_beacon(rdev, csa_attrs, &params.beacon_csa,
10343 				   info->extack);
10344 	if (err)
10345 		goto free;
10346 
10347 	if (!csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]) {
10348 		err = -EINVAL;
10349 		goto free;
10350 	}
10351 
10352 	err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.tail,
10353 					    params.beacon_csa.tail_len,
10354 					    params.count,
10355 					    csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON],
10356 					    &params.counter_offsets_beacon,
10357 					    &params.n_counter_offsets_beacon);
10358 	if (err)
10359 		goto free;
10360 
10361 	err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.probe_resp,
10362 					    params.beacon_csa.probe_resp_len,
10363 					    params.count,
10364 					    csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP],
10365 					    &params.counter_offsets_presp,
10366 					    &params.n_counter_offsets_presp);
10367 	if (err)
10368 		goto free;
10369 
10370 skip_beacons:
10371 	err = nl80211_parse_chandef(rdev, info, &params.chandef);
10372 	if (err)
10373 		goto free;
10374 
10375 	if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
10376 					   wdev->iftype)) {
10377 		err = -EINVAL;
10378 		goto free;
10379 	}
10380 
10381 	err = cfg80211_chandef_dfs_required(wdev->wiphy,
10382 					    &params.chandef,
10383 					    wdev->iftype);
10384 	if (err < 0)
10385 		goto free;
10386 
10387 	if (err > 0) {
10388 		params.radar_required = true;
10389 		if (need_handle_dfs_flag &&
10390 		    !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) {
10391 			err = -EINVAL;
10392 			goto free;
10393 		}
10394 	}
10395 
10396 	if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
10397 		params.block_tx = true;
10398 
10399 	params.link_id = link_id;
10400 	err = rdev_channel_switch(rdev, dev, &params);
10401 
10402 free:
10403 	kfree(params.beacon_after.mbssid_ies);
10404 	kfree(params.beacon_csa.mbssid_ies);
10405 	kfree(params.beacon_after.rnr_ies);
10406 	kfree(params.beacon_csa.rnr_ies);
10407 	kfree(csa_attrs);
10408 	return err;
10409 }
10410 
10411 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
10412 			    u32 seq, int flags,
10413 			    struct cfg80211_registered_device *rdev,
10414 			    struct wireless_dev *wdev,
10415 			    struct cfg80211_internal_bss *intbss)
10416 {
10417 	struct cfg80211_bss *res = &intbss->pub;
10418 	const struct cfg80211_bss_ies *ies;
10419 	unsigned int link_id;
10420 	void *hdr;
10421 	struct nlattr *bss;
10422 
10423 	lockdep_assert_wiphy(wdev->wiphy);
10424 
10425 	hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
10426 			     NL80211_CMD_NEW_SCAN_RESULTS);
10427 	if (!hdr)
10428 		return -1;
10429 
10430 	genl_dump_check_consistent(cb, hdr);
10431 
10432 	if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
10433 		goto nla_put_failure;
10434 	if (wdev->netdev &&
10435 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
10436 		goto nla_put_failure;
10437 	if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
10438 			      NL80211_ATTR_PAD))
10439 		goto nla_put_failure;
10440 
10441 	bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS);
10442 	if (!bss)
10443 		goto nla_put_failure;
10444 	if ((!is_zero_ether_addr(res->bssid) &&
10445 	     nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
10446 		goto nla_put_failure;
10447 
10448 	rcu_read_lock();
10449 	/* indicate whether we have probe response data or not */
10450 	if (rcu_access_pointer(res->proberesp_ies) &&
10451 	    nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
10452 		goto fail_unlock_rcu;
10453 
10454 	/* this pointer prefers to be pointed to probe response data
10455 	 * but is always valid
10456 	 */
10457 	ies = rcu_dereference(res->ies);
10458 	if (ies) {
10459 		if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
10460 				      NL80211_BSS_PAD))
10461 			goto fail_unlock_rcu;
10462 		if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
10463 					ies->len, ies->data))
10464 			goto fail_unlock_rcu;
10465 	}
10466 
10467 	/* and this pointer is always (unless driver didn't know) beacon data */
10468 	ies = rcu_dereference(res->beacon_ies);
10469 	if (ies && ies->from_beacon) {
10470 		if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
10471 				      NL80211_BSS_PAD))
10472 			goto fail_unlock_rcu;
10473 		if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
10474 					ies->len, ies->data))
10475 			goto fail_unlock_rcu;
10476 	}
10477 	rcu_read_unlock();
10478 
10479 	if (res->beacon_interval &&
10480 	    nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
10481 		goto nla_put_failure;
10482 	if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
10483 	    nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
10484 	    nla_put_u32(msg, NL80211_BSS_FREQUENCY_OFFSET,
10485 			res->channel->freq_offset) ||
10486 	    nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
10487 			jiffies_to_msecs(jiffies - intbss->ts)))
10488 		goto nla_put_failure;
10489 
10490 	if (intbss->parent_tsf &&
10491 	    (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
10492 			       intbss->parent_tsf, NL80211_BSS_PAD) ||
10493 	     nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
10494 		     intbss->parent_bssid)))
10495 		goto nla_put_failure;
10496 
10497 	if (intbss->ts_boottime &&
10498 	    nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
10499 			      intbss->ts_boottime, NL80211_BSS_PAD))
10500 		goto nla_put_failure;
10501 
10502 	if (!nl80211_put_signal(msg, intbss->pub.chains,
10503 				intbss->pub.chain_signal,
10504 				NL80211_BSS_CHAIN_SIGNAL))
10505 		goto nla_put_failure;
10506 
10507 	if (intbss->bss_source != BSS_SOURCE_STA_PROFILE) {
10508 		switch (rdev->wiphy.signal_type) {
10509 		case CFG80211_SIGNAL_TYPE_MBM:
10510 			if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM,
10511 					res->signal))
10512 				goto nla_put_failure;
10513 			break;
10514 		case CFG80211_SIGNAL_TYPE_UNSPEC:
10515 			if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC,
10516 				       res->signal))
10517 				goto nla_put_failure;
10518 			break;
10519 		default:
10520 			break;
10521 		}
10522 	}
10523 
10524 	switch (wdev->iftype) {
10525 	case NL80211_IFTYPE_P2P_CLIENT:
10526 	case NL80211_IFTYPE_STATION:
10527 		for_each_valid_link(wdev, link_id) {
10528 			if (intbss == wdev->links[link_id].client.current_bss &&
10529 			    (nla_put_u32(msg, NL80211_BSS_STATUS,
10530 					 NL80211_BSS_STATUS_ASSOCIATED) ||
10531 			     (wdev->valid_links &&
10532 			      (nla_put_u8(msg, NL80211_BSS_MLO_LINK_ID,
10533 					  link_id) ||
10534 			       nla_put(msg, NL80211_BSS_MLD_ADDR, ETH_ALEN,
10535 				       wdev->u.client.connected_addr)))))
10536 				goto nla_put_failure;
10537 		}
10538 		break;
10539 	case NL80211_IFTYPE_ADHOC:
10540 		if (intbss == wdev->u.ibss.current_bss &&
10541 		    nla_put_u32(msg, NL80211_BSS_STATUS,
10542 				NL80211_BSS_STATUS_IBSS_JOINED))
10543 			goto nla_put_failure;
10544 		break;
10545 	default:
10546 		break;
10547 	}
10548 
10549 	if (nla_put_u32(msg, NL80211_BSS_USE_FOR, res->use_for))
10550 		goto nla_put_failure;
10551 
10552 	if (res->cannot_use_reasons &&
10553 	    nla_put_u64_64bit(msg, NL80211_BSS_CANNOT_USE_REASONS,
10554 			      res->cannot_use_reasons,
10555 			      NL80211_BSS_PAD))
10556 		goto nla_put_failure;
10557 
10558 	nla_nest_end(msg, bss);
10559 
10560 	genlmsg_end(msg, hdr);
10561 	return 0;
10562 
10563  fail_unlock_rcu:
10564 	rcu_read_unlock();
10565  nla_put_failure:
10566 	genlmsg_cancel(msg, hdr);
10567 	return -EMSGSIZE;
10568 }
10569 
10570 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
10571 {
10572 	struct cfg80211_registered_device *rdev;
10573 	struct cfg80211_internal_bss *scan;
10574 	struct wireless_dev *wdev;
10575 	struct nlattr **attrbuf;
10576 	int start = cb->args[2], idx = 0;
10577 	bool dump_include_use_data;
10578 	int err;
10579 
10580 	attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
10581 	if (!attrbuf)
10582 		return -ENOMEM;
10583 
10584 	err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf);
10585 	if (err) {
10586 		kfree(attrbuf);
10587 		return err;
10588 	}
10589 	/* nl80211_prepare_wdev_dump acquired it in the successful case */
10590 	__acquire(&rdev->wiphy.mtx);
10591 
10592 	dump_include_use_data =
10593 		attrbuf[NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA];
10594 	kfree(attrbuf);
10595 
10596 	spin_lock_bh(&rdev->bss_lock);
10597 
10598 	/*
10599 	 * dump_scan will be called multiple times to break up the scan results
10600 	 * into multiple messages.  It is unlikely that any more bss-es will be
10601 	 * expired after the first call, so only call only call this on the
10602 	 * first dump_scan invocation.
10603 	 */
10604 	if (start == 0)
10605 		cfg80211_bss_expire(rdev);
10606 
10607 	cb->seq = rdev->bss_generation;
10608 
10609 	list_for_each_entry(scan, &rdev->bss_list, list) {
10610 		if (++idx <= start)
10611 			continue;
10612 		if (!dump_include_use_data &&
10613 		    !(scan->pub.use_for & NL80211_BSS_USE_FOR_NORMAL))
10614 			continue;
10615 		if (nl80211_send_bss(skb, cb,
10616 				cb->nlh->nlmsg_seq, NLM_F_MULTI,
10617 				rdev, wdev, scan) < 0) {
10618 			idx--;
10619 			break;
10620 		}
10621 	}
10622 
10623 	spin_unlock_bh(&rdev->bss_lock);
10624 
10625 	cb->args[2] = idx;
10626 	wiphy_unlock(&rdev->wiphy);
10627 
10628 	return skb->len;
10629 }
10630 
10631 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
10632 			       int flags, struct net_device *dev,
10633 			       bool allow_radio_stats,
10634 			       struct survey_info *survey)
10635 {
10636 	void *hdr;
10637 	struct nlattr *infoattr;
10638 
10639 	/* skip radio stats if userspace didn't request them */
10640 	if (!survey->channel && !allow_radio_stats)
10641 		return 0;
10642 
10643 	hdr = nl80211hdr_put(msg, portid, seq, flags,
10644 			     NL80211_CMD_NEW_SURVEY_RESULTS);
10645 	if (!hdr)
10646 		return -ENOMEM;
10647 
10648 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
10649 		goto nla_put_failure;
10650 
10651 	infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO);
10652 	if (!infoattr)
10653 		goto nla_put_failure;
10654 
10655 	if (survey->channel &&
10656 	    nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
10657 			survey->channel->center_freq))
10658 		goto nla_put_failure;
10659 
10660 	if (survey->channel && survey->channel->freq_offset &&
10661 	    nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY_OFFSET,
10662 			survey->channel->freq_offset))
10663 		goto nla_put_failure;
10664 
10665 	if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
10666 	    nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
10667 		goto nla_put_failure;
10668 	if ((survey->filled & SURVEY_INFO_IN_USE) &&
10669 	    nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
10670 		goto nla_put_failure;
10671 	if ((survey->filled & SURVEY_INFO_TIME) &&
10672 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
10673 			survey->time, NL80211_SURVEY_INFO_PAD))
10674 		goto nla_put_failure;
10675 	if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
10676 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
10677 			      survey->time_busy, NL80211_SURVEY_INFO_PAD))
10678 		goto nla_put_failure;
10679 	if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
10680 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
10681 			      survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
10682 		goto nla_put_failure;
10683 	if ((survey->filled & SURVEY_INFO_TIME_RX) &&
10684 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
10685 			      survey->time_rx, NL80211_SURVEY_INFO_PAD))
10686 		goto nla_put_failure;
10687 	if ((survey->filled & SURVEY_INFO_TIME_TX) &&
10688 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
10689 			      survey->time_tx, NL80211_SURVEY_INFO_PAD))
10690 		goto nla_put_failure;
10691 	if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
10692 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
10693 			      survey->time_scan, NL80211_SURVEY_INFO_PAD))
10694 		goto nla_put_failure;
10695 	if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) &&
10696 	    nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX,
10697 			      survey->time_bss_rx, NL80211_SURVEY_INFO_PAD))
10698 		goto nla_put_failure;
10699 
10700 	nla_nest_end(msg, infoattr);
10701 
10702 	genlmsg_end(msg, hdr);
10703 	return 0;
10704 
10705  nla_put_failure:
10706 	genlmsg_cancel(msg, hdr);
10707 	return -EMSGSIZE;
10708 }
10709 
10710 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
10711 {
10712 	struct nlattr **attrbuf;
10713 	struct survey_info survey;
10714 	struct cfg80211_registered_device *rdev;
10715 	struct wireless_dev *wdev;
10716 	int survey_idx = cb->args[2];
10717 	int res;
10718 	bool radio_stats;
10719 
10720 	attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
10721 	if (!attrbuf)
10722 		return -ENOMEM;
10723 
10724 	res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf);
10725 	if (res) {
10726 		kfree(attrbuf);
10727 		return res;
10728 	}
10729 	/* nl80211_prepare_wdev_dump acquired it in the successful case */
10730 	__acquire(&rdev->wiphy.mtx);
10731 
10732 	/* prepare_wdev_dump parsed the attributes */
10733 	radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
10734 
10735 	if (!wdev->netdev) {
10736 		res = -EINVAL;
10737 		goto out_err;
10738 	}
10739 
10740 	if (!rdev->ops->dump_survey) {
10741 		res = -EOPNOTSUPP;
10742 		goto out_err;
10743 	}
10744 
10745 	while (1) {
10746 		res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
10747 		if (res == -ENOENT)
10748 			break;
10749 		if (res)
10750 			goto out_err;
10751 
10752 		/* don't send disabled channels, but do send non-channel data */
10753 		if (survey.channel &&
10754 		    survey.channel->flags & IEEE80211_CHAN_DISABLED) {
10755 			survey_idx++;
10756 			continue;
10757 		}
10758 
10759 		if (nl80211_send_survey(skb,
10760 				NETLINK_CB(cb->skb).portid,
10761 				cb->nlh->nlmsg_seq, NLM_F_MULTI,
10762 				wdev->netdev, radio_stats, &survey) < 0)
10763 			goto out;
10764 		survey_idx++;
10765 	}
10766 
10767  out:
10768 	cb->args[2] = survey_idx;
10769 	res = skb->len;
10770  out_err:
10771 	kfree(attrbuf);
10772 	wiphy_unlock(&rdev->wiphy);
10773 	return res;
10774 }
10775 
10776 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
10777 {
10778 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
10779 	struct net_device *dev = info->user_ptr[1];
10780 	struct ieee80211_channel *chan;
10781 	const u8 *bssid, *ssid;
10782 	int err, ssid_len;
10783 	enum nl80211_auth_type auth_type;
10784 	struct key_parse key;
10785 	bool local_state_change;
10786 	struct cfg80211_auth_request req = {};
10787 	u32 freq;
10788 
10789 	if (!info->attrs[NL80211_ATTR_MAC])
10790 		return -EINVAL;
10791 
10792 	if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
10793 		return -EINVAL;
10794 
10795 	if (!info->attrs[NL80211_ATTR_SSID])
10796 		return -EINVAL;
10797 
10798 	if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
10799 		return -EINVAL;
10800 
10801 	err = nl80211_parse_key(info, &key);
10802 	if (err)
10803 		return err;
10804 
10805 	if (key.idx >= 0) {
10806 		if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
10807 			return -EINVAL;
10808 		if (!key.p.key || !key.p.key_len)
10809 			return -EINVAL;
10810 		if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
10811 		     key.p.key_len != WLAN_KEY_LEN_WEP40) &&
10812 		    (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
10813 		     key.p.key_len != WLAN_KEY_LEN_WEP104))
10814 			return -EINVAL;
10815 		if (key.idx > 3)
10816 			return -EINVAL;
10817 	} else {
10818 		key.p.key_len = 0;
10819 		key.p.key = NULL;
10820 	}
10821 
10822 	if (key.idx >= 0) {
10823 		int i;
10824 		bool ok = false;
10825 
10826 		for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
10827 			if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
10828 				ok = true;
10829 				break;
10830 			}
10831 		}
10832 		if (!ok)
10833 			return -EINVAL;
10834 	}
10835 
10836 	if (!rdev->ops->auth)
10837 		return -EOPNOTSUPP;
10838 
10839 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
10840 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
10841 		return -EOPNOTSUPP;
10842 
10843 	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
10844 	freq = MHZ_TO_KHZ(nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
10845 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
10846 		freq +=
10847 		    nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
10848 
10849 	chan = nl80211_get_valid_chan(&rdev->wiphy, freq);
10850 	if (!chan)
10851 		return -EINVAL;
10852 
10853 	ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
10854 	ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
10855 
10856 	if (info->attrs[NL80211_ATTR_IE]) {
10857 		req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
10858 		req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
10859 	}
10860 
10861 	auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
10862 	if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
10863 		return -EINVAL;
10864 
10865 	if ((auth_type == NL80211_AUTHTYPE_SAE ||
10866 	     auth_type == NL80211_AUTHTYPE_FILS_SK ||
10867 	     auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
10868 	     auth_type == NL80211_AUTHTYPE_FILS_PK) &&
10869 	    !info->attrs[NL80211_ATTR_AUTH_DATA])
10870 		return -EINVAL;
10871 
10872 	if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
10873 		if (auth_type != NL80211_AUTHTYPE_SAE &&
10874 		    auth_type != NL80211_AUTHTYPE_FILS_SK &&
10875 		    auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
10876 		    auth_type != NL80211_AUTHTYPE_FILS_PK)
10877 			return -EINVAL;
10878 		req.auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
10879 		req.auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
10880 	}
10881 
10882 	local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
10883 
10884 	/*
10885 	 * Since we no longer track auth state, ignore
10886 	 * requests to only change local state.
10887 	 */
10888 	if (local_state_change)
10889 		return 0;
10890 
10891 	req.auth_type = auth_type;
10892 	req.key = key.p.key;
10893 	req.key_len = key.p.key_len;
10894 	req.key_idx = key.idx;
10895 	req.link_id = nl80211_link_id_or_invalid(info->attrs);
10896 	if (req.link_id >= 0) {
10897 		if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO))
10898 			return -EINVAL;
10899 		if (!info->attrs[NL80211_ATTR_MLD_ADDR])
10900 			return -EINVAL;
10901 		req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
10902 		if (!is_valid_ether_addr(req.ap_mld_addr))
10903 			return -EINVAL;
10904 	}
10905 
10906 	req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
10907 				   IEEE80211_BSS_TYPE_ESS,
10908 				   IEEE80211_PRIVACY_ANY);
10909 	if (!req.bss)
10910 		return -ENOENT;
10911 
10912 	err = cfg80211_mlme_auth(rdev, dev, &req);
10913 
10914 	cfg80211_put_bss(&rdev->wiphy, req.bss);
10915 
10916 	return err;
10917 }
10918 
10919 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev,
10920 				     struct genl_info *info)
10921 {
10922 	if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
10923 		GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set");
10924 		return -EINVAL;
10925 	}
10926 
10927 	if (!rdev->ops->tx_control_port ||
10928 	    !wiphy_ext_feature_isset(&rdev->wiphy,
10929 				     NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
10930 		return -EOPNOTSUPP;
10931 
10932 	return 0;
10933 }
10934 
10935 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
10936 				   struct genl_info *info,
10937 				   struct cfg80211_crypto_settings *settings,
10938 				   int cipher_limit)
10939 {
10940 	memset(settings, 0, sizeof(*settings));
10941 
10942 	settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
10943 
10944 	if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
10945 		u16 proto;
10946 
10947 		proto = nla_get_u16(
10948 			info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
10949 		settings->control_port_ethertype = cpu_to_be16(proto);
10950 		if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
10951 		    proto != ETH_P_PAE)
10952 			return -EINVAL;
10953 		if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
10954 			settings->control_port_no_encrypt = true;
10955 	} else
10956 		settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
10957 
10958 	if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
10959 		int r = validate_pae_over_nl80211(rdev, info);
10960 
10961 		if (r < 0)
10962 			return r;
10963 
10964 		settings->control_port_over_nl80211 = true;
10965 
10966 		if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_PREAUTH])
10967 			settings->control_port_no_preauth = true;
10968 	}
10969 
10970 	if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
10971 		void *data;
10972 		int len, i;
10973 
10974 		data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
10975 		len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
10976 		settings->n_ciphers_pairwise = len / sizeof(u32);
10977 
10978 		if (len % sizeof(u32))
10979 			return -EINVAL;
10980 
10981 		if (settings->n_ciphers_pairwise > cipher_limit)
10982 			return -EINVAL;
10983 
10984 		memcpy(settings->ciphers_pairwise, data, len);
10985 
10986 		for (i = 0; i < settings->n_ciphers_pairwise; i++)
10987 			if (!cfg80211_supported_cipher_suite(
10988 					&rdev->wiphy,
10989 					settings->ciphers_pairwise[i]))
10990 				return -EINVAL;
10991 	}
10992 
10993 	if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
10994 		settings->cipher_group =
10995 			nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
10996 		if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
10997 						     settings->cipher_group))
10998 			return -EINVAL;
10999 	}
11000 
11001 	if (info->attrs[NL80211_ATTR_WPA_VERSIONS])
11002 		settings->wpa_versions =
11003 			nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
11004 
11005 	if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
11006 		void *data;
11007 		int len;
11008 
11009 		data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
11010 		len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
11011 		settings->n_akm_suites = len / sizeof(u32);
11012 
11013 		if (len % sizeof(u32))
11014 			return -EINVAL;
11015 
11016 		if (settings->n_akm_suites > rdev->wiphy.max_num_akm_suites)
11017 			return -EINVAL;
11018 
11019 		memcpy(settings->akm_suites, data, len);
11020 	}
11021 
11022 	if (info->attrs[NL80211_ATTR_PMK]) {
11023 		if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN)
11024 			return -EINVAL;
11025 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
11026 					     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK) &&
11027 		    !wiphy_ext_feature_isset(&rdev->wiphy,
11028 					     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_AP_PSK))
11029 			return -EINVAL;
11030 		settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]);
11031 	}
11032 
11033 	if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) {
11034 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
11035 					     NL80211_EXT_FEATURE_SAE_OFFLOAD) &&
11036 		    !wiphy_ext_feature_isset(&rdev->wiphy,
11037 					     NL80211_EXT_FEATURE_SAE_OFFLOAD_AP))
11038 			return -EINVAL;
11039 		settings->sae_pwd =
11040 			nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]);
11041 		settings->sae_pwd_len =
11042 			nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]);
11043 	}
11044 
11045 	settings->sae_pwe =
11046 		nla_get_u8_default(info->attrs[NL80211_ATTR_SAE_PWE],
11047 				   NL80211_SAE_PWE_UNSPECIFIED);
11048 
11049 	return 0;
11050 }
11051 
11052 static struct cfg80211_bss *nl80211_assoc_bss(struct cfg80211_registered_device *rdev,
11053 					      const u8 *ssid, int ssid_len,
11054 					      struct nlattr **attrs,
11055 					      int assoc_link_id, int link_id)
11056 {
11057 	struct ieee80211_channel *chan;
11058 	struct cfg80211_bss *bss;
11059 	const u8 *bssid;
11060 	u32 freq, use_for = 0;
11061 
11062 	if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_WIPHY_FREQ])
11063 		return ERR_PTR(-EINVAL);
11064 
11065 	bssid = nla_data(attrs[NL80211_ATTR_MAC]);
11066 
11067 	freq = MHZ_TO_KHZ(nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ]));
11068 	if (attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
11069 		freq += nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
11070 
11071 	chan = nl80211_get_valid_chan(&rdev->wiphy, freq);
11072 	if (!chan)
11073 		return ERR_PTR(-EINVAL);
11074 
11075 	if (assoc_link_id >= 0)
11076 		use_for = NL80211_BSS_USE_FOR_MLD_LINK;
11077 	if (assoc_link_id == link_id)
11078 		use_for |= NL80211_BSS_USE_FOR_NORMAL;
11079 
11080 	bss = __cfg80211_get_bss(&rdev->wiphy, chan, bssid,
11081 				 ssid, ssid_len,
11082 				 IEEE80211_BSS_TYPE_ESS,
11083 				 IEEE80211_PRIVACY_ANY,
11084 				 use_for);
11085 	if (!bss)
11086 		return ERR_PTR(-ENOENT);
11087 
11088 	return bss;
11089 }
11090 
11091 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
11092 {
11093 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11094 	struct net_device *dev = info->user_ptr[1];
11095 	struct cfg80211_assoc_request req = {};
11096 	struct nlattr **attrs = NULL;
11097 	const u8 *ap_addr, *ssid;
11098 	unsigned int link_id;
11099 	int err, ssid_len;
11100 
11101 	if (dev->ieee80211_ptr->conn_owner_nlportid &&
11102 	    dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
11103 		return -EPERM;
11104 
11105 	if (!info->attrs[NL80211_ATTR_SSID])
11106 		return -EINVAL;
11107 
11108 	if (!rdev->ops->assoc)
11109 		return -EOPNOTSUPP;
11110 
11111 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
11112 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
11113 		return -EOPNOTSUPP;
11114 
11115 	ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
11116 	ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
11117 
11118 	if (info->attrs[NL80211_ATTR_IE]) {
11119 		req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
11120 		req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
11121 
11122 		if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE,
11123 					   req.ie, req.ie_len)) {
11124 			NL_SET_ERR_MSG_ATTR(info->extack,
11125 					    info->attrs[NL80211_ATTR_IE],
11126 					    "non-inheritance makes no sense");
11127 			return -EINVAL;
11128 		}
11129 	}
11130 
11131 	if (info->attrs[NL80211_ATTR_USE_MFP]) {
11132 		enum nl80211_mfp mfp =
11133 			nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
11134 		if (mfp == NL80211_MFP_REQUIRED)
11135 			req.use_mfp = true;
11136 		else if (mfp != NL80211_MFP_NO)
11137 			return -EINVAL;
11138 	}
11139 
11140 	if (info->attrs[NL80211_ATTR_PREV_BSSID])
11141 		req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
11142 
11143 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
11144 		req.flags |= ASSOC_REQ_DISABLE_HT;
11145 
11146 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
11147 		memcpy(&req.ht_capa_mask,
11148 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
11149 		       sizeof(req.ht_capa_mask));
11150 
11151 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
11152 		if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
11153 			return -EINVAL;
11154 		memcpy(&req.ht_capa,
11155 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
11156 		       sizeof(req.ht_capa));
11157 	}
11158 
11159 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
11160 		req.flags |= ASSOC_REQ_DISABLE_VHT;
11161 
11162 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE]))
11163 		req.flags |= ASSOC_REQ_DISABLE_HE;
11164 
11165 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT]))
11166 		req.flags |= ASSOC_REQ_DISABLE_EHT;
11167 
11168 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
11169 		memcpy(&req.vht_capa_mask,
11170 		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
11171 		       sizeof(req.vht_capa_mask));
11172 
11173 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
11174 		if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
11175 			return -EINVAL;
11176 		memcpy(&req.vht_capa,
11177 		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
11178 		       sizeof(req.vht_capa));
11179 	}
11180 
11181 	if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
11182 		if (!((rdev->wiphy.features &
11183 			NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
11184 		       (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
11185 		    !wiphy_ext_feature_isset(&rdev->wiphy,
11186 					     NL80211_EXT_FEATURE_RRM))
11187 			return -EINVAL;
11188 		req.flags |= ASSOC_REQ_USE_RRM;
11189 	}
11190 
11191 	if (info->attrs[NL80211_ATTR_FILS_KEK]) {
11192 		req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
11193 		req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
11194 		if (!info->attrs[NL80211_ATTR_FILS_NONCES])
11195 			return -EINVAL;
11196 		req.fils_nonces =
11197 			nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
11198 	}
11199 
11200 	if (info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) {
11201 		if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY])
11202 			return -EINVAL;
11203 		memcpy(&req.s1g_capa_mask,
11204 		       nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]),
11205 		       sizeof(req.s1g_capa_mask));
11206 	}
11207 
11208 	if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) {
11209 		if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK])
11210 			return -EINVAL;
11211 		memcpy(&req.s1g_capa,
11212 		       nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]),
11213 		       sizeof(req.s1g_capa));
11214 	}
11215 
11216 	if (nla_get_flag(info->attrs[NL80211_ATTR_ASSOC_SPP_AMSDU])) {
11217 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
11218 					     NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT)) {
11219 			GENL_SET_ERR_MSG(info, "SPP A-MSDUs not supported");
11220 			return -EINVAL;
11221 		}
11222 		req.flags |= ASSOC_REQ_SPP_AMSDU;
11223 	}
11224 
11225 	req.link_id = nl80211_link_id_or_invalid(info->attrs);
11226 
11227 	if (info->attrs[NL80211_ATTR_MLO_LINKS]) {
11228 		unsigned int attrsize = NUM_NL80211_ATTR * sizeof(*attrs);
11229 		struct nlattr *link;
11230 		int rem = 0;
11231 
11232 		if (req.link_id < 0)
11233 			return -EINVAL;
11234 
11235 		if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO))
11236 			return -EINVAL;
11237 
11238 		if (info->attrs[NL80211_ATTR_MAC] ||
11239 		    info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
11240 		    !info->attrs[NL80211_ATTR_MLD_ADDR])
11241 			return -EINVAL;
11242 
11243 		req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
11244 		ap_addr = req.ap_mld_addr;
11245 
11246 		attrs = kzalloc(attrsize, GFP_KERNEL);
11247 		if (!attrs)
11248 			return -ENOMEM;
11249 
11250 		nla_for_each_nested(link,
11251 				    info->attrs[NL80211_ATTR_MLO_LINKS],
11252 				    rem) {
11253 			memset(attrs, 0, attrsize);
11254 
11255 			nla_parse_nested(attrs, NL80211_ATTR_MAX,
11256 					 link, NULL, NULL);
11257 
11258 			if (!attrs[NL80211_ATTR_MLO_LINK_ID]) {
11259 				err = -EINVAL;
11260 				NL_SET_BAD_ATTR(info->extack, link);
11261 				goto free;
11262 			}
11263 
11264 			link_id = nla_get_u8(attrs[NL80211_ATTR_MLO_LINK_ID]);
11265 			/* cannot use the same link ID again */
11266 			if (req.links[link_id].bss) {
11267 				err = -EINVAL;
11268 				NL_SET_BAD_ATTR(info->extack, link);
11269 				goto free;
11270 			}
11271 			req.links[link_id].bss =
11272 				nl80211_assoc_bss(rdev, ssid, ssid_len, attrs,
11273 						  req.link_id, link_id);
11274 			if (IS_ERR(req.links[link_id].bss)) {
11275 				err = PTR_ERR(req.links[link_id].bss);
11276 				req.links[link_id].bss = NULL;
11277 				NL_SET_ERR_MSG_ATTR(info->extack,
11278 						    link, "Error fetching BSS for link");
11279 				goto free;
11280 			}
11281 
11282 			if (attrs[NL80211_ATTR_IE]) {
11283 				req.links[link_id].elems =
11284 					nla_data(attrs[NL80211_ATTR_IE]);
11285 				req.links[link_id].elems_len =
11286 					nla_len(attrs[NL80211_ATTR_IE]);
11287 
11288 				if (cfg80211_find_elem(WLAN_EID_FRAGMENT,
11289 						       req.links[link_id].elems,
11290 						       req.links[link_id].elems_len)) {
11291 					NL_SET_ERR_MSG_ATTR(info->extack,
11292 							    attrs[NL80211_ATTR_IE],
11293 							    "cannot deal with fragmentation");
11294 					err = -EINVAL;
11295 					goto free;
11296 				}
11297 
11298 				if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE,
11299 							   req.links[link_id].elems,
11300 							   req.links[link_id].elems_len)) {
11301 					NL_SET_ERR_MSG_ATTR(info->extack,
11302 							    attrs[NL80211_ATTR_IE],
11303 							    "cannot deal with non-inheritance");
11304 					err = -EINVAL;
11305 					goto free;
11306 				}
11307 			}
11308 
11309 			req.links[link_id].disabled =
11310 				nla_get_flag(attrs[NL80211_ATTR_MLO_LINK_DISABLED]);
11311 		}
11312 
11313 		if (!req.links[req.link_id].bss) {
11314 			err = -EINVAL;
11315 			goto free;
11316 		}
11317 
11318 		if (req.links[req.link_id].elems_len) {
11319 			GENL_SET_ERR_MSG(info,
11320 					 "cannot have per-link elems on assoc link");
11321 			err = -EINVAL;
11322 			goto free;
11323 		}
11324 
11325 		if (req.links[req.link_id].disabled) {
11326 			GENL_SET_ERR_MSG(info,
11327 					 "cannot have assoc link disabled");
11328 			err = -EINVAL;
11329 			goto free;
11330 		}
11331 
11332 		kfree(attrs);
11333 		attrs = NULL;
11334 	} else {
11335 		if (req.link_id >= 0)
11336 			return -EINVAL;
11337 
11338 		req.bss = nl80211_assoc_bss(rdev, ssid, ssid_len, info->attrs,
11339 					    -1, -1);
11340 		if (IS_ERR(req.bss))
11341 			return PTR_ERR(req.bss);
11342 		ap_addr = req.bss->bssid;
11343 	}
11344 
11345 	err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
11346 	if (!err) {
11347 		struct nlattr *link;
11348 		int rem = 0;
11349 
11350 		err = cfg80211_mlme_assoc(rdev, dev, &req,
11351 					  info->extack);
11352 
11353 		if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
11354 			dev->ieee80211_ptr->conn_owner_nlportid =
11355 				info->snd_portid;
11356 			memcpy(dev->ieee80211_ptr->disconnect_bssid,
11357 			       ap_addr, ETH_ALEN);
11358 		}
11359 
11360 		/* Report error from first problematic link */
11361 		if (info->attrs[NL80211_ATTR_MLO_LINKS]) {
11362 			nla_for_each_nested(link,
11363 					    info->attrs[NL80211_ATTR_MLO_LINKS],
11364 					    rem) {
11365 				struct nlattr *link_id_attr =
11366 					nla_find_nested(link, NL80211_ATTR_MLO_LINK_ID);
11367 
11368 				if (!link_id_attr)
11369 					continue;
11370 
11371 				link_id = nla_get_u8(link_id_attr);
11372 
11373 				if (link_id == req.link_id)
11374 					continue;
11375 
11376 				if (!req.links[link_id].error ||
11377 				    WARN_ON(req.links[link_id].error > 0))
11378 					continue;
11379 
11380 				WARN_ON(err >= 0);
11381 
11382 				NL_SET_BAD_ATTR(info->extack, link);
11383 				err = req.links[link_id].error;
11384 				break;
11385 			}
11386 		}
11387 	}
11388 
11389 free:
11390 	for (link_id = 0; link_id < ARRAY_SIZE(req.links); link_id++)
11391 		cfg80211_put_bss(&rdev->wiphy, req.links[link_id].bss);
11392 	cfg80211_put_bss(&rdev->wiphy, req.bss);
11393 	kfree(attrs);
11394 
11395 	return err;
11396 }
11397 
11398 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
11399 {
11400 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11401 	struct net_device *dev = info->user_ptr[1];
11402 	const u8 *ie = NULL, *bssid;
11403 	int ie_len = 0;
11404 	u16 reason_code;
11405 	bool local_state_change;
11406 
11407 	if (dev->ieee80211_ptr->conn_owner_nlportid &&
11408 	    dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
11409 		return -EPERM;
11410 
11411 	if (!info->attrs[NL80211_ATTR_MAC])
11412 		return -EINVAL;
11413 
11414 	if (!info->attrs[NL80211_ATTR_REASON_CODE])
11415 		return -EINVAL;
11416 
11417 	if (!rdev->ops->deauth)
11418 		return -EOPNOTSUPP;
11419 
11420 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
11421 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
11422 		return -EOPNOTSUPP;
11423 
11424 	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
11425 
11426 	reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
11427 	if (reason_code == 0) {
11428 		/* Reason Code 0 is reserved */
11429 		return -EINVAL;
11430 	}
11431 
11432 	if (info->attrs[NL80211_ATTR_IE]) {
11433 		ie = nla_data(info->attrs[NL80211_ATTR_IE]);
11434 		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
11435 	}
11436 
11437 	local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
11438 
11439 	return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
11440 				    local_state_change);
11441 }
11442 
11443 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
11444 {
11445 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11446 	struct net_device *dev = info->user_ptr[1];
11447 	const u8 *ie = NULL, *bssid;
11448 	int ie_len = 0;
11449 	u16 reason_code;
11450 	bool local_state_change;
11451 
11452 	if (dev->ieee80211_ptr->conn_owner_nlportid &&
11453 	    dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
11454 		return -EPERM;
11455 
11456 	if (!info->attrs[NL80211_ATTR_MAC])
11457 		return -EINVAL;
11458 
11459 	if (!info->attrs[NL80211_ATTR_REASON_CODE])
11460 		return -EINVAL;
11461 
11462 	if (!rdev->ops->disassoc)
11463 		return -EOPNOTSUPP;
11464 
11465 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
11466 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
11467 		return -EOPNOTSUPP;
11468 
11469 	bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
11470 
11471 	reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
11472 	if (reason_code == 0) {
11473 		/* Reason Code 0 is reserved */
11474 		return -EINVAL;
11475 	}
11476 
11477 	if (info->attrs[NL80211_ATTR_IE]) {
11478 		ie = nla_data(info->attrs[NL80211_ATTR_IE]);
11479 		ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
11480 	}
11481 
11482 	local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
11483 
11484 	return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
11485 				      local_state_change);
11486 }
11487 
11488 static bool
11489 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
11490 			 int mcast_rate[NUM_NL80211_BANDS],
11491 			 int rateval)
11492 {
11493 	struct wiphy *wiphy = &rdev->wiphy;
11494 	bool found = false;
11495 	int band, i;
11496 
11497 	for (band = 0; band < NUM_NL80211_BANDS; band++) {
11498 		struct ieee80211_supported_band *sband;
11499 
11500 		sband = wiphy->bands[band];
11501 		if (!sband)
11502 			continue;
11503 
11504 		for (i = 0; i < sband->n_bitrates; i++) {
11505 			if (sband->bitrates[i].bitrate == rateval) {
11506 				mcast_rate[band] = i + 1;
11507 				found = true;
11508 				break;
11509 			}
11510 		}
11511 	}
11512 
11513 	return found;
11514 }
11515 
11516 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
11517 {
11518 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11519 	struct net_device *dev = info->user_ptr[1];
11520 	struct cfg80211_ibss_params ibss;
11521 	struct wiphy *wiphy;
11522 	struct cfg80211_cached_keys *connkeys = NULL;
11523 	int err;
11524 
11525 	memset(&ibss, 0, sizeof(ibss));
11526 
11527 	if (!info->attrs[NL80211_ATTR_SSID] ||
11528 	    !nla_len(info->attrs[NL80211_ATTR_SSID]))
11529 		return -EINVAL;
11530 
11531 	ibss.beacon_interval = 100;
11532 
11533 	if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
11534 		ibss.beacon_interval =
11535 			nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
11536 
11537 	err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
11538 					   ibss.beacon_interval);
11539 	if (err)
11540 		return err;
11541 
11542 	if (!rdev->ops->join_ibss)
11543 		return -EOPNOTSUPP;
11544 
11545 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
11546 		return -EOPNOTSUPP;
11547 
11548 	wiphy = &rdev->wiphy;
11549 
11550 	if (info->attrs[NL80211_ATTR_MAC]) {
11551 		ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
11552 
11553 		if (!is_valid_ether_addr(ibss.bssid))
11554 			return -EINVAL;
11555 	}
11556 	ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
11557 	ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
11558 
11559 	if (info->attrs[NL80211_ATTR_IE]) {
11560 		ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
11561 		ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
11562 	}
11563 
11564 	err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
11565 	if (err)
11566 		return err;
11567 
11568 	if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
11569 				     NL80211_IFTYPE_ADHOC))
11570 		return -EINVAL;
11571 
11572 	switch (ibss.chandef.width) {
11573 	case NL80211_CHAN_WIDTH_5:
11574 	case NL80211_CHAN_WIDTH_10:
11575 	case NL80211_CHAN_WIDTH_20_NOHT:
11576 		break;
11577 	case NL80211_CHAN_WIDTH_20:
11578 	case NL80211_CHAN_WIDTH_40:
11579 		if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
11580 			return -EINVAL;
11581 		break;
11582 	case NL80211_CHAN_WIDTH_80:
11583 	case NL80211_CHAN_WIDTH_80P80:
11584 	case NL80211_CHAN_WIDTH_160:
11585 		if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
11586 			return -EINVAL;
11587 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
11588 					     NL80211_EXT_FEATURE_VHT_IBSS))
11589 			return -EINVAL;
11590 		break;
11591 	case NL80211_CHAN_WIDTH_320:
11592 		return -EINVAL;
11593 	default:
11594 		return -EINVAL;
11595 	}
11596 
11597 	ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
11598 	ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
11599 
11600 	if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
11601 		u8 *rates =
11602 			nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
11603 		int n_rates =
11604 			nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
11605 		struct ieee80211_supported_band *sband =
11606 			wiphy->bands[ibss.chandef.chan->band];
11607 
11608 		err = ieee80211_get_ratemask(sband, rates, n_rates,
11609 					     &ibss.basic_rates);
11610 		if (err)
11611 			return err;
11612 	}
11613 
11614 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
11615 		memcpy(&ibss.ht_capa_mask,
11616 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
11617 		       sizeof(ibss.ht_capa_mask));
11618 
11619 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
11620 		if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
11621 			return -EINVAL;
11622 		memcpy(&ibss.ht_capa,
11623 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
11624 		       sizeof(ibss.ht_capa));
11625 	}
11626 
11627 	if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
11628 	    !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
11629 			nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
11630 		return -EINVAL;
11631 
11632 	if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
11633 		bool no_ht = false;
11634 
11635 		connkeys = nl80211_parse_connkeys(rdev, info, &no_ht);
11636 		if (IS_ERR(connkeys))
11637 			return PTR_ERR(connkeys);
11638 
11639 		if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
11640 		    no_ht) {
11641 			kfree_sensitive(connkeys);
11642 			return -EINVAL;
11643 		}
11644 	}
11645 
11646 	ibss.control_port =
11647 		nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
11648 
11649 	if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
11650 		int r = validate_pae_over_nl80211(rdev, info);
11651 
11652 		if (r < 0) {
11653 			kfree_sensitive(connkeys);
11654 			return r;
11655 		}
11656 
11657 		ibss.control_port_over_nl80211 = true;
11658 	}
11659 
11660 	ibss.userspace_handles_dfs =
11661 		nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
11662 
11663 	err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
11664 	if (err)
11665 		kfree_sensitive(connkeys);
11666 	else if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
11667 		dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
11668 
11669 	return err;
11670 }
11671 
11672 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
11673 {
11674 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11675 	struct net_device *dev = info->user_ptr[1];
11676 
11677 	if (!rdev->ops->leave_ibss)
11678 		return -EOPNOTSUPP;
11679 
11680 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
11681 		return -EOPNOTSUPP;
11682 
11683 	return cfg80211_leave_ibss(rdev, dev, false);
11684 }
11685 
11686 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
11687 {
11688 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11689 	struct net_device *dev = info->user_ptr[1];
11690 	int mcast_rate[NUM_NL80211_BANDS];
11691 	u32 nla_rate;
11692 
11693 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
11694 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
11695 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
11696 		return -EOPNOTSUPP;
11697 
11698 	if (!rdev->ops->set_mcast_rate)
11699 		return -EOPNOTSUPP;
11700 
11701 	memset(mcast_rate, 0, sizeof(mcast_rate));
11702 
11703 	if (!info->attrs[NL80211_ATTR_MCAST_RATE])
11704 		return -EINVAL;
11705 
11706 	nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
11707 	if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
11708 		return -EINVAL;
11709 
11710 	return rdev_set_mcast_rate(rdev, dev, mcast_rate);
11711 }
11712 
11713 static struct sk_buff *
11714 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
11715 			    struct wireless_dev *wdev, int approxlen,
11716 			    u32 portid, u32 seq, enum nl80211_commands cmd,
11717 			    enum nl80211_attrs attr,
11718 			    const struct nl80211_vendor_cmd_info *info,
11719 			    gfp_t gfp)
11720 {
11721 	struct sk_buff *skb;
11722 	void *hdr;
11723 	struct nlattr *data;
11724 
11725 	skb = nlmsg_new(approxlen + 100, gfp);
11726 	if (!skb)
11727 		return NULL;
11728 
11729 	hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
11730 	if (!hdr) {
11731 		kfree_skb(skb);
11732 		return NULL;
11733 	}
11734 
11735 	if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
11736 		goto nla_put_failure;
11737 
11738 	if (info) {
11739 		if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
11740 				info->vendor_id))
11741 			goto nla_put_failure;
11742 		if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
11743 				info->subcmd))
11744 			goto nla_put_failure;
11745 	}
11746 
11747 	if (wdev) {
11748 		if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
11749 				      wdev_id(wdev), NL80211_ATTR_PAD))
11750 			goto nla_put_failure;
11751 		if (wdev->netdev &&
11752 		    nla_put_u32(skb, NL80211_ATTR_IFINDEX,
11753 				wdev->netdev->ifindex))
11754 			goto nla_put_failure;
11755 	}
11756 
11757 	data = nla_nest_start_noflag(skb, attr);
11758 	if (!data)
11759 		goto nla_put_failure;
11760 
11761 	((void **)skb->cb)[0] = rdev;
11762 	((void **)skb->cb)[1] = hdr;
11763 	((void **)skb->cb)[2] = data;
11764 
11765 	return skb;
11766 
11767  nla_put_failure:
11768 	kfree_skb(skb);
11769 	return NULL;
11770 }
11771 
11772 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
11773 					   struct wireless_dev *wdev,
11774 					   enum nl80211_commands cmd,
11775 					   enum nl80211_attrs attr,
11776 					   unsigned int portid,
11777 					   int vendor_event_idx,
11778 					   int approxlen, gfp_t gfp)
11779 {
11780 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11781 	const struct nl80211_vendor_cmd_info *info;
11782 
11783 	switch (cmd) {
11784 	case NL80211_CMD_TESTMODE:
11785 		if (WARN_ON(vendor_event_idx != -1))
11786 			return NULL;
11787 		info = NULL;
11788 		break;
11789 	case NL80211_CMD_VENDOR:
11790 		if (WARN_ON(vendor_event_idx < 0 ||
11791 			    vendor_event_idx >= wiphy->n_vendor_events))
11792 			return NULL;
11793 		info = &wiphy->vendor_events[vendor_event_idx];
11794 		break;
11795 	default:
11796 		WARN_ON(1);
11797 		return NULL;
11798 	}
11799 
11800 	return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0,
11801 					   cmd, attr, info, gfp);
11802 }
11803 EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
11804 
11805 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
11806 {
11807 	struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
11808 	void *hdr = ((void **)skb->cb)[1];
11809 	struct nlmsghdr *nlhdr = nlmsg_hdr(skb);
11810 	struct nlattr *data = ((void **)skb->cb)[2];
11811 	enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
11812 
11813 	/* clear CB data for netlink core to own from now on */
11814 	memset(skb->cb, 0, sizeof(skb->cb));
11815 
11816 	nla_nest_end(skb, data);
11817 	genlmsg_end(skb, hdr);
11818 
11819 	if (nlhdr->nlmsg_pid) {
11820 		genlmsg_unicast(wiphy_net(&rdev->wiphy), skb,
11821 				nlhdr->nlmsg_pid);
11822 	} else {
11823 		if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
11824 			mcgrp = NL80211_MCGRP_VENDOR;
11825 
11826 		genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11827 					skb, 0, mcgrp, gfp);
11828 	}
11829 }
11830 EXPORT_SYMBOL(__cfg80211_send_event_skb);
11831 
11832 #ifdef CONFIG_NL80211_TESTMODE
11833 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
11834 {
11835 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11836 	struct wireless_dev *wdev;
11837 	int err;
11838 
11839 	lockdep_assert_held(&rdev->wiphy.mtx);
11840 
11841 	wdev = __cfg80211_wdev_from_attrs(rdev, genl_info_net(info),
11842 					  info->attrs);
11843 
11844 	if (!rdev->ops->testmode_cmd)
11845 		return -EOPNOTSUPP;
11846 
11847 	if (IS_ERR(wdev)) {
11848 		err = PTR_ERR(wdev);
11849 		if (err != -EINVAL)
11850 			return err;
11851 		wdev = NULL;
11852 	} else if (wdev->wiphy != &rdev->wiphy) {
11853 		return -EINVAL;
11854 	}
11855 
11856 	if (!info->attrs[NL80211_ATTR_TESTDATA])
11857 		return -EINVAL;
11858 
11859 	rdev->cur_cmd_info = info;
11860 	err = rdev_testmode_cmd(rdev, wdev,
11861 				nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
11862 				nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
11863 	rdev->cur_cmd_info = NULL;
11864 
11865 	return err;
11866 }
11867 
11868 static int nl80211_testmode_dump(struct sk_buff *skb,
11869 				 struct netlink_callback *cb)
11870 {
11871 	struct cfg80211_registered_device *rdev;
11872 	struct nlattr **attrbuf = NULL;
11873 	int err;
11874 	long phy_idx;
11875 	void *data = NULL;
11876 	int data_len = 0;
11877 
11878 	rtnl_lock();
11879 
11880 	if (cb->args[0]) {
11881 		/*
11882 		 * 0 is a valid index, but not valid for args[0],
11883 		 * so we need to offset by 1.
11884 		 */
11885 		phy_idx = cb->args[0] - 1;
11886 
11887 		rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
11888 		if (!rdev) {
11889 			err = -ENOENT;
11890 			goto out_err;
11891 		}
11892 	} else {
11893 		attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf),
11894 				  GFP_KERNEL);
11895 		if (!attrbuf) {
11896 			err = -ENOMEM;
11897 			goto out_err;
11898 		}
11899 
11900 		err = nlmsg_parse_deprecated(cb->nlh,
11901 					     GENL_HDRLEN + nl80211_fam.hdrsize,
11902 					     attrbuf, nl80211_fam.maxattr,
11903 					     nl80211_policy, NULL);
11904 		if (err)
11905 			goto out_err;
11906 
11907 		rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
11908 		if (IS_ERR(rdev)) {
11909 			err = PTR_ERR(rdev);
11910 			goto out_err;
11911 		}
11912 		phy_idx = rdev->wiphy_idx;
11913 
11914 		if (attrbuf[NL80211_ATTR_TESTDATA])
11915 			cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
11916 	}
11917 
11918 	if (cb->args[1]) {
11919 		data = nla_data((void *)cb->args[1]);
11920 		data_len = nla_len((void *)cb->args[1]);
11921 	}
11922 
11923 	if (!rdev->ops->testmode_dump) {
11924 		err = -EOPNOTSUPP;
11925 		goto out_err;
11926 	}
11927 
11928 	while (1) {
11929 		void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
11930 					   cb->nlh->nlmsg_seq, NLM_F_MULTI,
11931 					   NL80211_CMD_TESTMODE);
11932 		struct nlattr *tmdata;
11933 
11934 		if (!hdr)
11935 			break;
11936 
11937 		if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
11938 			genlmsg_cancel(skb, hdr);
11939 			break;
11940 		}
11941 
11942 		tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA);
11943 		if (!tmdata) {
11944 			genlmsg_cancel(skb, hdr);
11945 			break;
11946 		}
11947 		err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
11948 		nla_nest_end(skb, tmdata);
11949 
11950 		if (err == -ENOBUFS || err == -ENOENT) {
11951 			genlmsg_cancel(skb, hdr);
11952 			break;
11953 		} else if (err) {
11954 			genlmsg_cancel(skb, hdr);
11955 			goto out_err;
11956 		}
11957 
11958 		genlmsg_end(skb, hdr);
11959 	}
11960 
11961 	err = skb->len;
11962 	/* see above */
11963 	cb->args[0] = phy_idx + 1;
11964  out_err:
11965 	kfree(attrbuf);
11966 	rtnl_unlock();
11967 	return err;
11968 }
11969 #endif
11970 
11971 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
11972 {
11973 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
11974 	struct net_device *dev = info->user_ptr[1];
11975 	struct cfg80211_connect_params connect;
11976 	struct wiphy *wiphy;
11977 	struct cfg80211_cached_keys *connkeys = NULL;
11978 	u32 freq = 0;
11979 	int err;
11980 
11981 	memset(&connect, 0, sizeof(connect));
11982 
11983 	if (!info->attrs[NL80211_ATTR_SSID] ||
11984 	    !nla_len(info->attrs[NL80211_ATTR_SSID]))
11985 		return -EINVAL;
11986 
11987 	if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
11988 		connect.auth_type =
11989 			nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
11990 		if (!nl80211_valid_auth_type(rdev, connect.auth_type,
11991 					     NL80211_CMD_CONNECT))
11992 			return -EINVAL;
11993 	} else
11994 		connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
11995 
11996 	connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
11997 
11998 	if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] &&
11999 	    !wiphy_ext_feature_isset(&rdev->wiphy,
12000 				     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
12001 		return -EINVAL;
12002 	connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS];
12003 
12004 	err = nl80211_crypto_settings(rdev, info, &connect.crypto,
12005 				      NL80211_MAX_NR_CIPHER_SUITES);
12006 	if (err)
12007 		return err;
12008 
12009 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
12010 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
12011 		return -EOPNOTSUPP;
12012 
12013 	wiphy = &rdev->wiphy;
12014 
12015 	connect.bg_scan_period = -1;
12016 	if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
12017 		(wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
12018 		connect.bg_scan_period =
12019 			nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
12020 	}
12021 
12022 	if (info->attrs[NL80211_ATTR_MAC])
12023 		connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
12024 	else if (info->attrs[NL80211_ATTR_MAC_HINT])
12025 		connect.bssid_hint =
12026 			nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
12027 	connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
12028 	connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
12029 
12030 	if (info->attrs[NL80211_ATTR_IE]) {
12031 		connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
12032 		connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
12033 	}
12034 
12035 	if (info->attrs[NL80211_ATTR_USE_MFP]) {
12036 		connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
12037 		if (connect.mfp == NL80211_MFP_OPTIONAL &&
12038 		    !wiphy_ext_feature_isset(&rdev->wiphy,
12039 					     NL80211_EXT_FEATURE_MFP_OPTIONAL))
12040 			return -EOPNOTSUPP;
12041 	} else {
12042 		connect.mfp = NL80211_MFP_NO;
12043 	}
12044 
12045 	if (info->attrs[NL80211_ATTR_PREV_BSSID])
12046 		connect.prev_bssid =
12047 			nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
12048 
12049 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ])
12050 		freq = MHZ_TO_KHZ(nla_get_u32(
12051 					info->attrs[NL80211_ATTR_WIPHY_FREQ]));
12052 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
12053 		freq +=
12054 		    nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
12055 
12056 	if (freq) {
12057 		connect.channel = nl80211_get_valid_chan(wiphy, freq);
12058 		if (!connect.channel)
12059 			return -EINVAL;
12060 	} else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
12061 		freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
12062 		freq = MHZ_TO_KHZ(freq);
12063 		connect.channel_hint = nl80211_get_valid_chan(wiphy, freq);
12064 		if (!connect.channel_hint)
12065 			return -EINVAL;
12066 	}
12067 
12068 	if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) {
12069 		connect.edmg.channels =
12070 		      nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]);
12071 
12072 		if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG])
12073 			connect.edmg.bw_config =
12074 				nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]);
12075 	}
12076 
12077 	if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
12078 		connkeys = nl80211_parse_connkeys(rdev, info, NULL);
12079 		if (IS_ERR(connkeys))
12080 			return PTR_ERR(connkeys);
12081 	}
12082 
12083 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
12084 		connect.flags |= ASSOC_REQ_DISABLE_HT;
12085 
12086 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
12087 		memcpy(&connect.ht_capa_mask,
12088 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
12089 		       sizeof(connect.ht_capa_mask));
12090 
12091 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
12092 		if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
12093 			kfree_sensitive(connkeys);
12094 			return -EINVAL;
12095 		}
12096 		memcpy(&connect.ht_capa,
12097 		       nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
12098 		       sizeof(connect.ht_capa));
12099 	}
12100 
12101 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
12102 		connect.flags |= ASSOC_REQ_DISABLE_VHT;
12103 
12104 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE]))
12105 		connect.flags |= ASSOC_REQ_DISABLE_HE;
12106 
12107 	if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT]))
12108 		connect.flags |= ASSOC_REQ_DISABLE_EHT;
12109 
12110 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
12111 		memcpy(&connect.vht_capa_mask,
12112 		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
12113 		       sizeof(connect.vht_capa_mask));
12114 
12115 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
12116 		if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
12117 			kfree_sensitive(connkeys);
12118 			return -EINVAL;
12119 		}
12120 		memcpy(&connect.vht_capa,
12121 		       nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
12122 		       sizeof(connect.vht_capa));
12123 	}
12124 
12125 	if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
12126 		if (!((rdev->wiphy.features &
12127 			NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
12128 		       (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
12129 		    !wiphy_ext_feature_isset(&rdev->wiphy,
12130 					     NL80211_EXT_FEATURE_RRM)) {
12131 			kfree_sensitive(connkeys);
12132 			return -EINVAL;
12133 		}
12134 		connect.flags |= ASSOC_REQ_USE_RRM;
12135 	}
12136 
12137 	connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
12138 	if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
12139 		kfree_sensitive(connkeys);
12140 		return -EOPNOTSUPP;
12141 	}
12142 
12143 	if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
12144 		/* bss selection makes no sense if bssid is set */
12145 		if (connect.bssid) {
12146 			kfree_sensitive(connkeys);
12147 			return -EINVAL;
12148 		}
12149 
12150 		err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
12151 				       wiphy, &connect.bss_select);
12152 		if (err) {
12153 			kfree_sensitive(connkeys);
12154 			return err;
12155 		}
12156 	}
12157 
12158 	if (wiphy_ext_feature_isset(&rdev->wiphy,
12159 				    NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
12160 	    info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
12161 	    info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
12162 	    info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
12163 	    info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
12164 		connect.fils_erp_username =
12165 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
12166 		connect.fils_erp_username_len =
12167 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
12168 		connect.fils_erp_realm =
12169 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
12170 		connect.fils_erp_realm_len =
12171 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
12172 		connect.fils_erp_next_seq_num =
12173 			nla_get_u16(
12174 			   info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
12175 		connect.fils_erp_rrk =
12176 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
12177 		connect.fils_erp_rrk_len =
12178 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
12179 	} else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
12180 		   info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
12181 		   info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
12182 		   info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
12183 		kfree_sensitive(connkeys);
12184 		return -EINVAL;
12185 	}
12186 
12187 	if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) {
12188 		if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
12189 			kfree_sensitive(connkeys);
12190 			GENL_SET_ERR_MSG(info,
12191 					 "external auth requires connection ownership");
12192 			return -EINVAL;
12193 		}
12194 		connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT;
12195 	}
12196 
12197 	if (nla_get_flag(info->attrs[NL80211_ATTR_MLO_SUPPORT]))
12198 		connect.flags |= CONNECT_REQ_MLO_SUPPORT;
12199 
12200 	err = cfg80211_connect(rdev, dev, &connect, connkeys,
12201 			       connect.prev_bssid);
12202 	if (err)
12203 		kfree_sensitive(connkeys);
12204 
12205 	if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
12206 		dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
12207 		if (connect.bssid)
12208 			memcpy(dev->ieee80211_ptr->disconnect_bssid,
12209 			       connect.bssid, ETH_ALEN);
12210 		else
12211 			eth_zero_addr(dev->ieee80211_ptr->disconnect_bssid);
12212 	}
12213 
12214 	return err;
12215 }
12216 
12217 static int nl80211_update_connect_params(struct sk_buff *skb,
12218 					 struct genl_info *info)
12219 {
12220 	struct cfg80211_connect_params connect = {};
12221 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12222 	struct net_device *dev = info->user_ptr[1];
12223 	struct wireless_dev *wdev = dev->ieee80211_ptr;
12224 	bool fils_sk_offload;
12225 	u32 auth_type;
12226 	u32 changed = 0;
12227 
12228 	if (!rdev->ops->update_connect_params)
12229 		return -EOPNOTSUPP;
12230 
12231 	if (info->attrs[NL80211_ATTR_IE]) {
12232 		connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
12233 		connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
12234 		changed |= UPDATE_ASSOC_IES;
12235 	}
12236 
12237 	fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy,
12238 						  NL80211_EXT_FEATURE_FILS_SK_OFFLOAD);
12239 
12240 	/*
12241 	 * when driver supports fils-sk offload all attributes must be
12242 	 * provided. So the else covers "fils-sk-not-all" and
12243 	 * "no-fils-sk-any".
12244 	 */
12245 	if (fils_sk_offload &&
12246 	    info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
12247 	    info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
12248 	    info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
12249 	    info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
12250 		connect.fils_erp_username =
12251 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
12252 		connect.fils_erp_username_len =
12253 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
12254 		connect.fils_erp_realm =
12255 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
12256 		connect.fils_erp_realm_len =
12257 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
12258 		connect.fils_erp_next_seq_num =
12259 			nla_get_u16(
12260 			   info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
12261 		connect.fils_erp_rrk =
12262 			nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
12263 		connect.fils_erp_rrk_len =
12264 			nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
12265 		changed |= UPDATE_FILS_ERP_INFO;
12266 	} else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
12267 		   info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
12268 		   info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
12269 		   info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
12270 		return -EINVAL;
12271 	}
12272 
12273 	if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
12274 		auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
12275 		if (!nl80211_valid_auth_type(rdev, auth_type,
12276 					     NL80211_CMD_CONNECT))
12277 			return -EINVAL;
12278 
12279 		if (auth_type == NL80211_AUTHTYPE_FILS_SK &&
12280 		    fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO))
12281 			return -EINVAL;
12282 
12283 		connect.auth_type = auth_type;
12284 		changed |= UPDATE_AUTH_TYPE;
12285 	}
12286 
12287 	if (!wdev->connected)
12288 		return -ENOLINK;
12289 
12290 	return rdev_update_connect_params(rdev, dev, &connect, changed);
12291 }
12292 
12293 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
12294 {
12295 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12296 	struct net_device *dev = info->user_ptr[1];
12297 	u16 reason;
12298 
12299 	if (dev->ieee80211_ptr->conn_owner_nlportid &&
12300 	    dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
12301 		return -EPERM;
12302 
12303 	reason = nla_get_u16_default(info->attrs[NL80211_ATTR_REASON_CODE],
12304 				     WLAN_REASON_DEAUTH_LEAVING);
12305 
12306 	if (reason == 0)
12307 		return -EINVAL;
12308 
12309 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
12310 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
12311 		return -EOPNOTSUPP;
12312 
12313 	return cfg80211_disconnect(rdev, dev, reason, true);
12314 }
12315 
12316 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
12317 {
12318 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12319 	struct net *net;
12320 	int err;
12321 
12322 	if (info->attrs[NL80211_ATTR_PID]) {
12323 		u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
12324 
12325 		net = get_net_ns_by_pid(pid);
12326 	} else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
12327 		u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
12328 
12329 		net = get_net_ns_by_fd(fd);
12330 	} else {
12331 		return -EINVAL;
12332 	}
12333 
12334 	if (IS_ERR(net))
12335 		return PTR_ERR(net);
12336 
12337 	err = 0;
12338 
12339 	/* check if anything to do */
12340 	if (!net_eq(wiphy_net(&rdev->wiphy), net))
12341 		err = cfg80211_switch_netns(rdev, net);
12342 
12343 	put_net(net);
12344 	return err;
12345 }
12346 
12347 static int nl80211_set_pmksa(struct sk_buff *skb, struct genl_info *info)
12348 {
12349 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12350 	struct net_device *dev = info->user_ptr[1];
12351 	struct cfg80211_pmksa pmksa;
12352 	bool ap_pmksa_caching_support = false;
12353 
12354 	memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
12355 
12356 	ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy,
12357 		NL80211_EXT_FEATURE_AP_PMKSA_CACHING);
12358 
12359 	if (!info->attrs[NL80211_ATTR_PMKID])
12360 		return -EINVAL;
12361 
12362 	pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
12363 
12364 	if (info->attrs[NL80211_ATTR_MAC]) {
12365 		pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
12366 	} else if (info->attrs[NL80211_ATTR_SSID] &&
12367 	           info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
12368 	           info->attrs[NL80211_ATTR_PMK]) {
12369 		pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
12370 		pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
12371 		pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
12372 	} else {
12373 		return -EINVAL;
12374 	}
12375 
12376 	if (info->attrs[NL80211_ATTR_PMK]) {
12377 		pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
12378 		pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
12379 	}
12380 
12381 	if (info->attrs[NL80211_ATTR_PMK_LIFETIME])
12382 		pmksa.pmk_lifetime =
12383 			nla_get_u32(info->attrs[NL80211_ATTR_PMK_LIFETIME]);
12384 
12385 	if (info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD])
12386 		pmksa.pmk_reauth_threshold =
12387 			nla_get_u8(info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]);
12388 
12389 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
12390 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
12391 	    !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP ||
12392 	       dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) &&
12393 	       ap_pmksa_caching_support))
12394 		return -EOPNOTSUPP;
12395 
12396 	if (!rdev->ops->set_pmksa)
12397 		return -EOPNOTSUPP;
12398 
12399 	return rdev_set_pmksa(rdev, dev, &pmksa);
12400 }
12401 
12402 static int nl80211_del_pmksa(struct sk_buff *skb, struct genl_info *info)
12403 {
12404 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12405 	struct net_device *dev = info->user_ptr[1];
12406 	struct cfg80211_pmksa pmksa;
12407 	bool sae_offload_support = false;
12408 	bool owe_offload_support = false;
12409 	bool ap_pmksa_caching_support = false;
12410 
12411 	memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
12412 
12413 	sae_offload_support = wiphy_ext_feature_isset(&rdev->wiphy,
12414 		NL80211_EXT_FEATURE_SAE_OFFLOAD);
12415 	owe_offload_support = wiphy_ext_feature_isset(&rdev->wiphy,
12416 		NL80211_EXT_FEATURE_OWE_OFFLOAD);
12417 	ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy,
12418 		NL80211_EXT_FEATURE_AP_PMKSA_CACHING);
12419 
12420 	if (info->attrs[NL80211_ATTR_PMKID])
12421 		pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
12422 
12423 	if (info->attrs[NL80211_ATTR_MAC]) {
12424 		pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
12425 	} else if (info->attrs[NL80211_ATTR_SSID]) {
12426 		/* SSID based pmksa flush supported only for FILS,
12427 		 * OWE/SAE OFFLOAD cases
12428 		 */
12429 		if (info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
12430 		    info->attrs[NL80211_ATTR_PMK]) {
12431 			pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
12432 		} else if (!sae_offload_support && !owe_offload_support) {
12433 			return -EINVAL;
12434 		}
12435 		pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
12436 		pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
12437 	} else {
12438 		return -EINVAL;
12439 	}
12440 
12441 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
12442 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
12443 	    !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP ||
12444 	       dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) &&
12445 	       ap_pmksa_caching_support))
12446 		return -EOPNOTSUPP;
12447 
12448 	if (!rdev->ops->del_pmksa)
12449 		return -EOPNOTSUPP;
12450 
12451 	return rdev_del_pmksa(rdev, dev, &pmksa);
12452 }
12453 
12454 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
12455 {
12456 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12457 	struct net_device *dev = info->user_ptr[1];
12458 
12459 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
12460 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
12461 		return -EOPNOTSUPP;
12462 
12463 	if (!rdev->ops->flush_pmksa)
12464 		return -EOPNOTSUPP;
12465 
12466 	return rdev_flush_pmksa(rdev, dev);
12467 }
12468 
12469 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
12470 {
12471 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12472 	struct net_device *dev = info->user_ptr[1];
12473 	u8 action_code, dialog_token;
12474 	u32 peer_capability = 0;
12475 	u16 status_code;
12476 	u8 *peer;
12477 	int link_id;
12478 	bool initiator;
12479 
12480 	if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
12481 	    !rdev->ops->tdls_mgmt)
12482 		return -EOPNOTSUPP;
12483 
12484 	if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
12485 	    !info->attrs[NL80211_ATTR_STATUS_CODE] ||
12486 	    !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
12487 	    !info->attrs[NL80211_ATTR_IE] ||
12488 	    !info->attrs[NL80211_ATTR_MAC])
12489 		return -EINVAL;
12490 
12491 	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12492 	action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
12493 	status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
12494 	dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
12495 	initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
12496 	if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
12497 		peer_capability =
12498 			nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
12499 	link_id = nl80211_link_id_or_invalid(info->attrs);
12500 
12501 	return rdev_tdls_mgmt(rdev, dev, peer, link_id, action_code,
12502 			      dialog_token, status_code, peer_capability,
12503 			      initiator,
12504 			      nla_data(info->attrs[NL80211_ATTR_IE]),
12505 			      nla_len(info->attrs[NL80211_ATTR_IE]));
12506 }
12507 
12508 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
12509 {
12510 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12511 	struct net_device *dev = info->user_ptr[1];
12512 	enum nl80211_tdls_operation operation;
12513 	u8 *peer;
12514 
12515 	if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
12516 	    !rdev->ops->tdls_oper)
12517 		return -EOPNOTSUPP;
12518 
12519 	if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
12520 	    !info->attrs[NL80211_ATTR_MAC])
12521 		return -EINVAL;
12522 
12523 	operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
12524 	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12525 
12526 	return rdev_tdls_oper(rdev, dev, peer, operation);
12527 }
12528 
12529 static int nl80211_remain_on_channel(struct sk_buff *skb,
12530 				     struct genl_info *info)
12531 {
12532 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12533 	unsigned int link_id = nl80211_link_id(info->attrs);
12534 	struct wireless_dev *wdev = info->user_ptr[1];
12535 	struct cfg80211_chan_def chandef;
12536 	struct sk_buff *msg;
12537 	void *hdr;
12538 	u64 cookie;
12539 	u32 duration;
12540 	int err;
12541 
12542 	if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
12543 	    !info->attrs[NL80211_ATTR_DURATION])
12544 		return -EINVAL;
12545 
12546 	duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
12547 
12548 	if (!rdev->ops->remain_on_channel ||
12549 	    !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
12550 		return -EOPNOTSUPP;
12551 
12552 	/*
12553 	 * We should be on that channel for at least a minimum amount of
12554 	 * time (10ms) but no longer than the driver supports.
12555 	 */
12556 	if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
12557 	    duration > rdev->wiphy.max_remain_on_channel_duration)
12558 		return -EINVAL;
12559 
12560 	err = nl80211_parse_chandef(rdev, info, &chandef);
12561 	if (err)
12562 		return err;
12563 
12564 	if (!cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) {
12565 		const struct cfg80211_chan_def *oper_chandef, *compat_chandef;
12566 
12567 		oper_chandef = wdev_chandef(wdev, link_id);
12568 
12569 		if (WARN_ON(!oper_chandef)) {
12570 			/* cannot happen since we must beacon to get here */
12571 			WARN_ON(1);
12572 			return -EBUSY;
12573 		}
12574 
12575 		/* note: returns first one if identical chandefs */
12576 		compat_chandef = cfg80211_chandef_compatible(&chandef,
12577 							     oper_chandef);
12578 
12579 		if (compat_chandef != &chandef)
12580 			return -EBUSY;
12581 	}
12582 
12583 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12584 	if (!msg)
12585 		return -ENOMEM;
12586 
12587 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12588 			     NL80211_CMD_REMAIN_ON_CHANNEL);
12589 	if (!hdr) {
12590 		err = -ENOBUFS;
12591 		goto free_msg;
12592 	}
12593 
12594 	err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
12595 				     duration, &cookie);
12596 
12597 	if (err)
12598 		goto free_msg;
12599 
12600 	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
12601 			      NL80211_ATTR_PAD))
12602 		goto nla_put_failure;
12603 
12604 	genlmsg_end(msg, hdr);
12605 
12606 	return genlmsg_reply(msg, info);
12607 
12608  nla_put_failure:
12609 	err = -ENOBUFS;
12610  free_msg:
12611 	nlmsg_free(msg);
12612 	return err;
12613 }
12614 
12615 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
12616 					    struct genl_info *info)
12617 {
12618 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12619 	struct wireless_dev *wdev = info->user_ptr[1];
12620 	u64 cookie;
12621 
12622 	if (!info->attrs[NL80211_ATTR_COOKIE])
12623 		return -EINVAL;
12624 
12625 	if (!rdev->ops->cancel_remain_on_channel)
12626 		return -EOPNOTSUPP;
12627 
12628 	cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
12629 
12630 	return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
12631 }
12632 
12633 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
12634 				       struct genl_info *info)
12635 {
12636 	struct cfg80211_bitrate_mask mask;
12637 	unsigned int link_id = nl80211_link_id(info->attrs);
12638 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12639 	struct net_device *dev = info->user_ptr[1];
12640 	int err;
12641 
12642 	if (!rdev->ops->set_bitrate_mask)
12643 		return -EOPNOTSUPP;
12644 
12645 	err = nl80211_parse_tx_bitrate_mask(info, info->attrs,
12646 					    NL80211_ATTR_TX_RATES, &mask,
12647 					    dev, true, link_id);
12648 	if (err)
12649 		return err;
12650 
12651 	return rdev_set_bitrate_mask(rdev, dev, link_id, NULL, &mask);
12652 }
12653 
12654 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
12655 {
12656 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12657 	struct wireless_dev *wdev = info->user_ptr[1];
12658 	u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
12659 
12660 	if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
12661 		return -EINVAL;
12662 
12663 	if (info->attrs[NL80211_ATTR_FRAME_TYPE])
12664 		frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
12665 
12666 	switch (wdev->iftype) {
12667 	case NL80211_IFTYPE_STATION:
12668 	case NL80211_IFTYPE_ADHOC:
12669 	case NL80211_IFTYPE_P2P_CLIENT:
12670 	case NL80211_IFTYPE_AP:
12671 	case NL80211_IFTYPE_AP_VLAN:
12672 	case NL80211_IFTYPE_MESH_POINT:
12673 	case NL80211_IFTYPE_P2P_GO:
12674 	case NL80211_IFTYPE_P2P_DEVICE:
12675 		break;
12676 	case NL80211_IFTYPE_NAN:
12677 		if (!wiphy_ext_feature_isset(wdev->wiphy,
12678 					     NL80211_EXT_FEATURE_SECURE_NAN))
12679 			return -EOPNOTSUPP;
12680 		break;
12681 	default:
12682 		return -EOPNOTSUPP;
12683 	}
12684 
12685 	/* not much point in registering if we can't reply */
12686 	if (!rdev->ops->mgmt_tx)
12687 		return -EOPNOTSUPP;
12688 
12689 	if (info->attrs[NL80211_ATTR_RECEIVE_MULTICAST] &&
12690 	    !wiphy_ext_feature_isset(&rdev->wiphy,
12691 				     NL80211_EXT_FEATURE_MULTICAST_REGISTRATIONS)) {
12692 		GENL_SET_ERR_MSG(info,
12693 				 "multicast RX registrations are not supported");
12694 		return -EOPNOTSUPP;
12695 	}
12696 
12697 	return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
12698 					   nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
12699 					   nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]),
12700 					   info->attrs[NL80211_ATTR_RECEIVE_MULTICAST],
12701 					   info->extack);
12702 }
12703 
12704 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
12705 {
12706 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12707 	struct wireless_dev *wdev = info->user_ptr[1];
12708 	struct cfg80211_chan_def chandef;
12709 	int err;
12710 	void *hdr = NULL;
12711 	u64 cookie;
12712 	struct sk_buff *msg = NULL;
12713 	struct cfg80211_mgmt_tx_params params = {
12714 		.dont_wait_for_ack =
12715 			info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
12716 	};
12717 
12718 	if (!info->attrs[NL80211_ATTR_FRAME])
12719 		return -EINVAL;
12720 
12721 	if (!rdev->ops->mgmt_tx)
12722 		return -EOPNOTSUPP;
12723 
12724 	switch (wdev->iftype) {
12725 	case NL80211_IFTYPE_P2P_DEVICE:
12726 		if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
12727 			return -EINVAL;
12728 		break;
12729 	case NL80211_IFTYPE_STATION:
12730 	case NL80211_IFTYPE_ADHOC:
12731 	case NL80211_IFTYPE_P2P_CLIENT:
12732 	case NL80211_IFTYPE_AP:
12733 	case NL80211_IFTYPE_AP_VLAN:
12734 	case NL80211_IFTYPE_MESH_POINT:
12735 	case NL80211_IFTYPE_P2P_GO:
12736 		break;
12737 	case NL80211_IFTYPE_NAN:
12738 		if (!wiphy_ext_feature_isset(wdev->wiphy,
12739 					     NL80211_EXT_FEATURE_SECURE_NAN))
12740 			return -EOPNOTSUPP;
12741 		break;
12742 	default:
12743 		return -EOPNOTSUPP;
12744 	}
12745 
12746 	if (info->attrs[NL80211_ATTR_DURATION]) {
12747 		if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
12748 			return -EINVAL;
12749 		params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
12750 
12751 		/*
12752 		 * We should wait on the channel for at least a minimum amount
12753 		 * of time (10ms) but no longer than the driver supports.
12754 		 */
12755 		if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
12756 		    params.wait > rdev->wiphy.max_remain_on_channel_duration)
12757 			return -EINVAL;
12758 	}
12759 
12760 	params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
12761 
12762 	if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
12763 		return -EINVAL;
12764 
12765 	params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
12766 
12767 	/* get the channel if any has been specified, otherwise pass NULL to
12768 	 * the driver. The latter will use the current one
12769 	 */
12770 	chandef.chan = NULL;
12771 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
12772 		err = nl80211_parse_chandef(rdev, info, &chandef);
12773 		if (err)
12774 			return err;
12775 	}
12776 
12777 	if (!chandef.chan && params.offchan)
12778 		return -EINVAL;
12779 
12780 	if (params.offchan &&
12781 	    !cfg80211_off_channel_oper_allowed(wdev, chandef.chan))
12782 		return -EBUSY;
12783 
12784 	params.link_id = nl80211_link_id_or_invalid(info->attrs);
12785 	/*
12786 	 * This now races due to the unlock, but we cannot check
12787 	 * the valid links for the _station_ anyway, so that's up
12788 	 * to the driver.
12789 	 */
12790 	if (params.link_id >= 0 &&
12791 	    !(wdev->valid_links & BIT(params.link_id)))
12792 		return -EINVAL;
12793 
12794 	params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
12795 	params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
12796 
12797 	err = nl80211_parse_counter_offsets(rdev, NULL, params.len, -1,
12798 					    info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX],
12799 					    &params.csa_offsets,
12800 					    &params.n_csa_offsets);
12801 	if (err)
12802 		return err;
12803 
12804 	if (!params.dont_wait_for_ack) {
12805 		msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12806 		if (!msg)
12807 			return -ENOMEM;
12808 
12809 		hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12810 				     NL80211_CMD_FRAME);
12811 		if (!hdr) {
12812 			err = -ENOBUFS;
12813 			goto free_msg;
12814 		}
12815 	}
12816 
12817 	params.chan = chandef.chan;
12818 	err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
12819 	if (err)
12820 		goto free_msg;
12821 
12822 	if (msg) {
12823 		if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
12824 				      NL80211_ATTR_PAD))
12825 			goto nla_put_failure;
12826 
12827 		genlmsg_end(msg, hdr);
12828 		return genlmsg_reply(msg, info);
12829 	}
12830 
12831 	return 0;
12832 
12833  nla_put_failure:
12834 	err = -ENOBUFS;
12835  free_msg:
12836 	nlmsg_free(msg);
12837 	return err;
12838 }
12839 
12840 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
12841 {
12842 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12843 	struct wireless_dev *wdev = info->user_ptr[1];
12844 	u64 cookie;
12845 
12846 	if (!info->attrs[NL80211_ATTR_COOKIE])
12847 		return -EINVAL;
12848 
12849 	if (!rdev->ops->mgmt_tx_cancel_wait)
12850 		return -EOPNOTSUPP;
12851 
12852 	switch (wdev->iftype) {
12853 	case NL80211_IFTYPE_STATION:
12854 	case NL80211_IFTYPE_ADHOC:
12855 	case NL80211_IFTYPE_P2P_CLIENT:
12856 	case NL80211_IFTYPE_AP:
12857 	case NL80211_IFTYPE_AP_VLAN:
12858 	case NL80211_IFTYPE_P2P_GO:
12859 	case NL80211_IFTYPE_P2P_DEVICE:
12860 		break;
12861 	case NL80211_IFTYPE_NAN:
12862 		if (!wiphy_ext_feature_isset(wdev->wiphy,
12863 					     NL80211_EXT_FEATURE_SECURE_NAN))
12864 			return -EOPNOTSUPP;
12865 		break;
12866 	default:
12867 		return -EOPNOTSUPP;
12868 	}
12869 
12870 	cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
12871 
12872 	return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
12873 }
12874 
12875 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
12876 {
12877 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12878 	struct wireless_dev *wdev;
12879 	struct net_device *dev = info->user_ptr[1];
12880 	u8 ps_state;
12881 	bool state;
12882 	int err;
12883 
12884 	if (!info->attrs[NL80211_ATTR_PS_STATE])
12885 		return -EINVAL;
12886 
12887 	ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
12888 
12889 	wdev = dev->ieee80211_ptr;
12890 
12891 	if (!rdev->ops->set_power_mgmt)
12892 		return -EOPNOTSUPP;
12893 
12894 	state = (ps_state == NL80211_PS_ENABLED) ? true : false;
12895 
12896 	if (state == wdev->ps)
12897 		return 0;
12898 
12899 	err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
12900 	if (!err)
12901 		wdev->ps = state;
12902 	return err;
12903 }
12904 
12905 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
12906 {
12907 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12908 	enum nl80211_ps_state ps_state;
12909 	struct wireless_dev *wdev;
12910 	struct net_device *dev = info->user_ptr[1];
12911 	struct sk_buff *msg;
12912 	void *hdr;
12913 	int err;
12914 
12915 	wdev = dev->ieee80211_ptr;
12916 
12917 	if (!rdev->ops->set_power_mgmt)
12918 		return -EOPNOTSUPP;
12919 
12920 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12921 	if (!msg)
12922 		return -ENOMEM;
12923 
12924 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12925 			     NL80211_CMD_GET_POWER_SAVE);
12926 	if (!hdr) {
12927 		err = -ENOBUFS;
12928 		goto free_msg;
12929 	}
12930 
12931 	if (wdev->ps)
12932 		ps_state = NL80211_PS_ENABLED;
12933 	else
12934 		ps_state = NL80211_PS_DISABLED;
12935 
12936 	if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
12937 		goto nla_put_failure;
12938 
12939 	genlmsg_end(msg, hdr);
12940 	return genlmsg_reply(msg, info);
12941 
12942  nla_put_failure:
12943 	err = -ENOBUFS;
12944  free_msg:
12945 	nlmsg_free(msg);
12946 	return err;
12947 }
12948 
12949 static const struct nla_policy
12950 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
12951 	[NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
12952 	[NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
12953 	[NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
12954 	[NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
12955 	[NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
12956 	[NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
12957 	[NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
12958 };
12959 
12960 static int nl80211_set_cqm_txe(struct genl_info *info,
12961 			       u32 rate, u32 pkts, u32 intvl)
12962 {
12963 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
12964 	struct net_device *dev = info->user_ptr[1];
12965 	struct wireless_dev *wdev = dev->ieee80211_ptr;
12966 
12967 	if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
12968 		return -EINVAL;
12969 
12970 	if (!rdev->ops->set_cqm_txe_config)
12971 		return -EOPNOTSUPP;
12972 
12973 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
12974 	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
12975 		return -EOPNOTSUPP;
12976 
12977 	return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
12978 }
12979 
12980 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
12981 				    struct net_device *dev,
12982 				    struct cfg80211_cqm_config *cqm_config)
12983 {
12984 	struct wireless_dev *wdev = dev->ieee80211_ptr;
12985 	s32 last, low, high;
12986 	u32 hyst;
12987 	int i, n, low_index;
12988 	int err;
12989 
12990 	/*
12991 	 * Obtain current RSSI value if possible, if not and no RSSI threshold
12992 	 * event has been received yet, we should receive an event after a
12993 	 * connection is established and enough beacons received to calculate
12994 	 * the average.
12995 	 */
12996 	if (!cqm_config->last_rssi_event_value &&
12997 	    wdev->links[0].client.current_bss &&
12998 	    rdev->ops->get_station) {
12999 		struct station_info sinfo = {};
13000 		u8 *mac_addr;
13001 
13002 		mac_addr = wdev->links[0].client.current_bss->pub.bssid;
13003 
13004 		err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
13005 		if (err)
13006 			return err;
13007 
13008 		cfg80211_sinfo_release_content(&sinfo);
13009 		if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
13010 			cqm_config->last_rssi_event_value =
13011 				(s8) sinfo.rx_beacon_signal_avg;
13012 	}
13013 
13014 	last = cqm_config->last_rssi_event_value;
13015 	hyst = cqm_config->rssi_hyst;
13016 	n = cqm_config->n_rssi_thresholds;
13017 
13018 	for (i = 0; i < n; i++) {
13019 		i = array_index_nospec(i, n);
13020 		if (last < cqm_config->rssi_thresholds[i])
13021 			break;
13022 	}
13023 
13024 	low_index = i - 1;
13025 	if (low_index >= 0) {
13026 		low_index = array_index_nospec(low_index, n);
13027 		low = cqm_config->rssi_thresholds[low_index] - hyst;
13028 	} else {
13029 		low = S32_MIN;
13030 	}
13031 	if (i < n) {
13032 		i = array_index_nospec(i, n);
13033 		high = cqm_config->rssi_thresholds[i] + hyst - 1;
13034 	} else {
13035 		high = S32_MAX;
13036 	}
13037 
13038 	return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
13039 }
13040 
13041 static int nl80211_set_cqm_rssi(struct genl_info *info,
13042 				const s32 *thresholds, int n_thresholds,
13043 				u32 hysteresis)
13044 {
13045 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13046 	struct cfg80211_cqm_config *cqm_config = NULL, *old;
13047 	struct net_device *dev = info->user_ptr[1];
13048 	struct wireless_dev *wdev = dev->ieee80211_ptr;
13049 	s32 prev = S32_MIN;
13050 	int i, err;
13051 
13052 	/* Check all values negative and sorted */
13053 	for (i = 0; i < n_thresholds; i++) {
13054 		if (thresholds[i] > 0 || thresholds[i] <= prev)
13055 			return -EINVAL;
13056 
13057 		prev = thresholds[i];
13058 	}
13059 
13060 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
13061 	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
13062 		return -EOPNOTSUPP;
13063 
13064 	if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
13065 		n_thresholds = 0;
13066 
13067 	old = wiphy_dereference(wdev->wiphy, wdev->cqm_config);
13068 
13069 	/* if already disabled just succeed */
13070 	if (!n_thresholds && !old)
13071 		return 0;
13072 
13073 	if (n_thresholds > 1) {
13074 		if (!wiphy_ext_feature_isset(&rdev->wiphy,
13075 					     NL80211_EXT_FEATURE_CQM_RSSI_LIST) ||
13076 		    !rdev->ops->set_cqm_rssi_range_config)
13077 			return -EOPNOTSUPP;
13078 	} else {
13079 		if (!rdev->ops->set_cqm_rssi_config)
13080 			return -EOPNOTSUPP;
13081 	}
13082 
13083 	if (n_thresholds) {
13084 		cqm_config = kzalloc(struct_size(cqm_config, rssi_thresholds,
13085 						 n_thresholds),
13086 				     GFP_KERNEL);
13087 		if (!cqm_config)
13088 			return -ENOMEM;
13089 
13090 		cqm_config->rssi_hyst = hysteresis;
13091 		cqm_config->n_rssi_thresholds = n_thresholds;
13092 		memcpy(cqm_config->rssi_thresholds, thresholds,
13093 		       flex_array_size(cqm_config, rssi_thresholds,
13094 				       n_thresholds));
13095 		cqm_config->use_range_api = n_thresholds > 1 ||
13096 					    !rdev->ops->set_cqm_rssi_config;
13097 
13098 		rcu_assign_pointer(wdev->cqm_config, cqm_config);
13099 
13100 		if (cqm_config->use_range_api)
13101 			err = cfg80211_cqm_rssi_update(rdev, dev, cqm_config);
13102 		else
13103 			err = rdev_set_cqm_rssi_config(rdev, dev,
13104 						       thresholds[0],
13105 						       hysteresis);
13106 	} else {
13107 		RCU_INIT_POINTER(wdev->cqm_config, NULL);
13108 		/* if enabled as range also disable via range */
13109 		if (old->use_range_api)
13110 			err = rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);
13111 		else
13112 			err = rdev_set_cqm_rssi_config(rdev, dev, 0, 0);
13113 	}
13114 
13115 	if (err) {
13116 		rcu_assign_pointer(wdev->cqm_config, old);
13117 		kfree_rcu(cqm_config, rcu_head);
13118 	} else {
13119 		kfree_rcu(old, rcu_head);
13120 	}
13121 
13122 	return err;
13123 }
13124 
13125 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
13126 {
13127 	struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
13128 	struct nlattr *cqm;
13129 	int err;
13130 
13131 	cqm = info->attrs[NL80211_ATTR_CQM];
13132 	if (!cqm)
13133 		return -EINVAL;
13134 
13135 	err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm,
13136 					  nl80211_attr_cqm_policy,
13137 					  info->extack);
13138 	if (err)
13139 		return err;
13140 
13141 	if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
13142 	    attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
13143 		const s32 *thresholds =
13144 			nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
13145 		int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
13146 		u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
13147 
13148 		if (len % 4)
13149 			return -EINVAL;
13150 
13151 		return nl80211_set_cqm_rssi(info, thresholds, len / 4,
13152 					    hysteresis);
13153 	}
13154 
13155 	if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
13156 	    attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
13157 	    attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
13158 		u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
13159 		u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
13160 		u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
13161 
13162 		return nl80211_set_cqm_txe(info, rate, pkts, intvl);
13163 	}
13164 
13165 	return -EINVAL;
13166 }
13167 
13168 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
13169 {
13170 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13171 	struct net_device *dev = info->user_ptr[1];
13172 	struct ocb_setup setup = {};
13173 	int err;
13174 
13175 	err = nl80211_parse_chandef(rdev, info, &setup.chandef);
13176 	if (err)
13177 		return err;
13178 
13179 	return cfg80211_join_ocb(rdev, dev, &setup);
13180 }
13181 
13182 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
13183 {
13184 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13185 	struct net_device *dev = info->user_ptr[1];
13186 
13187 	return cfg80211_leave_ocb(rdev, dev);
13188 }
13189 
13190 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
13191 {
13192 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13193 	struct net_device *dev = info->user_ptr[1];
13194 	struct mesh_config cfg;
13195 	struct mesh_setup setup;
13196 	int err;
13197 
13198 	/* start with default */
13199 	memcpy(&cfg, &default_mesh_config, sizeof(cfg));
13200 	memcpy(&setup, &default_mesh_setup, sizeof(setup));
13201 
13202 	if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
13203 		/* and parse parameters if given */
13204 		err = nl80211_parse_mesh_config(info, &cfg, NULL);
13205 		if (err)
13206 			return err;
13207 	}
13208 
13209 	if (!info->attrs[NL80211_ATTR_MESH_ID] ||
13210 	    !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
13211 		return -EINVAL;
13212 
13213 	setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
13214 	setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
13215 
13216 	if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
13217 	    !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
13218 			    nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
13219 			return -EINVAL;
13220 
13221 	if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
13222 		setup.beacon_interval =
13223 			nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
13224 
13225 		err = cfg80211_validate_beacon_int(rdev,
13226 						   NL80211_IFTYPE_MESH_POINT,
13227 						   setup.beacon_interval);
13228 		if (err)
13229 			return err;
13230 	}
13231 
13232 	if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
13233 		setup.dtim_period =
13234 			nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
13235 		if (setup.dtim_period < 1 || setup.dtim_period > 100)
13236 			return -EINVAL;
13237 	}
13238 
13239 	if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
13240 		/* parse additional setup parameters if given */
13241 		err = nl80211_parse_mesh_setup(info, &setup);
13242 		if (err)
13243 			return err;
13244 	}
13245 
13246 	if (setup.user_mpm)
13247 		cfg.auto_open_plinks = false;
13248 
13249 	if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
13250 		err = nl80211_parse_chandef(rdev, info, &setup.chandef);
13251 		if (err)
13252 			return err;
13253 	} else {
13254 		/* __cfg80211_join_mesh() will sort it out */
13255 		setup.chandef.chan = NULL;
13256 	}
13257 
13258 	if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
13259 		u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
13260 		int n_rates =
13261 			nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
13262 		struct ieee80211_supported_band *sband;
13263 
13264 		if (!setup.chandef.chan)
13265 			return -EINVAL;
13266 
13267 		sband = rdev->wiphy.bands[setup.chandef.chan->band];
13268 
13269 		err = ieee80211_get_ratemask(sband, rates, n_rates,
13270 					     &setup.basic_rates);
13271 		if (err)
13272 			return err;
13273 	}
13274 
13275 	if (info->attrs[NL80211_ATTR_TX_RATES]) {
13276 		err = nl80211_parse_tx_bitrate_mask(info, info->attrs,
13277 						    NL80211_ATTR_TX_RATES,
13278 						    &setup.beacon_rate,
13279 						    dev, false, 0);
13280 		if (err)
13281 			return err;
13282 
13283 		if (!setup.chandef.chan)
13284 			return -EINVAL;
13285 
13286 		err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
13287 					      &setup.beacon_rate);
13288 		if (err)
13289 			return err;
13290 	}
13291 
13292 	setup.userspace_handles_dfs =
13293 		nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
13294 
13295 	if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
13296 		int r = validate_pae_over_nl80211(rdev, info);
13297 
13298 		if (r < 0)
13299 			return r;
13300 
13301 		setup.control_port_over_nl80211 = true;
13302 	}
13303 
13304 	err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg);
13305 	if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER])
13306 		dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
13307 
13308 	return err;
13309 }
13310 
13311 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
13312 {
13313 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13314 	struct net_device *dev = info->user_ptr[1];
13315 
13316 	return cfg80211_leave_mesh(rdev, dev);
13317 }
13318 
13319 #ifdef CONFIG_PM
13320 static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
13321 					struct cfg80211_registered_device *rdev)
13322 {
13323 	struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
13324 	struct nlattr *nl_pats, *nl_pat;
13325 	int i, pat_len;
13326 
13327 	if (!wowlan->n_patterns)
13328 		return 0;
13329 
13330 	nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
13331 	if (!nl_pats)
13332 		return -ENOBUFS;
13333 
13334 	for (i = 0; i < wowlan->n_patterns; i++) {
13335 		nl_pat = nla_nest_start_noflag(msg, i + 1);
13336 		if (!nl_pat)
13337 			return -ENOBUFS;
13338 		pat_len = wowlan->patterns[i].pattern_len;
13339 		if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
13340 			    wowlan->patterns[i].mask) ||
13341 		    nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
13342 			    wowlan->patterns[i].pattern) ||
13343 		    nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
13344 				wowlan->patterns[i].pkt_offset))
13345 			return -ENOBUFS;
13346 		nla_nest_end(msg, nl_pat);
13347 	}
13348 	nla_nest_end(msg, nl_pats);
13349 
13350 	return 0;
13351 }
13352 
13353 static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
13354 				   struct cfg80211_wowlan_tcp *tcp)
13355 {
13356 	struct nlattr *nl_tcp;
13357 
13358 	if (!tcp)
13359 		return 0;
13360 
13361 	nl_tcp = nla_nest_start_noflag(msg,
13362 				       NL80211_WOWLAN_TRIG_TCP_CONNECTION);
13363 	if (!nl_tcp)
13364 		return -ENOBUFS;
13365 
13366 	if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
13367 	    nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
13368 	    nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
13369 	    nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
13370 	    nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
13371 	    nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
13372 		    tcp->payload_len, tcp->payload) ||
13373 	    nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
13374 			tcp->data_interval) ||
13375 	    nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
13376 		    tcp->wake_len, tcp->wake_data) ||
13377 	    nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
13378 		    DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
13379 		return -ENOBUFS;
13380 
13381 	if (tcp->payload_seq.len &&
13382 	    nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
13383 		    sizeof(tcp->payload_seq), &tcp->payload_seq))
13384 		return -ENOBUFS;
13385 
13386 	if (tcp->payload_tok.len &&
13387 	    nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
13388 		    sizeof(tcp->payload_tok) + tcp->tokens_size,
13389 		    &tcp->payload_tok))
13390 		return -ENOBUFS;
13391 
13392 	nla_nest_end(msg, nl_tcp);
13393 
13394 	return 0;
13395 }
13396 
13397 static int nl80211_send_wowlan_nd(struct sk_buff *msg,
13398 				  struct cfg80211_sched_scan_request *req)
13399 {
13400 	struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
13401 	int i;
13402 
13403 	if (!req)
13404 		return 0;
13405 
13406 	nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
13407 	if (!nd)
13408 		return -ENOBUFS;
13409 
13410 	if (req->n_scan_plans == 1 &&
13411 	    nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
13412 			req->scan_plans[0].interval * 1000))
13413 		return -ENOBUFS;
13414 
13415 	if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
13416 		return -ENOBUFS;
13417 
13418 	if (req->relative_rssi_set) {
13419 		struct nl80211_bss_select_rssi_adjust rssi_adjust;
13420 
13421 		if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
13422 			       req->relative_rssi))
13423 			return -ENOBUFS;
13424 
13425 		rssi_adjust.band = req->rssi_adjust.band;
13426 		rssi_adjust.delta = req->rssi_adjust.delta;
13427 		if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
13428 			    sizeof(rssi_adjust), &rssi_adjust))
13429 			return -ENOBUFS;
13430 	}
13431 
13432 	freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES);
13433 	if (!freqs)
13434 		return -ENOBUFS;
13435 
13436 	for (i = 0; i < req->n_channels; i++) {
13437 		if (nla_put_u32(msg, i, req->channels[i]->center_freq))
13438 			return -ENOBUFS;
13439 	}
13440 
13441 	nla_nest_end(msg, freqs);
13442 
13443 	if (req->n_match_sets) {
13444 		matches = nla_nest_start_noflag(msg,
13445 						NL80211_ATTR_SCHED_SCAN_MATCH);
13446 		if (!matches)
13447 			return -ENOBUFS;
13448 
13449 		for (i = 0; i < req->n_match_sets; i++) {
13450 			match = nla_nest_start_noflag(msg, i);
13451 			if (!match)
13452 				return -ENOBUFS;
13453 
13454 			if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
13455 				    req->match_sets[i].ssid.ssid_len,
13456 				    req->match_sets[i].ssid.ssid))
13457 				return -ENOBUFS;
13458 			nla_nest_end(msg, match);
13459 		}
13460 		nla_nest_end(msg, matches);
13461 	}
13462 
13463 	scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
13464 	if (!scan_plans)
13465 		return -ENOBUFS;
13466 
13467 	for (i = 0; i < req->n_scan_plans; i++) {
13468 		scan_plan = nla_nest_start_noflag(msg, i + 1);
13469 		if (!scan_plan)
13470 			return -ENOBUFS;
13471 
13472 		if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
13473 				req->scan_plans[i].interval) ||
13474 		    (req->scan_plans[i].iterations &&
13475 		     nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
13476 				 req->scan_plans[i].iterations)))
13477 			return -ENOBUFS;
13478 		nla_nest_end(msg, scan_plan);
13479 	}
13480 	nla_nest_end(msg, scan_plans);
13481 
13482 	nla_nest_end(msg, nd);
13483 
13484 	return 0;
13485 }
13486 
13487 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
13488 {
13489 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13490 	struct sk_buff *msg;
13491 	void *hdr;
13492 	u32 size = NLMSG_DEFAULT_SIZE;
13493 
13494 	if (!rdev->wiphy.wowlan)
13495 		return -EOPNOTSUPP;
13496 
13497 	if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
13498 		/* adjust size to have room for all the data */
13499 		size += rdev->wiphy.wowlan_config->tcp->tokens_size +
13500 			rdev->wiphy.wowlan_config->tcp->payload_len +
13501 			rdev->wiphy.wowlan_config->tcp->wake_len +
13502 			rdev->wiphy.wowlan_config->tcp->wake_len / 8;
13503 	}
13504 
13505 	msg = nlmsg_new(size, GFP_KERNEL);
13506 	if (!msg)
13507 		return -ENOMEM;
13508 
13509 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
13510 			     NL80211_CMD_GET_WOWLAN);
13511 	if (!hdr)
13512 		goto nla_put_failure;
13513 
13514 	if (rdev->wiphy.wowlan_config) {
13515 		struct nlattr *nl_wowlan;
13516 
13517 		nl_wowlan = nla_nest_start_noflag(msg,
13518 						  NL80211_ATTR_WOWLAN_TRIGGERS);
13519 		if (!nl_wowlan)
13520 			goto nla_put_failure;
13521 
13522 		if ((rdev->wiphy.wowlan_config->any &&
13523 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
13524 		    (rdev->wiphy.wowlan_config->disconnect &&
13525 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
13526 		    (rdev->wiphy.wowlan_config->magic_pkt &&
13527 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
13528 		    (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
13529 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
13530 		    (rdev->wiphy.wowlan_config->eap_identity_req &&
13531 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
13532 		    (rdev->wiphy.wowlan_config->four_way_handshake &&
13533 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
13534 		    (rdev->wiphy.wowlan_config->rfkill_release &&
13535 		     nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
13536 			goto nla_put_failure;
13537 
13538 		if (nl80211_send_wowlan_patterns(msg, rdev))
13539 			goto nla_put_failure;
13540 
13541 		if (nl80211_send_wowlan_tcp(msg,
13542 					    rdev->wiphy.wowlan_config->tcp))
13543 			goto nla_put_failure;
13544 
13545 		if (nl80211_send_wowlan_nd(
13546 			    msg,
13547 			    rdev->wiphy.wowlan_config->nd_config))
13548 			goto nla_put_failure;
13549 
13550 		nla_nest_end(msg, nl_wowlan);
13551 	}
13552 
13553 	genlmsg_end(msg, hdr);
13554 	return genlmsg_reply(msg, info);
13555 
13556 nla_put_failure:
13557 	nlmsg_free(msg);
13558 	return -ENOBUFS;
13559 }
13560 
13561 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
13562 				    struct nlattr *attr,
13563 				    struct cfg80211_wowlan *trig)
13564 {
13565 	struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
13566 	struct cfg80211_wowlan_tcp *cfg;
13567 	struct nl80211_wowlan_tcp_data_token *tok = NULL;
13568 	struct nl80211_wowlan_tcp_data_seq *seq = NULL;
13569 	u32 size;
13570 	u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
13571 	int err, port;
13572 
13573 	if (!rdev->wiphy.wowlan->tcp)
13574 		return -EINVAL;
13575 
13576 	err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr,
13577 					  nl80211_wowlan_tcp_policy, NULL);
13578 	if (err)
13579 		return err;
13580 
13581 	if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
13582 	    !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
13583 	    !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
13584 	    !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
13585 	    !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
13586 	    !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
13587 	    !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
13588 	    !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
13589 		return -EINVAL;
13590 
13591 	data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
13592 	if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
13593 		return -EINVAL;
13594 
13595 	if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
13596 			rdev->wiphy.wowlan->tcp->data_interval_max ||
13597 	    nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
13598 		return -EINVAL;
13599 
13600 	wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
13601 	if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
13602 		return -EINVAL;
13603 
13604 	wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
13605 	if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
13606 		return -EINVAL;
13607 
13608 	if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
13609 		u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
13610 
13611 		tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
13612 		tokens_size = tokln - sizeof(*tok);
13613 
13614 		if (!tok->len || tokens_size % tok->len)
13615 			return -EINVAL;
13616 		if (!rdev->wiphy.wowlan->tcp->tok)
13617 			return -EINVAL;
13618 		if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
13619 			return -EINVAL;
13620 		if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
13621 			return -EINVAL;
13622 		if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
13623 			return -EINVAL;
13624 		if (tok->offset + tok->len > data_size)
13625 			return -EINVAL;
13626 	}
13627 
13628 	if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
13629 		seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
13630 		if (!rdev->wiphy.wowlan->tcp->seq)
13631 			return -EINVAL;
13632 		if (seq->len == 0 || seq->len > 4)
13633 			return -EINVAL;
13634 		if (seq->len + seq->offset > data_size)
13635 			return -EINVAL;
13636 	}
13637 
13638 	size = sizeof(*cfg);
13639 	size += data_size;
13640 	size += wake_size + wake_mask_size;
13641 	size += tokens_size;
13642 
13643 	cfg = kzalloc(size, GFP_KERNEL);
13644 	if (!cfg)
13645 		return -ENOMEM;
13646 	cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
13647 	cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
13648 	memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
13649 	       ETH_ALEN);
13650 	port = nla_get_u16_default(tb[NL80211_WOWLAN_TCP_SRC_PORT], 0);
13651 #ifdef CONFIG_INET
13652 	/* allocate a socket and port for it and use it */
13653 	err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
13654 			    IPPROTO_TCP, &cfg->sock, 1);
13655 	if (err) {
13656 		kfree(cfg);
13657 		return err;
13658 	}
13659 	if (inet_csk_get_port(cfg->sock->sk, port)) {
13660 		sock_release(cfg->sock);
13661 		kfree(cfg);
13662 		return -EADDRINUSE;
13663 	}
13664 	cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
13665 #else
13666 	if (!port) {
13667 		kfree(cfg);
13668 		return -EINVAL;
13669 	}
13670 	cfg->src_port = port;
13671 #endif
13672 
13673 	cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
13674 	cfg->payload_len = data_size;
13675 	cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
13676 	memcpy((void *)cfg->payload,
13677 	       nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
13678 	       data_size);
13679 	if (seq)
13680 		cfg->payload_seq = *seq;
13681 	cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
13682 	cfg->wake_len = wake_size;
13683 	cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
13684 	memcpy((void *)cfg->wake_data,
13685 	       nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
13686 	       wake_size);
13687 	cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
13688 			 data_size + wake_size;
13689 	memcpy((void *)cfg->wake_mask,
13690 	       nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
13691 	       wake_mask_size);
13692 	if (tok) {
13693 		cfg->tokens_size = tokens_size;
13694 		cfg->payload_tok = *tok;
13695 		memcpy(cfg->payload_tok.token_stream, tok->token_stream,
13696 		       tokens_size);
13697 	}
13698 
13699 	trig->tcp = cfg;
13700 
13701 	return 0;
13702 }
13703 
13704 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
13705 				   const struct wiphy_wowlan_support *wowlan,
13706 				   struct nlattr *attr,
13707 				   struct cfg80211_wowlan *trig)
13708 {
13709 	struct nlattr **tb;
13710 	int err;
13711 
13712 	tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
13713 	if (!tb)
13714 		return -ENOMEM;
13715 
13716 	if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
13717 		err = -EOPNOTSUPP;
13718 		goto out;
13719 	}
13720 
13721 	err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr,
13722 					  nl80211_policy, NULL);
13723 	if (err)
13724 		goto out;
13725 
13726 	trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
13727 						   wowlan->max_nd_match_sets);
13728 	err = PTR_ERR_OR_ZERO(trig->nd_config);
13729 	if (err)
13730 		trig->nd_config = NULL;
13731 
13732 out:
13733 	kfree(tb);
13734 	return err;
13735 }
13736 
13737 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
13738 {
13739 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
13740 	struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
13741 	struct cfg80211_wowlan new_triggers = {};
13742 	struct cfg80211_wowlan *ntrig;
13743 	const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
13744 	int err, i;
13745 	bool prev_enabled = rdev->wiphy.wowlan_config;
13746 	bool regular = false;
13747 
13748 	if (!wowlan)
13749 		return -EOPNOTSUPP;
13750 
13751 	if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
13752 		cfg80211_rdev_free_wowlan(rdev);
13753 		rdev->wiphy.wowlan_config = NULL;
13754 		goto set_wakeup;
13755 	}
13756 
13757 	err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG,
13758 					  info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
13759 					  nl80211_wowlan_policy, info->extack);
13760 	if (err)
13761 		return err;
13762 
13763 	if (tb[NL80211_WOWLAN_TRIG_ANY]) {
13764 		if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
13765 			return -EINVAL;
13766 		new_triggers.any = true;
13767 	}
13768 
13769 	if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
13770 		if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
13771 			return -EINVAL;
13772 		new_triggers.disconnect = true;
13773 		regular = true;
13774 	}
13775 
13776 	if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
13777 		if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
13778 			return -EINVAL;
13779 		new_triggers.magic_pkt = true;
13780 		regular = true;
13781 	}
13782 
13783 	if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
13784 		return -EINVAL;
13785 
13786 	if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
13787 		if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
13788 			return -EINVAL;
13789 		new_triggers.gtk_rekey_failure = true;
13790 		regular = true;
13791 	}
13792 
13793 	if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
13794 		if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
13795 			return -EINVAL;
13796 		new_triggers.eap_identity_req = true;
13797 		regular = true;
13798 	}
13799 
13800 	if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
13801 		if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
13802 			return -EINVAL;
13803 		new_triggers.four_way_handshake = true;
13804 		regular = true;
13805 	}
13806 
13807 	if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
13808 		if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
13809 			return -EINVAL;
13810 		new_triggers.rfkill_release = true;
13811 		regular = true;
13812 	}
13813 
13814 	if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
13815 		struct nlattr *pat;
13816 		int n_patterns = 0;
13817 		int rem, pat_len, mask_len, pkt_offset;
13818 		struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
13819 
13820 		regular = true;
13821 
13822 		nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
13823 				    rem)
13824 			n_patterns++;
13825 		if (n_patterns > wowlan->n_patterns)
13826 			return -EINVAL;
13827 
13828 		new_triggers.patterns = kcalloc(n_patterns,
13829 						sizeof(new_triggers.patterns[0]),
13830 						GFP_KERNEL);
13831 		if (!new_triggers.patterns)
13832 			return -ENOMEM;
13833 
13834 		new_triggers.n_patterns = n_patterns;
13835 		i = 0;
13836 
13837 		nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
13838 				    rem) {
13839 			u8 *mask_pat;
13840 
13841 			err = nla_parse_nested_deprecated(pat_tb,
13842 							  MAX_NL80211_PKTPAT,
13843 							  pat,
13844 							  nl80211_packet_pattern_policy,
13845 							  info->extack);
13846 			if (err)
13847 				goto error;
13848 
13849 			err = -EINVAL;
13850 			if (!pat_tb[NL80211_PKTPAT_MASK] ||
13851 			    !pat_tb[NL80211_PKTPAT_PATTERN])
13852 				goto error;
13853 			pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
13854 			mask_len = DIV_ROUND_UP(pat_len, 8);
13855 			if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
13856 				goto error;
13857 			if (pat_len > wowlan->pattern_max_len ||
13858 			    pat_len < wowlan->pattern_min_len)
13859 				goto error;
13860 
13861 			pkt_offset =
13862 				nla_get_u32_default(pat_tb[NL80211_PKTPAT_OFFSET],
13863 						    0);
13864 			if (pkt_offset > wowlan->max_pkt_offset)
13865 				goto error;
13866 			new_triggers.patterns[i].pkt_offset = pkt_offset;
13867 
13868 			mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
13869 			if (!mask_pat) {
13870 				err = -ENOMEM;
13871 				goto error;
13872 			}
13873 			new_triggers.patterns[i].mask = mask_pat;
13874 			memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
13875 			       mask_len);
13876 			mask_pat += mask_len;
13877 			new_triggers.patterns[i].pattern = mask_pat;
13878 			new_triggers.patterns[i].pattern_len = pat_len;
13879 			memcpy(mask_pat,
13880 			       nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
13881 			       pat_len);
13882 			i++;
13883 		}
13884 	}
13885 
13886 	if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
13887 		regular = true;
13888 		err = nl80211_parse_wowlan_tcp(
13889 			rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
13890 			&new_triggers);
13891 		if (err)
13892 			goto error;
13893 	}
13894 
13895 	if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
13896 		regular = true;
13897 		err = nl80211_parse_wowlan_nd(
13898 			rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
13899 			&new_triggers);
13900 		if (err)
13901 			goto error;
13902 	}
13903 
13904 	/* The 'any' trigger means the device continues operating more or less
13905 	 * as in its normal operation mode and wakes up the host on most of the
13906 	 * normal interrupts (like packet RX, ...)
13907 	 * It therefore makes little sense to combine with the more constrained
13908 	 * wakeup trigger modes.
13909 	 */
13910 	if (new_triggers.any && regular) {
13911 		err = -EINVAL;
13912 		goto error;
13913 	}
13914 
13915 	ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
13916 	if (!ntrig) {
13917 		err = -ENOMEM;
13918 		goto error;
13919 	}
13920 	cfg80211_rdev_free_wowlan(rdev);
13921 	rdev->wiphy.wowlan_config = ntrig;
13922 
13923  set_wakeup:
13924 	if (rdev->ops->set_wakeup &&
13925 	    prev_enabled != !!rdev->wiphy.wowlan_config)
13926 		rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
13927 
13928 	return 0;
13929  error:
13930 	for (i = 0; i < new_triggers.n_patterns; i++)
13931 		kfree(new_triggers.patterns[i].mask);
13932 	kfree(new_triggers.patterns);
13933 	if (new_triggers.tcp && new_triggers.tcp->sock)
13934 		sock_release(new_triggers.tcp->sock);
13935 	kfree(new_triggers.tcp);
13936 	kfree(new_triggers.nd_config);
13937 	return err;
13938 }
13939 #endif
13940 
13941 static int nl80211_send_coalesce_rules(struct sk_buff *msg,
13942 				       struct cfg80211_registered_device *rdev)
13943 {
13944 	struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
13945 	int i, j, pat_len;
13946 	struct cfg80211_coalesce_rules *rule;
13947 
13948 	if (!rdev->coalesce->n_rules)
13949 		return 0;
13950 
13951 	nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE);
13952 	if (!nl_rules)
13953 		return -ENOBUFS;
13954 
13955 	for (i = 0; i < rdev->coalesce->n_rules; i++) {
13956 		nl_rule = nla_nest_start_noflag(msg, i + 1);
13957 		if (!nl_rule)
13958 			return -ENOBUFS;
13959 
13960 		rule = &rdev->coalesce->rules[i];
13961 		if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
13962 				rule->delay))
13963 			return -ENOBUFS;
13964 
13965 		if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
13966 				rule->condition))
13967 			return -ENOBUFS;
13968 
13969 		nl_pats = nla_nest_start_noflag(msg,
13970 						NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
13971 		if (!nl_pats)
13972 			return -ENOBUFS;
13973 
13974 		for (j = 0; j < rule->n_patterns; j++) {
13975 			nl_pat = nla_nest_start_noflag(msg, j + 1);
13976 			if (!nl_pat)
13977 				return -ENOBUFS;
13978 			pat_len = rule->patterns[j].pattern_len;
13979 			if (nla_put(msg, NL80211_PKTPAT_MASK,
13980 				    DIV_ROUND_UP(pat_len, 8),
13981 				    rule->patterns[j].mask) ||
13982 			    nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
13983 				    rule->patterns[j].pattern) ||
13984 			    nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
13985 					rule->patterns[j].pkt_offset))
13986 				return -ENOBUFS;
13987 			nla_nest_end(msg, nl_pat);
13988 		}
13989 		nla_nest_end(msg, nl_pats);
13990 		nla_nest_end(msg, nl_rule);
13991 	}
13992 	nla_nest_end(msg, nl_rules);
13993 
13994 	return 0;
13995 }
13996 
13997 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
13998 {
13999 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14000 	struct sk_buff *msg;
14001 	void *hdr;
14002 
14003 	if (!rdev->wiphy.coalesce)
14004 		return -EOPNOTSUPP;
14005 
14006 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14007 	if (!msg)
14008 		return -ENOMEM;
14009 
14010 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
14011 			     NL80211_CMD_GET_COALESCE);
14012 	if (!hdr)
14013 		goto nla_put_failure;
14014 
14015 	if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
14016 		goto nla_put_failure;
14017 
14018 	genlmsg_end(msg, hdr);
14019 	return genlmsg_reply(msg, info);
14020 
14021 nla_put_failure:
14022 	nlmsg_free(msg);
14023 	return -ENOBUFS;
14024 }
14025 
14026 void cfg80211_free_coalesce(struct cfg80211_coalesce *coalesce)
14027 {
14028 	int i, j;
14029 	struct cfg80211_coalesce_rules *rule;
14030 
14031 	if (!coalesce)
14032 		return;
14033 
14034 	for (i = 0; i < coalesce->n_rules; i++) {
14035 		rule = &coalesce->rules[i];
14036 		for (j = 0; j < rule->n_patterns; j++)
14037 			kfree(rule->patterns[j].mask);
14038 		kfree(rule->patterns);
14039 	}
14040 	kfree(coalesce);
14041 }
14042 
14043 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
14044 				       struct nlattr *rule,
14045 				       struct cfg80211_coalesce_rules *new_rule)
14046 {
14047 	int err, i;
14048 	const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
14049 	struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
14050 	int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
14051 	struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
14052 
14053 	err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX,
14054 					  rule, nl80211_coalesce_policy, NULL);
14055 	if (err)
14056 		return err;
14057 
14058 	if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
14059 		new_rule->delay =
14060 			nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
14061 	if (new_rule->delay > coalesce->max_delay)
14062 		return -EINVAL;
14063 
14064 	if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
14065 		new_rule->condition =
14066 			nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
14067 
14068 	if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
14069 		return -EINVAL;
14070 
14071 	nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
14072 			    rem)
14073 		n_patterns++;
14074 	if (n_patterns > coalesce->n_patterns)
14075 		return -EINVAL;
14076 
14077 	new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
14078 				     GFP_KERNEL);
14079 	if (!new_rule->patterns)
14080 		return -ENOMEM;
14081 
14082 	new_rule->n_patterns = n_patterns;
14083 	i = 0;
14084 
14085 	nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
14086 			    rem) {
14087 		u8 *mask_pat;
14088 
14089 		err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT,
14090 						  pat,
14091 						  nl80211_packet_pattern_policy,
14092 						  NULL);
14093 		if (err)
14094 			return err;
14095 
14096 		if (!pat_tb[NL80211_PKTPAT_MASK] ||
14097 		    !pat_tb[NL80211_PKTPAT_PATTERN])
14098 			return -EINVAL;
14099 		pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
14100 		mask_len = DIV_ROUND_UP(pat_len, 8);
14101 		if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
14102 			return -EINVAL;
14103 		if (pat_len > coalesce->pattern_max_len ||
14104 		    pat_len < coalesce->pattern_min_len)
14105 			return -EINVAL;
14106 
14107 		pkt_offset = nla_get_u32_default(pat_tb[NL80211_PKTPAT_OFFSET],
14108 						 0);
14109 		if (pkt_offset > coalesce->max_pkt_offset)
14110 			return -EINVAL;
14111 		new_rule->patterns[i].pkt_offset = pkt_offset;
14112 
14113 		mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
14114 		if (!mask_pat)
14115 			return -ENOMEM;
14116 
14117 		new_rule->patterns[i].mask = mask_pat;
14118 		memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
14119 		       mask_len);
14120 
14121 		mask_pat += mask_len;
14122 		new_rule->patterns[i].pattern = mask_pat;
14123 		new_rule->patterns[i].pattern_len = pat_len;
14124 		memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
14125 		       pat_len);
14126 		i++;
14127 	}
14128 
14129 	return 0;
14130 }
14131 
14132 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
14133 {
14134 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14135 	const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
14136 	struct cfg80211_coalesce *new_coalesce;
14137 	int err, rem_rule, n_rules = 0, i;
14138 	struct nlattr *rule;
14139 
14140 	if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
14141 		return -EOPNOTSUPP;
14142 
14143 	if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
14144 		cfg80211_free_coalesce(rdev->coalesce);
14145 		rdev->coalesce = NULL;
14146 		rdev_set_coalesce(rdev, NULL);
14147 		return 0;
14148 	}
14149 
14150 	nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
14151 			    rem_rule)
14152 		n_rules++;
14153 	if (n_rules > coalesce->n_rules)
14154 		return -EINVAL;
14155 
14156 	new_coalesce = kzalloc(struct_size(new_coalesce, rules, n_rules),
14157 			       GFP_KERNEL);
14158 	if (!new_coalesce)
14159 		return -ENOMEM;
14160 
14161 	new_coalesce->n_rules = n_rules;
14162 	i = 0;
14163 
14164 	nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
14165 			    rem_rule) {
14166 		err = nl80211_parse_coalesce_rule(rdev, rule,
14167 						  &new_coalesce->rules[i]);
14168 		if (err)
14169 			goto error;
14170 
14171 		i++;
14172 	}
14173 
14174 	err = rdev_set_coalesce(rdev, new_coalesce);
14175 	if (err)
14176 		goto error;
14177 
14178 	cfg80211_free_coalesce(rdev->coalesce);
14179 	rdev->coalesce = new_coalesce;
14180 
14181 	return 0;
14182 error:
14183 	cfg80211_free_coalesce(new_coalesce);
14184 
14185 	return err;
14186 }
14187 
14188 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
14189 {
14190 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14191 	struct net_device *dev = info->user_ptr[1];
14192 	struct wireless_dev *wdev = dev->ieee80211_ptr;
14193 	struct nlattr *tb[NUM_NL80211_REKEY_DATA];
14194 	struct cfg80211_gtk_rekey_data rekey_data = {};
14195 	int err;
14196 
14197 	if (!info->attrs[NL80211_ATTR_REKEY_DATA])
14198 		return -EINVAL;
14199 
14200 	err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA,
14201 					  info->attrs[NL80211_ATTR_REKEY_DATA],
14202 					  nl80211_rekey_policy, info->extack);
14203 	if (err)
14204 		return err;
14205 
14206 	if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] ||
14207 	    !tb[NL80211_REKEY_DATA_KCK])
14208 		return -EINVAL;
14209 	if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN &&
14210 	    !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK &&
14211 	      nla_len(tb[NL80211_REKEY_DATA_KEK]) == NL80211_KEK_EXT_LEN))
14212 		return -ERANGE;
14213 	if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN &&
14214 	    !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK &&
14215 	      nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN) &&
14216 	     !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KCK_32 &&
14217 	       nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN_32))
14218 		return -ERANGE;
14219 
14220 	rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
14221 	rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
14222 	rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
14223 	rekey_data.kek_len = nla_len(tb[NL80211_REKEY_DATA_KEK]);
14224 	rekey_data.kck_len = nla_len(tb[NL80211_REKEY_DATA_KCK]);
14225 	if (tb[NL80211_REKEY_DATA_AKM])
14226 		rekey_data.akm = nla_get_u32(tb[NL80211_REKEY_DATA_AKM]);
14227 
14228 	if (!wdev->connected)
14229 		return -ENOTCONN;
14230 
14231 	if (!rdev->ops->set_rekey_data)
14232 		return -EOPNOTSUPP;
14233 
14234 	return rdev_set_rekey_data(rdev, dev, &rekey_data);
14235 }
14236 
14237 static int nl80211_register_unexpected_frame(struct sk_buff *skb,
14238 					     struct genl_info *info)
14239 {
14240 	struct net_device *dev = info->user_ptr[1];
14241 	struct wireless_dev *wdev = dev->ieee80211_ptr;
14242 
14243 	if (wdev->iftype != NL80211_IFTYPE_AP &&
14244 	    wdev->iftype != NL80211_IFTYPE_P2P_GO)
14245 		return -EINVAL;
14246 
14247 	if (wdev->ap_unexpected_nlportid)
14248 		return -EBUSY;
14249 
14250 	wdev->ap_unexpected_nlportid = info->snd_portid;
14251 	return 0;
14252 }
14253 
14254 static int nl80211_probe_client(struct sk_buff *skb,
14255 				struct genl_info *info)
14256 {
14257 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14258 	struct net_device *dev = info->user_ptr[1];
14259 	struct wireless_dev *wdev = dev->ieee80211_ptr;
14260 	struct sk_buff *msg;
14261 	void *hdr;
14262 	const u8 *addr;
14263 	u64 cookie;
14264 	int err;
14265 
14266 	if (wdev->iftype != NL80211_IFTYPE_AP &&
14267 	    wdev->iftype != NL80211_IFTYPE_P2P_GO)
14268 		return -EOPNOTSUPP;
14269 
14270 	if (!info->attrs[NL80211_ATTR_MAC])
14271 		return -EINVAL;
14272 
14273 	if (!rdev->ops->probe_client)
14274 		return -EOPNOTSUPP;
14275 
14276 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14277 	if (!msg)
14278 		return -ENOMEM;
14279 
14280 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
14281 			     NL80211_CMD_PROBE_CLIENT);
14282 	if (!hdr) {
14283 		err = -ENOBUFS;
14284 		goto free_msg;
14285 	}
14286 
14287 	addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
14288 
14289 	err = rdev_probe_client(rdev, dev, addr, &cookie);
14290 	if (err)
14291 		goto free_msg;
14292 
14293 	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14294 			      NL80211_ATTR_PAD))
14295 		goto nla_put_failure;
14296 
14297 	genlmsg_end(msg, hdr);
14298 
14299 	return genlmsg_reply(msg, info);
14300 
14301  nla_put_failure:
14302 	err = -ENOBUFS;
14303  free_msg:
14304 	nlmsg_free(msg);
14305 	return err;
14306 }
14307 
14308 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
14309 {
14310 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14311 	struct cfg80211_beacon_registration *reg, *nreg;
14312 	int rv;
14313 
14314 	if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
14315 		return -EOPNOTSUPP;
14316 
14317 	nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
14318 	if (!nreg)
14319 		return -ENOMEM;
14320 
14321 	/* First, check if already registered. */
14322 	spin_lock_bh(&rdev->beacon_registrations_lock);
14323 	list_for_each_entry(reg, &rdev->beacon_registrations, list) {
14324 		if (reg->nlportid == info->snd_portid) {
14325 			rv = -EALREADY;
14326 			goto out_err;
14327 		}
14328 	}
14329 	/* Add it to the list */
14330 	nreg->nlportid = info->snd_portid;
14331 	list_add(&nreg->list, &rdev->beacon_registrations);
14332 
14333 	spin_unlock_bh(&rdev->beacon_registrations_lock);
14334 
14335 	return 0;
14336 out_err:
14337 	spin_unlock_bh(&rdev->beacon_registrations_lock);
14338 	kfree(nreg);
14339 	return rv;
14340 }
14341 
14342 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
14343 {
14344 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14345 	struct wireless_dev *wdev = info->user_ptr[1];
14346 	int err;
14347 
14348 	if (!rdev->ops->start_p2p_device)
14349 		return -EOPNOTSUPP;
14350 
14351 	if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
14352 		return -EOPNOTSUPP;
14353 
14354 	if (wdev_running(wdev))
14355 		return 0;
14356 
14357 	if (rfkill_blocked(rdev->wiphy.rfkill))
14358 		return -ERFKILL;
14359 
14360 	err = rdev_start_p2p_device(rdev, wdev);
14361 	if (err)
14362 		return err;
14363 
14364 	wdev->is_running = true;
14365 	rdev->opencount++;
14366 
14367 	return 0;
14368 }
14369 
14370 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
14371 {
14372 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14373 	struct wireless_dev *wdev = info->user_ptr[1];
14374 
14375 	if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
14376 		return -EOPNOTSUPP;
14377 
14378 	if (!rdev->ops->stop_p2p_device)
14379 		return -EOPNOTSUPP;
14380 
14381 	cfg80211_stop_p2p_device(rdev, wdev);
14382 
14383 	return 0;
14384 }
14385 
14386 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
14387 {
14388 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14389 	struct wireless_dev *wdev = info->user_ptr[1];
14390 	struct cfg80211_nan_conf conf = {};
14391 	int err;
14392 
14393 	if (wdev->iftype != NL80211_IFTYPE_NAN)
14394 		return -EOPNOTSUPP;
14395 
14396 	if (wdev_running(wdev))
14397 		return -EEXIST;
14398 
14399 	if (rfkill_blocked(rdev->wiphy.rfkill))
14400 		return -ERFKILL;
14401 
14402 	if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
14403 		return -EINVAL;
14404 
14405 	conf.master_pref =
14406 		nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
14407 
14408 	if (info->attrs[NL80211_ATTR_BANDS]) {
14409 		u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
14410 
14411 		if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
14412 			return -EOPNOTSUPP;
14413 
14414 		if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
14415 			return -EINVAL;
14416 
14417 		conf.bands = bands;
14418 	}
14419 
14420 	err = rdev_start_nan(rdev, wdev, &conf);
14421 	if (err)
14422 		return err;
14423 
14424 	wdev->is_running = true;
14425 	rdev->opencount++;
14426 
14427 	return 0;
14428 }
14429 
14430 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
14431 {
14432 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14433 	struct wireless_dev *wdev = info->user_ptr[1];
14434 
14435 	if (wdev->iftype != NL80211_IFTYPE_NAN)
14436 		return -EOPNOTSUPP;
14437 
14438 	cfg80211_stop_nan(rdev, wdev);
14439 
14440 	return 0;
14441 }
14442 
14443 static int validate_nan_filter(struct nlattr *filter_attr)
14444 {
14445 	struct nlattr *attr;
14446 	int len = 0, n_entries = 0, rem;
14447 
14448 	nla_for_each_nested(attr, filter_attr, rem) {
14449 		len += nla_len(attr);
14450 		n_entries++;
14451 	}
14452 
14453 	if (len >= U8_MAX)
14454 		return -EINVAL;
14455 
14456 	return n_entries;
14457 }
14458 
14459 static int handle_nan_filter(struct nlattr *attr_filter,
14460 			     struct cfg80211_nan_func *func,
14461 			     bool tx)
14462 {
14463 	struct nlattr *attr;
14464 	int n_entries, rem, i;
14465 	struct cfg80211_nan_func_filter *filter;
14466 
14467 	n_entries = validate_nan_filter(attr_filter);
14468 	if (n_entries < 0)
14469 		return n_entries;
14470 
14471 	BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
14472 
14473 	filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
14474 	if (!filter)
14475 		return -ENOMEM;
14476 
14477 	i = 0;
14478 	nla_for_each_nested(attr, attr_filter, rem) {
14479 		filter[i].filter = nla_memdup(attr, GFP_KERNEL);
14480 		if (!filter[i].filter)
14481 			goto err;
14482 
14483 		filter[i].len = nla_len(attr);
14484 		i++;
14485 	}
14486 	if (tx) {
14487 		func->num_tx_filters = n_entries;
14488 		func->tx_filters = filter;
14489 	} else {
14490 		func->num_rx_filters = n_entries;
14491 		func->rx_filters = filter;
14492 	}
14493 
14494 	return 0;
14495 
14496 err:
14497 	i = 0;
14498 	nla_for_each_nested(attr, attr_filter, rem) {
14499 		kfree(filter[i].filter);
14500 		i++;
14501 	}
14502 	kfree(filter);
14503 	return -ENOMEM;
14504 }
14505 
14506 static int nl80211_nan_add_func(struct sk_buff *skb,
14507 				struct genl_info *info)
14508 {
14509 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14510 	struct wireless_dev *wdev = info->user_ptr[1];
14511 	struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
14512 	struct cfg80211_nan_func *func;
14513 	struct sk_buff *msg = NULL;
14514 	void *hdr = NULL;
14515 	int err = 0;
14516 
14517 	if (wdev->iftype != NL80211_IFTYPE_NAN)
14518 		return -EOPNOTSUPP;
14519 
14520 	if (!wdev_running(wdev))
14521 		return -ENOTCONN;
14522 
14523 	if (!info->attrs[NL80211_ATTR_NAN_FUNC])
14524 		return -EINVAL;
14525 
14526 	err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX,
14527 					  info->attrs[NL80211_ATTR_NAN_FUNC],
14528 					  nl80211_nan_func_policy,
14529 					  info->extack);
14530 	if (err)
14531 		return err;
14532 
14533 	func = kzalloc(sizeof(*func), GFP_KERNEL);
14534 	if (!func)
14535 		return -ENOMEM;
14536 
14537 	func->cookie = cfg80211_assign_cookie(rdev);
14538 
14539 	if (!tb[NL80211_NAN_FUNC_TYPE]) {
14540 		err = -EINVAL;
14541 		goto out;
14542 	}
14543 
14544 
14545 	func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
14546 
14547 	if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
14548 		err = -EINVAL;
14549 		goto out;
14550 	}
14551 
14552 	memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
14553 	       sizeof(func->service_id));
14554 
14555 	func->close_range =
14556 		nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
14557 
14558 	if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
14559 		func->serv_spec_info_len =
14560 			nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
14561 		func->serv_spec_info =
14562 			kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
14563 				func->serv_spec_info_len,
14564 				GFP_KERNEL);
14565 		if (!func->serv_spec_info) {
14566 			err = -ENOMEM;
14567 			goto out;
14568 		}
14569 	}
14570 
14571 	if (tb[NL80211_NAN_FUNC_TTL])
14572 		func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
14573 
14574 	switch (func->type) {
14575 	case NL80211_NAN_FUNC_PUBLISH:
14576 		if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
14577 			err = -EINVAL;
14578 			goto out;
14579 		}
14580 
14581 		func->publish_type =
14582 			nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
14583 		func->publish_bcast =
14584 			nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
14585 
14586 		if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
14587 			func->publish_bcast) {
14588 			err = -EINVAL;
14589 			goto out;
14590 		}
14591 		break;
14592 	case NL80211_NAN_FUNC_SUBSCRIBE:
14593 		func->subscribe_active =
14594 			nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
14595 		break;
14596 	case NL80211_NAN_FUNC_FOLLOW_UP:
14597 		if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
14598 		    !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
14599 		    !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
14600 			err = -EINVAL;
14601 			goto out;
14602 		}
14603 
14604 		func->followup_id =
14605 			nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
14606 		func->followup_reqid =
14607 			nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
14608 		memcpy(func->followup_dest.addr,
14609 		       nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
14610 		       sizeof(func->followup_dest.addr));
14611 		if (func->ttl) {
14612 			err = -EINVAL;
14613 			goto out;
14614 		}
14615 		break;
14616 	default:
14617 		err = -EINVAL;
14618 		goto out;
14619 	}
14620 
14621 	if (tb[NL80211_NAN_FUNC_SRF]) {
14622 		struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
14623 
14624 		err = nla_parse_nested_deprecated(srf_tb,
14625 						  NL80211_NAN_SRF_ATTR_MAX,
14626 						  tb[NL80211_NAN_FUNC_SRF],
14627 						  nl80211_nan_srf_policy,
14628 						  info->extack);
14629 		if (err)
14630 			goto out;
14631 
14632 		func->srf_include =
14633 			nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
14634 
14635 		if (srf_tb[NL80211_NAN_SRF_BF]) {
14636 			if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
14637 			    !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
14638 				err = -EINVAL;
14639 				goto out;
14640 			}
14641 
14642 			func->srf_bf_len =
14643 				nla_len(srf_tb[NL80211_NAN_SRF_BF]);
14644 			func->srf_bf =
14645 				kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
14646 					func->srf_bf_len, GFP_KERNEL);
14647 			if (!func->srf_bf) {
14648 				err = -ENOMEM;
14649 				goto out;
14650 			}
14651 
14652 			func->srf_bf_idx =
14653 				nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
14654 		} else {
14655 			struct nlattr *attr, *mac_attr =
14656 				srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
14657 			int n_entries, rem, i = 0;
14658 
14659 			if (!mac_attr) {
14660 				err = -EINVAL;
14661 				goto out;
14662 			}
14663 
14664 			n_entries = validate_acl_mac_addrs(mac_attr);
14665 			if (n_entries <= 0) {
14666 				err = -EINVAL;
14667 				goto out;
14668 			}
14669 
14670 			func->srf_num_macs = n_entries;
14671 			func->srf_macs =
14672 				kcalloc(n_entries, sizeof(*func->srf_macs),
14673 					GFP_KERNEL);
14674 			if (!func->srf_macs) {
14675 				err = -ENOMEM;
14676 				goto out;
14677 			}
14678 
14679 			nla_for_each_nested(attr, mac_attr, rem)
14680 				memcpy(func->srf_macs[i++].addr, nla_data(attr),
14681 				       sizeof(*func->srf_macs));
14682 		}
14683 	}
14684 
14685 	if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
14686 		err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
14687 					func, true);
14688 		if (err)
14689 			goto out;
14690 	}
14691 
14692 	if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
14693 		err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
14694 					func, false);
14695 		if (err)
14696 			goto out;
14697 	}
14698 
14699 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14700 	if (!msg) {
14701 		err = -ENOMEM;
14702 		goto out;
14703 	}
14704 
14705 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
14706 			     NL80211_CMD_ADD_NAN_FUNCTION);
14707 	/* This can't really happen - we just allocated 4KB */
14708 	if (WARN_ON(!hdr)) {
14709 		err = -ENOMEM;
14710 		goto out;
14711 	}
14712 
14713 	err = rdev_add_nan_func(rdev, wdev, func);
14714 out:
14715 	if (err < 0) {
14716 		cfg80211_free_nan_func(func);
14717 		nlmsg_free(msg);
14718 		return err;
14719 	}
14720 
14721 	/* propagate the instance id and cookie to userspace  */
14722 	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
14723 			      NL80211_ATTR_PAD))
14724 		goto nla_put_failure;
14725 
14726 	func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
14727 	if (!func_attr)
14728 		goto nla_put_failure;
14729 
14730 	if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
14731 		       func->instance_id))
14732 		goto nla_put_failure;
14733 
14734 	nla_nest_end(msg, func_attr);
14735 
14736 	genlmsg_end(msg, hdr);
14737 	return genlmsg_reply(msg, info);
14738 
14739 nla_put_failure:
14740 	nlmsg_free(msg);
14741 	return -ENOBUFS;
14742 }
14743 
14744 static int nl80211_nan_del_func(struct sk_buff *skb,
14745 			       struct genl_info *info)
14746 {
14747 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14748 	struct wireless_dev *wdev = info->user_ptr[1];
14749 	u64 cookie;
14750 
14751 	if (wdev->iftype != NL80211_IFTYPE_NAN)
14752 		return -EOPNOTSUPP;
14753 
14754 	if (!wdev_running(wdev))
14755 		return -ENOTCONN;
14756 
14757 	if (!info->attrs[NL80211_ATTR_COOKIE])
14758 		return -EINVAL;
14759 
14760 	cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
14761 
14762 	rdev_del_nan_func(rdev, wdev, cookie);
14763 
14764 	return 0;
14765 }
14766 
14767 static int nl80211_nan_change_config(struct sk_buff *skb,
14768 				     struct genl_info *info)
14769 {
14770 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14771 	struct wireless_dev *wdev = info->user_ptr[1];
14772 	struct cfg80211_nan_conf conf = {};
14773 	u32 changed = 0;
14774 
14775 	if (wdev->iftype != NL80211_IFTYPE_NAN)
14776 		return -EOPNOTSUPP;
14777 
14778 	if (!wdev_running(wdev))
14779 		return -ENOTCONN;
14780 
14781 	if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
14782 		conf.master_pref =
14783 			nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
14784 		if (conf.master_pref <= 1 || conf.master_pref == 255)
14785 			return -EINVAL;
14786 
14787 		changed |= CFG80211_NAN_CONF_CHANGED_PREF;
14788 	}
14789 
14790 	if (info->attrs[NL80211_ATTR_BANDS]) {
14791 		u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
14792 
14793 		if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
14794 			return -EOPNOTSUPP;
14795 
14796 		if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
14797 			return -EINVAL;
14798 
14799 		conf.bands = bands;
14800 		changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
14801 	}
14802 
14803 	if (!changed)
14804 		return -EINVAL;
14805 
14806 	return rdev_nan_change_conf(rdev, wdev, &conf, changed);
14807 }
14808 
14809 void cfg80211_nan_match(struct wireless_dev *wdev,
14810 			struct cfg80211_nan_match_params *match, gfp_t gfp)
14811 {
14812 	struct wiphy *wiphy = wdev->wiphy;
14813 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14814 	struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
14815 	struct sk_buff *msg;
14816 	void *hdr;
14817 
14818 	if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
14819 		return;
14820 
14821 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14822 	if (!msg)
14823 		return;
14824 
14825 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
14826 	if (!hdr) {
14827 		nlmsg_free(msg);
14828 		return;
14829 	}
14830 
14831 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14832 	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14833 					 wdev->netdev->ifindex)) ||
14834 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14835 			      NL80211_ATTR_PAD))
14836 		goto nla_put_failure;
14837 
14838 	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
14839 			      NL80211_ATTR_PAD) ||
14840 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
14841 		goto nla_put_failure;
14842 
14843 	match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH);
14844 	if (!match_attr)
14845 		goto nla_put_failure;
14846 
14847 	local_func_attr = nla_nest_start_noflag(msg,
14848 						NL80211_NAN_MATCH_FUNC_LOCAL);
14849 	if (!local_func_attr)
14850 		goto nla_put_failure;
14851 
14852 	if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
14853 		goto nla_put_failure;
14854 
14855 	nla_nest_end(msg, local_func_attr);
14856 
14857 	peer_func_attr = nla_nest_start_noflag(msg,
14858 					       NL80211_NAN_MATCH_FUNC_PEER);
14859 	if (!peer_func_attr)
14860 		goto nla_put_failure;
14861 
14862 	if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
14863 	    nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
14864 		goto nla_put_failure;
14865 
14866 	if (match->info && match->info_len &&
14867 	    nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
14868 		    match->info))
14869 		goto nla_put_failure;
14870 
14871 	nla_nest_end(msg, peer_func_attr);
14872 	nla_nest_end(msg, match_attr);
14873 	genlmsg_end(msg, hdr);
14874 
14875 	if (!wdev->owner_nlportid)
14876 		genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
14877 					msg, 0, NL80211_MCGRP_NAN, gfp);
14878 	else
14879 		genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
14880 				wdev->owner_nlportid);
14881 
14882 	return;
14883 
14884 nla_put_failure:
14885 	nlmsg_free(msg);
14886 }
14887 EXPORT_SYMBOL(cfg80211_nan_match);
14888 
14889 void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
14890 				  u8 inst_id,
14891 				  enum nl80211_nan_func_term_reason reason,
14892 				  u64 cookie, gfp_t gfp)
14893 {
14894 	struct wiphy *wiphy = wdev->wiphy;
14895 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14896 	struct sk_buff *msg;
14897 	struct nlattr *func_attr;
14898 	void *hdr;
14899 
14900 	if (WARN_ON(!inst_id))
14901 		return;
14902 
14903 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14904 	if (!msg)
14905 		return;
14906 
14907 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
14908 	if (!hdr) {
14909 		nlmsg_free(msg);
14910 		return;
14911 	}
14912 
14913 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14914 	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14915 					 wdev->netdev->ifindex)) ||
14916 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14917 			      NL80211_ATTR_PAD))
14918 		goto nla_put_failure;
14919 
14920 	if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14921 			      NL80211_ATTR_PAD))
14922 		goto nla_put_failure;
14923 
14924 	func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
14925 	if (!func_attr)
14926 		goto nla_put_failure;
14927 
14928 	if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
14929 	    nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
14930 		goto nla_put_failure;
14931 
14932 	nla_nest_end(msg, func_attr);
14933 	genlmsg_end(msg, hdr);
14934 
14935 	if (!wdev->owner_nlportid)
14936 		genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
14937 					msg, 0, NL80211_MCGRP_NAN, gfp);
14938 	else
14939 		genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
14940 				wdev->owner_nlportid);
14941 
14942 	return;
14943 
14944 nla_put_failure:
14945 	nlmsg_free(msg);
14946 }
14947 EXPORT_SYMBOL(cfg80211_nan_func_terminated);
14948 
14949 static int nl80211_get_protocol_features(struct sk_buff *skb,
14950 					 struct genl_info *info)
14951 {
14952 	void *hdr;
14953 	struct sk_buff *msg;
14954 
14955 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14956 	if (!msg)
14957 		return -ENOMEM;
14958 
14959 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
14960 			     NL80211_CMD_GET_PROTOCOL_FEATURES);
14961 	if (!hdr)
14962 		goto nla_put_failure;
14963 
14964 	if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
14965 			NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
14966 		goto nla_put_failure;
14967 
14968 	genlmsg_end(msg, hdr);
14969 	return genlmsg_reply(msg, info);
14970 
14971  nla_put_failure:
14972 	kfree_skb(msg);
14973 	return -ENOBUFS;
14974 }
14975 
14976 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
14977 {
14978 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
14979 	struct cfg80211_update_ft_ies_params ft_params;
14980 	struct net_device *dev = info->user_ptr[1];
14981 
14982 	if (!rdev->ops->update_ft_ies)
14983 		return -EOPNOTSUPP;
14984 
14985 	if (!info->attrs[NL80211_ATTR_MDID] ||
14986 	    !info->attrs[NL80211_ATTR_IE])
14987 		return -EINVAL;
14988 
14989 	memset(&ft_params, 0, sizeof(ft_params));
14990 	ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
14991 	ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
14992 	ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
14993 
14994 	return rdev_update_ft_ies(rdev, dev, &ft_params);
14995 }
14996 
14997 static int nl80211_crit_protocol_start(struct sk_buff *skb,
14998 				       struct genl_info *info)
14999 {
15000 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15001 	struct wireless_dev *wdev = info->user_ptr[1];
15002 	enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
15003 	u16 duration;
15004 	int ret;
15005 
15006 	if (!rdev->ops->crit_proto_start)
15007 		return -EOPNOTSUPP;
15008 
15009 	if (WARN_ON(!rdev->ops->crit_proto_stop))
15010 		return -EINVAL;
15011 
15012 	if (rdev->crit_proto_nlportid)
15013 		return -EBUSY;
15014 
15015 	/* determine protocol if provided */
15016 	if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
15017 		proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
15018 
15019 	if (proto >= NUM_NL80211_CRIT_PROTO)
15020 		return -EINVAL;
15021 
15022 	/* timeout must be provided */
15023 	if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
15024 		return -EINVAL;
15025 
15026 	duration =
15027 		nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
15028 
15029 	ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
15030 	if (!ret)
15031 		rdev->crit_proto_nlportid = info->snd_portid;
15032 
15033 	return ret;
15034 }
15035 
15036 static int nl80211_crit_protocol_stop(struct sk_buff *skb,
15037 				      struct genl_info *info)
15038 {
15039 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15040 	struct wireless_dev *wdev = info->user_ptr[1];
15041 
15042 	if (!rdev->ops->crit_proto_stop)
15043 		return -EOPNOTSUPP;
15044 
15045 	if (rdev->crit_proto_nlportid) {
15046 		rdev->crit_proto_nlportid = 0;
15047 		rdev_crit_proto_stop(rdev, wdev);
15048 	}
15049 	return 0;
15050 }
15051 
15052 static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd,
15053 				       struct nlattr *attr,
15054 				       struct netlink_ext_ack *extack)
15055 {
15056 	if (vcmd->policy == VENDOR_CMD_RAW_DATA) {
15057 		if (attr->nla_type & NLA_F_NESTED) {
15058 			NL_SET_ERR_MSG_ATTR(extack, attr,
15059 					    "unexpected nested data");
15060 			return -EINVAL;
15061 		}
15062 
15063 		return 0;
15064 	}
15065 
15066 	if (!(attr->nla_type & NLA_F_NESTED)) {
15067 		NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data");
15068 		return -EINVAL;
15069 	}
15070 
15071 	return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack);
15072 }
15073 
15074 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
15075 {
15076 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15077 	struct wireless_dev *wdev =
15078 		__cfg80211_wdev_from_attrs(rdev, genl_info_net(info),
15079 					   info->attrs);
15080 	int i, err;
15081 	u32 vid, subcmd;
15082 
15083 	if (!rdev->wiphy.vendor_commands)
15084 		return -EOPNOTSUPP;
15085 
15086 	if (IS_ERR(wdev)) {
15087 		err = PTR_ERR(wdev);
15088 		if (err != -EINVAL)
15089 			return err;
15090 		wdev = NULL;
15091 	} else if (wdev->wiphy != &rdev->wiphy) {
15092 		return -EINVAL;
15093 	}
15094 
15095 	if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
15096 	    !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
15097 		return -EINVAL;
15098 
15099 	vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
15100 	subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
15101 	for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
15102 		const struct wiphy_vendor_command *vcmd;
15103 		void *data = NULL;
15104 		int len = 0;
15105 
15106 		vcmd = &rdev->wiphy.vendor_commands[i];
15107 
15108 		if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
15109 			continue;
15110 
15111 		if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
15112 				   WIPHY_VENDOR_CMD_NEED_NETDEV)) {
15113 			if (!wdev)
15114 				return -EINVAL;
15115 			if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
15116 			    !wdev->netdev)
15117 				return -EINVAL;
15118 
15119 			if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
15120 				if (!wdev_running(wdev))
15121 					return -ENETDOWN;
15122 			}
15123 		} else {
15124 			wdev = NULL;
15125 		}
15126 
15127 		if (!vcmd->doit)
15128 			return -EOPNOTSUPP;
15129 
15130 		if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
15131 			data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
15132 			len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
15133 
15134 			err = nl80211_vendor_check_policy(vcmd,
15135 					info->attrs[NL80211_ATTR_VENDOR_DATA],
15136 					info->extack);
15137 			if (err)
15138 				return err;
15139 		}
15140 
15141 		rdev->cur_cmd_info = info;
15142 		err = vcmd->doit(&rdev->wiphy, wdev, data, len);
15143 		rdev->cur_cmd_info = NULL;
15144 		return err;
15145 	}
15146 
15147 	return -EOPNOTSUPP;
15148 }
15149 
15150 static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
15151 				       struct netlink_callback *cb,
15152 				       struct cfg80211_registered_device **rdev,
15153 				       struct wireless_dev **wdev)
15154 {
15155 	struct nlattr **attrbuf;
15156 	u32 vid, subcmd;
15157 	unsigned int i;
15158 	int vcmd_idx = -1;
15159 	int err;
15160 	void *data = NULL;
15161 	unsigned int data_len = 0;
15162 
15163 	if (cb->args[0]) {
15164 		/* subtract the 1 again here */
15165 		struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
15166 		struct wireless_dev *tmp;
15167 
15168 		if (!wiphy)
15169 			return -ENODEV;
15170 		*rdev = wiphy_to_rdev(wiphy);
15171 		*wdev = NULL;
15172 
15173 		if (cb->args[1]) {
15174 			list_for_each_entry(tmp, &wiphy->wdev_list, list) {
15175 				if (tmp->identifier == cb->args[1] - 1) {
15176 					*wdev = tmp;
15177 					break;
15178 				}
15179 			}
15180 		}
15181 
15182 		/* keep rtnl locked in successful case */
15183 		return 0;
15184 	}
15185 
15186 	attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
15187 	if (!attrbuf)
15188 		return -ENOMEM;
15189 
15190 	err = nlmsg_parse_deprecated(cb->nlh,
15191 				     GENL_HDRLEN + nl80211_fam.hdrsize,
15192 				     attrbuf, nl80211_fam.maxattr,
15193 				     nl80211_policy, NULL);
15194 	if (err)
15195 		goto out;
15196 
15197 	if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
15198 	    !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) {
15199 		err = -EINVAL;
15200 		goto out;
15201 	}
15202 
15203 	*wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(skb->sk), attrbuf);
15204 	if (IS_ERR(*wdev))
15205 		*wdev = NULL;
15206 
15207 	*rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
15208 	if (IS_ERR(*rdev)) {
15209 		err = PTR_ERR(*rdev);
15210 		goto out;
15211 	}
15212 
15213 	vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
15214 	subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
15215 
15216 	for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
15217 		const struct wiphy_vendor_command *vcmd;
15218 
15219 		vcmd = &(*rdev)->wiphy.vendor_commands[i];
15220 
15221 		if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
15222 			continue;
15223 
15224 		if (!vcmd->dumpit) {
15225 			err = -EOPNOTSUPP;
15226 			goto out;
15227 		}
15228 
15229 		vcmd_idx = i;
15230 		break;
15231 	}
15232 
15233 	if (vcmd_idx < 0) {
15234 		err = -EOPNOTSUPP;
15235 		goto out;
15236 	}
15237 
15238 	if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
15239 		data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
15240 		data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
15241 
15242 		err = nl80211_vendor_check_policy(
15243 				&(*rdev)->wiphy.vendor_commands[vcmd_idx],
15244 				attrbuf[NL80211_ATTR_VENDOR_DATA],
15245 				cb->extack);
15246 		if (err)
15247 			goto out;
15248 	}
15249 
15250 	/* 0 is the first index - add 1 to parse only once */
15251 	cb->args[0] = (*rdev)->wiphy_idx + 1;
15252 	/* add 1 to know if it was NULL */
15253 	cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
15254 	cb->args[2] = vcmd_idx;
15255 	cb->args[3] = (unsigned long)data;
15256 	cb->args[4] = data_len;
15257 
15258 	/* keep rtnl locked in successful case */
15259 	err = 0;
15260 out:
15261 	kfree(attrbuf);
15262 	return err;
15263 }
15264 
15265 static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
15266 				   struct netlink_callback *cb)
15267 {
15268 	struct cfg80211_registered_device *rdev;
15269 	struct wireless_dev *wdev;
15270 	unsigned int vcmd_idx;
15271 	const struct wiphy_vendor_command *vcmd;
15272 	void *data;
15273 	int data_len;
15274 	int err;
15275 	struct nlattr *vendor_data;
15276 
15277 	rtnl_lock();
15278 	err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
15279 	if (err)
15280 		goto out;
15281 
15282 	vcmd_idx = cb->args[2];
15283 	data = (void *)cb->args[3];
15284 	data_len = cb->args[4];
15285 	vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
15286 
15287 	if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
15288 			   WIPHY_VENDOR_CMD_NEED_NETDEV)) {
15289 		if (!wdev) {
15290 			err = -EINVAL;
15291 			goto out;
15292 		}
15293 		if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
15294 		    !wdev->netdev) {
15295 			err = -EINVAL;
15296 			goto out;
15297 		}
15298 
15299 		if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
15300 			if (!wdev_running(wdev)) {
15301 				err = -ENETDOWN;
15302 				goto out;
15303 			}
15304 		}
15305 	}
15306 
15307 	while (1) {
15308 		void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
15309 					   cb->nlh->nlmsg_seq, NLM_F_MULTI,
15310 					   NL80211_CMD_VENDOR);
15311 		if (!hdr)
15312 			break;
15313 
15314 		if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15315 		    (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
15316 					       wdev_id(wdev),
15317 					       NL80211_ATTR_PAD))) {
15318 			genlmsg_cancel(skb, hdr);
15319 			break;
15320 		}
15321 
15322 		vendor_data = nla_nest_start_noflag(skb,
15323 						    NL80211_ATTR_VENDOR_DATA);
15324 		if (!vendor_data) {
15325 			genlmsg_cancel(skb, hdr);
15326 			break;
15327 		}
15328 
15329 		err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
15330 				   (unsigned long *)&cb->args[5]);
15331 		nla_nest_end(skb, vendor_data);
15332 
15333 		if (err == -ENOBUFS || err == -ENOENT) {
15334 			genlmsg_cancel(skb, hdr);
15335 			break;
15336 		} else if (err <= 0) {
15337 			genlmsg_cancel(skb, hdr);
15338 			goto out;
15339 		}
15340 
15341 		genlmsg_end(skb, hdr);
15342 	}
15343 
15344 	err = skb->len;
15345  out:
15346 	rtnl_unlock();
15347 	return err;
15348 }
15349 
15350 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
15351 					   enum nl80211_commands cmd,
15352 					   enum nl80211_attrs attr,
15353 					   int approxlen)
15354 {
15355 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15356 
15357 	if (WARN_ON(!rdev->cur_cmd_info))
15358 		return NULL;
15359 
15360 	return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
15361 					   rdev->cur_cmd_info->snd_portid,
15362 					   rdev->cur_cmd_info->snd_seq,
15363 					   cmd, attr, NULL, GFP_KERNEL);
15364 }
15365 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
15366 
15367 int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
15368 {
15369 	struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
15370 	void *hdr = ((void **)skb->cb)[1];
15371 	struct nlattr *data = ((void **)skb->cb)[2];
15372 
15373 	/* clear CB data for netlink core to own from now on */
15374 	memset(skb->cb, 0, sizeof(skb->cb));
15375 
15376 	if (WARN_ON(!rdev->cur_cmd_info)) {
15377 		kfree_skb(skb);
15378 		return -EINVAL;
15379 	}
15380 
15381 	nla_nest_end(skb, data);
15382 	genlmsg_end(skb, hdr);
15383 	return genlmsg_reply(skb, rdev->cur_cmd_info);
15384 }
15385 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
15386 
15387 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy)
15388 {
15389 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15390 
15391 	if (WARN_ON(!rdev->cur_cmd_info))
15392 		return 0;
15393 
15394 	return rdev->cur_cmd_info->snd_portid;
15395 }
15396 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender);
15397 
15398 static int nl80211_set_qos_map(struct sk_buff *skb,
15399 			       struct genl_info *info)
15400 {
15401 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15402 	struct cfg80211_qos_map *qos_map = NULL;
15403 	struct net_device *dev = info->user_ptr[1];
15404 	u8 *pos, len, num_des, des_len, des;
15405 	int ret;
15406 
15407 	if (!rdev->ops->set_qos_map)
15408 		return -EOPNOTSUPP;
15409 
15410 	if (info->attrs[NL80211_ATTR_QOS_MAP]) {
15411 		pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
15412 		len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
15413 
15414 		if (len % 2)
15415 			return -EINVAL;
15416 
15417 		qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
15418 		if (!qos_map)
15419 			return -ENOMEM;
15420 
15421 		num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
15422 		if (num_des) {
15423 			des_len = num_des *
15424 				sizeof(struct cfg80211_dscp_exception);
15425 			memcpy(qos_map->dscp_exception, pos, des_len);
15426 			qos_map->num_des = num_des;
15427 			for (des = 0; des < num_des; des++) {
15428 				if (qos_map->dscp_exception[des].up > 7) {
15429 					kfree(qos_map);
15430 					return -EINVAL;
15431 				}
15432 			}
15433 			pos += des_len;
15434 		}
15435 		memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
15436 	}
15437 
15438 	ret = nl80211_key_allowed(dev->ieee80211_ptr);
15439 	if (!ret)
15440 		ret = rdev_set_qos_map(rdev, dev, qos_map);
15441 
15442 	kfree(qos_map);
15443 	return ret;
15444 }
15445 
15446 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
15447 {
15448 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15449 	struct net_device *dev = info->user_ptr[1];
15450 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15451 	const u8 *peer;
15452 	u8 tsid, up;
15453 	u16 admitted_time = 0;
15454 
15455 	if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
15456 		return -EOPNOTSUPP;
15457 
15458 	if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
15459 	    !info->attrs[NL80211_ATTR_USER_PRIO])
15460 		return -EINVAL;
15461 
15462 	tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
15463 	up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
15464 
15465 	/* WMM uses TIDs 0-7 even for TSPEC */
15466 	if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
15467 		/* TODO: handle 802.11 TSPEC/admission control
15468 		 * need more attributes for that (e.g. BA session requirement);
15469 		 * change the WMM admission test above to allow both then
15470 		 */
15471 		return -EINVAL;
15472 	}
15473 
15474 	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
15475 
15476 	if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
15477 		admitted_time =
15478 			nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
15479 		if (!admitted_time)
15480 			return -EINVAL;
15481 	}
15482 
15483 	switch (wdev->iftype) {
15484 	case NL80211_IFTYPE_STATION:
15485 	case NL80211_IFTYPE_P2P_CLIENT:
15486 		if (wdev->connected)
15487 			break;
15488 		return -ENOTCONN;
15489 	default:
15490 		return -EOPNOTSUPP;
15491 	}
15492 
15493 	return rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
15494 }
15495 
15496 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
15497 {
15498 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15499 	struct net_device *dev = info->user_ptr[1];
15500 	const u8 *peer;
15501 	u8 tsid;
15502 
15503 	if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
15504 		return -EINVAL;
15505 
15506 	tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
15507 	peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
15508 
15509 	return rdev_del_tx_ts(rdev, dev, tsid, peer);
15510 }
15511 
15512 static int nl80211_tdls_channel_switch(struct sk_buff *skb,
15513 				       struct genl_info *info)
15514 {
15515 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15516 	struct net_device *dev = info->user_ptr[1];
15517 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15518 	struct cfg80211_chan_def chandef = {};
15519 	const u8 *addr;
15520 	u8 oper_class;
15521 	int err;
15522 
15523 	if (!rdev->ops->tdls_channel_switch ||
15524 	    !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
15525 		return -EOPNOTSUPP;
15526 
15527 	switch (dev->ieee80211_ptr->iftype) {
15528 	case NL80211_IFTYPE_STATION:
15529 	case NL80211_IFTYPE_P2P_CLIENT:
15530 		break;
15531 	default:
15532 		return -EOPNOTSUPP;
15533 	}
15534 
15535 	if (!info->attrs[NL80211_ATTR_MAC] ||
15536 	    !info->attrs[NL80211_ATTR_OPER_CLASS])
15537 		return -EINVAL;
15538 
15539 	err = nl80211_parse_chandef(rdev, info, &chandef);
15540 	if (err)
15541 		return err;
15542 
15543 	/*
15544 	 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
15545 	 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
15546 	 * specification is not defined for them.
15547 	 */
15548 	if (chandef.chan->band == NL80211_BAND_2GHZ &&
15549 	    chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
15550 	    chandef.width != NL80211_CHAN_WIDTH_20)
15551 		return -EINVAL;
15552 
15553 	/* we will be active on the TDLS link */
15554 	if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
15555 					   wdev->iftype))
15556 		return -EINVAL;
15557 
15558 	/* don't allow switching to DFS channels */
15559 	if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
15560 		return -EINVAL;
15561 
15562 	addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
15563 	oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
15564 
15565 	return rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
15566 }
15567 
15568 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
15569 					      struct genl_info *info)
15570 {
15571 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15572 	struct net_device *dev = info->user_ptr[1];
15573 	const u8 *addr;
15574 
15575 	if (!rdev->ops->tdls_channel_switch ||
15576 	    !rdev->ops->tdls_cancel_channel_switch ||
15577 	    !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
15578 		return -EOPNOTSUPP;
15579 
15580 	switch (dev->ieee80211_ptr->iftype) {
15581 	case NL80211_IFTYPE_STATION:
15582 	case NL80211_IFTYPE_P2P_CLIENT:
15583 		break;
15584 	default:
15585 		return -EOPNOTSUPP;
15586 	}
15587 
15588 	if (!info->attrs[NL80211_ATTR_MAC])
15589 		return -EINVAL;
15590 
15591 	addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
15592 
15593 	rdev_tdls_cancel_channel_switch(rdev, dev, addr);
15594 
15595 	return 0;
15596 }
15597 
15598 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
15599 					    struct genl_info *info)
15600 {
15601 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15602 	struct net_device *dev = info->user_ptr[1];
15603 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15604 	const struct nlattr *nla;
15605 	bool enabled;
15606 
15607 	if (!rdev->ops->set_multicast_to_unicast)
15608 		return -EOPNOTSUPP;
15609 
15610 	if (wdev->iftype != NL80211_IFTYPE_AP &&
15611 	    wdev->iftype != NL80211_IFTYPE_P2P_GO)
15612 		return -EOPNOTSUPP;
15613 
15614 	nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
15615 	enabled = nla_get_flag(nla);
15616 
15617 	return rdev_set_multicast_to_unicast(rdev, dev, enabled);
15618 }
15619 
15620 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info)
15621 {
15622 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15623 	struct net_device *dev = info->user_ptr[1];
15624 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15625 	struct cfg80211_pmk_conf pmk_conf = {};
15626 
15627 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
15628 	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
15629 		return -EOPNOTSUPP;
15630 
15631 	if (!wiphy_ext_feature_isset(&rdev->wiphy,
15632 				     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
15633 		return -EOPNOTSUPP;
15634 
15635 	if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK])
15636 		return -EINVAL;
15637 
15638 	if (!wdev->connected)
15639 		return -ENOTCONN;
15640 
15641 	pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
15642 	if (memcmp(pmk_conf.aa, wdev->u.client.connected_addr, ETH_ALEN))
15643 		return -EINVAL;
15644 
15645 	pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
15646 	pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
15647 	if (pmk_conf.pmk_len != WLAN_PMK_LEN &&
15648 	    pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192)
15649 		return -EINVAL;
15650 
15651 	if (info->attrs[NL80211_ATTR_PMKR0_NAME])
15652 		pmk_conf.pmk_r0_name =
15653 			nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]);
15654 
15655 	return rdev_set_pmk(rdev, dev, &pmk_conf);
15656 }
15657 
15658 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info)
15659 {
15660 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15661 	struct net_device *dev = info->user_ptr[1];
15662 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15663 	const u8 *aa;
15664 
15665 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
15666 	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
15667 		return -EOPNOTSUPP;
15668 
15669 	if (!wiphy_ext_feature_isset(&rdev->wiphy,
15670 				     NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
15671 		return -EOPNOTSUPP;
15672 
15673 	if (!info->attrs[NL80211_ATTR_MAC])
15674 		return -EINVAL;
15675 
15676 	aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
15677 	return rdev_del_pmk(rdev, dev, aa);
15678 }
15679 
15680 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info)
15681 {
15682 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15683 	struct net_device *dev = info->user_ptr[1];
15684 	struct cfg80211_external_auth_params params;
15685 
15686 	if (!rdev->ops->external_auth)
15687 		return -EOPNOTSUPP;
15688 
15689 	if (!info->attrs[NL80211_ATTR_SSID] &&
15690 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
15691 	    dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
15692 		return -EINVAL;
15693 
15694 	if (!info->attrs[NL80211_ATTR_BSSID])
15695 		return -EINVAL;
15696 
15697 	if (!info->attrs[NL80211_ATTR_STATUS_CODE])
15698 		return -EINVAL;
15699 
15700 	memset(&params, 0, sizeof(params));
15701 
15702 	if (info->attrs[NL80211_ATTR_SSID]) {
15703 		params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
15704 		if (params.ssid.ssid_len == 0)
15705 			return -EINVAL;
15706 		memcpy(params.ssid.ssid,
15707 		       nla_data(info->attrs[NL80211_ATTR_SSID]),
15708 		       params.ssid.ssid_len);
15709 	}
15710 
15711 	memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]),
15712 	       ETH_ALEN);
15713 
15714 	params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
15715 
15716 	if (info->attrs[NL80211_ATTR_PMKID])
15717 		params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
15718 
15719 	return rdev_external_auth(rdev, dev, &params);
15720 }
15721 
15722 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info)
15723 {
15724 	bool dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK];
15725 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15726 	struct net_device *dev = info->user_ptr[1];
15727 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15728 	const u8 *buf;
15729 	size_t len;
15730 	u8 *dest;
15731 	u16 proto;
15732 	bool noencrypt;
15733 	u64 cookie = 0;
15734 	int link_id;
15735 	int err;
15736 
15737 	if (!wiphy_ext_feature_isset(&rdev->wiphy,
15738 				     NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
15739 		return -EOPNOTSUPP;
15740 
15741 	if (!rdev->ops->tx_control_port)
15742 		return -EOPNOTSUPP;
15743 
15744 	if (!info->attrs[NL80211_ATTR_FRAME] ||
15745 	    !info->attrs[NL80211_ATTR_MAC] ||
15746 	    !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
15747 		GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing");
15748 		return -EINVAL;
15749 	}
15750 
15751 	switch (wdev->iftype) {
15752 	case NL80211_IFTYPE_AP:
15753 	case NL80211_IFTYPE_P2P_GO:
15754 	case NL80211_IFTYPE_MESH_POINT:
15755 		break;
15756 	case NL80211_IFTYPE_ADHOC:
15757 		if (wdev->u.ibss.current_bss)
15758 			break;
15759 		return -ENOTCONN;
15760 	case NL80211_IFTYPE_STATION:
15761 	case NL80211_IFTYPE_P2P_CLIENT:
15762 		if (wdev->connected)
15763 			break;
15764 		return -ENOTCONN;
15765 	default:
15766 		return -EOPNOTSUPP;
15767 	}
15768 
15769 	buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
15770 	len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
15771 	dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
15772 	proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
15773 	noencrypt =
15774 		nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]);
15775 
15776 	link_id = nl80211_link_id_or_invalid(info->attrs);
15777 
15778 	err = rdev_tx_control_port(rdev, dev, buf, len,
15779 				   dest, cpu_to_be16(proto), noencrypt, link_id,
15780 				   dont_wait_for_ack ? NULL : &cookie);
15781 	if (!err && !dont_wait_for_ack)
15782 		nl_set_extack_cookie_u64(info->extack, cookie);
15783 	return err;
15784 }
15785 
15786 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb,
15787 					   struct genl_info *info)
15788 {
15789 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15790 	struct net_device *dev = info->user_ptr[1];
15791 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15792 	struct cfg80211_ftm_responder_stats ftm_stats = {};
15793 	unsigned int link_id = nl80211_link_id(info->attrs);
15794 	struct sk_buff *msg;
15795 	void *hdr;
15796 	struct nlattr *ftm_stats_attr;
15797 	int err;
15798 
15799 	if (wdev->iftype != NL80211_IFTYPE_AP ||
15800 	    !wdev->links[link_id].ap.beacon_interval)
15801 		return -EOPNOTSUPP;
15802 
15803 	err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats);
15804 	if (err)
15805 		return err;
15806 
15807 	if (!ftm_stats.filled)
15808 		return -ENODATA;
15809 
15810 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15811 	if (!msg)
15812 		return -ENOMEM;
15813 
15814 	hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
15815 			     NL80211_CMD_GET_FTM_RESPONDER_STATS);
15816 	if (!hdr)
15817 		goto nla_put_failure;
15818 
15819 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
15820 		goto nla_put_failure;
15821 
15822 	ftm_stats_attr = nla_nest_start_noflag(msg,
15823 					       NL80211_ATTR_FTM_RESPONDER_STATS);
15824 	if (!ftm_stats_attr)
15825 		goto nla_put_failure;
15826 
15827 #define SET_FTM(field, name, type)					 \
15828 	do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
15829 	    nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name,		 \
15830 			     ftm_stats.field))				 \
15831 		goto nla_put_failure; } while (0)
15832 #define SET_FTM_U64(field, name)					 \
15833 	do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
15834 	    nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name,		 \
15835 			      ftm_stats.field, NL80211_FTM_STATS_PAD))	 \
15836 		goto nla_put_failure; } while (0)
15837 
15838 	SET_FTM(success_num, SUCCESS_NUM, u32);
15839 	SET_FTM(partial_num, PARTIAL_NUM, u32);
15840 	SET_FTM(failed_num, FAILED_NUM, u32);
15841 	SET_FTM(asap_num, ASAP_NUM, u32);
15842 	SET_FTM(non_asap_num, NON_ASAP_NUM, u32);
15843 	SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC);
15844 	SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32);
15845 	SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32);
15846 	SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32);
15847 #undef SET_FTM
15848 
15849 	nla_nest_end(msg, ftm_stats_attr);
15850 
15851 	genlmsg_end(msg, hdr);
15852 	return genlmsg_reply(msg, info);
15853 
15854 nla_put_failure:
15855 	nlmsg_free(msg);
15856 	return -ENOBUFS;
15857 }
15858 
15859 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info)
15860 {
15861 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15862 	struct cfg80211_update_owe_info owe_info;
15863 	struct net_device *dev = info->user_ptr[1];
15864 
15865 	if (!rdev->ops->update_owe_info)
15866 		return -EOPNOTSUPP;
15867 
15868 	if (!info->attrs[NL80211_ATTR_STATUS_CODE] ||
15869 	    !info->attrs[NL80211_ATTR_MAC])
15870 		return -EINVAL;
15871 
15872 	memset(&owe_info, 0, sizeof(owe_info));
15873 	owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
15874 	nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN);
15875 
15876 	if (info->attrs[NL80211_ATTR_IE]) {
15877 		owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
15878 		owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
15879 	}
15880 
15881 	return rdev_update_owe_info(rdev, dev, &owe_info);
15882 }
15883 
15884 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info)
15885 {
15886 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
15887 	struct net_device *dev = info->user_ptr[1];
15888 	struct wireless_dev *wdev = dev->ieee80211_ptr;
15889 	struct station_info sinfo = {};
15890 	const u8 *buf;
15891 	size_t len;
15892 	u8 *dest;
15893 	int err;
15894 
15895 	if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station)
15896 		return -EOPNOTSUPP;
15897 
15898 	if (!info->attrs[NL80211_ATTR_MAC] ||
15899 	    !info->attrs[NL80211_ATTR_FRAME]) {
15900 		GENL_SET_ERR_MSG(info, "Frame or MAC missing");
15901 		return -EINVAL;
15902 	}
15903 
15904 	if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
15905 		return -EOPNOTSUPP;
15906 
15907 	dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
15908 	buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
15909 	len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
15910 
15911 	if (len < sizeof(struct ethhdr))
15912 		return -EINVAL;
15913 
15914 	if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) ||
15915 	    !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr))
15916 		return -EINVAL;
15917 
15918 	err = rdev_get_station(rdev, dev, dest, &sinfo);
15919 	if (err)
15920 		return err;
15921 
15922 	cfg80211_sinfo_release_content(&sinfo);
15923 
15924 	return rdev_probe_mesh_link(rdev, dev, dest, buf, len);
15925 }
15926 
15927 static int parse_tid_conf(struct cfg80211_registered_device *rdev,
15928 			  struct nlattr *attrs[], struct net_device *dev,
15929 			  struct cfg80211_tid_cfg *tid_conf,
15930 			  struct genl_info *info, const u8 *peer,
15931 			  unsigned int link_id)
15932 {
15933 	struct netlink_ext_ack *extack = info->extack;
15934 	u64 mask;
15935 	int err;
15936 
15937 	if (!attrs[NL80211_TID_CONFIG_ATTR_TIDS])
15938 		return -EINVAL;
15939 
15940 	tid_conf->config_override =
15941 			nla_get_flag(attrs[NL80211_TID_CONFIG_ATTR_OVERRIDE]);
15942 	tid_conf->tids = nla_get_u16(attrs[NL80211_TID_CONFIG_ATTR_TIDS]);
15943 
15944 	if (tid_conf->config_override) {
15945 		if (rdev->ops->reset_tid_config) {
15946 			err = rdev_reset_tid_config(rdev, dev, peer,
15947 						    tid_conf->tids);
15948 			if (err)
15949 				return err;
15950 		} else {
15951 			return -EINVAL;
15952 		}
15953 	}
15954 
15955 	if (attrs[NL80211_TID_CONFIG_ATTR_NOACK]) {
15956 		tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_NOACK);
15957 		tid_conf->noack =
15958 			nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_NOACK]);
15959 	}
15960 
15961 	if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]) {
15962 		tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_SHORT);
15963 		tid_conf->retry_short =
15964 			nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]);
15965 
15966 		if (tid_conf->retry_short > rdev->wiphy.max_data_retry_count)
15967 			return -EINVAL;
15968 	}
15969 
15970 	if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]) {
15971 		tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_LONG);
15972 		tid_conf->retry_long =
15973 			nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]);
15974 
15975 		if (tid_conf->retry_long > rdev->wiphy.max_data_retry_count)
15976 			return -EINVAL;
15977 	}
15978 
15979 	if (attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]) {
15980 		tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMPDU_CTRL);
15981 		tid_conf->ampdu =
15982 			nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]);
15983 	}
15984 
15985 	if (attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]) {
15986 		tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL);
15987 		tid_conf->rtscts =
15988 			nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]);
15989 	}
15990 
15991 	if (attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]) {
15992 		tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMSDU_CTRL);
15993 		tid_conf->amsdu =
15994 			nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]);
15995 	}
15996 
15997 	if (attrs[NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE]) {
15998 		u32 idx = NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE, attr;
15999 
16000 		tid_conf->txrate_type = nla_get_u8(attrs[idx]);
16001 
16002 		if (tid_conf->txrate_type != NL80211_TX_RATE_AUTOMATIC) {
16003 			attr = NL80211_TID_CONFIG_ATTR_TX_RATE;
16004 			err = nl80211_parse_tx_bitrate_mask(info, attrs, attr,
16005 						    &tid_conf->txrate_mask, dev,
16006 						    true, link_id);
16007 			if (err)
16008 				return err;
16009 
16010 			tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE);
16011 		}
16012 		tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE);
16013 	}
16014 
16015 	if (peer)
16016 		mask = rdev->wiphy.tid_config_support.peer;
16017 	else
16018 		mask = rdev->wiphy.tid_config_support.vif;
16019 
16020 	if (tid_conf->mask & ~mask) {
16021 		NL_SET_ERR_MSG(extack, "unsupported TID configuration");
16022 		return -EOPNOTSUPP;
16023 	}
16024 
16025 	return 0;
16026 }
16027 
16028 static int nl80211_set_tid_config(struct sk_buff *skb,
16029 				  struct genl_info *info)
16030 {
16031 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
16032 	struct nlattr *attrs[NL80211_TID_CONFIG_ATTR_MAX + 1];
16033 	unsigned int link_id = nl80211_link_id(info->attrs);
16034 	struct net_device *dev = info->user_ptr[1];
16035 	struct cfg80211_tid_config *tid_config;
16036 	struct nlattr *tid;
16037 	int conf_idx = 0, rem_conf;
16038 	int ret = -EINVAL;
16039 	u32 num_conf = 0;
16040 
16041 	if (!info->attrs[NL80211_ATTR_TID_CONFIG])
16042 		return -EINVAL;
16043 
16044 	if (!rdev->ops->set_tid_config)
16045 		return -EOPNOTSUPP;
16046 
16047 	nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG],
16048 			    rem_conf)
16049 		num_conf++;
16050 
16051 	tid_config = kzalloc(struct_size(tid_config, tid_conf, num_conf),
16052 			     GFP_KERNEL);
16053 	if (!tid_config)
16054 		return -ENOMEM;
16055 
16056 	tid_config->n_tid_conf = num_conf;
16057 
16058 	if (info->attrs[NL80211_ATTR_MAC])
16059 		tid_config->peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
16060 
16061 	nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG],
16062 			    rem_conf) {
16063 		ret = nla_parse_nested(attrs, NL80211_TID_CONFIG_ATTR_MAX,
16064 				       tid, NULL, NULL);
16065 
16066 		if (ret)
16067 			goto bad_tid_conf;
16068 
16069 		ret = parse_tid_conf(rdev, attrs, dev,
16070 				     &tid_config->tid_conf[conf_idx],
16071 				     info, tid_config->peer, link_id);
16072 		if (ret)
16073 			goto bad_tid_conf;
16074 
16075 		conf_idx++;
16076 	}
16077 
16078 	ret = rdev_set_tid_config(rdev, dev, tid_config);
16079 
16080 bad_tid_conf:
16081 	kfree(tid_config);
16082 	return ret;
16083 }
16084 
16085 static int nl80211_color_change(struct sk_buff *skb, struct genl_info *info)
16086 {
16087 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
16088 	struct cfg80211_color_change_settings params = {};
16089 	struct net_device *dev = info->user_ptr[1];
16090 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16091 	struct nlattr **tb;
16092 	u16 offset;
16093 	int err;
16094 
16095 	if (!rdev->ops->color_change)
16096 		return -EOPNOTSUPP;
16097 
16098 	if (!wiphy_ext_feature_isset(&rdev->wiphy,
16099 				     NL80211_EXT_FEATURE_BSS_COLOR))
16100 		return -EOPNOTSUPP;
16101 
16102 	if (wdev->iftype != NL80211_IFTYPE_AP)
16103 		return -EOPNOTSUPP;
16104 
16105 	if (!info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT] ||
16106 	    !info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR] ||
16107 	    !info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS])
16108 		return -EINVAL;
16109 
16110 	params.count = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT]);
16111 	params.color = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR]);
16112 
16113 	err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon_next,
16114 				   info->extack);
16115 	if (err)
16116 		return err;
16117 
16118 	tb = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*tb), GFP_KERNEL);
16119 	if (!tb)
16120 		return -ENOMEM;
16121 
16122 	err = nla_parse_nested(tb, NL80211_ATTR_MAX,
16123 			       info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS],
16124 			       nl80211_policy, info->extack);
16125 	if (err)
16126 		goto out;
16127 
16128 	err = nl80211_parse_beacon(rdev, tb, &params.beacon_color_change,
16129 				   info->extack);
16130 	if (err)
16131 		goto out;
16132 
16133 	if (!tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) {
16134 		err = -EINVAL;
16135 		goto out;
16136 	}
16137 
16138 	if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) != sizeof(u16)) {
16139 		err = -EINVAL;
16140 		goto out;
16141 	}
16142 
16143 	offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]);
16144 	if (offset >= params.beacon_color_change.tail_len) {
16145 		err = -EINVAL;
16146 		goto out;
16147 	}
16148 
16149 	if (params.beacon_color_change.tail[offset] != params.count) {
16150 		err = -EINVAL;
16151 		goto out;
16152 	}
16153 
16154 	params.counter_offset_beacon = offset;
16155 
16156 	if (tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) {
16157 		if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) !=
16158 		    sizeof(u16)) {
16159 			err = -EINVAL;
16160 			goto out;
16161 		}
16162 
16163 		offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]);
16164 		if (offset >= params.beacon_color_change.probe_resp_len) {
16165 			err = -EINVAL;
16166 			goto out;
16167 		}
16168 
16169 		if (params.beacon_color_change.probe_resp[offset] !=
16170 		    params.count) {
16171 			err = -EINVAL;
16172 			goto out;
16173 		}
16174 
16175 		params.counter_offset_presp = offset;
16176 	}
16177 
16178 	params.link_id = nl80211_link_id(info->attrs);
16179 	err = rdev_color_change(rdev, dev, &params);
16180 
16181 out:
16182 	kfree(params.beacon_next.mbssid_ies);
16183 	kfree(params.beacon_color_change.mbssid_ies);
16184 	kfree(params.beacon_next.rnr_ies);
16185 	kfree(params.beacon_color_change.rnr_ies);
16186 	kfree(tb);
16187 	return err;
16188 }
16189 
16190 static int nl80211_set_fils_aad(struct sk_buff *skb,
16191 				struct genl_info *info)
16192 {
16193 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
16194 	struct net_device *dev = info->user_ptr[1];
16195 	struct cfg80211_fils_aad fils_aad = {};
16196 	u8 *nonces;
16197 
16198 	if (!info->attrs[NL80211_ATTR_MAC] ||
16199 	    !info->attrs[NL80211_ATTR_FILS_KEK] ||
16200 	    !info->attrs[NL80211_ATTR_FILS_NONCES])
16201 		return -EINVAL;
16202 
16203 	fils_aad.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]);
16204 	fils_aad.kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
16205 	fils_aad.kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
16206 	nonces = nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
16207 	fils_aad.snonce = nonces;
16208 	fils_aad.anonce = nonces + FILS_NONCE_LEN;
16209 
16210 	return rdev_set_fils_aad(rdev, dev, &fils_aad);
16211 }
16212 
16213 static int nl80211_add_link(struct sk_buff *skb, struct genl_info *info)
16214 {
16215 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
16216 	unsigned int link_id = nl80211_link_id(info->attrs);
16217 	struct net_device *dev = info->user_ptr[1];
16218 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16219 	int ret;
16220 
16221 	if (!(wdev->wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO))
16222 		return -EINVAL;
16223 
16224 	switch (wdev->iftype) {
16225 	case NL80211_IFTYPE_AP:
16226 		break;
16227 	default:
16228 		return -EINVAL;
16229 	}
16230 
16231 	if (!info->attrs[NL80211_ATTR_MAC] ||
16232 	    !is_valid_ether_addr(nla_data(info->attrs[NL80211_ATTR_MAC])))
16233 		return -EINVAL;
16234 
16235 	wdev->valid_links |= BIT(link_id);
16236 	ether_addr_copy(wdev->links[link_id].addr,
16237 			nla_data(info->attrs[NL80211_ATTR_MAC]));
16238 
16239 	ret = rdev_add_intf_link(rdev, wdev, link_id);
16240 	if (ret) {
16241 		wdev->valid_links &= ~BIT(link_id);
16242 		eth_zero_addr(wdev->links[link_id].addr);
16243 	}
16244 
16245 	return ret;
16246 }
16247 
16248 static int nl80211_remove_link(struct sk_buff *skb, struct genl_info *info)
16249 {
16250 	unsigned int link_id = nl80211_link_id(info->attrs);
16251 	struct net_device *dev = info->user_ptr[1];
16252 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16253 
16254 	/* cannot remove if there's no link */
16255 	if (!info->attrs[NL80211_ATTR_MLO_LINK_ID])
16256 		return -EINVAL;
16257 
16258 	switch (wdev->iftype) {
16259 	case NL80211_IFTYPE_AP:
16260 		break;
16261 	default:
16262 		return -EINVAL;
16263 	}
16264 
16265 	cfg80211_remove_link(wdev, link_id);
16266 
16267 	return 0;
16268 }
16269 
16270 static int
16271 nl80211_add_mod_link_station(struct sk_buff *skb, struct genl_info *info,
16272 			     bool add)
16273 {
16274 	struct link_station_parameters params = {};
16275 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
16276 	struct net_device *dev = info->user_ptr[1];
16277 	int err;
16278 
16279 	if ((add && !rdev->ops->add_link_station) ||
16280 	    (!add && !rdev->ops->mod_link_station))
16281 		return -EOPNOTSUPP;
16282 
16283 	if (add && !info->attrs[NL80211_ATTR_MAC])
16284 		return -EINVAL;
16285 
16286 	if (!info->attrs[NL80211_ATTR_MLD_ADDR])
16287 		return -EINVAL;
16288 
16289 	if (add && !info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
16290 		return -EINVAL;
16291 
16292 	params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
16293 
16294 	if (info->attrs[NL80211_ATTR_MAC]) {
16295 		params.link_mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
16296 		if (!is_valid_ether_addr(params.link_mac))
16297 			return -EINVAL;
16298 	}
16299 
16300 	if (!info->attrs[NL80211_ATTR_MLO_LINK_ID])
16301 		return -EINVAL;
16302 
16303 	params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]);
16304 
16305 	if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
16306 		params.supported_rates =
16307 			nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
16308 		params.supported_rates_len =
16309 			nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
16310 	}
16311 
16312 	if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
16313 		params.ht_capa =
16314 			nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
16315 
16316 	if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
16317 		params.vht_capa =
16318 			nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
16319 
16320 	if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
16321 		params.he_capa =
16322 			nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
16323 		params.he_capa_len =
16324 			nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
16325 
16326 		if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) {
16327 			params.eht_capa =
16328 				nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
16329 			params.eht_capa_len =
16330 				nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
16331 
16332 			if (!ieee80211_eht_capa_size_ok((const u8 *)params.he_capa,
16333 							(const u8 *)params.eht_capa,
16334 							params.eht_capa_len,
16335 							false))
16336 				return -EINVAL;
16337 		}
16338 	}
16339 
16340 	if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY])
16341 		params.he_6ghz_capa =
16342 			nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]);
16343 
16344 	if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
16345 		params.opmode_notif_used = true;
16346 		params.opmode_notif =
16347 			nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
16348 	}
16349 
16350 	err = nl80211_parse_sta_txpower_setting(info, &params.txpwr,
16351 						&params.txpwr_set);
16352 	if (err)
16353 		return err;
16354 
16355 	if (add)
16356 		return rdev_add_link_station(rdev, dev, &params);
16357 
16358 	return rdev_mod_link_station(rdev, dev, &params);
16359 }
16360 
16361 static int
16362 nl80211_add_link_station(struct sk_buff *skb, struct genl_info *info)
16363 {
16364 	return nl80211_add_mod_link_station(skb, info, true);
16365 }
16366 
16367 static int
16368 nl80211_modify_link_station(struct sk_buff *skb, struct genl_info *info)
16369 {
16370 	return nl80211_add_mod_link_station(skb, info, false);
16371 }
16372 
16373 static int
16374 nl80211_remove_link_station(struct sk_buff *skb, struct genl_info *info)
16375 {
16376 	struct link_station_del_parameters params = {};
16377 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
16378 	struct net_device *dev = info->user_ptr[1];
16379 
16380 	if (!rdev->ops->del_link_station)
16381 		return -EOPNOTSUPP;
16382 
16383 	if (!info->attrs[NL80211_ATTR_MLD_ADDR] ||
16384 	    !info->attrs[NL80211_ATTR_MLO_LINK_ID])
16385 		return -EINVAL;
16386 
16387 	params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
16388 	params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]);
16389 
16390 	return rdev_del_link_station(rdev, dev, &params);
16391 }
16392 
16393 static int nl80211_set_hw_timestamp(struct sk_buff *skb,
16394 				    struct genl_info *info)
16395 {
16396 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
16397 	struct net_device *dev = info->user_ptr[1];
16398 	struct cfg80211_set_hw_timestamp hwts = {};
16399 
16400 	if (!rdev->wiphy.hw_timestamp_max_peers)
16401 		return -EOPNOTSUPP;
16402 
16403 	if (!info->attrs[NL80211_ATTR_MAC] &&
16404 	    rdev->wiphy.hw_timestamp_max_peers != CFG80211_HW_TIMESTAMP_ALL_PEERS)
16405 		return -EOPNOTSUPP;
16406 
16407 	if (info->attrs[NL80211_ATTR_MAC])
16408 		hwts.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]);
16409 
16410 	hwts.enable =
16411 		nla_get_flag(info->attrs[NL80211_ATTR_HW_TIMESTAMP_ENABLED]);
16412 
16413 	return rdev_set_hw_timestamp(rdev, dev, &hwts);
16414 }
16415 
16416 static int
16417 nl80211_set_ttlm(struct sk_buff *skb, struct genl_info *info)
16418 {
16419 	struct cfg80211_ttlm_params params = {};
16420 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
16421 	struct net_device *dev = info->user_ptr[1];
16422 	struct wireless_dev *wdev = dev->ieee80211_ptr;
16423 
16424 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
16425 	    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
16426 		return -EOPNOTSUPP;
16427 
16428 	if (!wdev->connected)
16429 		return -ENOLINK;
16430 
16431 	if (!info->attrs[NL80211_ATTR_MLO_TTLM_DLINK] ||
16432 	    !info->attrs[NL80211_ATTR_MLO_TTLM_ULINK])
16433 		return -EINVAL;
16434 
16435 	nla_memcpy(params.dlink,
16436 		   info->attrs[NL80211_ATTR_MLO_TTLM_DLINK],
16437 		   sizeof(params.dlink));
16438 	nla_memcpy(params.ulink,
16439 		   info->attrs[NL80211_ATTR_MLO_TTLM_ULINK],
16440 		   sizeof(params.ulink));
16441 
16442 	return rdev_set_ttlm(rdev, dev, &params);
16443 }
16444 
16445 #define NL80211_FLAG_NEED_WIPHY		0x01
16446 #define NL80211_FLAG_NEED_NETDEV	0x02
16447 #define NL80211_FLAG_NEED_RTNL		0x04
16448 #define NL80211_FLAG_CHECK_NETDEV_UP	0x08
16449 #define NL80211_FLAG_NEED_NETDEV_UP	(NL80211_FLAG_NEED_NETDEV |\
16450 					 NL80211_FLAG_CHECK_NETDEV_UP)
16451 #define NL80211_FLAG_NEED_WDEV		0x10
16452 /* If a netdev is associated, it must be UP, P2P must be started */
16453 #define NL80211_FLAG_NEED_WDEV_UP	(NL80211_FLAG_NEED_WDEV |\
16454 					 NL80211_FLAG_CHECK_NETDEV_UP)
16455 #define NL80211_FLAG_CLEAR_SKB		0x20
16456 #define NL80211_FLAG_NO_WIPHY_MTX	0x40
16457 #define NL80211_FLAG_MLO_VALID_LINK_ID	0x80
16458 #define NL80211_FLAG_MLO_UNSUPPORTED	0x100
16459 
16460 #define INTERNAL_FLAG_SELECTORS(__sel)			\
16461 	SELECTOR(__sel, NONE, 0) /* must be first */	\
16462 	SELECTOR(__sel, WIPHY,				\
16463 		 NL80211_FLAG_NEED_WIPHY)		\
16464 	SELECTOR(__sel, WDEV,				\
16465 		 NL80211_FLAG_NEED_WDEV)		\
16466 	SELECTOR(__sel, NETDEV,				\
16467 		 NL80211_FLAG_NEED_NETDEV)		\
16468 	SELECTOR(__sel, NETDEV_LINK,			\
16469 		 NL80211_FLAG_NEED_NETDEV |		\
16470 		 NL80211_FLAG_MLO_VALID_LINK_ID)	\
16471 	SELECTOR(__sel, NETDEV_NO_MLO,			\
16472 		 NL80211_FLAG_NEED_NETDEV |		\
16473 		 NL80211_FLAG_MLO_UNSUPPORTED)	\
16474 	SELECTOR(__sel, WIPHY_RTNL,			\
16475 		 NL80211_FLAG_NEED_WIPHY |		\
16476 		 NL80211_FLAG_NEED_RTNL)		\
16477 	SELECTOR(__sel, WIPHY_RTNL_NOMTX,		\
16478 		 NL80211_FLAG_NEED_WIPHY |		\
16479 		 NL80211_FLAG_NEED_RTNL |		\
16480 		 NL80211_FLAG_NO_WIPHY_MTX)		\
16481 	SELECTOR(__sel, WDEV_RTNL,			\
16482 		 NL80211_FLAG_NEED_WDEV |		\
16483 		 NL80211_FLAG_NEED_RTNL)		\
16484 	SELECTOR(__sel, NETDEV_RTNL,			\
16485 		 NL80211_FLAG_NEED_NETDEV |		\
16486 		 NL80211_FLAG_NEED_RTNL)		\
16487 	SELECTOR(__sel, NETDEV_UP,			\
16488 		 NL80211_FLAG_NEED_NETDEV_UP)		\
16489 	SELECTOR(__sel, NETDEV_UP_LINK,			\
16490 		 NL80211_FLAG_NEED_NETDEV_UP |		\
16491 		 NL80211_FLAG_MLO_VALID_LINK_ID)	\
16492 	SELECTOR(__sel, NETDEV_UP_NO_MLO,		\
16493 		 NL80211_FLAG_NEED_NETDEV_UP |		\
16494 		 NL80211_FLAG_MLO_UNSUPPORTED)		\
16495 	SELECTOR(__sel, NETDEV_UP_NO_MLO_CLEAR,		\
16496 		 NL80211_FLAG_NEED_NETDEV_UP |		\
16497 		 NL80211_FLAG_CLEAR_SKB |		\
16498 		 NL80211_FLAG_MLO_UNSUPPORTED)		\
16499 	SELECTOR(__sel, NETDEV_UP_NOTMX,		\
16500 		 NL80211_FLAG_NEED_NETDEV_UP |		\
16501 		 NL80211_FLAG_NO_WIPHY_MTX)		\
16502 	SELECTOR(__sel, NETDEV_UP_NOTMX_MLO,		\
16503 		 NL80211_FLAG_NEED_NETDEV_UP |		\
16504 		 NL80211_FLAG_NO_WIPHY_MTX |		\
16505 		 NL80211_FLAG_MLO_VALID_LINK_ID)	\
16506 	SELECTOR(__sel, NETDEV_UP_CLEAR,		\
16507 		 NL80211_FLAG_NEED_NETDEV_UP |		\
16508 		 NL80211_FLAG_CLEAR_SKB)		\
16509 	SELECTOR(__sel, WDEV_UP,			\
16510 		 NL80211_FLAG_NEED_WDEV_UP)		\
16511 	SELECTOR(__sel, WDEV_UP_LINK,			\
16512 		 NL80211_FLAG_NEED_WDEV_UP |		\
16513 		 NL80211_FLAG_MLO_VALID_LINK_ID)	\
16514 	SELECTOR(__sel, WDEV_UP_RTNL,			\
16515 		 NL80211_FLAG_NEED_WDEV_UP |		\
16516 		 NL80211_FLAG_NEED_RTNL)		\
16517 	SELECTOR(__sel, WIPHY_CLEAR,			\
16518 		 NL80211_FLAG_NEED_WIPHY |		\
16519 		 NL80211_FLAG_CLEAR_SKB)
16520 
16521 enum nl80211_internal_flags_selector {
16522 #define SELECTOR(_, name, value)	NL80211_IFL_SEL_##name,
16523 	INTERNAL_FLAG_SELECTORS(_)
16524 #undef SELECTOR
16525 };
16526 
16527 static u32 nl80211_internal_flags[] = {
16528 #define SELECTOR(_, name, value)	[NL80211_IFL_SEL_##name] = value,
16529 	INTERNAL_FLAG_SELECTORS(_)
16530 #undef SELECTOR
16531 };
16532 
16533 static int nl80211_pre_doit(const struct genl_split_ops *ops,
16534 			    struct sk_buff *skb,
16535 			    struct genl_info *info)
16536 {
16537 	struct cfg80211_registered_device *rdev = NULL;
16538 	struct wireless_dev *wdev = NULL;
16539 	struct net_device *dev = NULL;
16540 	u32 internal_flags;
16541 	int err;
16542 
16543 	if (WARN_ON(ops->internal_flags >= ARRAY_SIZE(nl80211_internal_flags)))
16544 		return -EINVAL;
16545 
16546 	internal_flags = nl80211_internal_flags[ops->internal_flags];
16547 
16548 	rtnl_lock();
16549 	if (internal_flags & NL80211_FLAG_NEED_WIPHY) {
16550 		rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
16551 		if (IS_ERR(rdev)) {
16552 			err = PTR_ERR(rdev);
16553 			goto out_unlock;
16554 		}
16555 		info->user_ptr[0] = rdev;
16556 	} else if (internal_flags & NL80211_FLAG_NEED_NETDEV ||
16557 		   internal_flags & NL80211_FLAG_NEED_WDEV) {
16558 		wdev = __cfg80211_wdev_from_attrs(NULL, genl_info_net(info),
16559 						  info->attrs);
16560 		if (IS_ERR(wdev)) {
16561 			err = PTR_ERR(wdev);
16562 			goto out_unlock;
16563 		}
16564 
16565 		dev = wdev->netdev;
16566 		dev_hold(dev);
16567 		rdev = wiphy_to_rdev(wdev->wiphy);
16568 
16569 		if (internal_flags & NL80211_FLAG_NEED_NETDEV) {
16570 			if (!dev) {
16571 				err = -EINVAL;
16572 				goto out_unlock;
16573 			}
16574 
16575 			info->user_ptr[1] = dev;
16576 		} else {
16577 			info->user_ptr[1] = wdev;
16578 		}
16579 
16580 		if (internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
16581 		    !wdev_running(wdev)) {
16582 			err = -ENETDOWN;
16583 			goto out_unlock;
16584 		}
16585 
16586 		info->user_ptr[0] = rdev;
16587 	}
16588 
16589 	if (internal_flags & NL80211_FLAG_MLO_VALID_LINK_ID) {
16590 		struct nlattr *link_id = info->attrs[NL80211_ATTR_MLO_LINK_ID];
16591 
16592 		if (!wdev) {
16593 			err = -EINVAL;
16594 			goto out_unlock;
16595 		}
16596 
16597 		/* MLO -> require valid link ID */
16598 		if (wdev->valid_links &&
16599 		    (!link_id ||
16600 		     !(wdev->valid_links & BIT(nla_get_u8(link_id))))) {
16601 			err = -EINVAL;
16602 			goto out_unlock;
16603 		}
16604 
16605 		/* non-MLO -> no link ID attribute accepted */
16606 		if (!wdev->valid_links && link_id) {
16607 			err = -EINVAL;
16608 			goto out_unlock;
16609 		}
16610 	}
16611 
16612 	if (internal_flags & NL80211_FLAG_MLO_UNSUPPORTED) {
16613 		if (info->attrs[NL80211_ATTR_MLO_LINK_ID] ||
16614 		    (wdev && wdev->valid_links)) {
16615 			err = -EINVAL;
16616 			goto out_unlock;
16617 		}
16618 	}
16619 
16620 	if (rdev && !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) {
16621 		wiphy_lock(&rdev->wiphy);
16622 		/* we keep the mutex locked until post_doit */
16623 		__release(&rdev->wiphy.mtx);
16624 	}
16625 	if (!(internal_flags & NL80211_FLAG_NEED_RTNL))
16626 		rtnl_unlock();
16627 
16628 	return 0;
16629 out_unlock:
16630 	rtnl_unlock();
16631 	dev_put(dev);
16632 	return err;
16633 }
16634 
16635 static void nl80211_post_doit(const struct genl_split_ops *ops,
16636 			      struct sk_buff *skb,
16637 			      struct genl_info *info)
16638 {
16639 	u32 internal_flags = nl80211_internal_flags[ops->internal_flags];
16640 
16641 	if (info->user_ptr[1]) {
16642 		if (internal_flags & NL80211_FLAG_NEED_WDEV) {
16643 			struct wireless_dev *wdev = info->user_ptr[1];
16644 
16645 			dev_put(wdev->netdev);
16646 		} else {
16647 			dev_put(info->user_ptr[1]);
16648 		}
16649 	}
16650 
16651 	if (info->user_ptr[0] &&
16652 	    !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) {
16653 		struct cfg80211_registered_device *rdev = info->user_ptr[0];
16654 
16655 		/* we kept the mutex locked since pre_doit */
16656 		__acquire(&rdev->wiphy.mtx);
16657 		wiphy_unlock(&rdev->wiphy);
16658 	}
16659 
16660 	if (internal_flags & NL80211_FLAG_NEED_RTNL)
16661 		rtnl_unlock();
16662 
16663 	/* If needed, clear the netlink message payload from the SKB
16664 	 * as it might contain key data that shouldn't stick around on
16665 	 * the heap after the SKB is freed. The netlink message header
16666 	 * is still needed for further processing, so leave it intact.
16667 	 */
16668 	if (internal_flags & NL80211_FLAG_CLEAR_SKB) {
16669 		struct nlmsghdr *nlh = nlmsg_hdr(skb);
16670 
16671 		memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
16672 	}
16673 }
16674 
16675 static int nl80211_set_sar_sub_specs(struct cfg80211_registered_device *rdev,
16676 				     struct cfg80211_sar_specs *sar_specs,
16677 				     struct nlattr *spec[], int index)
16678 {
16679 	u32 range_index, i;
16680 
16681 	if (!sar_specs || !spec)
16682 		return -EINVAL;
16683 
16684 	if (!spec[NL80211_SAR_ATTR_SPECS_POWER] ||
16685 	    !spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX])
16686 		return -EINVAL;
16687 
16688 	range_index = nla_get_u32(spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]);
16689 
16690 	/* check if range_index exceeds num_freq_ranges */
16691 	if (range_index >= rdev->wiphy.sar_capa->num_freq_ranges)
16692 		return -EINVAL;
16693 
16694 	/* check if range_index duplicates */
16695 	for (i = 0; i < index; i++) {
16696 		if (sar_specs->sub_specs[i].freq_range_index == range_index)
16697 			return -EINVAL;
16698 	}
16699 
16700 	sar_specs->sub_specs[index].power =
16701 		nla_get_s32(spec[NL80211_SAR_ATTR_SPECS_POWER]);
16702 
16703 	sar_specs->sub_specs[index].freq_range_index = range_index;
16704 
16705 	return 0;
16706 }
16707 
16708 static int nl80211_set_sar_specs(struct sk_buff *skb, struct genl_info *info)
16709 {
16710 	struct cfg80211_registered_device *rdev = info->user_ptr[0];
16711 	struct nlattr *spec[NL80211_SAR_ATTR_SPECS_MAX + 1];
16712 	struct nlattr *tb[NL80211_SAR_ATTR_MAX + 1];
16713 	struct cfg80211_sar_specs *sar_spec;
16714 	enum nl80211_sar_type type;
16715 	struct nlattr *spec_list;
16716 	u32 specs;
16717 	int rem, err;
16718 
16719 	if (!rdev->wiphy.sar_capa || !rdev->ops->set_sar_specs)
16720 		return -EOPNOTSUPP;
16721 
16722 	if (!info->attrs[NL80211_ATTR_SAR_SPEC])
16723 		return -EINVAL;
16724 
16725 	nla_parse_nested(tb, NL80211_SAR_ATTR_MAX,
16726 			 info->attrs[NL80211_ATTR_SAR_SPEC],
16727 			 NULL, NULL);
16728 
16729 	if (!tb[NL80211_SAR_ATTR_TYPE] || !tb[NL80211_SAR_ATTR_SPECS])
16730 		return -EINVAL;
16731 
16732 	type = nla_get_u32(tb[NL80211_SAR_ATTR_TYPE]);
16733 	if (type != rdev->wiphy.sar_capa->type)
16734 		return -EINVAL;
16735 
16736 	specs = 0;
16737 	nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem)
16738 		specs++;
16739 
16740 	if (specs > rdev->wiphy.sar_capa->num_freq_ranges)
16741 		return -EINVAL;
16742 
16743 	sar_spec = kzalloc(struct_size(sar_spec, sub_specs, specs), GFP_KERNEL);
16744 	if (!sar_spec)
16745 		return -ENOMEM;
16746 
16747 	sar_spec->type = type;
16748 	specs = 0;
16749 	nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) {
16750 		nla_parse_nested(spec, NL80211_SAR_ATTR_SPECS_MAX,
16751 				 spec_list, NULL, NULL);
16752 
16753 		switch (type) {
16754 		case NL80211_SAR_TYPE_POWER:
16755 			if (nl80211_set_sar_sub_specs(rdev, sar_spec,
16756 						      spec, specs)) {
16757 				err = -EINVAL;
16758 				goto error;
16759 			}
16760 			break;
16761 		default:
16762 			err = -EINVAL;
16763 			goto error;
16764 		}
16765 		specs++;
16766 	}
16767 
16768 	sar_spec->num_sub_specs = specs;
16769 
16770 	rdev->cur_cmd_info = info;
16771 	err = rdev_set_sar_specs(rdev, sar_spec);
16772 	rdev->cur_cmd_info = NULL;
16773 error:
16774 	kfree(sar_spec);
16775 	return err;
16776 }
16777 
16778 #define SELECTOR(__sel, name, value) \
16779 	((__sel) == (value)) ? NL80211_IFL_SEL_##name :
16780 int __missing_selector(void);
16781 #define IFLAGS(__val) INTERNAL_FLAG_SELECTORS(__val) __missing_selector()
16782 
16783 static const struct genl_ops nl80211_ops[] = {
16784 	{
16785 		.cmd = NL80211_CMD_GET_WIPHY,
16786 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16787 		.doit = nl80211_get_wiphy,
16788 		.dumpit = nl80211_dump_wiphy,
16789 		.done = nl80211_dump_wiphy_done,
16790 		/* can be retrieved by unprivileged users */
16791 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
16792 	},
16793 };
16794 
16795 static const struct genl_small_ops nl80211_small_ops[] = {
16796 	{
16797 		.cmd = NL80211_CMD_SET_WIPHY,
16798 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16799 		.doit = nl80211_set_wiphy,
16800 		.flags = GENL_UNS_ADMIN_PERM,
16801 	},
16802 	{
16803 		.cmd = NL80211_CMD_GET_INTERFACE,
16804 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16805 		.doit = nl80211_get_interface,
16806 		.dumpit = nl80211_dump_interface,
16807 		/* can be retrieved by unprivileged users */
16808 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV),
16809 	},
16810 	{
16811 		.cmd = NL80211_CMD_SET_INTERFACE,
16812 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16813 		.doit = nl80211_set_interface,
16814 		.flags = GENL_UNS_ADMIN_PERM,
16815 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
16816 					 NL80211_FLAG_NEED_RTNL),
16817 	},
16818 	{
16819 		.cmd = NL80211_CMD_NEW_INTERFACE,
16820 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16821 		.doit = nl80211_new_interface,
16822 		.flags = GENL_UNS_ADMIN_PERM,
16823 		.internal_flags =
16824 			IFLAGS(NL80211_FLAG_NEED_WIPHY |
16825 			       NL80211_FLAG_NEED_RTNL |
16826 			       /* we take the wiphy mutex later ourselves */
16827 			       NL80211_FLAG_NO_WIPHY_MTX),
16828 	},
16829 	{
16830 		.cmd = NL80211_CMD_DEL_INTERFACE,
16831 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16832 		.doit = nl80211_del_interface,
16833 		.flags = GENL_UNS_ADMIN_PERM,
16834 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV |
16835 					 NL80211_FLAG_NEED_RTNL),
16836 	},
16837 	{
16838 		.cmd = NL80211_CMD_GET_KEY,
16839 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16840 		.doit = nl80211_get_key,
16841 		.flags = GENL_UNS_ADMIN_PERM,
16842 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
16843 	},
16844 	{
16845 		.cmd = NL80211_CMD_SET_KEY,
16846 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16847 		.doit = nl80211_set_key,
16848 		.flags = GENL_UNS_ADMIN_PERM,
16849 		/* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on key */
16850 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
16851 					 NL80211_FLAG_CLEAR_SKB),
16852 	},
16853 	{
16854 		.cmd = NL80211_CMD_NEW_KEY,
16855 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16856 		.doit = nl80211_new_key,
16857 		.flags = GENL_UNS_ADMIN_PERM,
16858 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
16859 					 NL80211_FLAG_CLEAR_SKB),
16860 	},
16861 	{
16862 		.cmd = NL80211_CMD_DEL_KEY,
16863 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16864 		.doit = nl80211_del_key,
16865 		.flags = GENL_UNS_ADMIN_PERM,
16866 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
16867 	},
16868 	{
16869 		.cmd = NL80211_CMD_SET_BEACON,
16870 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16871 		.flags = GENL_UNS_ADMIN_PERM,
16872 		.doit = nl80211_set_beacon,
16873 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
16874 					 NL80211_FLAG_MLO_VALID_LINK_ID),
16875 	},
16876 	{
16877 		.cmd = NL80211_CMD_START_AP,
16878 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16879 		.flags = GENL_UNS_ADMIN_PERM,
16880 		.doit = nl80211_start_ap,
16881 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
16882 					 NL80211_FLAG_MLO_VALID_LINK_ID),
16883 	},
16884 	{
16885 		.cmd = NL80211_CMD_STOP_AP,
16886 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16887 		.flags = GENL_UNS_ADMIN_PERM,
16888 		.doit = nl80211_stop_ap,
16889 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
16890 					 NL80211_FLAG_MLO_VALID_LINK_ID),
16891 	},
16892 	{
16893 		.cmd = NL80211_CMD_GET_STATION,
16894 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16895 		.doit = nl80211_get_station,
16896 		.dumpit = nl80211_dump_station,
16897 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
16898 	},
16899 	{
16900 		.cmd = NL80211_CMD_SET_STATION,
16901 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16902 		.doit = nl80211_set_station,
16903 		.flags = GENL_UNS_ADMIN_PERM,
16904 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
16905 	},
16906 	{
16907 		.cmd = NL80211_CMD_NEW_STATION,
16908 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16909 		.doit = nl80211_new_station,
16910 		.flags = GENL_UNS_ADMIN_PERM,
16911 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
16912 	},
16913 	{
16914 		.cmd = NL80211_CMD_DEL_STATION,
16915 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16916 		.doit = nl80211_del_station,
16917 		.flags = GENL_UNS_ADMIN_PERM,
16918 		/* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on
16919 		 * whether MAC address is passed or not. If MAC address is
16920 		 * passed, then even during MLO, link ID is not required.
16921 		 */
16922 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
16923 	},
16924 	{
16925 		.cmd = NL80211_CMD_GET_MPATH,
16926 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16927 		.doit = nl80211_get_mpath,
16928 		.dumpit = nl80211_dump_mpath,
16929 		.flags = GENL_UNS_ADMIN_PERM,
16930 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
16931 	},
16932 	{
16933 		.cmd = NL80211_CMD_GET_MPP,
16934 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16935 		.doit = nl80211_get_mpp,
16936 		.dumpit = nl80211_dump_mpp,
16937 		.flags = GENL_UNS_ADMIN_PERM,
16938 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
16939 	},
16940 	{
16941 		.cmd = NL80211_CMD_SET_MPATH,
16942 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16943 		.doit = nl80211_set_mpath,
16944 		.flags = GENL_UNS_ADMIN_PERM,
16945 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
16946 	},
16947 	{
16948 		.cmd = NL80211_CMD_NEW_MPATH,
16949 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16950 		.doit = nl80211_new_mpath,
16951 		.flags = GENL_UNS_ADMIN_PERM,
16952 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
16953 	},
16954 	{
16955 		.cmd = NL80211_CMD_DEL_MPATH,
16956 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16957 		.doit = nl80211_del_mpath,
16958 		.flags = GENL_UNS_ADMIN_PERM,
16959 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
16960 	},
16961 	{
16962 		.cmd = NL80211_CMD_SET_BSS,
16963 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16964 		.doit = nl80211_set_bss,
16965 		.flags = GENL_UNS_ADMIN_PERM,
16966 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
16967 					 NL80211_FLAG_MLO_VALID_LINK_ID),
16968 	},
16969 	{
16970 		.cmd = NL80211_CMD_GET_REG,
16971 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16972 		.doit = nl80211_get_reg_do,
16973 		.dumpit = nl80211_get_reg_dump,
16974 		/* can be retrieved by unprivileged users */
16975 	},
16976 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
16977 	{
16978 		.cmd = NL80211_CMD_SET_REG,
16979 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16980 		.doit = nl80211_set_reg,
16981 		.flags = GENL_ADMIN_PERM,
16982 	},
16983 #endif
16984 	{
16985 		.cmd = NL80211_CMD_REQ_SET_REG,
16986 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16987 		.doit = nl80211_req_set_reg,
16988 		.flags = GENL_ADMIN_PERM,
16989 	},
16990 	{
16991 		.cmd = NL80211_CMD_RELOAD_REGDB,
16992 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16993 		.doit = nl80211_reload_regdb,
16994 		.flags = GENL_ADMIN_PERM,
16995 	},
16996 	{
16997 		.cmd = NL80211_CMD_GET_MESH_CONFIG,
16998 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
16999 		.doit = nl80211_get_mesh_config,
17000 		/* can be retrieved by unprivileged users */
17001 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17002 	},
17003 	{
17004 		.cmd = NL80211_CMD_SET_MESH_CONFIG,
17005 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17006 		.doit = nl80211_update_mesh_config,
17007 		.flags = GENL_UNS_ADMIN_PERM,
17008 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17009 	},
17010 	{
17011 		.cmd = NL80211_CMD_TRIGGER_SCAN,
17012 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17013 		.doit = nl80211_trigger_scan,
17014 		.flags = GENL_UNS_ADMIN_PERM,
17015 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17016 	},
17017 	{
17018 		.cmd = NL80211_CMD_ABORT_SCAN,
17019 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17020 		.doit = nl80211_abort_scan,
17021 		.flags = GENL_UNS_ADMIN_PERM,
17022 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17023 	},
17024 	{
17025 		.cmd = NL80211_CMD_GET_SCAN,
17026 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17027 		.dumpit = nl80211_dump_scan,
17028 	},
17029 	{
17030 		.cmd = NL80211_CMD_START_SCHED_SCAN,
17031 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17032 		.doit = nl80211_start_sched_scan,
17033 		.flags = GENL_UNS_ADMIN_PERM,
17034 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17035 	},
17036 	{
17037 		.cmd = NL80211_CMD_STOP_SCHED_SCAN,
17038 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17039 		.doit = nl80211_stop_sched_scan,
17040 		.flags = GENL_UNS_ADMIN_PERM,
17041 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17042 	},
17043 	{
17044 		.cmd = NL80211_CMD_AUTHENTICATE,
17045 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17046 		.doit = nl80211_authenticate,
17047 		.flags = GENL_UNS_ADMIN_PERM,
17048 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17049 					 NL80211_FLAG_CLEAR_SKB),
17050 	},
17051 	{
17052 		.cmd = NL80211_CMD_ASSOCIATE,
17053 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17054 		.doit = nl80211_associate,
17055 		.flags = GENL_UNS_ADMIN_PERM,
17056 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17057 					 NL80211_FLAG_CLEAR_SKB),
17058 	},
17059 	{
17060 		.cmd = NL80211_CMD_DEAUTHENTICATE,
17061 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17062 		.doit = nl80211_deauthenticate,
17063 		.flags = GENL_UNS_ADMIN_PERM,
17064 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17065 	},
17066 	{
17067 		.cmd = NL80211_CMD_DISASSOCIATE,
17068 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17069 		.doit = nl80211_disassociate,
17070 		.flags = GENL_UNS_ADMIN_PERM,
17071 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17072 	},
17073 	{
17074 		.cmd = NL80211_CMD_JOIN_IBSS,
17075 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17076 		.doit = nl80211_join_ibss,
17077 		.flags = GENL_UNS_ADMIN_PERM,
17078 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17079 	},
17080 	{
17081 		.cmd = NL80211_CMD_LEAVE_IBSS,
17082 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17083 		.doit = nl80211_leave_ibss,
17084 		.flags = GENL_UNS_ADMIN_PERM,
17085 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17086 	},
17087 #ifdef CONFIG_NL80211_TESTMODE
17088 	{
17089 		.cmd = NL80211_CMD_TESTMODE,
17090 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17091 		.doit = nl80211_testmode_do,
17092 		.dumpit = nl80211_testmode_dump,
17093 		.flags = GENL_UNS_ADMIN_PERM,
17094 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
17095 	},
17096 #endif
17097 	{
17098 		.cmd = NL80211_CMD_CONNECT,
17099 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17100 		.doit = nl80211_connect,
17101 		.flags = GENL_UNS_ADMIN_PERM,
17102 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17103 					 NL80211_FLAG_CLEAR_SKB),
17104 	},
17105 	{
17106 		.cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
17107 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17108 		.doit = nl80211_update_connect_params,
17109 		.flags = GENL_ADMIN_PERM,
17110 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17111 					 NL80211_FLAG_CLEAR_SKB),
17112 	},
17113 	{
17114 		.cmd = NL80211_CMD_DISCONNECT,
17115 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17116 		.doit = nl80211_disconnect,
17117 		.flags = GENL_UNS_ADMIN_PERM,
17118 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17119 	},
17120 	{
17121 		.cmd = NL80211_CMD_SET_WIPHY_NETNS,
17122 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17123 		.doit = nl80211_wiphy_netns,
17124 		.flags = GENL_UNS_ADMIN_PERM,
17125 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY |
17126 					 NL80211_FLAG_NEED_RTNL |
17127 					 NL80211_FLAG_NO_WIPHY_MTX),
17128 	},
17129 	{
17130 		.cmd = NL80211_CMD_GET_SURVEY,
17131 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17132 		.dumpit = nl80211_dump_survey,
17133 	},
17134 	{
17135 		.cmd = NL80211_CMD_SET_PMKSA,
17136 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17137 		.doit = nl80211_set_pmksa,
17138 		.flags = GENL_UNS_ADMIN_PERM,
17139 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17140 					 NL80211_FLAG_CLEAR_SKB),
17141 	},
17142 	{
17143 		.cmd = NL80211_CMD_DEL_PMKSA,
17144 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17145 		.doit = nl80211_del_pmksa,
17146 		.flags = GENL_UNS_ADMIN_PERM,
17147 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17148 	},
17149 	{
17150 		.cmd = NL80211_CMD_FLUSH_PMKSA,
17151 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17152 		.doit = nl80211_flush_pmksa,
17153 		.flags = GENL_UNS_ADMIN_PERM,
17154 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17155 	},
17156 	{
17157 		.cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
17158 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17159 		.doit = nl80211_remain_on_channel,
17160 		.flags = GENL_UNS_ADMIN_PERM,
17161 		/* FIXME: requiring a link ID here is probably not good */
17162 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP |
17163 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17164 	},
17165 	{
17166 		.cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
17167 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17168 		.doit = nl80211_cancel_remain_on_channel,
17169 		.flags = GENL_UNS_ADMIN_PERM,
17170 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17171 	},
17172 	{
17173 		.cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
17174 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17175 		.doit = nl80211_set_tx_bitrate_mask,
17176 		.flags = GENL_UNS_ADMIN_PERM,
17177 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
17178 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17179 	},
17180 	{
17181 		.cmd = NL80211_CMD_REGISTER_FRAME,
17182 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17183 		.doit = nl80211_register_mgmt,
17184 		.flags = GENL_UNS_ADMIN_PERM,
17185 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV),
17186 	},
17187 	{
17188 		.cmd = NL80211_CMD_FRAME,
17189 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17190 		.doit = nl80211_tx_mgmt,
17191 		.flags = GENL_UNS_ADMIN_PERM,
17192 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17193 	},
17194 	{
17195 		.cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
17196 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17197 		.doit = nl80211_tx_mgmt_cancel_wait,
17198 		.flags = GENL_UNS_ADMIN_PERM,
17199 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17200 	},
17201 	{
17202 		.cmd = NL80211_CMD_SET_POWER_SAVE,
17203 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17204 		.doit = nl80211_set_power_save,
17205 		.flags = GENL_UNS_ADMIN_PERM,
17206 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
17207 	},
17208 	{
17209 		.cmd = NL80211_CMD_GET_POWER_SAVE,
17210 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17211 		.doit = nl80211_get_power_save,
17212 		/* can be retrieved by unprivileged users */
17213 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
17214 	},
17215 	{
17216 		.cmd = NL80211_CMD_SET_CQM,
17217 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17218 		.doit = nl80211_set_cqm,
17219 		.flags = GENL_UNS_ADMIN_PERM,
17220 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
17221 	},
17222 	{
17223 		.cmd = NL80211_CMD_SET_CHANNEL,
17224 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17225 		.doit = nl80211_set_channel,
17226 		.flags = GENL_UNS_ADMIN_PERM,
17227 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
17228 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17229 	},
17230 	{
17231 		.cmd = NL80211_CMD_JOIN_MESH,
17232 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17233 		.doit = nl80211_join_mesh,
17234 		.flags = GENL_UNS_ADMIN_PERM,
17235 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17236 	},
17237 	{
17238 		.cmd = NL80211_CMD_LEAVE_MESH,
17239 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17240 		.doit = nl80211_leave_mesh,
17241 		.flags = GENL_UNS_ADMIN_PERM,
17242 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17243 	},
17244 	{
17245 		.cmd = NL80211_CMD_JOIN_OCB,
17246 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17247 		.doit = nl80211_join_ocb,
17248 		.flags = GENL_UNS_ADMIN_PERM,
17249 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17250 	},
17251 	{
17252 		.cmd = NL80211_CMD_LEAVE_OCB,
17253 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17254 		.doit = nl80211_leave_ocb,
17255 		.flags = GENL_UNS_ADMIN_PERM,
17256 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17257 	},
17258 #ifdef CONFIG_PM
17259 	{
17260 		.cmd = NL80211_CMD_GET_WOWLAN,
17261 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17262 		.doit = nl80211_get_wowlan,
17263 		/* can be retrieved by unprivileged users */
17264 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
17265 	},
17266 	{
17267 		.cmd = NL80211_CMD_SET_WOWLAN,
17268 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17269 		.doit = nl80211_set_wowlan,
17270 		.flags = GENL_UNS_ADMIN_PERM,
17271 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
17272 	},
17273 #endif
17274 	{
17275 		.cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
17276 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17277 		.doit = nl80211_set_rekey_data,
17278 		.flags = GENL_UNS_ADMIN_PERM,
17279 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17280 					 NL80211_FLAG_CLEAR_SKB),
17281 	},
17282 	{
17283 		.cmd = NL80211_CMD_TDLS_MGMT,
17284 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17285 		.doit = nl80211_tdls_mgmt,
17286 		.flags = GENL_UNS_ADMIN_PERM,
17287 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17288 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17289 	},
17290 	{
17291 		.cmd = NL80211_CMD_TDLS_OPER,
17292 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17293 		.doit = nl80211_tdls_oper,
17294 		.flags = GENL_UNS_ADMIN_PERM,
17295 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17296 	},
17297 	{
17298 		.cmd = NL80211_CMD_UNEXPECTED_FRAME,
17299 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17300 		.doit = nl80211_register_unexpected_frame,
17301 		.flags = GENL_UNS_ADMIN_PERM,
17302 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
17303 	},
17304 	{
17305 		.cmd = NL80211_CMD_PROBE_CLIENT,
17306 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17307 		.doit = nl80211_probe_client,
17308 		.flags = GENL_UNS_ADMIN_PERM,
17309 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17310 	},
17311 	{
17312 		.cmd = NL80211_CMD_REGISTER_BEACONS,
17313 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17314 		.doit = nl80211_register_beacons,
17315 		.flags = GENL_UNS_ADMIN_PERM,
17316 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
17317 	},
17318 	{
17319 		.cmd = NL80211_CMD_SET_NOACK_MAP,
17320 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17321 		.doit = nl80211_set_noack_map,
17322 		.flags = GENL_UNS_ADMIN_PERM,
17323 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
17324 	},
17325 	{
17326 		.cmd = NL80211_CMD_START_P2P_DEVICE,
17327 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17328 		.doit = nl80211_start_p2p_device,
17329 		.flags = GENL_UNS_ADMIN_PERM,
17330 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV |
17331 					 NL80211_FLAG_NEED_RTNL),
17332 	},
17333 	{
17334 		.cmd = NL80211_CMD_STOP_P2P_DEVICE,
17335 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17336 		.doit = nl80211_stop_p2p_device,
17337 		.flags = GENL_UNS_ADMIN_PERM,
17338 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP |
17339 					 NL80211_FLAG_NEED_RTNL),
17340 	},
17341 	{
17342 		.cmd = NL80211_CMD_START_NAN,
17343 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17344 		.doit = nl80211_start_nan,
17345 		.flags = GENL_ADMIN_PERM,
17346 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV |
17347 					 NL80211_FLAG_NEED_RTNL),
17348 	},
17349 	{
17350 		.cmd = NL80211_CMD_STOP_NAN,
17351 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17352 		.doit = nl80211_stop_nan,
17353 		.flags = GENL_ADMIN_PERM,
17354 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP |
17355 					 NL80211_FLAG_NEED_RTNL),
17356 	},
17357 	{
17358 		.cmd = NL80211_CMD_ADD_NAN_FUNCTION,
17359 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17360 		.doit = nl80211_nan_add_func,
17361 		.flags = GENL_ADMIN_PERM,
17362 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17363 	},
17364 	{
17365 		.cmd = NL80211_CMD_DEL_NAN_FUNCTION,
17366 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17367 		.doit = nl80211_nan_del_func,
17368 		.flags = GENL_ADMIN_PERM,
17369 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17370 	},
17371 	{
17372 		.cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
17373 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17374 		.doit = nl80211_nan_change_config,
17375 		.flags = GENL_ADMIN_PERM,
17376 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17377 	},
17378 	{
17379 		.cmd = NL80211_CMD_SET_MCAST_RATE,
17380 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17381 		.doit = nl80211_set_mcast_rate,
17382 		.flags = GENL_UNS_ADMIN_PERM,
17383 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
17384 	},
17385 	{
17386 		.cmd = NL80211_CMD_SET_MAC_ACL,
17387 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17388 		.doit = nl80211_set_mac_acl,
17389 		.flags = GENL_UNS_ADMIN_PERM,
17390 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
17391 					 NL80211_FLAG_MLO_UNSUPPORTED),
17392 	},
17393 	{
17394 		.cmd = NL80211_CMD_RADAR_DETECT,
17395 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17396 		.doit = nl80211_start_radar_detection,
17397 		.flags = GENL_UNS_ADMIN_PERM,
17398 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17399 					 NL80211_FLAG_NO_WIPHY_MTX |
17400 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17401 	},
17402 	{
17403 		.cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
17404 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17405 		.doit = nl80211_get_protocol_features,
17406 	},
17407 	{
17408 		.cmd = NL80211_CMD_UPDATE_FT_IES,
17409 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17410 		.doit = nl80211_update_ft_ies,
17411 		.flags = GENL_UNS_ADMIN_PERM,
17412 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17413 	},
17414 	{
17415 		.cmd = NL80211_CMD_CRIT_PROTOCOL_START,
17416 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17417 		.doit = nl80211_crit_protocol_start,
17418 		.flags = GENL_UNS_ADMIN_PERM,
17419 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17420 	},
17421 	{
17422 		.cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
17423 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17424 		.doit = nl80211_crit_protocol_stop,
17425 		.flags = GENL_UNS_ADMIN_PERM,
17426 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17427 	},
17428 	{
17429 		.cmd = NL80211_CMD_GET_COALESCE,
17430 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17431 		.doit = nl80211_get_coalesce,
17432 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
17433 	},
17434 	{
17435 		.cmd = NL80211_CMD_SET_COALESCE,
17436 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17437 		.doit = nl80211_set_coalesce,
17438 		.flags = GENL_UNS_ADMIN_PERM,
17439 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
17440 	},
17441 	{
17442 		.cmd = NL80211_CMD_CHANNEL_SWITCH,
17443 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17444 		.doit = nl80211_channel_switch,
17445 		.flags = GENL_UNS_ADMIN_PERM,
17446 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17447 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17448 	},
17449 	{
17450 		.cmd = NL80211_CMD_VENDOR,
17451 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17452 		.doit = nl80211_vendor_cmd,
17453 		.dumpit = nl80211_vendor_cmd_dump,
17454 		.flags = GENL_UNS_ADMIN_PERM,
17455 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY |
17456 					 NL80211_FLAG_CLEAR_SKB),
17457 	},
17458 	{
17459 		.cmd = NL80211_CMD_SET_QOS_MAP,
17460 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17461 		.doit = nl80211_set_qos_map,
17462 		.flags = GENL_UNS_ADMIN_PERM,
17463 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17464 	},
17465 	{
17466 		.cmd = NL80211_CMD_ADD_TX_TS,
17467 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17468 		.doit = nl80211_add_tx_ts,
17469 		.flags = GENL_UNS_ADMIN_PERM,
17470 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17471 					 NL80211_FLAG_MLO_UNSUPPORTED),
17472 	},
17473 	{
17474 		.cmd = NL80211_CMD_DEL_TX_TS,
17475 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17476 		.doit = nl80211_del_tx_ts,
17477 		.flags = GENL_UNS_ADMIN_PERM,
17478 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17479 	},
17480 	{
17481 		.cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
17482 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17483 		.doit = nl80211_tdls_channel_switch,
17484 		.flags = GENL_UNS_ADMIN_PERM,
17485 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17486 	},
17487 	{
17488 		.cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
17489 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17490 		.doit = nl80211_tdls_cancel_channel_switch,
17491 		.flags = GENL_UNS_ADMIN_PERM,
17492 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17493 	},
17494 	{
17495 		.cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
17496 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17497 		.doit = nl80211_set_multicast_to_unicast,
17498 		.flags = GENL_UNS_ADMIN_PERM,
17499 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
17500 	},
17501 	{
17502 		.cmd = NL80211_CMD_SET_PMK,
17503 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17504 		.doit = nl80211_set_pmk,
17505 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17506 					 NL80211_FLAG_CLEAR_SKB),
17507 	},
17508 	{
17509 		.cmd = NL80211_CMD_DEL_PMK,
17510 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17511 		.doit = nl80211_del_pmk,
17512 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17513 	},
17514 	{
17515 		.cmd = NL80211_CMD_EXTERNAL_AUTH,
17516 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17517 		.doit = nl80211_external_auth,
17518 		.flags = GENL_ADMIN_PERM,
17519 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17520 	},
17521 	{
17522 		.cmd = NL80211_CMD_CONTROL_PORT_FRAME,
17523 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17524 		.doit = nl80211_tx_control_port,
17525 		.flags = GENL_UNS_ADMIN_PERM,
17526 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17527 	},
17528 	{
17529 		.cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS,
17530 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17531 		.doit = nl80211_get_ftm_responder_stats,
17532 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
17533 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17534 	},
17535 	{
17536 		.cmd = NL80211_CMD_PEER_MEASUREMENT_START,
17537 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17538 		.doit = nl80211_pmsr_start,
17539 		.flags = GENL_UNS_ADMIN_PERM,
17540 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
17541 	},
17542 	{
17543 		.cmd = NL80211_CMD_NOTIFY_RADAR,
17544 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17545 		.doit = nl80211_notify_radar_detection,
17546 		.flags = GENL_UNS_ADMIN_PERM,
17547 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17548 	},
17549 	{
17550 		.cmd = NL80211_CMD_UPDATE_OWE_INFO,
17551 		.doit = nl80211_update_owe_info,
17552 		.flags = GENL_ADMIN_PERM,
17553 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17554 	},
17555 	{
17556 		.cmd = NL80211_CMD_PROBE_MESH_LINK,
17557 		.doit = nl80211_probe_mesh_link,
17558 		.flags = GENL_UNS_ADMIN_PERM,
17559 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17560 	},
17561 	{
17562 		.cmd = NL80211_CMD_SET_TID_CONFIG,
17563 		.doit = nl80211_set_tid_config,
17564 		.flags = GENL_UNS_ADMIN_PERM,
17565 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
17566 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17567 	},
17568 	{
17569 		.cmd = NL80211_CMD_SET_SAR_SPECS,
17570 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17571 		.doit = nl80211_set_sar_specs,
17572 		.flags = GENL_UNS_ADMIN_PERM,
17573 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY |
17574 					 NL80211_FLAG_NEED_RTNL),
17575 	},
17576 	{
17577 		.cmd = NL80211_CMD_COLOR_CHANGE_REQUEST,
17578 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17579 		.doit = nl80211_color_change,
17580 		.flags = GENL_UNS_ADMIN_PERM,
17581 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17582 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17583 	},
17584 	{
17585 		.cmd = NL80211_CMD_SET_FILS_AAD,
17586 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
17587 		.doit = nl80211_set_fils_aad,
17588 		.flags = GENL_UNS_ADMIN_PERM,
17589 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17590 	},
17591 	{
17592 		.cmd = NL80211_CMD_ADD_LINK,
17593 		.doit = nl80211_add_link,
17594 		.flags = GENL_UNS_ADMIN_PERM,
17595 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17596 	},
17597 	{
17598 		.cmd = NL80211_CMD_REMOVE_LINK,
17599 		.doit = nl80211_remove_link,
17600 		.flags = GENL_UNS_ADMIN_PERM,
17601 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17602 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17603 	},
17604 	{
17605 		.cmd = NL80211_CMD_ADD_LINK_STA,
17606 		.doit = nl80211_add_link_station,
17607 		.flags = GENL_UNS_ADMIN_PERM,
17608 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17609 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17610 	},
17611 	{
17612 		.cmd = NL80211_CMD_MODIFY_LINK_STA,
17613 		.doit = nl80211_modify_link_station,
17614 		.flags = GENL_UNS_ADMIN_PERM,
17615 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17616 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17617 	},
17618 	{
17619 		.cmd = NL80211_CMD_REMOVE_LINK_STA,
17620 		.doit = nl80211_remove_link_station,
17621 		.flags = GENL_UNS_ADMIN_PERM,
17622 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
17623 					 NL80211_FLAG_MLO_VALID_LINK_ID),
17624 	},
17625 	{
17626 		.cmd = NL80211_CMD_SET_HW_TIMESTAMP,
17627 		.doit = nl80211_set_hw_timestamp,
17628 		.flags = GENL_UNS_ADMIN_PERM,
17629 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17630 	},
17631 	{
17632 		.cmd = NL80211_CMD_SET_TID_TO_LINK_MAPPING,
17633 		.doit = nl80211_set_ttlm,
17634 		.flags = GENL_UNS_ADMIN_PERM,
17635 		.internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
17636 	},
17637 };
17638 
17639 static struct genl_family nl80211_fam __ro_after_init = {
17640 	.name = NL80211_GENL_NAME,	/* have users key off the name instead */
17641 	.hdrsize = 0,			/* no private header */
17642 	.version = 1,			/* no particular meaning now */
17643 	.maxattr = NL80211_ATTR_MAX,
17644 	.policy = nl80211_policy,
17645 	.netnsok = true,
17646 	.pre_doit = nl80211_pre_doit,
17647 	.post_doit = nl80211_post_doit,
17648 	.module = THIS_MODULE,
17649 	.ops = nl80211_ops,
17650 	.n_ops = ARRAY_SIZE(nl80211_ops),
17651 	.small_ops = nl80211_small_ops,
17652 	.n_small_ops = ARRAY_SIZE(nl80211_small_ops),
17653 	.resv_start_op = NL80211_CMD_REMOVE_LINK_STA + 1,
17654 	.mcgrps = nl80211_mcgrps,
17655 	.n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
17656 	.parallel_ops = true,
17657 };
17658 
17659 /* notification functions */
17660 
17661 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
17662 			  enum nl80211_commands cmd)
17663 {
17664 	struct sk_buff *msg;
17665 	struct nl80211_dump_wiphy_state state = {};
17666 
17667 	WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
17668 		cmd != NL80211_CMD_DEL_WIPHY);
17669 
17670 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
17671 	if (!msg)
17672 		return;
17673 
17674 	if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
17675 		nlmsg_free(msg);
17676 		return;
17677 	}
17678 
17679 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
17680 				NL80211_MCGRP_CONFIG, GFP_KERNEL);
17681 }
17682 
17683 void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
17684 				struct wireless_dev *wdev,
17685 				enum nl80211_commands cmd)
17686 {
17687 	struct sk_buff *msg;
17688 
17689 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
17690 	if (!msg)
17691 		return;
17692 
17693 	if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) {
17694 		nlmsg_free(msg);
17695 		return;
17696 	}
17697 
17698 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
17699 				NL80211_MCGRP_CONFIG, GFP_KERNEL);
17700 }
17701 
17702 static int nl80211_add_scan_req(struct sk_buff *msg,
17703 				struct cfg80211_registered_device *rdev)
17704 {
17705 	struct cfg80211_scan_request *req = rdev->scan_req;
17706 	struct nlattr *nest;
17707 	int i;
17708 	struct cfg80211_scan_info *info;
17709 
17710 	if (WARN_ON(!req))
17711 		return 0;
17712 
17713 	nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS);
17714 	if (!nest)
17715 		goto nla_put_failure;
17716 	for (i = 0; i < req->n_ssids; i++) {
17717 		if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
17718 			goto nla_put_failure;
17719 	}
17720 	nla_nest_end(msg, nest);
17721 
17722 	if (req->flags & NL80211_SCAN_FLAG_FREQ_KHZ) {
17723 		nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQ_KHZ);
17724 		if (!nest)
17725 			goto nla_put_failure;
17726 		for (i = 0; i < req->n_channels; i++) {
17727 			if (nla_put_u32(msg, i,
17728 				   ieee80211_channel_to_khz(req->channels[i])))
17729 				goto nla_put_failure;
17730 		}
17731 		nla_nest_end(msg, nest);
17732 	} else {
17733 		nest = nla_nest_start_noflag(msg,
17734 					     NL80211_ATTR_SCAN_FREQUENCIES);
17735 		if (!nest)
17736 			goto nla_put_failure;
17737 		for (i = 0; i < req->n_channels; i++) {
17738 			if (nla_put_u32(msg, i, req->channels[i]->center_freq))
17739 				goto nla_put_failure;
17740 		}
17741 		nla_nest_end(msg, nest);
17742 	}
17743 
17744 	if (req->ie &&
17745 	    nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
17746 		goto nla_put_failure;
17747 
17748 	if (req->flags &&
17749 	    nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
17750 		goto nla_put_failure;
17751 
17752 	info = rdev->int_scan_req ? &rdev->int_scan_req->info :
17753 		&rdev->scan_req->info;
17754 	if (info->scan_start_tsf &&
17755 	    (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
17756 			       info->scan_start_tsf, NL80211_BSS_PAD) ||
17757 	     nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
17758 		     info->tsf_bssid)))
17759 		goto nla_put_failure;
17760 
17761 	return 0;
17762  nla_put_failure:
17763 	return -ENOBUFS;
17764 }
17765 
17766 static int nl80211_prep_scan_msg(struct sk_buff *msg,
17767 				 struct cfg80211_registered_device *rdev,
17768 				 struct wireless_dev *wdev,
17769 				 u32 portid, u32 seq, int flags,
17770 				 u32 cmd)
17771 {
17772 	void *hdr;
17773 
17774 	hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
17775 	if (!hdr)
17776 		return -1;
17777 
17778 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
17779 	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
17780 					 wdev->netdev->ifindex)) ||
17781 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
17782 			      NL80211_ATTR_PAD))
17783 		goto nla_put_failure;
17784 
17785 	/* ignore errors and send incomplete event anyway */
17786 	nl80211_add_scan_req(msg, rdev);
17787 
17788 	genlmsg_end(msg, hdr);
17789 	return 0;
17790 
17791  nla_put_failure:
17792 	genlmsg_cancel(msg, hdr);
17793 	return -EMSGSIZE;
17794 }
17795 
17796 static int
17797 nl80211_prep_sched_scan_msg(struct sk_buff *msg,
17798 			    struct cfg80211_sched_scan_request *req, u32 cmd)
17799 {
17800 	void *hdr;
17801 
17802 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
17803 	if (!hdr)
17804 		return -1;
17805 
17806 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
17807 			wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
17808 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
17809 	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
17810 			      NL80211_ATTR_PAD))
17811 		goto nla_put_failure;
17812 
17813 	genlmsg_end(msg, hdr);
17814 	return 0;
17815 
17816  nla_put_failure:
17817 	genlmsg_cancel(msg, hdr);
17818 	return -EMSGSIZE;
17819 }
17820 
17821 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
17822 			     struct wireless_dev *wdev)
17823 {
17824 	struct sk_buff *msg;
17825 
17826 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
17827 	if (!msg)
17828 		return;
17829 
17830 	if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
17831 				  NL80211_CMD_TRIGGER_SCAN) < 0) {
17832 		nlmsg_free(msg);
17833 		return;
17834 	}
17835 
17836 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
17837 				NL80211_MCGRP_SCAN, GFP_KERNEL);
17838 }
17839 
17840 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
17841 				       struct wireless_dev *wdev, bool aborted)
17842 {
17843 	struct sk_buff *msg;
17844 
17845 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
17846 	if (!msg)
17847 		return NULL;
17848 
17849 	if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
17850 				  aborted ? NL80211_CMD_SCAN_ABORTED :
17851 					    NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
17852 		nlmsg_free(msg);
17853 		return NULL;
17854 	}
17855 
17856 	return msg;
17857 }
17858 
17859 /* send message created by nl80211_build_scan_msg() */
17860 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
17861 			   struct sk_buff *msg)
17862 {
17863 	if (!msg)
17864 		return;
17865 
17866 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
17867 				NL80211_MCGRP_SCAN, GFP_KERNEL);
17868 }
17869 
17870 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
17871 {
17872 	struct sk_buff *msg;
17873 
17874 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
17875 	if (!msg)
17876 		return;
17877 
17878 	if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
17879 		nlmsg_free(msg);
17880 		return;
17881 	}
17882 
17883 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
17884 				NL80211_MCGRP_SCAN, GFP_KERNEL);
17885 }
17886 
17887 static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
17888 					  struct regulatory_request *request)
17889 {
17890 	/* Userspace can always count this one always being set */
17891 	if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
17892 		goto nla_put_failure;
17893 
17894 	if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
17895 		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
17896 			       NL80211_REGDOM_TYPE_WORLD))
17897 			goto nla_put_failure;
17898 	} else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
17899 		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
17900 			       NL80211_REGDOM_TYPE_CUSTOM_WORLD))
17901 			goto nla_put_failure;
17902 	} else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
17903 		   request->intersect) {
17904 		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
17905 			       NL80211_REGDOM_TYPE_INTERSECTION))
17906 			goto nla_put_failure;
17907 	} else {
17908 		if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
17909 			       NL80211_REGDOM_TYPE_COUNTRY) ||
17910 		    nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
17911 				   request->alpha2))
17912 			goto nla_put_failure;
17913 	}
17914 
17915 	if (request->wiphy_idx != WIPHY_IDX_INVALID) {
17916 		struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
17917 
17918 		if (wiphy &&
17919 		    nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
17920 			goto nla_put_failure;
17921 
17922 		if (wiphy &&
17923 		    wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
17924 		    nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
17925 			goto nla_put_failure;
17926 	}
17927 
17928 	return true;
17929 
17930 nla_put_failure:
17931 	return false;
17932 }
17933 
17934 /*
17935  * This can happen on global regulatory changes or device specific settings
17936  * based on custom regulatory domains.
17937  */
17938 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
17939 				     struct regulatory_request *request)
17940 {
17941 	struct sk_buff *msg;
17942 	void *hdr;
17943 
17944 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
17945 	if (!msg)
17946 		return;
17947 
17948 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
17949 	if (!hdr)
17950 		goto nla_put_failure;
17951 
17952 	if (!nl80211_reg_change_event_fill(msg, request))
17953 		goto nla_put_failure;
17954 
17955 	genlmsg_end(msg, hdr);
17956 
17957 	genlmsg_multicast_allns(&nl80211_fam, msg, 0,
17958 				NL80211_MCGRP_REGULATORY);
17959 
17960 	return;
17961 
17962 nla_put_failure:
17963 	nlmsg_free(msg);
17964 }
17965 
17966 struct nl80211_mlme_event {
17967 	enum nl80211_commands cmd;
17968 	const u8 *buf;
17969 	size_t buf_len;
17970 	int uapsd_queues;
17971 	const u8 *req_ies;
17972 	size_t req_ies_len;
17973 	bool reconnect;
17974 };
17975 
17976 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
17977 				    struct net_device *netdev,
17978 				    const struct nl80211_mlme_event *event,
17979 				    gfp_t gfp)
17980 {
17981 	struct sk_buff *msg;
17982 	void *hdr;
17983 
17984 	msg = nlmsg_new(100 + event->buf_len + event->req_ies_len, gfp);
17985 	if (!msg)
17986 		return;
17987 
17988 	hdr = nl80211hdr_put(msg, 0, 0, 0, event->cmd);
17989 	if (!hdr) {
17990 		nlmsg_free(msg);
17991 		return;
17992 	}
17993 
17994 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
17995 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
17996 	    nla_put(msg, NL80211_ATTR_FRAME, event->buf_len, event->buf) ||
17997 	    (event->req_ies &&
17998 	     nla_put(msg, NL80211_ATTR_REQ_IE, event->req_ies_len,
17999 		     event->req_ies)))
18000 		goto nla_put_failure;
18001 
18002 	if (event->reconnect &&
18003 	    nla_put_flag(msg, NL80211_ATTR_RECONNECT_REQUESTED))
18004 		goto nla_put_failure;
18005 
18006 	if (event->uapsd_queues >= 0) {
18007 		struct nlattr *nla_wmm =
18008 			nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME);
18009 		if (!nla_wmm)
18010 			goto nla_put_failure;
18011 
18012 		if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
18013 			       event->uapsd_queues))
18014 			goto nla_put_failure;
18015 
18016 		nla_nest_end(msg, nla_wmm);
18017 	}
18018 
18019 	genlmsg_end(msg, hdr);
18020 
18021 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18022 				NL80211_MCGRP_MLME, gfp);
18023 	return;
18024 
18025  nla_put_failure:
18026 	nlmsg_free(msg);
18027 }
18028 
18029 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
18030 			  struct net_device *netdev, const u8 *buf,
18031 			  size_t len, gfp_t gfp)
18032 {
18033 	struct nl80211_mlme_event event = {
18034 		.cmd = NL80211_CMD_AUTHENTICATE,
18035 		.buf = buf,
18036 		.buf_len = len,
18037 		.uapsd_queues = -1,
18038 	};
18039 
18040 	nl80211_send_mlme_event(rdev, netdev, &event, gfp);
18041 }
18042 
18043 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
18044 			   struct net_device *netdev,
18045 			   const struct cfg80211_rx_assoc_resp_data *data)
18046 {
18047 	struct nl80211_mlme_event event = {
18048 		.cmd = NL80211_CMD_ASSOCIATE,
18049 		.buf = data->buf,
18050 		.buf_len = data->len,
18051 		.uapsd_queues = data->uapsd_queues,
18052 		.req_ies = data->req_ies,
18053 		.req_ies_len = data->req_ies_len,
18054 	};
18055 
18056 	nl80211_send_mlme_event(rdev, netdev, &event, GFP_KERNEL);
18057 }
18058 
18059 void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
18060 			 struct net_device *netdev, const u8 *buf,
18061 			 size_t len, bool reconnect, gfp_t gfp)
18062 {
18063 	struct nl80211_mlme_event event = {
18064 		.cmd = NL80211_CMD_DEAUTHENTICATE,
18065 		.buf = buf,
18066 		.buf_len = len,
18067 		.reconnect = reconnect,
18068 		.uapsd_queues = -1,
18069 	};
18070 
18071 	nl80211_send_mlme_event(rdev, netdev, &event, gfp);
18072 }
18073 
18074 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
18075 			   struct net_device *netdev, const u8 *buf,
18076 			   size_t len, bool reconnect, gfp_t gfp)
18077 {
18078 	struct nl80211_mlme_event event = {
18079 		.cmd = NL80211_CMD_DISASSOCIATE,
18080 		.buf = buf,
18081 		.buf_len = len,
18082 		.reconnect = reconnect,
18083 		.uapsd_queues = -1,
18084 	};
18085 
18086 	nl80211_send_mlme_event(rdev, netdev, &event, gfp);
18087 }
18088 
18089 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
18090 				  size_t len)
18091 {
18092 	struct wireless_dev *wdev = dev->ieee80211_ptr;
18093 	struct wiphy *wiphy = wdev->wiphy;
18094 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
18095 	const struct ieee80211_mgmt *mgmt = (void *)buf;
18096 	struct nl80211_mlme_event event = {
18097 		.buf = buf,
18098 		.buf_len = len,
18099 		.uapsd_queues = -1,
18100 	};
18101 
18102 	if (WARN_ON(len < 2))
18103 		return;
18104 
18105 	if (ieee80211_is_deauth(mgmt->frame_control)) {
18106 		event.cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
18107 	} else if (ieee80211_is_disassoc(mgmt->frame_control)) {
18108 		event.cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
18109 	} else if (ieee80211_is_beacon(mgmt->frame_control)) {
18110 		if (wdev->unprot_beacon_reported &&
18111 		    elapsed_jiffies_msecs(wdev->unprot_beacon_reported) < 10000)
18112 			return;
18113 		event.cmd = NL80211_CMD_UNPROT_BEACON;
18114 		wdev->unprot_beacon_reported = jiffies;
18115 	} else {
18116 		return;
18117 	}
18118 
18119 	trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
18120 	nl80211_send_mlme_event(rdev, dev, &event, GFP_ATOMIC);
18121 }
18122 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
18123 
18124 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
18125 				      struct net_device *netdev, int cmd,
18126 				      const u8 *addr, gfp_t gfp)
18127 {
18128 	struct sk_buff *msg;
18129 	void *hdr;
18130 
18131 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
18132 	if (!msg)
18133 		return;
18134 
18135 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
18136 	if (!hdr) {
18137 		nlmsg_free(msg);
18138 		return;
18139 	}
18140 
18141 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18142 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
18143 	    nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
18144 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
18145 		goto nla_put_failure;
18146 
18147 	genlmsg_end(msg, hdr);
18148 
18149 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18150 				NL80211_MCGRP_MLME, gfp);
18151 	return;
18152 
18153  nla_put_failure:
18154 	nlmsg_free(msg);
18155 }
18156 
18157 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
18158 			       struct net_device *netdev, const u8 *addr,
18159 			       gfp_t gfp)
18160 {
18161 	nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
18162 				  addr, gfp);
18163 }
18164 
18165 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
18166 				struct net_device *netdev, const u8 *addr,
18167 				gfp_t gfp)
18168 {
18169 	nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
18170 				  addr, gfp);
18171 }
18172 
18173 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
18174 				 struct net_device *netdev,
18175 				 struct cfg80211_connect_resp_params *cr,
18176 				 gfp_t gfp)
18177 {
18178 	struct sk_buff *msg;
18179 	void *hdr;
18180 	unsigned int link;
18181 	size_t link_info_size = 0;
18182 	const u8 *connected_addr = cr->valid_links ?
18183 				   cr->ap_mld_addr : cr->links[0].bssid;
18184 
18185 	if (cr->valid_links) {
18186 		for_each_valid_link(cr, link) {
18187 			/* Nested attribute header */
18188 			link_info_size += NLA_HDRLEN;
18189 			/* Link ID */
18190 			link_info_size += nla_total_size(sizeof(u8));
18191 			link_info_size += cr->links[link].addr ?
18192 					  nla_total_size(ETH_ALEN) : 0;
18193 			link_info_size += (cr->links[link].bssid ||
18194 					   cr->links[link].bss) ?
18195 					  nla_total_size(ETH_ALEN) : 0;
18196 			link_info_size += nla_total_size(sizeof(u16));
18197 		}
18198 	}
18199 
18200 	msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
18201 			cr->fils.kek_len + cr->fils.pmk_len +
18202 			(cr->fils.pmkid ? WLAN_PMKID_LEN : 0) + link_info_size,
18203 			gfp);
18204 	if (!msg)
18205 		return;
18206 
18207 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
18208 	if (!hdr) {
18209 		nlmsg_free(msg);
18210 		return;
18211 	}
18212 
18213 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18214 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
18215 	    (connected_addr &&
18216 	     nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr)) ||
18217 	    nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
18218 			cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
18219 			cr->status) ||
18220 	    (cr->status < 0 &&
18221 	     (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
18222 	      nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
18223 			  cr->timeout_reason))) ||
18224 	    (cr->req_ie &&
18225 	     nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
18226 	    (cr->resp_ie &&
18227 	     nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
18228 		     cr->resp_ie)) ||
18229 	    (cr->fils.update_erp_next_seq_num &&
18230 	     nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
18231 			 cr->fils.erp_next_seq_num)) ||
18232 	    (cr->status == WLAN_STATUS_SUCCESS &&
18233 	     ((cr->fils.kek &&
18234 	       nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len,
18235 		       cr->fils.kek)) ||
18236 	      (cr->fils.pmk &&
18237 	       nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) ||
18238 	      (cr->fils.pmkid &&
18239 	       nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid)))))
18240 		goto nla_put_failure;
18241 
18242 	if (cr->valid_links) {
18243 		int i = 1;
18244 		struct nlattr *nested;
18245 
18246 		nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS);
18247 		if (!nested)
18248 			goto nla_put_failure;
18249 
18250 		for_each_valid_link(cr, link) {
18251 			struct nlattr *nested_mlo_links;
18252 			const u8 *bssid = cr->links[link].bss ?
18253 					  cr->links[link].bss->bssid :
18254 					  cr->links[link].bssid;
18255 
18256 			nested_mlo_links = nla_nest_start(msg, i);
18257 			if (!nested_mlo_links)
18258 				goto nla_put_failure;
18259 
18260 			if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) ||
18261 			    (bssid &&
18262 			     nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) ||
18263 			    (cr->links[link].addr &&
18264 			     nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
18265 				     cr->links[link].addr)) ||
18266 			    nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
18267 					cr->links[link].status))
18268 				goto nla_put_failure;
18269 
18270 			nla_nest_end(msg, nested_mlo_links);
18271 			i++;
18272 		}
18273 		nla_nest_end(msg, nested);
18274 	}
18275 
18276 	genlmsg_end(msg, hdr);
18277 
18278 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18279 				NL80211_MCGRP_MLME, gfp);
18280 	return;
18281 
18282  nla_put_failure:
18283 	nlmsg_free(msg);
18284 }
18285 
18286 void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
18287 			 struct net_device *netdev,
18288 			 struct cfg80211_roam_info *info, gfp_t gfp)
18289 {
18290 	struct sk_buff *msg;
18291 	void *hdr;
18292 	size_t link_info_size = 0;
18293 	unsigned int link;
18294 	const u8 *connected_addr = info->ap_mld_addr ?
18295 				   info->ap_mld_addr :
18296 				   (info->links[0].bss ?
18297 				    info->links[0].bss->bssid :
18298 				    info->links[0].bssid);
18299 
18300 	if (info->valid_links) {
18301 		for_each_valid_link(info, link) {
18302 			/* Nested attribute header */
18303 			link_info_size += NLA_HDRLEN;
18304 			/* Link ID */
18305 			link_info_size += nla_total_size(sizeof(u8));
18306 			link_info_size += info->links[link].addr ?
18307 					  nla_total_size(ETH_ALEN) : 0;
18308 			link_info_size += (info->links[link].bssid ||
18309 					   info->links[link].bss) ?
18310 					  nla_total_size(ETH_ALEN) : 0;
18311 		}
18312 	}
18313 
18314 	msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len +
18315 			info->fils.kek_len + info->fils.pmk_len +
18316 			(info->fils.pmkid ? WLAN_PMKID_LEN : 0) +
18317 			link_info_size, gfp);
18318 	if (!msg)
18319 		return;
18320 
18321 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
18322 	if (!hdr) {
18323 		nlmsg_free(msg);
18324 		return;
18325 	}
18326 
18327 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18328 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
18329 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr) ||
18330 	    (info->req_ie &&
18331 	     nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
18332 		     info->req_ie)) ||
18333 	    (info->resp_ie &&
18334 	     nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
18335 		     info->resp_ie)) ||
18336 	    (info->fils.update_erp_next_seq_num &&
18337 	     nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
18338 			 info->fils.erp_next_seq_num)) ||
18339 	    (info->fils.kek &&
18340 	     nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len,
18341 		     info->fils.kek)) ||
18342 	    (info->fils.pmk &&
18343 	     nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) ||
18344 	    (info->fils.pmkid &&
18345 	     nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid)))
18346 		goto nla_put_failure;
18347 
18348 	if (info->valid_links) {
18349 		int i = 1;
18350 		struct nlattr *nested;
18351 
18352 		nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS);
18353 		if (!nested)
18354 			goto nla_put_failure;
18355 
18356 		for_each_valid_link(info, link) {
18357 			struct nlattr *nested_mlo_links;
18358 			const u8 *bssid = info->links[link].bss ?
18359 					  info->links[link].bss->bssid :
18360 					  info->links[link].bssid;
18361 
18362 			nested_mlo_links = nla_nest_start(msg, i);
18363 			if (!nested_mlo_links)
18364 				goto nla_put_failure;
18365 
18366 			if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) ||
18367 			    (bssid &&
18368 			     nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) ||
18369 			    (info->links[link].addr &&
18370 			     nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
18371 				     info->links[link].addr)))
18372 				goto nla_put_failure;
18373 
18374 			nla_nest_end(msg, nested_mlo_links);
18375 			i++;
18376 		}
18377 		nla_nest_end(msg, nested);
18378 	}
18379 
18380 	genlmsg_end(msg, hdr);
18381 
18382 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18383 				NL80211_MCGRP_MLME, gfp);
18384 	return;
18385 
18386  nla_put_failure:
18387 	nlmsg_free(msg);
18388 }
18389 
18390 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev,
18391 				  struct net_device *netdev, const u8 *peer_addr,
18392 				  const u8 *td_bitmap, u8 td_bitmap_len)
18393 {
18394 	struct sk_buff *msg;
18395 	void *hdr;
18396 
18397 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
18398 	if (!msg)
18399 		return;
18400 
18401 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED);
18402 	if (!hdr) {
18403 		nlmsg_free(msg);
18404 		return;
18405 	}
18406 
18407 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18408 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
18409 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer_addr))
18410 		goto nla_put_failure;
18411 
18412 	if ((td_bitmap_len > 0) && td_bitmap)
18413 		if (nla_put(msg, NL80211_ATTR_TD_BITMAP,
18414 			    td_bitmap_len, td_bitmap))
18415 			goto nla_put_failure;
18416 
18417 	genlmsg_end(msg, hdr);
18418 
18419 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18420 				NL80211_MCGRP_MLME, GFP_KERNEL);
18421 	return;
18422 
18423  nla_put_failure:
18424 	nlmsg_free(msg);
18425 }
18426 
18427 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
18428 			       struct net_device *netdev, u16 reason,
18429 			       const u8 *ie, size_t ie_len, bool from_ap)
18430 {
18431 	struct sk_buff *msg;
18432 	void *hdr;
18433 
18434 	msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
18435 	if (!msg)
18436 		return;
18437 
18438 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
18439 	if (!hdr) {
18440 		nlmsg_free(msg);
18441 		return;
18442 	}
18443 
18444 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18445 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
18446 	    (reason &&
18447 	     nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
18448 	    (from_ap &&
18449 	     nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
18450 	    (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
18451 		goto nla_put_failure;
18452 
18453 	genlmsg_end(msg, hdr);
18454 
18455 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18456 				NL80211_MCGRP_MLME, GFP_KERNEL);
18457 	return;
18458 
18459  nla_put_failure:
18460 	nlmsg_free(msg);
18461 }
18462 
18463 void cfg80211_links_removed(struct net_device *dev, u16 link_mask)
18464 {
18465 	struct wireless_dev *wdev = dev->ieee80211_ptr;
18466 	struct wiphy *wiphy = wdev->wiphy;
18467 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
18468 	struct sk_buff *msg;
18469 	struct nlattr *links;
18470 	void *hdr;
18471 
18472 	lockdep_assert_wiphy(wdev->wiphy);
18473 	trace_cfg80211_links_removed(dev, link_mask);
18474 
18475 	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION &&
18476 		    wdev->iftype != NL80211_IFTYPE_P2P_CLIENT))
18477 		return;
18478 
18479 	if (WARN_ON(!wdev->valid_links || !link_mask ||
18480 		    (wdev->valid_links & link_mask) != link_mask ||
18481 		    wdev->valid_links == link_mask))
18482 		return;
18483 
18484 	cfg80211_wdev_release_link_bsses(wdev, link_mask);
18485 	wdev->valid_links &= ~link_mask;
18486 
18487 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
18488 	if (!msg)
18489 		return;
18490 
18491 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_LINKS_REMOVED);
18492 	if (!hdr) {
18493 		nlmsg_free(msg);
18494 		return;
18495 	}
18496 
18497 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18498 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
18499 		goto nla_put_failure;
18500 
18501 	links = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS);
18502 	if (!links)
18503 		goto nla_put_failure;
18504 
18505 	while (link_mask) {
18506 		struct nlattr *link;
18507 		int link_id = __ffs(link_mask);
18508 
18509 		link = nla_nest_start(msg, link_id + 1);
18510 		if (!link)
18511 			goto nla_put_failure;
18512 
18513 		if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))
18514 			goto nla_put_failure;
18515 
18516 		nla_nest_end(msg, link);
18517 		link_mask &= ~(1 << link_id);
18518 	}
18519 
18520 	nla_nest_end(msg, links);
18521 
18522 	genlmsg_end(msg, hdr);
18523 
18524 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18525 				NL80211_MCGRP_MLME, GFP_KERNEL);
18526 	return;
18527 
18528  nla_put_failure:
18529 	nlmsg_free(msg);
18530 }
18531 EXPORT_SYMBOL(cfg80211_links_removed);
18532 
18533 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
18534 			     struct net_device *netdev, const u8 *bssid,
18535 			     gfp_t gfp)
18536 {
18537 	struct sk_buff *msg;
18538 	void *hdr;
18539 
18540 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
18541 	if (!msg)
18542 		return;
18543 
18544 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
18545 	if (!hdr) {
18546 		nlmsg_free(msg);
18547 		return;
18548 	}
18549 
18550 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18551 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
18552 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
18553 		goto nla_put_failure;
18554 
18555 	genlmsg_end(msg, hdr);
18556 
18557 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18558 				NL80211_MCGRP_MLME, gfp);
18559 	return;
18560 
18561  nla_put_failure:
18562 	nlmsg_free(msg);
18563 }
18564 
18565 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
18566 					const u8 *ie, u8 ie_len,
18567 					int sig_dbm, gfp_t gfp)
18568 {
18569 	struct wireless_dev *wdev = dev->ieee80211_ptr;
18570 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
18571 	struct sk_buff *msg;
18572 	void *hdr;
18573 
18574 	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
18575 		return;
18576 
18577 	trace_cfg80211_notify_new_peer_candidate(dev, addr);
18578 
18579 	msg = nlmsg_new(100 + ie_len, gfp);
18580 	if (!msg)
18581 		return;
18582 
18583 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
18584 	if (!hdr) {
18585 		nlmsg_free(msg);
18586 		return;
18587 	}
18588 
18589 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18590 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
18591 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
18592 	    (ie_len && ie &&
18593 	     nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) ||
18594 	    (sig_dbm &&
18595 	     nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)))
18596 		goto nla_put_failure;
18597 
18598 	genlmsg_end(msg, hdr);
18599 
18600 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18601 				NL80211_MCGRP_MLME, gfp);
18602 	return;
18603 
18604  nla_put_failure:
18605 	nlmsg_free(msg);
18606 }
18607 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
18608 
18609 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
18610 				 struct net_device *netdev, const u8 *addr,
18611 				 enum nl80211_key_type key_type, int key_id,
18612 				 const u8 *tsc, gfp_t gfp)
18613 {
18614 	struct sk_buff *msg;
18615 	void *hdr;
18616 
18617 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
18618 	if (!msg)
18619 		return;
18620 
18621 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
18622 	if (!hdr) {
18623 		nlmsg_free(msg);
18624 		return;
18625 	}
18626 
18627 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18628 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
18629 	    (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
18630 	    nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
18631 	    (key_id != -1 &&
18632 	     nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
18633 	    (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
18634 		goto nla_put_failure;
18635 
18636 	genlmsg_end(msg, hdr);
18637 
18638 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18639 				NL80211_MCGRP_MLME, gfp);
18640 	return;
18641 
18642  nla_put_failure:
18643 	nlmsg_free(msg);
18644 }
18645 
18646 void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
18647 				    struct ieee80211_channel *channel_before,
18648 				    struct ieee80211_channel *channel_after)
18649 {
18650 	struct sk_buff *msg;
18651 	void *hdr;
18652 	struct nlattr *nl_freq;
18653 
18654 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
18655 	if (!msg)
18656 		return;
18657 
18658 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
18659 	if (!hdr) {
18660 		nlmsg_free(msg);
18661 		return;
18662 	}
18663 
18664 	/*
18665 	 * Since we are applying the beacon hint to a wiphy we know its
18666 	 * wiphy_idx is valid
18667 	 */
18668 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
18669 		goto nla_put_failure;
18670 
18671 	/* Before */
18672 	nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE);
18673 	if (!nl_freq)
18674 		goto nla_put_failure;
18675 
18676 	if (nl80211_msg_put_channel(msg, wiphy, channel_before, false))
18677 		goto nla_put_failure;
18678 	nla_nest_end(msg, nl_freq);
18679 
18680 	/* After */
18681 	nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER);
18682 	if (!nl_freq)
18683 		goto nla_put_failure;
18684 
18685 	if (nl80211_msg_put_channel(msg, wiphy, channel_after, false))
18686 		goto nla_put_failure;
18687 	nla_nest_end(msg, nl_freq);
18688 
18689 	genlmsg_end(msg, hdr);
18690 
18691 	genlmsg_multicast_allns(&nl80211_fam, msg, 0,
18692 				NL80211_MCGRP_REGULATORY);
18693 
18694 	return;
18695 
18696 nla_put_failure:
18697 	nlmsg_free(msg);
18698 }
18699 
18700 static void nl80211_send_remain_on_chan_event(
18701 	int cmd, struct cfg80211_registered_device *rdev,
18702 	struct wireless_dev *wdev, u64 cookie,
18703 	struct ieee80211_channel *chan,
18704 	unsigned int duration, gfp_t gfp)
18705 {
18706 	struct sk_buff *msg;
18707 	void *hdr;
18708 
18709 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
18710 	if (!msg)
18711 		return;
18712 
18713 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
18714 	if (!hdr) {
18715 		nlmsg_free(msg);
18716 		return;
18717 	}
18718 
18719 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18720 	    (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
18721 					 wdev->netdev->ifindex)) ||
18722 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
18723 			      NL80211_ATTR_PAD) ||
18724 	    nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
18725 	    nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
18726 			NL80211_CHAN_NO_HT) ||
18727 	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
18728 			      NL80211_ATTR_PAD))
18729 		goto nla_put_failure;
18730 
18731 	if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
18732 	    nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
18733 		goto nla_put_failure;
18734 
18735 	genlmsg_end(msg, hdr);
18736 
18737 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18738 				NL80211_MCGRP_MLME, gfp);
18739 	return;
18740 
18741  nla_put_failure:
18742 	nlmsg_free(msg);
18743 }
18744 
18745 void cfg80211_assoc_comeback(struct net_device *netdev,
18746 			     const u8 *ap_addr, u32 timeout)
18747 {
18748 	struct wireless_dev *wdev = netdev->ieee80211_ptr;
18749 	struct wiphy *wiphy = wdev->wiphy;
18750 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
18751 	struct sk_buff *msg;
18752 	void *hdr;
18753 
18754 	trace_cfg80211_assoc_comeback(wdev, ap_addr, timeout);
18755 
18756 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
18757 	if (!msg)
18758 		return;
18759 
18760 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ASSOC_COMEBACK);
18761 	if (!hdr) {
18762 		nlmsg_free(msg);
18763 		return;
18764 	}
18765 
18766 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18767 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
18768 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ap_addr) ||
18769 	    nla_put_u32(msg, NL80211_ATTR_TIMEOUT, timeout))
18770 		goto nla_put_failure;
18771 
18772 	genlmsg_end(msg, hdr);
18773 
18774 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18775 				NL80211_MCGRP_MLME, GFP_KERNEL);
18776 	return;
18777 
18778  nla_put_failure:
18779 	nlmsg_free(msg);
18780 }
18781 EXPORT_SYMBOL(cfg80211_assoc_comeback);
18782 
18783 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
18784 			       struct ieee80211_channel *chan,
18785 			       unsigned int duration, gfp_t gfp)
18786 {
18787 	struct wiphy *wiphy = wdev->wiphy;
18788 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
18789 
18790 	trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
18791 	nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
18792 					  rdev, wdev, cookie, chan,
18793 					  duration, gfp);
18794 }
18795 EXPORT_SYMBOL(cfg80211_ready_on_channel);
18796 
18797 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
18798 					struct ieee80211_channel *chan,
18799 					gfp_t gfp)
18800 {
18801 	struct wiphy *wiphy = wdev->wiphy;
18802 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
18803 
18804 	trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
18805 	nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
18806 					  rdev, wdev, cookie, chan, 0, gfp);
18807 }
18808 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
18809 
18810 void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie,
18811 					struct ieee80211_channel *chan,
18812 					gfp_t gfp)
18813 {
18814 	struct wiphy *wiphy = wdev->wiphy;
18815 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
18816 
18817 	trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan);
18818 	nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL,
18819 					  rdev, wdev, cookie, chan, 0, gfp);
18820 }
18821 EXPORT_SYMBOL(cfg80211_tx_mgmt_expired);
18822 
18823 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
18824 		      struct station_info *sinfo, gfp_t gfp)
18825 {
18826 	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
18827 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
18828 	struct sk_buff *msg;
18829 
18830 	trace_cfg80211_new_sta(dev, mac_addr, sinfo);
18831 
18832 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
18833 	if (!msg)
18834 		return;
18835 
18836 	if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
18837 				 rdev, dev, mac_addr, sinfo) < 0) {
18838 		nlmsg_free(msg);
18839 		return;
18840 	}
18841 
18842 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18843 				NL80211_MCGRP_MLME, gfp);
18844 }
18845 EXPORT_SYMBOL(cfg80211_new_sta);
18846 
18847 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
18848 			    struct station_info *sinfo, gfp_t gfp)
18849 {
18850 	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
18851 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
18852 	struct sk_buff *msg;
18853 	struct station_info empty_sinfo = {};
18854 
18855 	if (!sinfo)
18856 		sinfo = &empty_sinfo;
18857 
18858 	trace_cfg80211_del_sta(dev, mac_addr);
18859 
18860 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
18861 	if (!msg) {
18862 		cfg80211_sinfo_release_content(sinfo);
18863 		return;
18864 	}
18865 
18866 	if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
18867 				 rdev, dev, mac_addr, sinfo) < 0) {
18868 		nlmsg_free(msg);
18869 		return;
18870 	}
18871 
18872 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18873 				NL80211_MCGRP_MLME, gfp);
18874 }
18875 EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
18876 
18877 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
18878 			  enum nl80211_connect_failed_reason reason,
18879 			  gfp_t gfp)
18880 {
18881 	struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
18882 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
18883 	struct sk_buff *msg;
18884 	void *hdr;
18885 
18886 	msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
18887 	if (!msg)
18888 		return;
18889 
18890 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
18891 	if (!hdr) {
18892 		nlmsg_free(msg);
18893 		return;
18894 	}
18895 
18896 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
18897 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
18898 	    nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
18899 		goto nla_put_failure;
18900 
18901 	genlmsg_end(msg, hdr);
18902 
18903 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
18904 				NL80211_MCGRP_MLME, gfp);
18905 	return;
18906 
18907  nla_put_failure:
18908 	nlmsg_free(msg);
18909 }
18910 EXPORT_SYMBOL(cfg80211_conn_failed);
18911 
18912 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
18913 				       const u8 *addr, gfp_t gfp)
18914 {
18915 	struct wireless_dev *wdev = dev->ieee80211_ptr;
18916 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
18917 	struct sk_buff *msg;
18918 	void *hdr;
18919 	u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid);
18920 
18921 	if (!nlportid)
18922 		return false;
18923 
18924 	msg = nlmsg_new(100, gfp);
18925 	if (!msg)
18926 		return true;
18927 
18928 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
18929 	if (!hdr) {
18930 		nlmsg_free(msg);
18931 		return true;
18932 	}
18933 
18934 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
18935 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
18936 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
18937 		goto nla_put_failure;
18938 
18939 	genlmsg_end(msg, hdr);
18940 	genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
18941 	return true;
18942 
18943  nla_put_failure:
18944 	nlmsg_free(msg);
18945 	return true;
18946 }
18947 
18948 bool cfg80211_rx_spurious_frame(struct net_device *dev,
18949 				const u8 *addr, gfp_t gfp)
18950 {
18951 	struct wireless_dev *wdev = dev->ieee80211_ptr;
18952 	bool ret;
18953 
18954 	trace_cfg80211_rx_spurious_frame(dev, addr);
18955 
18956 	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
18957 		    wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
18958 		trace_cfg80211_return_bool(false);
18959 		return false;
18960 	}
18961 	ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
18962 					 addr, gfp);
18963 	trace_cfg80211_return_bool(ret);
18964 	return ret;
18965 }
18966 EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
18967 
18968 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
18969 					const u8 *addr, gfp_t gfp)
18970 {
18971 	struct wireless_dev *wdev = dev->ieee80211_ptr;
18972 	bool ret;
18973 
18974 	trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
18975 
18976 	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
18977 		    wdev->iftype != NL80211_IFTYPE_P2P_GO &&
18978 		    wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
18979 		trace_cfg80211_return_bool(false);
18980 		return false;
18981 	}
18982 	ret = __nl80211_unexpected_frame(dev,
18983 					 NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
18984 					 addr, gfp);
18985 	trace_cfg80211_return_bool(ret);
18986 	return ret;
18987 }
18988 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
18989 
18990 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
18991 		      struct wireless_dev *wdev, u32 nlportid,
18992 		      struct cfg80211_rx_info *info, gfp_t gfp)
18993 {
18994 	struct net_device *netdev = wdev->netdev;
18995 	struct sk_buff *msg;
18996 	void *hdr;
18997 
18998 	msg = nlmsg_new(100 + info->len, gfp);
18999 	if (!msg)
19000 		return -ENOMEM;
19001 
19002 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
19003 	if (!hdr) {
19004 		nlmsg_free(msg);
19005 		return -ENOMEM;
19006 	}
19007 
19008 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
19009 	    (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
19010 					netdev->ifindex)) ||
19011 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
19012 			      NL80211_ATTR_PAD) ||
19013 	    (info->have_link_id &&
19014 	     nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, info->link_id)) ||
19015 	    nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, KHZ_TO_MHZ(info->freq)) ||
19016 	    nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, info->freq % 1000) ||
19017 	    (info->sig_dbm &&
19018 	     nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, info->sig_dbm)) ||
19019 	    nla_put(msg, NL80211_ATTR_FRAME, info->len, info->buf) ||
19020 	    (info->flags &&
19021 	     nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, info->flags)) ||
19022 	    (info->rx_tstamp && nla_put_u64_64bit(msg,
19023 						  NL80211_ATTR_RX_HW_TIMESTAMP,
19024 						  info->rx_tstamp,
19025 						  NL80211_ATTR_PAD)) ||
19026 	    (info->ack_tstamp && nla_put_u64_64bit(msg,
19027 						   NL80211_ATTR_TX_HW_TIMESTAMP,
19028 						   info->ack_tstamp,
19029 						   NL80211_ATTR_PAD)))
19030 		goto nla_put_failure;
19031 
19032 	genlmsg_end(msg, hdr);
19033 
19034 	return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
19035 
19036  nla_put_failure:
19037 	nlmsg_free(msg);
19038 	return -ENOBUFS;
19039 }
19040 
19041 static void nl80211_frame_tx_status(struct wireless_dev *wdev,
19042 				    struct cfg80211_tx_status *status,
19043 				    gfp_t gfp, enum nl80211_commands command)
19044 {
19045 	struct wiphy *wiphy = wdev->wiphy;
19046 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
19047 	struct net_device *netdev = wdev->netdev;
19048 	struct sk_buff *msg;
19049 	void *hdr;
19050 
19051 	if (command == NL80211_CMD_FRAME_TX_STATUS)
19052 		trace_cfg80211_mgmt_tx_status(wdev, status->cookie,
19053 					      status->ack);
19054 	else
19055 		trace_cfg80211_control_port_tx_status(wdev, status->cookie,
19056 						      status->ack);
19057 
19058 	msg = nlmsg_new(100 + status->len, gfp);
19059 	if (!msg)
19060 		return;
19061 
19062 	hdr = nl80211hdr_put(msg, 0, 0, 0, command);
19063 	if (!hdr) {
19064 		nlmsg_free(msg);
19065 		return;
19066 	}
19067 
19068 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
19069 	    (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
19070 				   netdev->ifindex)) ||
19071 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
19072 			      NL80211_ATTR_PAD) ||
19073 	    nla_put(msg, NL80211_ATTR_FRAME, status->len, status->buf) ||
19074 	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, status->cookie,
19075 			      NL80211_ATTR_PAD) ||
19076 	    (status->ack && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
19077 	    (status->tx_tstamp &&
19078 	     nla_put_u64_64bit(msg, NL80211_ATTR_TX_HW_TIMESTAMP,
19079 			       status->tx_tstamp, NL80211_ATTR_PAD)) ||
19080 	    (status->ack_tstamp &&
19081 	     nla_put_u64_64bit(msg, NL80211_ATTR_RX_HW_TIMESTAMP,
19082 			       status->ack_tstamp, NL80211_ATTR_PAD)))
19083 		goto nla_put_failure;
19084 
19085 	genlmsg_end(msg, hdr);
19086 
19087 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
19088 				NL80211_MCGRP_MLME, gfp);
19089 	return;
19090 
19091 nla_put_failure:
19092 	nlmsg_free(msg);
19093 }
19094 
19095 void cfg80211_control_port_tx_status(struct wireless_dev *wdev, u64 cookie,
19096 				     const u8 *buf, size_t len, bool ack,
19097 				     gfp_t gfp)
19098 {
19099 	struct cfg80211_tx_status status = {
19100 		.cookie = cookie,
19101 		.buf = buf,
19102 		.len = len,
19103 		.ack = ack
19104 	};
19105 
19106 	nl80211_frame_tx_status(wdev, &status, gfp,
19107 				NL80211_CMD_CONTROL_PORT_FRAME_TX_STATUS);
19108 }
19109 EXPORT_SYMBOL(cfg80211_control_port_tx_status);
19110 
19111 void cfg80211_mgmt_tx_status_ext(struct wireless_dev *wdev,
19112 				 struct cfg80211_tx_status *status, gfp_t gfp)
19113 {
19114 	nl80211_frame_tx_status(wdev, status, gfp, NL80211_CMD_FRAME_TX_STATUS);
19115 }
19116 EXPORT_SYMBOL(cfg80211_mgmt_tx_status_ext);
19117 
19118 static int __nl80211_rx_control_port(struct net_device *dev,
19119 				     struct sk_buff *skb,
19120 				     bool unencrypted,
19121 				     int link_id,
19122 				     gfp_t gfp)
19123 {
19124 	struct wireless_dev *wdev = dev->ieee80211_ptr;
19125 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
19126 	struct ethhdr *ehdr = eth_hdr(skb);
19127 	const u8 *addr = ehdr->h_source;
19128 	u16 proto = be16_to_cpu(skb->protocol);
19129 	struct sk_buff *msg;
19130 	void *hdr;
19131 	struct nlattr *frame;
19132 
19133 	u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid);
19134 
19135 	if (!nlportid)
19136 		return -ENOENT;
19137 
19138 	msg = nlmsg_new(100 + skb->len, gfp);
19139 	if (!msg)
19140 		return -ENOMEM;
19141 
19142 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME);
19143 	if (!hdr) {
19144 		nlmsg_free(msg);
19145 		return -ENOBUFS;
19146 	}
19147 
19148 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
19149 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
19150 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
19151 			      NL80211_ATTR_PAD) ||
19152 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
19153 	    nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) ||
19154 	    (link_id >= 0 &&
19155 	     nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) ||
19156 	    (unencrypted && nla_put_flag(msg,
19157 					 NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT)))
19158 		goto nla_put_failure;
19159 
19160 	frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len);
19161 	if (!frame)
19162 		goto nla_put_failure;
19163 
19164 	skb_copy_bits(skb, 0, nla_data(frame), skb->len);
19165 	genlmsg_end(msg, hdr);
19166 
19167 	return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
19168 
19169  nla_put_failure:
19170 	nlmsg_free(msg);
19171 	return -ENOBUFS;
19172 }
19173 
19174 bool cfg80211_rx_control_port(struct net_device *dev, struct sk_buff *skb,
19175 			      bool unencrypted, int link_id)
19176 {
19177 	int ret;
19178 
19179 	trace_cfg80211_rx_control_port(dev, skb, unencrypted, link_id);
19180 	ret = __nl80211_rx_control_port(dev, skb, unencrypted, link_id,
19181 					GFP_ATOMIC);
19182 	trace_cfg80211_return_bool(ret == 0);
19183 	return ret == 0;
19184 }
19185 EXPORT_SYMBOL(cfg80211_rx_control_port);
19186 
19187 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
19188 					    const char *mac, gfp_t gfp)
19189 {
19190 	struct wireless_dev *wdev = dev->ieee80211_ptr;
19191 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
19192 	struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
19193 	void **cb;
19194 
19195 	if (!msg)
19196 		return NULL;
19197 
19198 	cb = (void **)msg->cb;
19199 
19200 	cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
19201 	if (!cb[0]) {
19202 		nlmsg_free(msg);
19203 		return NULL;
19204 	}
19205 
19206 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
19207 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
19208 		goto nla_put_failure;
19209 
19210 	if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
19211 		goto nla_put_failure;
19212 
19213 	cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM);
19214 	if (!cb[1])
19215 		goto nla_put_failure;
19216 
19217 	cb[2] = rdev;
19218 
19219 	return msg;
19220  nla_put_failure:
19221 	nlmsg_free(msg);
19222 	return NULL;
19223 }
19224 
19225 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
19226 {
19227 	void **cb = (void **)msg->cb;
19228 	struct cfg80211_registered_device *rdev = cb[2];
19229 
19230 	nla_nest_end(msg, cb[1]);
19231 	genlmsg_end(msg, cb[0]);
19232 
19233 	memset(msg->cb, 0, sizeof(msg->cb));
19234 
19235 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
19236 				NL80211_MCGRP_MLME, gfp);
19237 }
19238 
19239 void cfg80211_cqm_rssi_notify(struct net_device *dev,
19240 			      enum nl80211_cqm_rssi_threshold_event rssi_event,
19241 			      s32 rssi_level, gfp_t gfp)
19242 {
19243 	struct wireless_dev *wdev = dev->ieee80211_ptr;
19244 	struct cfg80211_cqm_config *cqm_config;
19245 
19246 	trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
19247 
19248 	if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
19249 		    rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
19250 		return;
19251 
19252 	rcu_read_lock();
19253 	cqm_config = rcu_dereference(wdev->cqm_config);
19254 	if (cqm_config) {
19255 		cqm_config->last_rssi_event_value = rssi_level;
19256 		cqm_config->last_rssi_event_type = rssi_event;
19257 		wiphy_work_queue(wdev->wiphy, &wdev->cqm_rssi_work);
19258 	}
19259 	rcu_read_unlock();
19260 }
19261 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
19262 
19263 void cfg80211_cqm_rssi_notify_work(struct wiphy *wiphy, struct wiphy_work *work)
19264 {
19265 	struct wireless_dev *wdev = container_of(work, struct wireless_dev,
19266 						 cqm_rssi_work);
19267 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
19268 	enum nl80211_cqm_rssi_threshold_event rssi_event;
19269 	struct cfg80211_cqm_config *cqm_config;
19270 	struct sk_buff *msg;
19271 	s32 rssi_level;
19272 
19273 	cqm_config = wiphy_dereference(wdev->wiphy, wdev->cqm_config);
19274 	if (!cqm_config)
19275 		return;
19276 
19277 	if (cqm_config->use_range_api)
19278 		cfg80211_cqm_rssi_update(rdev, wdev->netdev, cqm_config);
19279 
19280 	rssi_level = cqm_config->last_rssi_event_value;
19281 	rssi_event = cqm_config->last_rssi_event_type;
19282 
19283 	msg = cfg80211_prepare_cqm(wdev->netdev, NULL, GFP_KERNEL);
19284 	if (!msg)
19285 		return;
19286 
19287 	if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
19288 			rssi_event))
19289 		goto nla_put_failure;
19290 
19291 	if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
19292 				      rssi_level))
19293 		goto nla_put_failure;
19294 
19295 	cfg80211_send_cqm(msg, GFP_KERNEL);
19296 
19297 	return;
19298 
19299  nla_put_failure:
19300 	nlmsg_free(msg);
19301 }
19302 
19303 void cfg80211_cqm_txe_notify(struct net_device *dev,
19304 			     const u8 *peer, u32 num_packets,
19305 			     u32 rate, u32 intvl, gfp_t gfp)
19306 {
19307 	struct sk_buff *msg;
19308 
19309 	msg = cfg80211_prepare_cqm(dev, peer, gfp);
19310 	if (!msg)
19311 		return;
19312 
19313 	if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
19314 		goto nla_put_failure;
19315 
19316 	if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
19317 		goto nla_put_failure;
19318 
19319 	if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
19320 		goto nla_put_failure;
19321 
19322 	cfg80211_send_cqm(msg, gfp);
19323 	return;
19324 
19325  nla_put_failure:
19326 	nlmsg_free(msg);
19327 }
19328 EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
19329 
19330 void cfg80211_cqm_pktloss_notify(struct net_device *dev,
19331 				 const u8 *peer, u32 num_packets, gfp_t gfp)
19332 {
19333 	struct sk_buff *msg;
19334 
19335 	trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
19336 
19337 	msg = cfg80211_prepare_cqm(dev, peer, gfp);
19338 	if (!msg)
19339 		return;
19340 
19341 	if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
19342 		goto nla_put_failure;
19343 
19344 	cfg80211_send_cqm(msg, gfp);
19345 	return;
19346 
19347  nla_put_failure:
19348 	nlmsg_free(msg);
19349 }
19350 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
19351 
19352 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
19353 {
19354 	struct sk_buff *msg;
19355 
19356 	msg = cfg80211_prepare_cqm(dev, NULL, gfp);
19357 	if (!msg)
19358 		return;
19359 
19360 	if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
19361 		goto nla_put_failure;
19362 
19363 	cfg80211_send_cqm(msg, gfp);
19364 	return;
19365 
19366  nla_put_failure:
19367 	nlmsg_free(msg);
19368 }
19369 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
19370 
19371 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
19372 				     struct net_device *netdev, const u8 *bssid,
19373 				     const u8 *replay_ctr, gfp_t gfp)
19374 {
19375 	struct sk_buff *msg;
19376 	struct nlattr *rekey_attr;
19377 	void *hdr;
19378 
19379 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
19380 	if (!msg)
19381 		return;
19382 
19383 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
19384 	if (!hdr) {
19385 		nlmsg_free(msg);
19386 		return;
19387 	}
19388 
19389 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
19390 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
19391 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
19392 		goto nla_put_failure;
19393 
19394 	rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA);
19395 	if (!rekey_attr)
19396 		goto nla_put_failure;
19397 
19398 	if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
19399 		    NL80211_REPLAY_CTR_LEN, replay_ctr))
19400 		goto nla_put_failure;
19401 
19402 	nla_nest_end(msg, rekey_attr);
19403 
19404 	genlmsg_end(msg, hdr);
19405 
19406 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
19407 				NL80211_MCGRP_MLME, gfp);
19408 	return;
19409 
19410  nla_put_failure:
19411 	nlmsg_free(msg);
19412 }
19413 
19414 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
19415 			       const u8 *replay_ctr, gfp_t gfp)
19416 {
19417 	struct wireless_dev *wdev = dev->ieee80211_ptr;
19418 	struct wiphy *wiphy = wdev->wiphy;
19419 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
19420 
19421 	trace_cfg80211_gtk_rekey_notify(dev, bssid);
19422 	nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
19423 }
19424 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
19425 
19426 static void
19427 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
19428 			       struct net_device *netdev, int index,
19429 			       const u8 *bssid, bool preauth, gfp_t gfp)
19430 {
19431 	struct sk_buff *msg;
19432 	struct nlattr *attr;
19433 	void *hdr;
19434 
19435 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
19436 	if (!msg)
19437 		return;
19438 
19439 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
19440 	if (!hdr) {
19441 		nlmsg_free(msg);
19442 		return;
19443 	}
19444 
19445 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
19446 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
19447 		goto nla_put_failure;
19448 
19449 	attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE);
19450 	if (!attr)
19451 		goto nla_put_failure;
19452 
19453 	if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
19454 	    nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
19455 	    (preauth &&
19456 	     nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
19457 		goto nla_put_failure;
19458 
19459 	nla_nest_end(msg, attr);
19460 
19461 	genlmsg_end(msg, hdr);
19462 
19463 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
19464 				NL80211_MCGRP_MLME, gfp);
19465 	return;
19466 
19467  nla_put_failure:
19468 	nlmsg_free(msg);
19469 }
19470 
19471 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
19472 				     const u8 *bssid, bool preauth, gfp_t gfp)
19473 {
19474 	struct wireless_dev *wdev = dev->ieee80211_ptr;
19475 	struct wiphy *wiphy = wdev->wiphy;
19476 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
19477 
19478 	trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
19479 	nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
19480 }
19481 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
19482 
19483 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
19484 				     struct net_device *netdev,
19485 				     unsigned int link_id,
19486 				     struct cfg80211_chan_def *chandef,
19487 				     gfp_t gfp,
19488 				     enum nl80211_commands notif,
19489 				     u8 count, bool quiet)
19490 {
19491 	struct wireless_dev *wdev = netdev->ieee80211_ptr;
19492 	struct sk_buff *msg;
19493 	void *hdr;
19494 
19495 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
19496 	if (!msg)
19497 		return;
19498 
19499 	hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
19500 	if (!hdr) {
19501 		nlmsg_free(msg);
19502 		return;
19503 	}
19504 
19505 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
19506 		goto nla_put_failure;
19507 
19508 	if (wdev->valid_links &&
19509 	    nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))
19510 		goto nla_put_failure;
19511 
19512 	if (nl80211_send_chandef(msg, chandef))
19513 		goto nla_put_failure;
19514 
19515 	if (notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) {
19516 		if (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count))
19517 			goto nla_put_failure;
19518 		if (quiet &&
19519 		    nla_put_flag(msg, NL80211_ATTR_CH_SWITCH_BLOCK_TX))
19520 			goto nla_put_failure;
19521 	}
19522 
19523 	genlmsg_end(msg, hdr);
19524 
19525 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
19526 				NL80211_MCGRP_MLME, gfp);
19527 	return;
19528 
19529  nla_put_failure:
19530 	nlmsg_free(msg);
19531 }
19532 
19533 void cfg80211_ch_switch_notify(struct net_device *dev,
19534 			       struct cfg80211_chan_def *chandef,
19535 			       unsigned int link_id)
19536 {
19537 	struct wireless_dev *wdev = dev->ieee80211_ptr;
19538 	struct wiphy *wiphy = wdev->wiphy;
19539 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
19540 
19541 	lockdep_assert_wiphy(wdev->wiphy);
19542 	WARN_INVALID_LINK_ID(wdev, link_id);
19543 
19544 	trace_cfg80211_ch_switch_notify(dev, chandef, link_id);
19545 
19546 	switch (wdev->iftype) {
19547 	case NL80211_IFTYPE_STATION:
19548 	case NL80211_IFTYPE_P2P_CLIENT:
19549 		if (!WARN_ON(!wdev->links[link_id].client.current_bss))
19550 			cfg80211_update_assoc_bss_entry(wdev, link_id,
19551 							chandef->chan);
19552 		break;
19553 	case NL80211_IFTYPE_MESH_POINT:
19554 		wdev->u.mesh.chandef = *chandef;
19555 		wdev->u.mesh.preset_chandef = *chandef;
19556 		break;
19557 	case NL80211_IFTYPE_AP:
19558 	case NL80211_IFTYPE_P2P_GO:
19559 		wdev->links[link_id].ap.chandef = *chandef;
19560 		break;
19561 	case NL80211_IFTYPE_ADHOC:
19562 		wdev->u.ibss.chandef = *chandef;
19563 		break;
19564 	default:
19565 		WARN_ON(1);
19566 		break;
19567 	}
19568 
19569 	cfg80211_schedule_channels_check(wdev);
19570 	cfg80211_sched_dfs_chan_update(rdev);
19571 
19572 	nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL,
19573 				 NL80211_CMD_CH_SWITCH_NOTIFY, 0, false);
19574 }
19575 EXPORT_SYMBOL(cfg80211_ch_switch_notify);
19576 
19577 void cfg80211_ch_switch_started_notify(struct net_device *dev,
19578 				       struct cfg80211_chan_def *chandef,
19579 				       unsigned int link_id, u8 count,
19580 				       bool quiet)
19581 {
19582 	struct wireless_dev *wdev = dev->ieee80211_ptr;
19583 	struct wiphy *wiphy = wdev->wiphy;
19584 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
19585 
19586 	lockdep_assert_wiphy(wdev->wiphy);
19587 	WARN_INVALID_LINK_ID(wdev, link_id);
19588 
19589 	trace_cfg80211_ch_switch_started_notify(dev, chandef, link_id);
19590 
19591 
19592 	nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL,
19593 				 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY,
19594 				 count, quiet);
19595 }
19596 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
19597 
19598 int cfg80211_bss_color_notify(struct net_device *dev,
19599 			      enum nl80211_commands cmd, u8 count,
19600 			      u64 color_bitmap, u8 link_id)
19601 {
19602 	struct wireless_dev *wdev = dev->ieee80211_ptr;
19603 	struct wiphy *wiphy = wdev->wiphy;
19604 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
19605 	struct sk_buff *msg;
19606 	void *hdr;
19607 
19608 	lockdep_assert_wiphy(wdev->wiphy);
19609 
19610 	trace_cfg80211_bss_color_notify(dev, cmd, count, color_bitmap);
19611 
19612 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
19613 	if (!msg)
19614 		return -ENOMEM;
19615 
19616 	hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
19617 	if (!hdr)
19618 		goto nla_put_failure;
19619 
19620 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
19621 		goto nla_put_failure;
19622 
19623 	if (wdev->valid_links &&
19624 	    nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))
19625 		goto nla_put_failure;
19626 
19627 	if (cmd == NL80211_CMD_COLOR_CHANGE_STARTED &&
19628 	    nla_put_u32(msg, NL80211_ATTR_COLOR_CHANGE_COUNT, count))
19629 		goto nla_put_failure;
19630 
19631 	if (cmd == NL80211_CMD_OBSS_COLOR_COLLISION &&
19632 	    nla_put_u64_64bit(msg, NL80211_ATTR_OBSS_COLOR_BITMAP,
19633 			      color_bitmap, NL80211_ATTR_PAD))
19634 		goto nla_put_failure;
19635 
19636 	genlmsg_end(msg, hdr);
19637 
19638 	return genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
19639 				       msg, 0, NL80211_MCGRP_MLME, GFP_KERNEL);
19640 
19641 nla_put_failure:
19642 	nlmsg_free(msg);
19643 	return -EINVAL;
19644 }
19645 EXPORT_SYMBOL(cfg80211_bss_color_notify);
19646 
19647 void
19648 nl80211_radar_notify(struct cfg80211_registered_device *rdev,
19649 		     const struct cfg80211_chan_def *chandef,
19650 		     enum nl80211_radar_event event,
19651 		     struct net_device *netdev, gfp_t gfp)
19652 {
19653 	struct sk_buff *msg;
19654 	void *hdr;
19655 
19656 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
19657 	if (!msg)
19658 		return;
19659 
19660 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
19661 	if (!hdr) {
19662 		nlmsg_free(msg);
19663 		return;
19664 	}
19665 
19666 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
19667 		goto nla_put_failure;
19668 
19669 	/* NOP and radar events don't need a netdev parameter */
19670 	if (netdev) {
19671 		struct wireless_dev *wdev = netdev->ieee80211_ptr;
19672 
19673 		if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
19674 		    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
19675 				      NL80211_ATTR_PAD))
19676 			goto nla_put_failure;
19677 	}
19678 
19679 	if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
19680 		goto nla_put_failure;
19681 
19682 	if (nl80211_send_chandef(msg, chandef))
19683 		goto nla_put_failure;
19684 
19685 	genlmsg_end(msg, hdr);
19686 
19687 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
19688 				NL80211_MCGRP_MLME, gfp);
19689 	return;
19690 
19691  nla_put_failure:
19692 	nlmsg_free(msg);
19693 }
19694 
19695 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac,
19696 				       struct sta_opmode_info *sta_opmode,
19697 				       gfp_t gfp)
19698 {
19699 	struct sk_buff *msg;
19700 	struct wireless_dev *wdev = dev->ieee80211_ptr;
19701 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
19702 	void *hdr;
19703 
19704 	if (WARN_ON(!mac))
19705 		return;
19706 
19707 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
19708 	if (!msg)
19709 		return;
19710 
19711 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED);
19712 	if (!hdr) {
19713 		nlmsg_free(msg);
19714 		return;
19715 	}
19716 
19717 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
19718 		goto nla_put_failure;
19719 
19720 	if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
19721 		goto nla_put_failure;
19722 
19723 	if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
19724 		goto nla_put_failure;
19725 
19726 	if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) &&
19727 	    nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode))
19728 		goto nla_put_failure;
19729 
19730 	if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) &&
19731 	    nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw))
19732 		goto nla_put_failure;
19733 
19734 	if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) &&
19735 	    nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss))
19736 		goto nla_put_failure;
19737 
19738 	genlmsg_end(msg, hdr);
19739 
19740 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
19741 				NL80211_MCGRP_MLME, gfp);
19742 
19743 	return;
19744 
19745 nla_put_failure:
19746 	nlmsg_free(msg);
19747 }
19748 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify);
19749 
19750 void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
19751 			   u64 cookie, bool acked, s32 ack_signal,
19752 			   bool is_valid_ack_signal, gfp_t gfp)
19753 {
19754 	struct wireless_dev *wdev = dev->ieee80211_ptr;
19755 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
19756 	struct sk_buff *msg;
19757 	void *hdr;
19758 
19759 	trace_cfg80211_probe_status(dev, addr, cookie, acked);
19760 
19761 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
19762 
19763 	if (!msg)
19764 		return;
19765 
19766 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
19767 	if (!hdr) {
19768 		nlmsg_free(msg);
19769 		return;
19770 	}
19771 
19772 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
19773 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
19774 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
19775 	    nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
19776 			      NL80211_ATTR_PAD) ||
19777 	    (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
19778 	    (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL,
19779 						ack_signal)))
19780 		goto nla_put_failure;
19781 
19782 	genlmsg_end(msg, hdr);
19783 
19784 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
19785 				NL80211_MCGRP_MLME, gfp);
19786 	return;
19787 
19788  nla_put_failure:
19789 	nlmsg_free(msg);
19790 }
19791 EXPORT_SYMBOL(cfg80211_probe_status);
19792 
19793 void cfg80211_report_obss_beacon_khz(struct wiphy *wiphy, const u8 *frame,
19794 				     size_t len, int freq, int sig_dbm)
19795 {
19796 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
19797 	struct sk_buff *msg;
19798 	void *hdr;
19799 	struct cfg80211_beacon_registration *reg;
19800 
19801 	trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
19802 
19803 	spin_lock_bh(&rdev->beacon_registrations_lock);
19804 	list_for_each_entry(reg, &rdev->beacon_registrations, list) {
19805 		msg = nlmsg_new(len + 100, GFP_ATOMIC);
19806 		if (!msg) {
19807 			spin_unlock_bh(&rdev->beacon_registrations_lock);
19808 			return;
19809 		}
19810 
19811 		hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
19812 		if (!hdr)
19813 			goto nla_put_failure;
19814 
19815 		if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
19816 		    (freq &&
19817 		     (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
19818 				  KHZ_TO_MHZ(freq)) ||
19819 		      nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET,
19820 				  freq % 1000))) ||
19821 		    (sig_dbm &&
19822 		     nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
19823 		    nla_put(msg, NL80211_ATTR_FRAME, len, frame))
19824 			goto nla_put_failure;
19825 
19826 		genlmsg_end(msg, hdr);
19827 
19828 		genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
19829 	}
19830 	spin_unlock_bh(&rdev->beacon_registrations_lock);
19831 	return;
19832 
19833  nla_put_failure:
19834 	spin_unlock_bh(&rdev->beacon_registrations_lock);
19835 	nlmsg_free(msg);
19836 }
19837 EXPORT_SYMBOL(cfg80211_report_obss_beacon_khz);
19838 
19839 #ifdef CONFIG_PM
19840 static int cfg80211_net_detect_results(struct sk_buff *msg,
19841 				       struct cfg80211_wowlan_wakeup *wakeup)
19842 {
19843 	struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
19844 	struct nlattr *nl_results, *nl_match, *nl_freqs;
19845 	int i, j;
19846 
19847 	nl_results = nla_nest_start_noflag(msg,
19848 					   NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
19849 	if (!nl_results)
19850 		return -EMSGSIZE;
19851 
19852 	for (i = 0; i < nd->n_matches; i++) {
19853 		struct cfg80211_wowlan_nd_match *match = nd->matches[i];
19854 
19855 		nl_match = nla_nest_start_noflag(msg, i);
19856 		if (!nl_match)
19857 			break;
19858 
19859 		/* The SSID attribute is optional in nl80211, but for
19860 		 * simplicity reasons it's always present in the
19861 		 * cfg80211 structure.  If a driver can't pass the
19862 		 * SSID, that needs to be changed.  A zero length SSID
19863 		 * is still a valid SSID (wildcard), so it cannot be
19864 		 * used for this purpose.
19865 		 */
19866 		if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
19867 			    match->ssid.ssid)) {
19868 			nla_nest_cancel(msg, nl_match);
19869 			goto out;
19870 		}
19871 
19872 		if (match->n_channels) {
19873 			nl_freqs = nla_nest_start_noflag(msg,
19874 							 NL80211_ATTR_SCAN_FREQUENCIES);
19875 			if (!nl_freqs) {
19876 				nla_nest_cancel(msg, nl_match);
19877 				goto out;
19878 			}
19879 
19880 			for (j = 0; j < match->n_channels; j++) {
19881 				if (nla_put_u32(msg, j, match->channels[j])) {
19882 					nla_nest_cancel(msg, nl_freqs);
19883 					nla_nest_cancel(msg, nl_match);
19884 					goto out;
19885 				}
19886 			}
19887 
19888 			nla_nest_end(msg, nl_freqs);
19889 		}
19890 
19891 		nla_nest_end(msg, nl_match);
19892 	}
19893 
19894 out:
19895 	nla_nest_end(msg, nl_results);
19896 	return 0;
19897 }
19898 
19899 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
19900 				   struct cfg80211_wowlan_wakeup *wakeup,
19901 				   gfp_t gfp)
19902 {
19903 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
19904 	struct sk_buff *msg;
19905 	void *hdr;
19906 	int size = 200;
19907 
19908 	trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
19909 
19910 	if (wakeup)
19911 		size += wakeup->packet_present_len;
19912 
19913 	msg = nlmsg_new(size, gfp);
19914 	if (!msg)
19915 		return;
19916 
19917 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
19918 	if (!hdr)
19919 		goto free_msg;
19920 
19921 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
19922 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
19923 			      NL80211_ATTR_PAD))
19924 		goto free_msg;
19925 
19926 	if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
19927 					wdev->netdev->ifindex))
19928 		goto free_msg;
19929 
19930 	if (wakeup) {
19931 		struct nlattr *reasons;
19932 
19933 		reasons = nla_nest_start_noflag(msg,
19934 						NL80211_ATTR_WOWLAN_TRIGGERS);
19935 		if (!reasons)
19936 			goto free_msg;
19937 
19938 		if (wakeup->disconnect &&
19939 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
19940 			goto free_msg;
19941 		if (wakeup->magic_pkt &&
19942 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
19943 			goto free_msg;
19944 		if (wakeup->gtk_rekey_failure &&
19945 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
19946 			goto free_msg;
19947 		if (wakeup->eap_identity_req &&
19948 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
19949 			goto free_msg;
19950 		if (wakeup->four_way_handshake &&
19951 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
19952 			goto free_msg;
19953 		if (wakeup->rfkill_release &&
19954 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
19955 			goto free_msg;
19956 
19957 		if (wakeup->pattern_idx >= 0 &&
19958 		    nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
19959 				wakeup->pattern_idx))
19960 			goto free_msg;
19961 
19962 		if (wakeup->tcp_match &&
19963 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
19964 			goto free_msg;
19965 
19966 		if (wakeup->tcp_connlost &&
19967 		    nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
19968 			goto free_msg;
19969 
19970 		if (wakeup->tcp_nomoretokens &&
19971 		    nla_put_flag(msg,
19972 				 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
19973 			goto free_msg;
19974 
19975 		if (wakeup->unprot_deauth_disassoc &&
19976 		    nla_put_flag(msg,
19977 				 NL80211_WOWLAN_TRIG_UNPROTECTED_DEAUTH_DISASSOC))
19978 			goto free_msg;
19979 
19980 		if (wakeup->packet) {
19981 			u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
19982 			u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
19983 
19984 			if (!wakeup->packet_80211) {
19985 				pkt_attr =
19986 					NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
19987 				len_attr =
19988 					NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
19989 			}
19990 
19991 			if (wakeup->packet_len &&
19992 			    nla_put_u32(msg, len_attr, wakeup->packet_len))
19993 				goto free_msg;
19994 
19995 			if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
19996 				    wakeup->packet))
19997 				goto free_msg;
19998 		}
19999 
20000 		if (wakeup->net_detect &&
20001 		    cfg80211_net_detect_results(msg, wakeup))
20002 				goto free_msg;
20003 
20004 		nla_nest_end(msg, reasons);
20005 	}
20006 
20007 	genlmsg_end(msg, hdr);
20008 
20009 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
20010 				NL80211_MCGRP_MLME, gfp);
20011 	return;
20012 
20013  free_msg:
20014 	nlmsg_free(msg);
20015 }
20016 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
20017 #endif
20018 
20019 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
20020 				enum nl80211_tdls_operation oper,
20021 				u16 reason_code, gfp_t gfp)
20022 {
20023 	struct wireless_dev *wdev = dev->ieee80211_ptr;
20024 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
20025 	struct sk_buff *msg;
20026 	void *hdr;
20027 
20028 	trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
20029 					 reason_code);
20030 
20031 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
20032 	if (!msg)
20033 		return;
20034 
20035 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
20036 	if (!hdr) {
20037 		nlmsg_free(msg);
20038 		return;
20039 	}
20040 
20041 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
20042 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
20043 	    nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
20044 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
20045 	    (reason_code > 0 &&
20046 	     nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
20047 		goto nla_put_failure;
20048 
20049 	genlmsg_end(msg, hdr);
20050 
20051 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
20052 				NL80211_MCGRP_MLME, gfp);
20053 	return;
20054 
20055  nla_put_failure:
20056 	nlmsg_free(msg);
20057 }
20058 EXPORT_SYMBOL(cfg80211_tdls_oper_request);
20059 
20060 static int nl80211_netlink_notify(struct notifier_block * nb,
20061 				  unsigned long state,
20062 				  void *_notify)
20063 {
20064 	struct netlink_notify *notify = _notify;
20065 	struct cfg80211_registered_device *rdev;
20066 	struct wireless_dev *wdev;
20067 	struct cfg80211_beacon_registration *reg, *tmp;
20068 
20069 	if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
20070 		return NOTIFY_DONE;
20071 
20072 	rcu_read_lock();
20073 
20074 	list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
20075 		struct cfg80211_sched_scan_request *sched_scan_req;
20076 
20077 		list_for_each_entry_rcu(sched_scan_req,
20078 					&rdev->sched_scan_req_list,
20079 					list) {
20080 			if (sched_scan_req->owner_nlportid == notify->portid) {
20081 				sched_scan_req->nl_owner_dead = true;
20082 				wiphy_work_queue(&rdev->wiphy,
20083 						 &rdev->sched_scan_stop_wk);
20084 			}
20085 		}
20086 
20087 		list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
20088 			cfg80211_mlme_unregister_socket(wdev, notify->portid);
20089 
20090 			if (wdev->owner_nlportid == notify->portid) {
20091 				wdev->nl_owner_dead = true;
20092 				schedule_work(&rdev->destroy_work);
20093 			} else if (wdev->conn_owner_nlportid == notify->portid) {
20094 				schedule_work(&wdev->disconnect_wk);
20095 			}
20096 
20097 			cfg80211_release_pmsr(wdev, notify->portid);
20098 		}
20099 
20100 		spin_lock_bh(&rdev->beacon_registrations_lock);
20101 		list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
20102 					 list) {
20103 			if (reg->nlportid == notify->portid) {
20104 				list_del(&reg->list);
20105 				kfree(reg);
20106 				break;
20107 			}
20108 		}
20109 		spin_unlock_bh(&rdev->beacon_registrations_lock);
20110 	}
20111 
20112 	rcu_read_unlock();
20113 
20114 	/*
20115 	 * It is possible that the user space process that is controlling the
20116 	 * indoor setting disappeared, so notify the regulatory core.
20117 	 */
20118 	regulatory_netlink_notify(notify->portid);
20119 	return NOTIFY_OK;
20120 }
20121 
20122 static struct notifier_block nl80211_netlink_notifier = {
20123 	.notifier_call = nl80211_netlink_notify,
20124 };
20125 
20126 void cfg80211_ft_event(struct net_device *netdev,
20127 		       struct cfg80211_ft_event_params *ft_event)
20128 {
20129 	struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
20130 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
20131 	struct sk_buff *msg;
20132 	void *hdr;
20133 
20134 	trace_cfg80211_ft_event(wiphy, netdev, ft_event);
20135 
20136 	if (!ft_event->target_ap)
20137 		return;
20138 
20139 	msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len,
20140 			GFP_KERNEL);
20141 	if (!msg)
20142 		return;
20143 
20144 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
20145 	if (!hdr)
20146 		goto out;
20147 
20148 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
20149 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
20150 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
20151 		goto out;
20152 
20153 	if (ft_event->ies &&
20154 	    nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
20155 		goto out;
20156 	if (ft_event->ric_ies &&
20157 	    nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
20158 		    ft_event->ric_ies))
20159 		goto out;
20160 
20161 	genlmsg_end(msg, hdr);
20162 
20163 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
20164 				NL80211_MCGRP_MLME, GFP_KERNEL);
20165 	return;
20166  out:
20167 	nlmsg_free(msg);
20168 }
20169 EXPORT_SYMBOL(cfg80211_ft_event);
20170 
20171 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
20172 {
20173 	struct cfg80211_registered_device *rdev;
20174 	struct sk_buff *msg;
20175 	void *hdr;
20176 	u32 nlportid;
20177 
20178 	rdev = wiphy_to_rdev(wdev->wiphy);
20179 	if (!rdev->crit_proto_nlportid)
20180 		return;
20181 
20182 	nlportid = rdev->crit_proto_nlportid;
20183 	rdev->crit_proto_nlportid = 0;
20184 
20185 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
20186 	if (!msg)
20187 		return;
20188 
20189 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
20190 	if (!hdr)
20191 		goto nla_put_failure;
20192 
20193 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
20194 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
20195 			      NL80211_ATTR_PAD))
20196 		goto nla_put_failure;
20197 
20198 	genlmsg_end(msg, hdr);
20199 
20200 	genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
20201 	return;
20202 
20203  nla_put_failure:
20204 	nlmsg_free(msg);
20205 }
20206 EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
20207 
20208 void nl80211_send_ap_stopped(struct wireless_dev *wdev, unsigned int link_id)
20209 {
20210 	struct wiphy *wiphy = wdev->wiphy;
20211 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
20212 	struct sk_buff *msg;
20213 	void *hdr;
20214 
20215 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
20216 	if (!msg)
20217 		return;
20218 
20219 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
20220 	if (!hdr)
20221 		goto out;
20222 
20223 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
20224 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
20225 	    nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
20226 			      NL80211_ATTR_PAD) ||
20227 	    (wdev->valid_links &&
20228 	     nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)))
20229 		goto out;
20230 
20231 	genlmsg_end(msg, hdr);
20232 
20233 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
20234 				NL80211_MCGRP_MLME, GFP_KERNEL);
20235 	return;
20236  out:
20237 	nlmsg_free(msg);
20238 }
20239 
20240 int cfg80211_external_auth_request(struct net_device *dev,
20241 				   struct cfg80211_external_auth_params *params,
20242 				   gfp_t gfp)
20243 {
20244 	struct wireless_dev *wdev = dev->ieee80211_ptr;
20245 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
20246 	struct sk_buff *msg;
20247 	void *hdr;
20248 
20249 	if (!wdev->conn_owner_nlportid)
20250 		return -EINVAL;
20251 
20252 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
20253 	if (!msg)
20254 		return -ENOMEM;
20255 
20256 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH);
20257 	if (!hdr)
20258 		goto nla_put_failure;
20259 
20260 	/* Some historical mistakes in drivers <-> userspace interface (notably
20261 	 * between drivers and wpa_supplicant) led to a big-endian conversion
20262 	 * being needed on NL80211_ATTR_AKM_SUITES _only_ when its value is
20263 	 * WLAN_AKM_SUITE_SAE. This is now fixed on userspace side, but for the
20264 	 * benefit of older wpa_supplicant versions, send this particular value
20265 	 * in big-endian. Note that newer wpa_supplicant will also detect this
20266 	 * particular value in big endian still, so it all continues to work.
20267 	 */
20268 	if (params->key_mgmt_suite == WLAN_AKM_SUITE_SAE) {
20269 		if (nla_put_be32(msg, NL80211_ATTR_AKM_SUITES,
20270 				 cpu_to_be32(WLAN_AKM_SUITE_SAE)))
20271 			goto nla_put_failure;
20272 	} else {
20273 		if (nla_put_u32(msg, NL80211_ATTR_AKM_SUITES,
20274 				params->key_mgmt_suite))
20275 			goto nla_put_failure;
20276 	}
20277 
20278 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
20279 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
20280 	    nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION,
20281 			params->action) ||
20282 	    nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) ||
20283 	    nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len,
20284 		    params->ssid.ssid) ||
20285 	    (!is_zero_ether_addr(params->mld_addr) &&
20286 	     nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, params->mld_addr)))
20287 		goto nla_put_failure;
20288 
20289 	genlmsg_end(msg, hdr);
20290 	genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
20291 			wdev->conn_owner_nlportid);
20292 	return 0;
20293 
20294  nla_put_failure:
20295 	nlmsg_free(msg);
20296 	return -ENOBUFS;
20297 }
20298 EXPORT_SYMBOL(cfg80211_external_auth_request);
20299 
20300 void cfg80211_update_owe_info_event(struct net_device *netdev,
20301 				    struct cfg80211_update_owe_info *owe_info,
20302 				    gfp_t gfp)
20303 {
20304 	struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
20305 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
20306 	struct sk_buff *msg;
20307 	void *hdr;
20308 
20309 	trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info);
20310 
20311 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
20312 	if (!msg)
20313 		return;
20314 
20315 	hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO);
20316 	if (!hdr)
20317 		goto nla_put_failure;
20318 
20319 	if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
20320 	    nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
20321 	    nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer))
20322 		goto nla_put_failure;
20323 
20324 	if (!owe_info->ie_len ||
20325 	    nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie))
20326 		goto nla_put_failure;
20327 
20328 	if (owe_info->assoc_link_id != -1) {
20329 		if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID,
20330 			       owe_info->assoc_link_id))
20331 			goto nla_put_failure;
20332 
20333 		if (!is_zero_ether_addr(owe_info->peer_mld_addr) &&
20334 		    nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN,
20335 			    owe_info->peer_mld_addr))
20336 			goto nla_put_failure;
20337 	}
20338 
20339 	genlmsg_end(msg, hdr);
20340 
20341 	genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
20342 				NL80211_MCGRP_MLME, gfp);
20343 	return;
20344 
20345 nla_put_failure:
20346 	genlmsg_cancel(msg, hdr);
20347 	nlmsg_free(msg);
20348 }
20349 EXPORT_SYMBOL(cfg80211_update_owe_info_event);
20350 
20351 void cfg80211_schedule_channels_check(struct wireless_dev *wdev)
20352 {
20353 	struct wiphy *wiphy = wdev->wiphy;
20354 
20355 	/* Schedule channels check if NO_IR or DFS relaxations are supported */
20356 	if (wdev->iftype == NL80211_IFTYPE_STATION &&
20357 	    (wiphy_ext_feature_isset(wiphy,
20358 				     NL80211_EXT_FEATURE_DFS_CONCURRENT) ||
20359 	    (IS_ENABLED(CONFIG_CFG80211_REG_RELAX_NO_IR) &&
20360 	     wiphy->regulatory_flags & REGULATORY_ENABLE_RELAX_NO_IR)))
20361 		reg_check_channels();
20362 }
20363 EXPORT_SYMBOL(cfg80211_schedule_channels_check);
20364 
20365 /* initialisation/exit functions */
20366 
20367 int __init nl80211_init(void)
20368 {
20369 	int err;
20370 
20371 	err = genl_register_family(&nl80211_fam);
20372 	if (err)
20373 		return err;
20374 
20375 	err = netlink_register_notifier(&nl80211_netlink_notifier);
20376 	if (err)
20377 		goto err_out;
20378 
20379 	return 0;
20380  err_out:
20381 	genl_unregister_family(&nl80211_fam);
20382 	return err;
20383 }
20384 
20385 void nl80211_exit(void)
20386 {
20387 	netlink_unregister_notifier(&nl80211_netlink_notifier);
20388 	genl_unregister_family(&nl80211_fam);
20389 }
20390