]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - net/wireless/nl80211.c
projects / mirror_ubuntu-bionic-kernel.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
nl80211: validate beacon head
[mirror_ubuntu-bionic-kernel.git] / net / wireless / nl80211.c
1 /*
2 * This is the new netlink-based wireless configuration interface.
3 *
4 * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net>
5 * Copyright 2013-2014 Intel Mobile Communications GmbH
6 * Copyright 2015-2017 Intel Deutschland GmbH
7 */
8
9 #include <linux/if.h>
10 #include <linux/module.h>
11 #include <linux/err.h>
12 #include <linux/slab.h>
13 #include <linux/list.h>
14 #include <linux/if_ether.h>
15 #include <linux/ieee80211.h>
16 #include <linux/nl80211.h>
17 #include <linux/rtnetlink.h>
18 #include <linux/netlink.h>
19 #include <linux/nospec.h>
20 #include <linux/etherdevice.h>
21 #include <net/net_namespace.h>
22 #include <net/genetlink.h>
23 #include <net/cfg80211.h>
24 #include <net/sock.h>
25 #include <net/inet_connection_sock.h>
26 #include "core.h"
27 #include "nl80211.h"
28 #include "reg.h"
29 #include "rdev-ops.h"
30
31 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
32 struct genl_info *info,
33 struct cfg80211_crypto_settings *settings,
34 int cipher_limit);
35
36 /* the netlink family */
37 static struct genl_family nl80211_fam;
38
39 /* multicast groups */
40 enum nl80211_multicast_groups {
41 NL80211_MCGRP_CONFIG,
42 NL80211_MCGRP_SCAN,
43 NL80211_MCGRP_REGULATORY,
44 NL80211_MCGRP_MLME,
45 NL80211_MCGRP_VENDOR,
46 NL80211_MCGRP_NAN,
47 NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
48 };
49
50 static const struct genl_multicast_group nl80211_mcgrps[] = {
51 [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
52 [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
53 [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
54 [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
55 [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
56 [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
57 #ifdef CONFIG_NL80211_TESTMODE
58 [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
59 #endif
60 };
61
62 /* returns ERR_PTR values */
63 static struct wireless_dev *
64 __cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
65 {
66 struct cfg80211_registered_device *rdev;
67 struct wireless_dev *result = NULL;
68 bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
69 bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
70 u64 wdev_id;
71 int wiphy_idx = -1;
72 int ifidx = -1;
73
74 ASSERT_RTNL();
75
76 if (!have_ifidx && !have_wdev_id)
77 return ERR_PTR(-EINVAL);
78
79 if (have_ifidx)
80 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
81 if (have_wdev_id) {
82 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
83 wiphy_idx = wdev_id >> 32;
84 }
85
86 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
87 struct wireless_dev *wdev;
88
89 if (wiphy_net(&rdev->wiphy) != netns)
90 continue;
91
92 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
93 continue;
94
95 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
96 if (have_ifidx && wdev->netdev &&
97 wdev->netdev->ifindex == ifidx) {
98 result = wdev;
99 break;
100 }
101 if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
102 result = wdev;
103 break;
104 }
105 }
106
107 if (result)
108 break;
109 }
110
111 if (result)
112 return result;
113 return ERR_PTR(-ENODEV);
114 }
115
116 static struct cfg80211_registered_device *
117 __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
118 {
119 struct cfg80211_registered_device *rdev = NULL, *tmp;
120 struct net_device *netdev;
121
122 ASSERT_RTNL();
123
124 if (!attrs[NL80211_ATTR_WIPHY] &&
125 !attrs[NL80211_ATTR_IFINDEX] &&
126 !attrs[NL80211_ATTR_WDEV])
127 return ERR_PTR(-EINVAL);
128
129 if (attrs[NL80211_ATTR_WIPHY])
130 rdev = cfg80211_rdev_by_wiphy_idx(
131 nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
132
133 if (attrs[NL80211_ATTR_WDEV]) {
134 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
135 struct wireless_dev *wdev;
136 bool found = false;
137
138 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
139 if (tmp) {
140 /* make sure wdev exists */
141 list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
142 if (wdev->identifier != (u32)wdev_id)
143 continue;
144 found = true;
145 break;
146 }
147
148 if (!found)
149 tmp = NULL;
150
151 if (rdev && tmp != rdev)
152 return ERR_PTR(-EINVAL);
153 rdev = tmp;
154 }
155 }
156
157 if (attrs[NL80211_ATTR_IFINDEX]) {
158 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
159
160 netdev = __dev_get_by_index(netns, ifindex);
161 if (netdev) {
162 if (netdev->ieee80211_ptr)
163 tmp = wiphy_to_rdev(
164 netdev->ieee80211_ptr->wiphy);
165 else
166 tmp = NULL;
167
168 /* not wireless device -- return error */
169 if (!tmp)
170 return ERR_PTR(-EINVAL);
171
172 /* mismatch -- return error */
173 if (rdev && tmp != rdev)
174 return ERR_PTR(-EINVAL);
175
176 rdev = tmp;
177 }
178 }
179
180 if (!rdev)
181 return ERR_PTR(-ENODEV);
182
183 if (netns != wiphy_net(&rdev->wiphy))
184 return ERR_PTR(-ENODEV);
185
186 return rdev;
187 }
188
189 /*
190 * This function returns a pointer to the driver
191 * that the genl_info item that is passed refers to.
192 *
193 * The result of this can be a PTR_ERR and hence must
194 * be checked with IS_ERR() for errors.
195 */
196 static struct cfg80211_registered_device *
197 cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
198 {
199 return __cfg80211_rdev_from_attrs(netns, info->attrs);
200 }
201
202 static int validate_beacon_head(const struct nlattr *attr,
203 struct netlink_ext_ack *extack)
204 {
205 const u8 *data = nla_data(attr);
206 unsigned int len = nla_len(attr);
207 const struct element *elem;
208 const struct ieee80211_mgmt *mgmt = (void *)data;
209 unsigned int fixedlen = offsetof(struct ieee80211_mgmt,
210 u.beacon.variable);
211
212 if (len < fixedlen)
213 goto err;
214
215 if (ieee80211_hdrlen(mgmt->frame_control) !=
216 offsetof(struct ieee80211_mgmt, u.beacon))
217 goto err;
218
219 data += fixedlen;
220 len -= fixedlen;
221
222 for_each_element(elem, data, len) {
223 /* nothing */
224 }
225
226 if (for_each_element_completed(elem, data, len))
227 return 0;
228
229 err:
230 NL_SET_ERR_MSG_ATTR(extack, attr, "malformed beacon head");
231 return -EINVAL;
232 }
233
234 /* policy for the attributes */
235 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
236 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
237 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
238 .len = 20-1 },
239 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
240
241 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
242 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
243 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
244 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
245 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
246
247 [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
248 [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
249 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
250 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
251 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
252 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
253
254 [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
255 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
256 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
257
258 [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
259 [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
260
261 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
262 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
263 .len = WLAN_MAX_KEY_LEN },
264 [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
265 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
266 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
267 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
268 [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
269
270 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
271 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
272 [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
273 .len = IEEE80211_MAX_DATA_LEN },
274 [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
275 .len = IEEE80211_MAX_DATA_LEN },
276 [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
277 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
278 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
279 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
280 .len = NL80211_MAX_SUPP_RATES },
281 [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
282 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
283 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
284 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
285 .len = IEEE80211_MAX_MESH_ID_LEN },
286 [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
287
288 [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
289 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
290
291 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
292 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
293 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
294 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
295 .len = NL80211_MAX_SUPP_RATES },
296 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
297
298 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
299 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
300
301 [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
302
303 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
304 [NL80211_ATTR_IE] = { .type = NLA_BINARY,
305 .len = IEEE80211_MAX_DATA_LEN },
306 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
307 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
308
309 [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
310 .len = IEEE80211_MAX_SSID_LEN },
311 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
312 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
313 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
314 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
315 [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
316 [NL80211_ATTR_STA_FLAGS2] = {
317 .len = sizeof(struct nl80211_sta_flag_update),
318 },
319 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
320 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
321 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
322 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
323 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
324 [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
325 [NL80211_ATTR_PID] = { .type = NLA_U32 },
326 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
327 [NL80211_ATTR_PMKID] = { .len = WLAN_PMKID_LEN },
328 [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
329 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
330 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
331 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
332 .len = IEEE80211_MAX_DATA_LEN },
333 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
334 [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
335 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
336 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
337 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
338 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
339 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
340 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
341 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
342 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
343 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
344 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
345 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
346 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
347 [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
348 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
349 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
350 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
351 [NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
352 [NL80211_ATTR_IE_PROBE_RESP] = { .type = NLA_BINARY,
353 .len = IEEE80211_MAX_DATA_LEN },
354 [NL80211_ATTR_IE_ASSOC_RESP] = { .type = NLA_BINARY,
355 .len = IEEE80211_MAX_DATA_LEN },
356 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
357 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
358 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
359 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
360 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
361 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
362 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
363 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
364 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
365 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
366 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
367 .len = IEEE80211_MAX_DATA_LEN },
368 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
369 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
370 [NL80211_ATTR_HT_CAPABILITY_MASK] = {
371 .len = NL80211_HT_CAPABILITY_LEN
372 },
373 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
374 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
375 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
376 [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
377 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
378 [NL80211_ATTR_AUTH_DATA] = { .type = NLA_BINARY, },
379 [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
380 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
381 [NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
382 [NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
383 [NL80211_ATTR_LOCAL_MESH_POWER_MODE] = {. type = NLA_U32 },
384 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
385 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
386 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
387 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
388 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
389 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
390 [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
391 .len = NL80211_VHT_CAPABILITY_LEN,
392 },
393 [NL80211_ATTR_MDID] = { .type = NLA_U16 },
394 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
395 .len = IEEE80211_MAX_DATA_LEN },
396 [NL80211_ATTR_PEER_AID] = { .type = NLA_U16 },
397 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
398 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
399 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
400 [NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
401 [NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
402 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
403 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
404 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
405 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
406 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
407 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
408 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
409 [NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
410 .len = IEEE80211_QOS_MAP_LEN_MAX },
411 [NL80211_ATTR_MAC_HINT] = { .len = ETH_ALEN },
412 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
413 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
414 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
415 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
416 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
417 [NL80211_ATTR_TSID] = { .type = NLA_U8 },
418 [NL80211_ATTR_USER_PRIO] = { .type = NLA_U8 },
419 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
420 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
421 [NL80211_ATTR_MAC_MASK] = { .len = ETH_ALEN },
422 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
423 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
424 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
425 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
426 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
427 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
428 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = { .type = NLA_U8 },
429 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
430 .len = VHT_MUMIMO_GROUPS_DATA_LEN
431 },
432 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = { .len = ETH_ALEN },
433 [NL80211_ATTR_NAN_MASTER_PREF] = { .type = NLA_U8 },
434 [NL80211_ATTR_BANDS] = { .type = NLA_U32 },
435 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
436 [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
437 .len = FILS_MAX_KEK_LEN },
438 [NL80211_ATTR_FILS_NONCES] = { .len = 2 * FILS_NONCE_LEN },
439 [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
440 [NL80211_ATTR_BSSID] = { .len = ETH_ALEN },
441 [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
442 [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
443 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
444 },
445 [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
446 [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
447 .len = FILS_ERP_MAX_USERNAME_LEN },
448 [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
449 .len = FILS_ERP_MAX_REALM_LEN },
450 [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
451 [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
452 .len = FILS_ERP_MAX_RRK_LEN },
453 [NL80211_ATTR_FILS_CACHE_ID] = { .len = 2 },
454 [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
455 [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
456 };
457
458 /* policy for the key attributes */
459 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
460 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
461 [NL80211_KEY_IDX] = { .type = NLA_U8 },
462 [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
463 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
464 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
465 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
466 [NL80211_KEY_TYPE] = { .type = NLA_U32 },
467 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
468 };
469
470 /* policy for the key default flags */
471 static const struct nla_policy
472 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
473 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
474 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
475 };
476
477 #ifdef CONFIG_PM
478 /* policy for WoWLAN attributes */
479 static const struct nla_policy
480 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
481 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
482 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
483 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
484 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
485 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
486 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
487 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
488 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
489 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
490 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
491 };
492
493 static const struct nla_policy
494 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
495 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
496 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
497 [NL80211_WOWLAN_TCP_DST_MAC] = { .len = ETH_ALEN },
498 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
499 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
500 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .len = 1 },
501 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
502 .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
503 },
504 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
505 .len = sizeof(struct nl80211_wowlan_tcp_data_token)
506 },
507 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
508 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .len = 1 },
509 [NL80211_WOWLAN_TCP_WAKE_MASK] = { .len = 1 },
510 };
511 #endif /* CONFIG_PM */
512
513 /* policy for coalesce rule attributes */
514 static const struct nla_policy
515 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
516 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
517 [NL80211_ATTR_COALESCE_RULE_CONDITION] = { .type = NLA_U32 },
518 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
519 };
520
521 /* policy for GTK rekey offload attributes */
522 static const struct nla_policy
523 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
524 [NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
525 [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
526 [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
527 };
528
529 static const struct nla_policy
530 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
531 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
532 .len = IEEE80211_MAX_SSID_LEN },
533 [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = { .len = ETH_ALEN },
534 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
535 };
536
537 static const struct nla_policy
538 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
539 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
540 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
541 };
542
543 static const struct nla_policy
544 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
545 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
546 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
547 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
548 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
549 },
550 };
551
552 /* policy for NAN function attributes */
553 static const struct nla_policy
554 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
555 [NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
556 [NL80211_NAN_FUNC_SERVICE_ID] = {
557 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
558 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
559 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
560 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
561 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
562 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
563 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = { .len = ETH_ALEN },
564 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
565 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
566 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
567 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
568 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
569 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
570 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
571 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
572 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
573 };
574
575 /* policy for Service Response Filter attributes */
576 static const struct nla_policy
577 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
578 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
579 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
580 .len = NL80211_NAN_FUNC_SRF_MAX_LEN },
581 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
582 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
583 };
584
585 /* policy for packet pattern attributes */
586 static const struct nla_policy
587 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
588 [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
589 [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
590 [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
591 };
592
593 static int nl80211_prepare_wdev_dump(struct sk_buff *skb,
594 struct netlink_callback *cb,
595 struct cfg80211_registered_device **rdev,
596 struct wireless_dev **wdev)
597 {
598 int err;
599
600 if (!cb->args[0]) {
601 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
602 genl_family_attrbuf(&nl80211_fam),
603 nl80211_fam.maxattr, nl80211_policy, NULL);
604 if (err)
605 return err;
606
607 *wdev = __cfg80211_wdev_from_attrs(
608 sock_net(skb->sk),
609 genl_family_attrbuf(&nl80211_fam));
610 if (IS_ERR(*wdev))
611 return PTR_ERR(*wdev);
612 *rdev = wiphy_to_rdev((*wdev)->wiphy);
613 /* 0 is the first index - add 1 to parse only once */
614 cb->args[0] = (*rdev)->wiphy_idx + 1;
615 cb->args[1] = (*wdev)->identifier;
616 } else {
617 /* subtract the 1 again here */
618 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
619 struct wireless_dev *tmp;
620
621 if (!wiphy)
622 return -ENODEV;
623 *rdev = wiphy_to_rdev(wiphy);
624 *wdev = NULL;
625
626 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
627 if (tmp->identifier == cb->args[1]) {
628 *wdev = tmp;
629 break;
630 }
631 }
632
633 if (!*wdev)
634 return -ENODEV;
635 }
636
637 return 0;
638 }
639
640 /* IE validation */
641 static bool is_valid_ie_attr(const struct nlattr *attr)
642 {
643 const u8 *pos;
644 int len;
645
646 if (!attr)
647 return true;
648
649 pos = nla_data(attr);
650 len = nla_len(attr);
651
652 while (len) {
653 u8 elemlen;
654
655 if (len < 2)
656 return false;
657 len -= 2;
658
659 elemlen = pos[1];
660 if (elemlen > len)
661 return false;
662
663 len -= elemlen;
664 pos += 2 + elemlen;
665 }
666
667 return true;
668 }
669
670 /* message building helper */
671 static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
672 int flags, u8 cmd)
673 {
674 /* since there is no private header just add the generic one */
675 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
676 }
677
678 static int nl80211_msg_put_channel(struct sk_buff *msg,
679 struct ieee80211_channel *chan,
680 bool large)
681 {
682 /* Some channels must be completely excluded from the
683 * list to protect old user-space tools from breaking
684 */
685 if (!large && chan->flags &
686 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
687 return 0;
688
689 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
690 chan->center_freq))
691 goto nla_put_failure;
692
693 if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
694 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
695 goto nla_put_failure;
696 if (chan->flags & IEEE80211_CHAN_NO_IR) {
697 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
698 goto nla_put_failure;
699 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
700 goto nla_put_failure;
701 }
702 if (chan->flags & IEEE80211_CHAN_RADAR) {
703 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
704 goto nla_put_failure;
705 if (large) {
706 u32 time;
707
708 time = elapsed_jiffies_msecs(chan->dfs_state_entered);
709
710 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
711 chan->dfs_state))
712 goto nla_put_failure;
713 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
714 time))
715 goto nla_put_failure;
716 if (nla_put_u32(msg,
717 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
718 chan->dfs_cac_ms))
719 goto nla_put_failure;
720 }
721 }
722
723 if (large) {
724 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
725 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
726 goto nla_put_failure;
727 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
728 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
729 goto nla_put_failure;
730 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
731 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
732 goto nla_put_failure;
733 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
734 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
735 goto nla_put_failure;
736 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
737 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
738 goto nla_put_failure;
739 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
740 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
741 goto nla_put_failure;
742 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
743 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
744 goto nla_put_failure;
745 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
746 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
747 goto nla_put_failure;
748 }
749
750 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
751 DBM_TO_MBM(chan->max_power)))
752 goto nla_put_failure;
753
754 return 0;
755
756 nla_put_failure:
757 return -ENOBUFS;
758 }
759
760 /* netlink command implementations */
761
762 struct key_parse {
763 struct key_params p;
764 int idx;
765 int type;
766 bool def, defmgmt;
767 bool def_uni, def_multi;
768 };
769
770 static int nl80211_parse_key_new(struct nlattr *key, struct key_parse *k)
771 {
772 struct nlattr *tb[NL80211_KEY_MAX + 1];
773 int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
774 nl80211_key_policy, NULL);
775 if (err)
776 return err;
777
778 k->def = !!tb[NL80211_KEY_DEFAULT];
779 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
780
781 if (k->def) {
782 k->def_uni = true;
783 k->def_multi = true;
784 }
785 if (k->defmgmt)
786 k->def_multi = true;
787
788 if (tb[NL80211_KEY_IDX])
789 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
790
791 if (tb[NL80211_KEY_DATA]) {
792 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
793 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
794 }
795
796 if (tb[NL80211_KEY_SEQ]) {
797 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
798 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
799 }
800
801 if (tb[NL80211_KEY_CIPHER])
802 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
803
804 if (tb[NL80211_KEY_TYPE]) {
805 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
806 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
807 return -EINVAL;
808 }
809
810 if (tb[NL80211_KEY_DEFAULT_TYPES]) {
811 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
812
813 err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
814 tb[NL80211_KEY_DEFAULT_TYPES],
815 nl80211_key_default_policy, NULL);
816 if (err)
817 return err;
818
819 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
820 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
821 }
822
823 return 0;
824 }
825
826 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
827 {
828 if (info->attrs[NL80211_ATTR_KEY_DATA]) {
829 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
830 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
831 }
832
833 if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
834 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
835 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
836 }
837
838 if (info->attrs[NL80211_ATTR_KEY_IDX])
839 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
840
841 if (info->attrs[NL80211_ATTR_KEY_CIPHER])
842 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
843
844 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
845 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
846
847 if (k->def) {
848 k->def_uni = true;
849 k->def_multi = true;
850 }
851 if (k->defmgmt)
852 k->def_multi = true;
853
854 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
855 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
856 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
857 return -EINVAL;
858 }
859
860 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
861 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
862 int err = nla_parse_nested(kdt,
863 NUM_NL80211_KEY_DEFAULT_TYPES - 1,
864 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
865 nl80211_key_default_policy,
866 info->extack);
867 if (err)
868 return err;
869
870 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
871 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
872 }
873
874 return 0;
875 }
876
877 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
878 {
879 int err;
880
881 memset(k, 0, sizeof(*k));
882 k->idx = -1;
883 k->type = -1;
884
885 if (info->attrs[NL80211_ATTR_KEY])
886 err = nl80211_parse_key_new(info->attrs[NL80211_ATTR_KEY], k);
887 else
888 err = nl80211_parse_key_old(info, k);
889
890 if (err)
891 return err;
892
893 if (k->def && k->defmgmt)
894 return -EINVAL;
895
896 if (k->defmgmt) {
897 if (k->def_uni || !k->def_multi)
898 return -EINVAL;
899 }
900
901 if (k->idx != -1) {
902 if (k->defmgmt) {
903 if (k->idx < 4 || k->idx > 5)
904 return -EINVAL;
905 } else if (k->def) {
906 if (k->idx < 0 || k->idx > 3)
907 return -EINVAL;
908 } else {
909 if (k->idx < 0 || k->idx > 5)
910 return -EINVAL;
911 }
912 }
913
914 return 0;
915 }
916
917 static struct cfg80211_cached_keys *
918 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
919 struct nlattr *keys, bool *no_ht)
920 {
921 struct key_parse parse;
922 struct nlattr *key;
923 struct cfg80211_cached_keys *result;
924 int rem, err, def = 0;
925 bool have_key = false;
926
927 nla_for_each_nested(key, keys, rem) {
928 have_key = true;
929 break;
930 }
931
932 if (!have_key)
933 return NULL;
934
935 result = kzalloc(sizeof(*result), GFP_KERNEL);
936 if (!result)
937 return ERR_PTR(-ENOMEM);
938
939 result->def = -1;
940
941 nla_for_each_nested(key, keys, rem) {
942 memset(&parse, 0, sizeof(parse));
943 parse.idx = -1;
944
945 err = nl80211_parse_key_new(key, &parse);
946 if (err)
947 goto error;
948 err = -EINVAL;
949 if (!parse.p.key)
950 goto error;
951 if (parse.idx < 0 || parse.idx > 3)
952 goto error;
953 if (parse.def) {
954 if (def)
955 goto error;
956 def = 1;
957 result->def = parse.idx;
958 if (!parse.def_uni || !parse.def_multi)
959 goto error;
960 } else if (parse.defmgmt)
961 goto error;
962 err = cfg80211_validate_key_settings(rdev, &parse.p,
963 parse.idx, false, NULL);
964 if (err)
965 goto error;
966 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
967 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
968 err = -EINVAL;
969 goto error;
970 }
971 result->params[parse.idx].cipher = parse.p.cipher;
972 result->params[parse.idx].key_len = parse.p.key_len;
973 result->params[parse.idx].key = result->data[parse.idx];
974 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
975
976 /* must be WEP key if we got here */
977 if (no_ht)
978 *no_ht = true;
979 }
980
981 if (result->def < 0) {
982 err = -EINVAL;
983 goto error;
984 }
985
986 return result;
987 error:
988 kfree(result);
989 return ERR_PTR(err);
990 }
991
992 static int nl80211_key_allowed(struct wireless_dev *wdev)
993 {
994 ASSERT_WDEV_LOCK(wdev);
995
996 switch (wdev->iftype) {
997 case NL80211_IFTYPE_AP:
998 case NL80211_IFTYPE_AP_VLAN:
999 case NL80211_IFTYPE_P2P_GO:
1000 case NL80211_IFTYPE_MESH_POINT:
1001 break;
1002 case NL80211_IFTYPE_ADHOC:
1003 case NL80211_IFTYPE_STATION:
1004 case NL80211_IFTYPE_P2P_CLIENT:
1005 if (!wdev->current_bss)
1006 return -ENOLINK;
1007 break;
1008 case NL80211_IFTYPE_UNSPECIFIED:
1009 case NL80211_IFTYPE_OCB:
1010 case NL80211_IFTYPE_MONITOR:
1011 case NL80211_IFTYPE_NAN:
1012 case NL80211_IFTYPE_P2P_DEVICE:
1013 case NL80211_IFTYPE_WDS:
1014 case NUM_NL80211_IFTYPES:
1015 return -EINVAL;
1016 }
1017
1018 return 0;
1019 }
1020
1021 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
1022 struct nlattr *tb)
1023 {
1024 struct ieee80211_channel *chan;
1025
1026 if (tb == NULL)
1027 return NULL;
1028 chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
1029 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
1030 return NULL;
1031 return chan;
1032 }
1033
1034 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
1035 {
1036 struct nlattr *nl_modes = nla_nest_start(msg, attr);
1037 int i;
1038
1039 if (!nl_modes)
1040 goto nla_put_failure;
1041
1042 i = 0;
1043 while (ifmodes) {
1044 if ((ifmodes & 1) && nla_put_flag(msg, i))
1045 goto nla_put_failure;
1046 ifmodes >>= 1;
1047 i++;
1048 }
1049
1050 nla_nest_end(msg, nl_modes);
1051 return 0;
1052
1053 nla_put_failure:
1054 return -ENOBUFS;
1055 }
1056
1057 static int nl80211_put_iface_combinations(struct wiphy *wiphy,
1058 struct sk_buff *msg,
1059 bool large)
1060 {
1061 struct nlattr *nl_combis;
1062 int i, j;
1063
1064 nl_combis = nla_nest_start(msg,
1065 NL80211_ATTR_INTERFACE_COMBINATIONS);
1066 if (!nl_combis)
1067 goto nla_put_failure;
1068
1069 for (i = 0; i < wiphy->n_iface_combinations; i++) {
1070 const struct ieee80211_iface_combination *c;
1071 struct nlattr *nl_combi, *nl_limits;
1072
1073 c = &wiphy->iface_combinations[i];
1074
1075 nl_combi = nla_nest_start(msg, i + 1);
1076 if (!nl_combi)
1077 goto nla_put_failure;
1078
1079 nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
1080 if (!nl_limits)
1081 goto nla_put_failure;
1082
1083 for (j = 0; j < c->n_limits; j++) {
1084 struct nlattr *nl_limit;
1085
1086 nl_limit = nla_nest_start(msg, j + 1);
1087 if (!nl_limit)
1088 goto nla_put_failure;
1089 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
1090 c->limits[j].max))
1091 goto nla_put_failure;
1092 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
1093 c->limits[j].types))
1094 goto nla_put_failure;
1095 nla_nest_end(msg, nl_limit);
1096 }
1097
1098 nla_nest_end(msg, nl_limits);
1099
1100 if (c->beacon_int_infra_match &&
1101 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
1102 goto nla_put_failure;
1103 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
1104 c->num_different_channels) ||
1105 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
1106 c->max_interfaces))
1107 goto nla_put_failure;
1108 if (large &&
1109 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
1110 c->radar_detect_widths) ||
1111 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
1112 c->radar_detect_regions)))
1113 goto nla_put_failure;
1114 if (c->beacon_int_min_gcd &&
1115 nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
1116 c->beacon_int_min_gcd))
1117 goto nla_put_failure;
1118
1119 nla_nest_end(msg, nl_combi);
1120 }
1121
1122 nla_nest_end(msg, nl_combis);
1123
1124 return 0;
1125 nla_put_failure:
1126 return -ENOBUFS;
1127 }
1128
1129 #ifdef CONFIG_PM
1130 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
1131 struct sk_buff *msg)
1132 {
1133 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
1134 struct nlattr *nl_tcp;
1135
1136 if (!tcp)
1137 return 0;
1138
1139 nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
1140 if (!nl_tcp)
1141 return -ENOBUFS;
1142
1143 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1144 tcp->data_payload_max))
1145 return -ENOBUFS;
1146
1147 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1148 tcp->data_payload_max))
1149 return -ENOBUFS;
1150
1151 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
1152 return -ENOBUFS;
1153
1154 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
1155 sizeof(*tcp->tok), tcp->tok))
1156 return -ENOBUFS;
1157
1158 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
1159 tcp->data_interval_max))
1160 return -ENOBUFS;
1161
1162 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
1163 tcp->wake_payload_max))
1164 return -ENOBUFS;
1165
1166 nla_nest_end(msg, nl_tcp);
1167 return 0;
1168 }
1169
1170 static int nl80211_send_wowlan(struct sk_buff *msg,
1171 struct cfg80211_registered_device *rdev,
1172 bool large)
1173 {
1174 struct nlattr *nl_wowlan;
1175
1176 if (!rdev->wiphy.wowlan)
1177 return 0;
1178
1179 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1180 if (!nl_wowlan)
1181 return -ENOBUFS;
1182
1183 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
1184 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1185 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
1186 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1187 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
1188 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1189 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
1190 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1191 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
1192 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1193 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
1194 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1195 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
1196 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1197 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
1198 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1199 return -ENOBUFS;
1200
1201 if (rdev->wiphy.wowlan->n_patterns) {
1202 struct nl80211_pattern_support pat = {
1203 .max_patterns = rdev->wiphy.wowlan->n_patterns,
1204 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
1205 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
1206 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
1207 };
1208
1209 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1210 sizeof(pat), &pat))
1211 return -ENOBUFS;
1212 }
1213
1214 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
1215 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
1216 rdev->wiphy.wowlan->max_nd_match_sets))
1217 return -ENOBUFS;
1218
1219 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
1220 return -ENOBUFS;
1221
1222 nla_nest_end(msg, nl_wowlan);
1223
1224 return 0;
1225 }
1226 #endif
1227
1228 static int nl80211_send_coalesce(struct sk_buff *msg,
1229 struct cfg80211_registered_device *rdev)
1230 {
1231 struct nl80211_coalesce_rule_support rule;
1232
1233 if (!rdev->wiphy.coalesce)
1234 return 0;
1235
1236 rule.max_rules = rdev->wiphy.coalesce->n_rules;
1237 rule.max_delay = rdev->wiphy.coalesce->max_delay;
1238 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
1239 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
1240 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
1241 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
1242
1243 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
1244 return -ENOBUFS;
1245
1246 return 0;
1247 }
1248
1249 static int nl80211_send_band_rateinfo(struct sk_buff *msg,
1250 struct ieee80211_supported_band *sband)
1251 {
1252 struct nlattr *nl_rates, *nl_rate;
1253 struct ieee80211_rate *rate;
1254 int i;
1255
1256 /* add HT info */
1257 if (sband->ht_cap.ht_supported &&
1258 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
1259 sizeof(sband->ht_cap.mcs),
1260 &sband->ht_cap.mcs) ||
1261 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
1262 sband->ht_cap.cap) ||
1263 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1264 sband->ht_cap.ampdu_factor) ||
1265 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1266 sband->ht_cap.ampdu_density)))
1267 return -ENOBUFS;
1268
1269 /* add VHT info */
1270 if (sband->vht_cap.vht_supported &&
1271 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1272 sizeof(sband->vht_cap.vht_mcs),
1273 &sband->vht_cap.vht_mcs) ||
1274 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1275 sband->vht_cap.cap)))
1276 return -ENOBUFS;
1277
1278 /* add bitrates */
1279 nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
1280 if (!nl_rates)
1281 return -ENOBUFS;
1282
1283 for (i = 0; i < sband->n_bitrates; i++) {
1284 nl_rate = nla_nest_start(msg, i);
1285 if (!nl_rate)
1286 return -ENOBUFS;
1287
1288 rate = &sband->bitrates[i];
1289 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1290 rate->bitrate))
1291 return -ENOBUFS;
1292 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1293 nla_put_flag(msg,
1294 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1295 return -ENOBUFS;
1296
1297 nla_nest_end(msg, nl_rate);
1298 }
1299
1300 nla_nest_end(msg, nl_rates);
1301
1302 return 0;
1303 }
1304
1305 static int
1306 nl80211_send_mgmt_stypes(struct sk_buff *msg,
1307 const struct ieee80211_txrx_stypes *mgmt_stypes)
1308 {
1309 u16 stypes;
1310 struct nlattr *nl_ftypes, *nl_ifs;
1311 enum nl80211_iftype ift;
1312 int i;
1313
1314 if (!mgmt_stypes)
1315 return 0;
1316
1317 nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
1318 if (!nl_ifs)
1319 return -ENOBUFS;
1320
1321 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1322 nl_ftypes = nla_nest_start(msg, ift);
1323 if (!nl_ftypes)
1324 return -ENOBUFS;
1325 i = 0;
1326 stypes = mgmt_stypes[ift].tx;
1327 while (stypes) {
1328 if ((stypes & 1) &&
1329 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1330 (i << 4) | IEEE80211_FTYPE_MGMT))
1331 return -ENOBUFS;
1332 stypes >>= 1;
1333 i++;
1334 }
1335 nla_nest_end(msg, nl_ftypes);
1336 }
1337
1338 nla_nest_end(msg, nl_ifs);
1339
1340 nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
1341 if (!nl_ifs)
1342 return -ENOBUFS;
1343
1344 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1345 nl_ftypes = nla_nest_start(msg, ift);
1346 if (!nl_ftypes)
1347 return -ENOBUFS;
1348 i = 0;
1349 stypes = mgmt_stypes[ift].rx;
1350 while (stypes) {
1351 if ((stypes & 1) &&
1352 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1353 (i << 4) | IEEE80211_FTYPE_MGMT))
1354 return -ENOBUFS;
1355 stypes >>= 1;
1356 i++;
1357 }
1358 nla_nest_end(msg, nl_ftypes);
1359 }
1360 nla_nest_end(msg, nl_ifs);
1361
1362 return 0;
1363 }
1364
1365 #define CMD(op, n) \
1366 do { \
1367 if (rdev->ops->op) { \
1368 i++; \
1369 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
1370 goto nla_put_failure; \
1371 } \
1372 } while (0)
1373
1374 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
1375 struct sk_buff *msg)
1376 {
1377 int i = 0;
1378
1379 /*
1380 * do *NOT* add anything into this function, new things need to be
1381 * advertised only to new versions of userspace that can deal with
1382 * the split (and they can't possibly care about new features...
1383 */
1384 CMD(add_virtual_intf, NEW_INTERFACE);
1385 CMD(change_virtual_intf, SET_INTERFACE);
1386 CMD(add_key, NEW_KEY);
1387 CMD(start_ap, START_AP);
1388 CMD(add_station, NEW_STATION);
1389 CMD(add_mpath, NEW_MPATH);
1390 CMD(update_mesh_config, SET_MESH_CONFIG);
1391 CMD(change_bss, SET_BSS);
1392 CMD(auth, AUTHENTICATE);
1393 CMD(assoc, ASSOCIATE);
1394 CMD(deauth, DEAUTHENTICATE);
1395 CMD(disassoc, DISASSOCIATE);
1396 CMD(join_ibss, JOIN_IBSS);
1397 CMD(join_mesh, JOIN_MESH);
1398 CMD(set_pmksa, SET_PMKSA);
1399 CMD(del_pmksa, DEL_PMKSA);
1400 CMD(flush_pmksa, FLUSH_PMKSA);
1401 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
1402 CMD(remain_on_channel, REMAIN_ON_CHANNEL);
1403 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
1404 CMD(mgmt_tx, FRAME);
1405 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
1406 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
1407 i++;
1408 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
1409 goto nla_put_failure;
1410 }
1411 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
1412 rdev->ops->join_mesh) {
1413 i++;
1414 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1415 goto nla_put_failure;
1416 }
1417 CMD(set_wds_peer, SET_WDS_PEER);
1418 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
1419 CMD(tdls_mgmt, TDLS_MGMT);
1420 CMD(tdls_oper, TDLS_OPER);
1421 }
1422 if (rdev->wiphy.max_sched_scan_reqs)
1423 CMD(sched_scan_start, START_SCHED_SCAN);
1424 CMD(probe_client, PROBE_CLIENT);
1425 CMD(set_noack_map, SET_NOACK_MAP);
1426 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
1427 i++;
1428 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1429 goto nla_put_failure;
1430 }
1431 CMD(start_p2p_device, START_P2P_DEVICE);
1432 CMD(set_mcast_rate, SET_MCAST_RATE);
1433 #ifdef CONFIG_NL80211_TESTMODE
1434 CMD(testmode_cmd, TESTMODE);
1435 #endif
1436
1437 if (rdev->ops->connect || rdev->ops->auth) {
1438 i++;
1439 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
1440 goto nla_put_failure;
1441 }
1442
1443 if (rdev->ops->disconnect || rdev->ops->deauth) {
1444 i++;
1445 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1446 goto nla_put_failure;
1447 }
1448
1449 return i;
1450 nla_put_failure:
1451 return -ENOBUFS;
1452 }
1453
1454 struct nl80211_dump_wiphy_state {
1455 s64 filter_wiphy;
1456 long start;
1457 long split_start, band_start, chan_start, capa_start;
1458 bool split;
1459 };
1460
1461 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
1462 enum nl80211_commands cmd,
1463 struct sk_buff *msg, u32 portid, u32 seq,
1464 int flags, struct nl80211_dump_wiphy_state *state)
1465 {
1466 void *hdr;
1467 struct nlattr *nl_bands, *nl_band;
1468 struct nlattr *nl_freqs, *nl_freq;
1469 struct nlattr *nl_cmds;
1470 enum nl80211_band band;
1471 struct ieee80211_channel *chan;
1472 int i;
1473 const struct ieee80211_txrx_stypes *mgmt_stypes =
1474 rdev->wiphy.mgmt_stypes;
1475 u32 features;
1476
1477 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
1478 if (!hdr)
1479 return -ENOBUFS;
1480
1481 if (WARN_ON(!state))
1482 return -EINVAL;
1483
1484 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
1485 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
1486 wiphy_name(&rdev->wiphy)) ||
1487 nla_put_u32(msg, NL80211_ATTR_GENERATION,
1488 cfg80211_rdev_list_generation))
1489 goto nla_put_failure;
1490
1491 if (cmd != NL80211_CMD_NEW_WIPHY)
1492 goto finish;
1493
1494 switch (state->split_start) {
1495 case 0:
1496 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
1497 rdev->wiphy.retry_short) ||
1498 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
1499 rdev->wiphy.retry_long) ||
1500 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
1501 rdev->wiphy.frag_threshold) ||
1502 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
1503 rdev->wiphy.rts_threshold) ||
1504 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
1505 rdev->wiphy.coverage_class) ||
1506 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
1507 rdev->wiphy.max_scan_ssids) ||
1508 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
1509 rdev->wiphy.max_sched_scan_ssids) ||
1510 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
1511 rdev->wiphy.max_scan_ie_len) ||
1512 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
1513 rdev->wiphy.max_sched_scan_ie_len) ||
1514 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
1515 rdev->wiphy.max_match_sets) ||
1516 nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
1517 rdev->wiphy.max_sched_scan_plans) ||
1518 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
1519 rdev->wiphy.max_sched_scan_plan_interval) ||
1520 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
1521 rdev->wiphy.max_sched_scan_plan_iterations))
1522 goto nla_put_failure;
1523
1524 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
1525 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
1526 goto nla_put_failure;
1527 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
1528 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
1529 goto nla_put_failure;
1530 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
1531 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
1532 goto nla_put_failure;
1533 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
1534 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
1535 goto nla_put_failure;
1536 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
1537 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
1538 goto nla_put_failure;
1539 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
1540 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
1541 goto nla_put_failure;
1542 state->split_start++;
1543 if (state->split)
1544 break;
1545 case 1:
1546 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
1547 sizeof(u32) * rdev->wiphy.n_cipher_suites,
1548 rdev->wiphy.cipher_suites))
1549 goto nla_put_failure;
1550
1551 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
1552 rdev->wiphy.max_num_pmkids))
1553 goto nla_put_failure;
1554
1555 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
1556 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
1557 goto nla_put_failure;
1558
1559 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
1560 rdev->wiphy.available_antennas_tx) ||
1561 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
1562 rdev->wiphy.available_antennas_rx))
1563 goto nla_put_failure;
1564
1565 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
1566 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
1567 rdev->wiphy.probe_resp_offload))
1568 goto nla_put_failure;
1569
1570 if ((rdev->wiphy.available_antennas_tx ||
1571 rdev->wiphy.available_antennas_rx) &&
1572 rdev->ops->get_antenna) {
1573 u32 tx_ant = 0, rx_ant = 0;
1574 int res;
1575
1576 res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
1577 if (!res) {
1578 if (nla_put_u32(msg,
1579 NL80211_ATTR_WIPHY_ANTENNA_TX,
1580 tx_ant) ||
1581 nla_put_u32(msg,
1582 NL80211_ATTR_WIPHY_ANTENNA_RX,
1583 rx_ant))
1584 goto nla_put_failure;
1585 }
1586 }
1587
1588 state->split_start++;
1589 if (state->split)
1590 break;
1591 case 2:
1592 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
1593 rdev->wiphy.interface_modes))
1594 goto nla_put_failure;
1595 state->split_start++;
1596 if (state->split)
1597 break;
1598 case 3:
1599 nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
1600 if (!nl_bands)
1601 goto nla_put_failure;
1602
1603 for (band = state->band_start;
1604 band < NUM_NL80211_BANDS; band++) {
1605 struct ieee80211_supported_band *sband;
1606
1607 sband = rdev->wiphy.bands[band];
1608
1609 if (!sband)
1610 continue;
1611
1612 nl_band = nla_nest_start(msg, band);
1613 if (!nl_band)
1614 goto nla_put_failure;
1615
1616 switch (state->chan_start) {
1617 case 0:
1618 if (nl80211_send_band_rateinfo(msg, sband))
1619 goto nla_put_failure;
1620 state->chan_start++;
1621 if (state->split)
1622 break;
1623 default:
1624 /* add frequencies */
1625 nl_freqs = nla_nest_start(
1626 msg, NL80211_BAND_ATTR_FREQS);
1627 if (!nl_freqs)
1628 goto nla_put_failure;
1629
1630 for (i = state->chan_start - 1;
1631 i < sband->n_channels;
1632 i++) {
1633 nl_freq = nla_nest_start(msg, i);
1634 if (!nl_freq)
1635 goto nla_put_failure;
1636
1637 chan = &sband->channels[i];
1638
1639 if (nl80211_msg_put_channel(
1640 msg, chan,
1641 state->split))
1642 goto nla_put_failure;
1643
1644 nla_nest_end(msg, nl_freq);
1645 if (state->split)
1646 break;
1647 }
1648 if (i < sband->n_channels)
1649 state->chan_start = i + 2;
1650 else
1651 state->chan_start = 0;
1652 nla_nest_end(msg, nl_freqs);
1653 }
1654
1655 nla_nest_end(msg, nl_band);
1656
1657 if (state->split) {
1658 /* start again here */
1659 if (state->chan_start)
1660 band--;
1661 break;
1662 }
1663 }
1664 nla_nest_end(msg, nl_bands);
1665
1666 if (band < NUM_NL80211_BANDS)
1667 state->band_start = band + 1;
1668 else
1669 state->band_start = 0;
1670
1671 /* if bands & channels are done, continue outside */
1672 if (state->band_start == 0 && state->chan_start == 0)
1673 state->split_start++;
1674 if (state->split)
1675 break;
1676 case 4:
1677 nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
1678 if (!nl_cmds)
1679 goto nla_put_failure;
1680
1681 i = nl80211_add_commands_unsplit(rdev, msg);
1682 if (i < 0)
1683 goto nla_put_failure;
1684 if (state->split) {
1685 CMD(crit_proto_start, CRIT_PROTOCOL_START);
1686 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
1687 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
1688 CMD(channel_switch, CHANNEL_SWITCH);
1689 CMD(set_qos_map, SET_QOS_MAP);
1690 if (rdev->wiphy.features &
1691 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
1692 CMD(add_tx_ts, ADD_TX_TS);
1693 CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
1694 CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
1695 }
1696 #undef CMD
1697
1698 nla_nest_end(msg, nl_cmds);
1699 state->split_start++;
1700 if (state->split)
1701 break;
1702 case 5:
1703 if (rdev->ops->remain_on_channel &&
1704 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
1705 nla_put_u32(msg,
1706 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
1707 rdev->wiphy.max_remain_on_channel_duration))
1708 goto nla_put_failure;
1709
1710 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
1711 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
1712 goto nla_put_failure;
1713
1714 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
1715 goto nla_put_failure;
1716 state->split_start++;
1717 if (state->split)
1718 break;
1719 case 6:
1720 #ifdef CONFIG_PM
1721 if (nl80211_send_wowlan(msg, rdev, state->split))
1722 goto nla_put_failure;
1723 state->split_start++;
1724 if (state->split)
1725 break;
1726 #else
1727 state->split_start++;
1728 #endif
1729 case 7:
1730 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
1731 rdev->wiphy.software_iftypes))
1732 goto nla_put_failure;
1733
1734 if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
1735 state->split))
1736 goto nla_put_failure;
1737
1738 state->split_start++;
1739 if (state->split)
1740 break;
1741 case 8:
1742 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
1743 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
1744 rdev->wiphy.ap_sme_capa))
1745 goto nla_put_failure;
1746
1747 features = rdev->wiphy.features;
1748 /*
1749 * We can only add the per-channel limit information if the
1750 * dump is split, otherwise it makes it too big. Therefore
1751 * only advertise it in that case.
1752 */
1753 if (state->split)
1754 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
1755 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
1756 goto nla_put_failure;
1757
1758 if (rdev->wiphy.ht_capa_mod_mask &&
1759 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
1760 sizeof(*rdev->wiphy.ht_capa_mod_mask),
1761 rdev->wiphy.ht_capa_mod_mask))
1762 goto nla_put_failure;
1763
1764 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
1765 rdev->wiphy.max_acl_mac_addrs &&
1766 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
1767 rdev->wiphy.max_acl_mac_addrs))
1768 goto nla_put_failure;
1769
1770 /*
1771 * Any information below this point is only available to
1772 * applications that can deal with it being split. This
1773 * helps ensure that newly added capabilities don't break
1774 * older tools by overrunning their buffers.
1775 *
1776 * We still increment split_start so that in the split
1777 * case we'll continue with more data in the next round,
1778 * but break unconditionally so unsplit data stops here.
1779 */
1780 state->split_start++;
1781 break;
1782 case 9:
1783 if (rdev->wiphy.extended_capabilities &&
1784 (nla_put(msg, NL80211_ATTR_EXT_CAPA,
1785 rdev->wiphy.extended_capabilities_len,
1786 rdev->wiphy.extended_capabilities) ||
1787 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1788 rdev->wiphy.extended_capabilities_len,
1789 rdev->wiphy.extended_capabilities_mask)))
1790 goto nla_put_failure;
1791
1792 if (rdev->wiphy.vht_capa_mod_mask &&
1793 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
1794 sizeof(*rdev->wiphy.vht_capa_mod_mask),
1795 rdev->wiphy.vht_capa_mod_mask))
1796 goto nla_put_failure;
1797
1798 state->split_start++;
1799 break;
1800 case 10:
1801 if (nl80211_send_coalesce(msg, rdev))
1802 goto nla_put_failure;
1803
1804 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
1805 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
1806 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
1807 goto nla_put_failure;
1808
1809 if (rdev->wiphy.max_ap_assoc_sta &&
1810 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
1811 rdev->wiphy.max_ap_assoc_sta))
1812 goto nla_put_failure;
1813
1814 state->split_start++;
1815 break;
1816 case 11:
1817 if (rdev->wiphy.n_vendor_commands) {
1818 const struct nl80211_vendor_cmd_info *info;
1819 struct nlattr *nested;
1820
1821 nested = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA);
1822 if (!nested)
1823 goto nla_put_failure;
1824
1825 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
1826 info = &rdev->wiphy.vendor_commands[i].info;
1827 if (nla_put(msg, i + 1, sizeof(*info), info))
1828 goto nla_put_failure;
1829 }
1830 nla_nest_end(msg, nested);
1831 }
1832
1833 if (rdev->wiphy.n_vendor_events) {
1834 const struct nl80211_vendor_cmd_info *info;
1835 struct nlattr *nested;
1836
1837 nested = nla_nest_start(msg,
1838 NL80211_ATTR_VENDOR_EVENTS);
1839 if (!nested)
1840 goto nla_put_failure;
1841
1842 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
1843 info = &rdev->wiphy.vendor_events[i];
1844 if (nla_put(msg, i + 1, sizeof(*info), info))
1845 goto nla_put_failure;
1846 }
1847 nla_nest_end(msg, nested);
1848 }
1849 state->split_start++;
1850 break;
1851 case 12:
1852 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
1853 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
1854 rdev->wiphy.max_num_csa_counters))
1855 goto nla_put_failure;
1856
1857 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
1858 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
1859 goto nla_put_failure;
1860
1861 if (rdev->wiphy.max_sched_scan_reqs &&
1862 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
1863 rdev->wiphy.max_sched_scan_reqs))
1864 goto nla_put_failure;
1865
1866 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
1867 sizeof(rdev->wiphy.ext_features),
1868 rdev->wiphy.ext_features))
1869 goto nla_put_failure;
1870
1871 if (rdev->wiphy.bss_select_support) {
1872 struct nlattr *nested;
1873 u32 bss_select_support = rdev->wiphy.bss_select_support;
1874
1875 nested = nla_nest_start(msg, NL80211_ATTR_BSS_SELECT);
1876 if (!nested)
1877 goto nla_put_failure;
1878
1879 i = 0;
1880 while (bss_select_support) {
1881 if ((bss_select_support & 1) &&
1882 nla_put_flag(msg, i))
1883 goto nla_put_failure;
1884 i++;
1885 bss_select_support >>= 1;
1886 }
1887 nla_nest_end(msg, nested);
1888 }
1889
1890 state->split_start++;
1891 break;
1892 case 13:
1893 if (rdev->wiphy.num_iftype_ext_capab &&
1894 rdev->wiphy.iftype_ext_capab) {
1895 struct nlattr *nested_ext_capab, *nested;
1896
1897 nested = nla_nest_start(msg,
1898 NL80211_ATTR_IFTYPE_EXT_CAPA);
1899 if (!nested)
1900 goto nla_put_failure;
1901
1902 for (i = state->capa_start;
1903 i < rdev->wiphy.num_iftype_ext_capab; i++) {
1904 const struct wiphy_iftype_ext_capab *capab;
1905
1906 capab = &rdev->wiphy.iftype_ext_capab[i];
1907
1908 nested_ext_capab = nla_nest_start(msg, i);
1909 if (!nested_ext_capab ||
1910 nla_put_u32(msg, NL80211_ATTR_IFTYPE,
1911 capab->iftype) ||
1912 nla_put(msg, NL80211_ATTR_EXT_CAPA,
1913 capab->extended_capabilities_len,
1914 capab->extended_capabilities) ||
1915 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1916 capab->extended_capabilities_len,
1917 capab->extended_capabilities_mask))
1918 goto nla_put_failure;
1919
1920 nla_nest_end(msg, nested_ext_capab);
1921 if (state->split)
1922 break;
1923 }
1924 nla_nest_end(msg, nested);
1925 if (i < rdev->wiphy.num_iftype_ext_capab) {
1926 state->capa_start = i + 1;
1927 break;
1928 }
1929 }
1930
1931 if (nla_put_u32(msg, NL80211_ATTR_BANDS,
1932 rdev->wiphy.nan_supported_bands))
1933 goto nla_put_failure;
1934
1935 /* done */
1936 state->split_start = 0;
1937 break;
1938 }
1939 finish:
1940 genlmsg_end(msg, hdr);
1941 return 0;
1942
1943 nla_put_failure:
1944 genlmsg_cancel(msg, hdr);
1945 return -EMSGSIZE;
1946 }
1947
1948 static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
1949 struct netlink_callback *cb,
1950 struct nl80211_dump_wiphy_state *state)
1951 {
1952 struct nlattr **tb = genl_family_attrbuf(&nl80211_fam);
1953 int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize, tb,
1954 nl80211_fam.maxattr, nl80211_policy, NULL);
1955 /* ignore parse errors for backward compatibility */
1956 if (ret)
1957 return 0;
1958
1959 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
1960 if (tb[NL80211_ATTR_WIPHY])
1961 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
1962 if (tb[NL80211_ATTR_WDEV])
1963 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
1964 if (tb[NL80211_ATTR_IFINDEX]) {
1965 struct net_device *netdev;
1966 struct cfg80211_registered_device *rdev;
1967 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
1968
1969 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
1970 if (!netdev)
1971 return -ENODEV;
1972 if (netdev->ieee80211_ptr) {
1973 rdev = wiphy_to_rdev(
1974 netdev->ieee80211_ptr->wiphy);
1975 state->filter_wiphy = rdev->wiphy_idx;
1976 }
1977 }
1978
1979 return 0;
1980 }
1981
1982 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
1983 {
1984 int idx = 0, ret;
1985 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
1986 struct cfg80211_registered_device *rdev;
1987
1988 rtnl_lock();
1989 if (!state) {
1990 state = kzalloc(sizeof(*state), GFP_KERNEL);
1991 if (!state) {
1992 rtnl_unlock();
1993 return -ENOMEM;
1994 }
1995 state->filter_wiphy = -1;
1996 ret = nl80211_dump_wiphy_parse(skb, cb, state);
1997 if (ret) {
1998 kfree(state);
1999 rtnl_unlock();
2000 return ret;
2001 }
2002 cb->args[0] = (long)state;
2003 }
2004
2005 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2006 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
2007 continue;
2008 if (++idx <= state->start)
2009 continue;
2010 if (state->filter_wiphy != -1 &&
2011 state->filter_wiphy != rdev->wiphy_idx)
2012 continue;
2013 /* attempt to fit multiple wiphy data chunks into the skb */
2014 do {
2015 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
2016 skb,
2017 NETLINK_CB(cb->skb).portid,
2018 cb->nlh->nlmsg_seq,
2019 NLM_F_MULTI, state);
2020 if (ret < 0) {
2021 /*
2022 * If sending the wiphy data didn't fit (ENOBUFS
2023 * or EMSGSIZE returned), this SKB is still
2024 * empty (so it's not too big because another
2025 * wiphy dataset is already in the skb) and
2026 * we've not tried to adjust the dump allocation
2027 * yet ... then adjust the alloc size to be
2028 * bigger, and return 1 but with the empty skb.
2029 * This results in an empty message being RX'ed
2030 * in userspace, but that is ignored.
2031 *
2032 * We can then retry with the larger buffer.
2033 */
2034 if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
2035 !skb->len && !state->split &&
2036 cb->min_dump_alloc < 4096) {
2037 cb->min_dump_alloc = 4096;
2038 state->split_start = 0;
2039 rtnl_unlock();
2040 return 1;
2041 }
2042 idx--;
2043 break;
2044 }
2045 } while (state->split_start > 0);
2046 break;
2047 }
2048 rtnl_unlock();
2049
2050 state->start = idx;
2051
2052 return skb->len;
2053 }
2054
2055 static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
2056 {
2057 kfree((void *)cb->args[0]);
2058 return 0;
2059 }
2060
2061 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
2062 {
2063 struct sk_buff *msg;
2064 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2065 struct nl80211_dump_wiphy_state state = {};
2066
2067 msg = nlmsg_new(4096, GFP_KERNEL);
2068 if (!msg)
2069 return -ENOMEM;
2070
2071 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
2072 info->snd_portid, info->snd_seq, 0,
2073 &state) < 0) {
2074 nlmsg_free(msg);
2075 return -ENOBUFS;
2076 }
2077
2078 return genlmsg_reply(msg, info);
2079 }
2080
2081 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
2082 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
2083 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
2084 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
2085 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
2086 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
2087 };
2088
2089 static int parse_txq_params(struct nlattr *tb[],
2090 struct ieee80211_txq_params *txq_params)
2091 {
2092 u8 ac;
2093
2094 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
2095 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
2096 !tb[NL80211_TXQ_ATTR_AIFS])
2097 return -EINVAL;
2098
2099 ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
2100 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
2101 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
2102 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
2103 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
2104
2105 if (ac >= NL80211_NUM_ACS)
2106 return -EINVAL;
2107 txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS);
2108 return 0;
2109 }
2110
2111 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
2112 {
2113 /*
2114 * You can only set the channel explicitly for WDS interfaces,
2115 * all others have their channel managed via their respective
2116 * "establish a connection" command (connect, join, ...)
2117 *
2118 * For AP/GO and mesh mode, the channel can be set with the
2119 * channel userspace API, but is only stored and passed to the
2120 * low-level driver when the AP starts or the mesh is joined.
2121 * This is for backward compatibility, userspace can also give
2122 * the channel in the start-ap or join-mesh commands instead.
2123 *
2124 * Monitors are special as they are normally slaved to
2125 * whatever else is going on, so they have their own special
2126 * operation to set the monitor channel if possible.
2127 */
2128 return !wdev ||
2129 wdev->iftype == NL80211_IFTYPE_AP ||
2130 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
2131 wdev->iftype == NL80211_IFTYPE_MONITOR ||
2132 wdev->iftype == NL80211_IFTYPE_P2P_GO;
2133 }
2134
2135 static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
2136 struct genl_info *info,
2137 struct cfg80211_chan_def *chandef)
2138 {
2139 u32 control_freq;
2140
2141 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
2142 return -EINVAL;
2143
2144 control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
2145
2146 memset(chandef, 0, sizeof(*chandef));
2147
2148 chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
2149 chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
2150 chandef->center_freq1 = control_freq;
2151 chandef->center_freq2 = 0;
2152
2153 /* Primary channel not allowed */
2154 if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
2155 return -EINVAL;
2156
2157 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
2158 enum nl80211_channel_type chantype;
2159
2160 chantype = nla_get_u32(
2161 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
2162
2163 switch (chantype) {
2164 case NL80211_CHAN_NO_HT:
2165 case NL80211_CHAN_HT20:
2166 case NL80211_CHAN_HT40PLUS:
2167 case NL80211_CHAN_HT40MINUS:
2168 cfg80211_chandef_create(chandef, chandef->chan,
2169 chantype);
2170 /* user input for center_freq is incorrect */
2171 if (info->attrs[NL80211_ATTR_CENTER_FREQ1] &&
2172 chandef->center_freq1 != nla_get_u32(
2173 info->attrs[NL80211_ATTR_CENTER_FREQ1]))
2174 return -EINVAL;
2175 /* center_freq2 must be zero */
2176 if (info->attrs[NL80211_ATTR_CENTER_FREQ2] &&
2177 nla_get_u32(info->attrs[NL80211_ATTR_CENTER_FREQ2]))
2178 return -EINVAL;
2179 break;
2180 default:
2181 return -EINVAL;
2182 }
2183 } else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
2184 chandef->width =
2185 nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
2186 if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
2187 chandef->center_freq1 =
2188 nla_get_u32(
2189 info->attrs[NL80211_ATTR_CENTER_FREQ1]);
2190 if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
2191 chandef->center_freq2 =
2192 nla_get_u32(
2193 info->attrs[NL80211_ATTR_CENTER_FREQ2]);
2194 }
2195
2196 if (!cfg80211_chandef_valid(chandef))
2197 return -EINVAL;
2198
2199 if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
2200 IEEE80211_CHAN_DISABLED))
2201 return -EINVAL;
2202
2203 if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
2204 chandef->width == NL80211_CHAN_WIDTH_10) &&
2205 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ))
2206 return -EINVAL;
2207
2208 return 0;
2209 }
2210
2211 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
2212 struct net_device *dev,
2213 struct genl_info *info)
2214 {
2215 struct cfg80211_chan_def chandef;
2216 int result;
2217 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
2218 struct wireless_dev *wdev = NULL;
2219
2220 if (dev)
2221 wdev = dev->ieee80211_ptr;
2222 if (!nl80211_can_set_dev_channel(wdev))
2223 return -EOPNOTSUPP;
2224 if (wdev)
2225 iftype = wdev->iftype;
2226
2227 result = nl80211_parse_chandef(rdev, info, &chandef);
2228 if (result)
2229 return result;
2230
2231 switch (iftype) {
2232 case NL80211_IFTYPE_AP:
2233 case NL80211_IFTYPE_P2P_GO:
2234 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
2235 iftype)) {
2236 result = -EINVAL;
2237 break;
2238 }
2239 if (wdev->beacon_interval) {
2240 if (!dev || !rdev->ops->set_ap_chanwidth ||
2241 !(rdev->wiphy.features &
2242 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
2243 result = -EBUSY;
2244 break;
2245 }
2246
2247 /* Only allow dynamic channel width changes */
2248 if (chandef.chan != wdev->preset_chandef.chan) {
2249 result = -EBUSY;
2250 break;
2251 }
2252 result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
2253 if (result)
2254 break;
2255 }
2256 wdev->preset_chandef = chandef;
2257 result = 0;
2258 break;
2259 case NL80211_IFTYPE_MESH_POINT:
2260 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
2261 break;
2262 case NL80211_IFTYPE_MONITOR:
2263 result = cfg80211_set_monitor_channel(rdev, &chandef);
2264 break;
2265 default:
2266 result = -EINVAL;
2267 }
2268
2269 return result;
2270 }
2271
2272 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
2273 {
2274 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2275 struct net_device *netdev = info->user_ptr[1];
2276
2277 return __nl80211_set_channel(rdev, netdev, info);
2278 }
2279
2280 static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
2281 {
2282 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2283 struct net_device *dev = info->user_ptr[1];
2284 struct wireless_dev *wdev = dev->ieee80211_ptr;
2285 const u8 *bssid;
2286
2287 if (!info->attrs[NL80211_ATTR_MAC])
2288 return -EINVAL;
2289
2290 if (netif_running(dev))
2291 return -EBUSY;
2292
2293 if (!rdev->ops->set_wds_peer)
2294 return -EOPNOTSUPP;
2295
2296 if (wdev->iftype != NL80211_IFTYPE_WDS)
2297 return -EOPNOTSUPP;
2298
2299 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
2300 return rdev_set_wds_peer(rdev, dev, bssid);
2301 }
2302
2303 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
2304 {
2305 struct cfg80211_registered_device *rdev;
2306 struct net_device *netdev = NULL;
2307 struct wireless_dev *wdev;
2308 int result = 0, rem_txq_params = 0;
2309 struct nlattr *nl_txq_params;
2310 u32 changed;
2311 u8 retry_short = 0, retry_long = 0;
2312 u32 frag_threshold = 0, rts_threshold = 0;
2313 u8 coverage_class = 0;
2314
2315 ASSERT_RTNL();
2316
2317 /*
2318 * Try to find the wiphy and netdev. Normally this
2319 * function shouldn't need the netdev, but this is
2320 * done for backward compatibility -- previously
2321 * setting the channel was done per wiphy, but now
2322 * it is per netdev. Previous userland like hostapd
2323 * also passed a netdev to set_wiphy, so that it is
2324 * possible to let that go to the right netdev!
2325 */
2326
2327 if (info->attrs[NL80211_ATTR_IFINDEX]) {
2328 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
2329
2330 netdev = __dev_get_by_index(genl_info_net(info), ifindex);
2331 if (netdev && netdev->ieee80211_ptr)
2332 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
2333 else
2334 netdev = NULL;
2335 }
2336
2337 if (!netdev) {
2338 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
2339 info->attrs);
2340 if (IS_ERR(rdev))
2341 return PTR_ERR(rdev);
2342 wdev = NULL;
2343 netdev = NULL;
2344 result = 0;
2345 } else
2346 wdev = netdev->ieee80211_ptr;
2347
2348 /*
2349 * end workaround code, by now the rdev is available
2350 * and locked, and wdev may or may not be NULL.
2351 */
2352
2353 if (info->attrs[NL80211_ATTR_WIPHY_NAME])
2354 result = cfg80211_dev_rename(
2355 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
2356
2357 if (result)
2358 return result;
2359
2360 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
2361 struct ieee80211_txq_params txq_params;
2362 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
2363
2364 if (!rdev->ops->set_txq_params)
2365 return -EOPNOTSUPP;
2366
2367 if (!netdev)
2368 return -EINVAL;
2369
2370 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2371 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2372 return -EINVAL;
2373
2374 if (!netif_running(netdev))
2375 return -ENETDOWN;
2376
2377 nla_for_each_nested(nl_txq_params,
2378 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
2379 rem_txq_params) {
2380 result = nla_parse_nested(tb, NL80211_TXQ_ATTR_MAX,
2381 nl_txq_params,
2382 txq_params_policy,
2383 info->extack);
2384 if (result)
2385 return result;
2386 result = parse_txq_params(tb, &txq_params);
2387 if (result)
2388 return result;
2389
2390 result = rdev_set_txq_params(rdev, netdev,
2391 &txq_params);
2392 if (result)
2393 return result;
2394 }
2395 }
2396
2397 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
2398 result = __nl80211_set_channel(
2399 rdev,
2400 nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
2401 info);
2402 if (result)
2403 return result;
2404 }
2405
2406 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
2407 struct wireless_dev *txp_wdev = wdev;
2408 enum nl80211_tx_power_setting type;
2409 int idx, mbm = 0;
2410
2411 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
2412 txp_wdev = NULL;
2413
2414 if (!rdev->ops->set_tx_power)
2415 return -EOPNOTSUPP;
2416
2417 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
2418 type = nla_get_u32(info->attrs[idx]);
2419
2420 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
2421 (type != NL80211_TX_POWER_AUTOMATIC))
2422 return -EINVAL;
2423
2424 if (type != NL80211_TX_POWER_AUTOMATIC) {
2425 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
2426 mbm = nla_get_u32(info->attrs[idx]);
2427 }
2428
2429 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
2430 if (result)
2431 return result;
2432 }
2433
2434 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
2435 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
2436 u32 tx_ant, rx_ant;
2437
2438 if ((!rdev->wiphy.available_antennas_tx &&
2439 !rdev->wiphy.available_antennas_rx) ||
2440 !rdev->ops->set_antenna)
2441 return -EOPNOTSUPP;
2442
2443 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
2444 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
2445
2446 /* reject antenna configurations which don't match the
2447 * available antenna masks, except for the "all" mask */
2448 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
2449 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
2450 return -EINVAL;
2451
2452 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
2453 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
2454
2455 result = rdev_set_antenna(rdev, tx_ant, rx_ant);
2456 if (result)
2457 return result;
2458 }
2459
2460 changed = 0;
2461
2462 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
2463 retry_short = nla_get_u8(
2464 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
2465 if (retry_short == 0)
2466 return -EINVAL;
2467
2468 changed |= WIPHY_PARAM_RETRY_SHORT;
2469 }
2470
2471 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
2472 retry_long = nla_get_u8(
2473 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
2474 if (retry_long == 0)
2475 return -EINVAL;
2476
2477 changed |= WIPHY_PARAM_RETRY_LONG;
2478 }
2479
2480 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
2481 frag_threshold = nla_get_u32(
2482 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
2483 if (frag_threshold < 256)
2484 return -EINVAL;
2485
2486 if (frag_threshold != (u32) -1) {
2487 /*
2488 * Fragments (apart from the last one) are required to
2489 * have even length. Make the fragmentation code
2490 * simpler by stripping LSB should someone try to use
2491 * odd threshold value.
2492 */
2493 frag_threshold &= ~0x1;
2494 }
2495 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
2496 }
2497
2498 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
2499 rts_threshold = nla_get_u32(
2500 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
2501 changed |= WIPHY_PARAM_RTS_THRESHOLD;
2502 }
2503
2504 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
2505 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
2506 return -EINVAL;
2507
2508 coverage_class = nla_get_u8(
2509 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
2510 changed |= WIPHY_PARAM_COVERAGE_CLASS;
2511 }
2512
2513 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
2514 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
2515 return -EOPNOTSUPP;
2516
2517 changed |= WIPHY_PARAM_DYN_ACK;
2518 }
2519
2520 if (changed) {
2521 u8 old_retry_short, old_retry_long;
2522 u32 old_frag_threshold, old_rts_threshold;
2523 u8 old_coverage_class;
2524
2525 if (!rdev->ops->set_wiphy_params)
2526 return -EOPNOTSUPP;
2527
2528 old_retry_short = rdev->wiphy.retry_short;
2529 old_retry_long = rdev->wiphy.retry_long;
2530 old_frag_threshold = rdev->wiphy.frag_threshold;
2531 old_rts_threshold = rdev->wiphy.rts_threshold;
2532 old_coverage_class = rdev->wiphy.coverage_class;
2533
2534 if (changed & WIPHY_PARAM_RETRY_SHORT)
2535 rdev->wiphy.retry_short = retry_short;
2536 if (changed & WIPHY_PARAM_RETRY_LONG)
2537 rdev->wiphy.retry_long = retry_long;
2538 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
2539 rdev->wiphy.frag_threshold = frag_threshold;
2540 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
2541 rdev->wiphy.rts_threshold = rts_threshold;
2542 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
2543 rdev->wiphy.coverage_class = coverage_class;
2544
2545 result = rdev_set_wiphy_params(rdev, changed);
2546 if (result) {
2547 rdev->wiphy.retry_short = old_retry_short;
2548 rdev->wiphy.retry_long = old_retry_long;
2549 rdev->wiphy.frag_threshold = old_frag_threshold;
2550 rdev->wiphy.rts_threshold = old_rts_threshold;
2551 rdev->wiphy.coverage_class = old_coverage_class;
2552 return result;
2553 }
2554 }
2555 return 0;
2556 }
2557
2558 static inline u64 wdev_id(struct wireless_dev *wdev)
2559 {
2560 return (u64)wdev->identifier |
2561 ((u64)wiphy_to_rdev(wdev->wiphy)->wiphy_idx << 32);
2562 }
2563
2564 static int nl80211_send_chandef(struct sk_buff *msg,
2565 const struct cfg80211_chan_def *chandef)
2566 {
2567 if (WARN_ON(!cfg80211_chandef_valid(chandef)))
2568 return -EINVAL;
2569
2570 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
2571 chandef->chan->center_freq))
2572 return -ENOBUFS;
2573 switch (chandef->width) {
2574 case NL80211_CHAN_WIDTH_20_NOHT:
2575 case NL80211_CHAN_WIDTH_20:
2576 case NL80211_CHAN_WIDTH_40:
2577 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
2578 cfg80211_get_chandef_type(chandef)))
2579 return -ENOBUFS;
2580 break;
2581 default:
2582 break;
2583 }
2584 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
2585 return -ENOBUFS;
2586 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
2587 return -ENOBUFS;
2588 if (chandef->center_freq2 &&
2589 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
2590 return -ENOBUFS;
2591 return 0;
2592 }
2593
2594 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
2595 struct cfg80211_registered_device *rdev,
2596 struct wireless_dev *wdev, bool removal)
2597 {
2598 struct net_device *dev = wdev->netdev;
2599 u8 cmd = NL80211_CMD_NEW_INTERFACE;
2600 void *hdr;
2601
2602 if (removal)
2603 cmd = NL80211_CMD_DEL_INTERFACE;
2604
2605 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
2606 if (!hdr)
2607 return -1;
2608
2609 if (dev &&
2610 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
2611 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
2612 goto nla_put_failure;
2613
2614 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
2615 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
2616 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
2617 NL80211_ATTR_PAD) ||
2618 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
2619 nla_put_u32(msg, NL80211_ATTR_GENERATION,
2620 rdev->devlist_generation ^
2621 (cfg80211_rdev_list_generation << 2)))
2622 goto nla_put_failure;
2623
2624 if (rdev->ops->get_channel) {
2625 int ret;
2626 struct cfg80211_chan_def chandef = {};
2627
2628 ret = rdev_get_channel(rdev, wdev, &chandef);
2629 if (ret == 0) {
2630 if (nl80211_send_chandef(msg, &chandef))
2631 goto nla_put_failure;
2632 }
2633 }
2634
2635 if (rdev->ops->get_tx_power) {
2636 int dbm, ret;
2637
2638 ret = rdev_get_tx_power(rdev, wdev, &dbm);
2639 if (ret == 0 &&
2640 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
2641 DBM_TO_MBM(dbm)))
2642 goto nla_put_failure;
2643 }
2644
2645 wdev_lock(wdev);
2646 switch (wdev->iftype) {
2647 case NL80211_IFTYPE_AP:
2648 if (wdev->ssid_len &&
2649 nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
2650 goto nla_put_failure_locked;
2651 break;
2652 case NL80211_IFTYPE_STATION:
2653 case NL80211_IFTYPE_P2P_CLIENT:
2654 case NL80211_IFTYPE_ADHOC: {
2655 const u8 *ssid_ie;
2656 if (!wdev->current_bss)
2657 break;
2658 rcu_read_lock();
2659 ssid_ie = ieee80211_bss_get_ie(&wdev->current_bss->pub,
2660 WLAN_EID_SSID);
2661 if (ssid_ie &&
2662 nla_put(msg, NL80211_ATTR_SSID, ssid_ie[1], ssid_ie + 2))
2663 goto nla_put_failure_rcu_locked;
2664 rcu_read_unlock();
2665 break;
2666 }
2667 default:
2668 /* nothing */
2669 break;
2670 }
2671 wdev_unlock(wdev);
2672
2673 genlmsg_end(msg, hdr);
2674 return 0;
2675
2676 nla_put_failure_rcu_locked:
2677 rcu_read_unlock();
2678 nla_put_failure_locked:
2679 wdev_unlock(wdev);
2680 nla_put_failure:
2681 genlmsg_cancel(msg, hdr);
2682 return -EMSGSIZE;
2683 }
2684
2685 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
2686 {
2687 int wp_idx = 0;
2688 int if_idx = 0;
2689 int wp_start = cb->args[0];
2690 int if_start = cb->args[1];
2691 int filter_wiphy = -1;
2692 struct cfg80211_registered_device *rdev;
2693 struct wireless_dev *wdev;
2694 int ret;
2695
2696 rtnl_lock();
2697 if (!cb->args[2]) {
2698 struct nl80211_dump_wiphy_state state = {
2699 .filter_wiphy = -1,
2700 };
2701
2702 ret = nl80211_dump_wiphy_parse(skb, cb, &state);
2703 if (ret)
2704 goto out_unlock;
2705
2706 filter_wiphy = state.filter_wiphy;
2707
2708 /*
2709 * if filtering, set cb->args[2] to +1 since 0 is the default
2710 * value needed to determine that parsing is necessary.
2711 */
2712 if (filter_wiphy >= 0)
2713 cb->args[2] = filter_wiphy + 1;
2714 else
2715 cb->args[2] = -1;
2716 } else if (cb->args[2] > 0) {
2717 filter_wiphy = cb->args[2] - 1;
2718 }
2719
2720 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2721 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
2722 continue;
2723 if (wp_idx < wp_start) {
2724 wp_idx++;
2725 continue;
2726 }
2727
2728 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
2729 continue;
2730
2731 if_idx = 0;
2732
2733 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
2734 if (if_idx < if_start) {
2735 if_idx++;
2736 continue;
2737 }
2738 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
2739 cb->nlh->nlmsg_seq, NLM_F_MULTI,
2740 rdev, wdev, false) < 0) {
2741 goto out;
2742 }
2743 if_idx++;
2744 }
2745
2746 wp_idx++;
2747 }
2748 out:
2749 cb->args[0] = wp_idx;
2750 cb->args[1] = if_idx;
2751
2752 ret = skb->len;
2753 out_unlock:
2754 rtnl_unlock();
2755
2756 return ret;
2757 }
2758
2759 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
2760 {
2761 struct sk_buff *msg;
2762 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2763 struct wireless_dev *wdev = info->user_ptr[1];
2764
2765 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2766 if (!msg)
2767 return -ENOMEM;
2768
2769 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
2770 rdev, wdev, false) < 0) {
2771 nlmsg_free(msg);
2772 return -ENOBUFS;
2773 }
2774
2775 return genlmsg_reply(msg, info);
2776 }
2777
2778 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
2779 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
2780 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
2781 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
2782 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
2783 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
2784 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
2785 };
2786
2787 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
2788 {
2789 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
2790 int flag;
2791
2792 *mntrflags = 0;
2793
2794 if (!nla)
2795 return -EINVAL;
2796
2797 if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX, nla,
2798 mntr_flags_policy, NULL))
2799 return -EINVAL;
2800
2801 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
2802 if (flags[flag])
2803 *mntrflags |= (1<<flag);
2804
2805 *mntrflags |= MONITOR_FLAG_CHANGED;
2806
2807 return 0;
2808 }
2809
2810 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
2811 enum nl80211_iftype type,
2812 struct genl_info *info,
2813 struct vif_params *params)
2814 {
2815 bool change = false;
2816 int err;
2817
2818 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
2819 if (type != NL80211_IFTYPE_MONITOR)
2820 return -EINVAL;
2821
2822 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
2823 &params->flags);
2824 if (err)
2825 return err;
2826
2827 change = true;
2828 }
2829
2830 if (params->flags & MONITOR_FLAG_ACTIVE &&
2831 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
2832 return -EOPNOTSUPP;
2833
2834 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
2835 const u8 *mumimo_groups;
2836 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2837
2838 if (type != NL80211_IFTYPE_MONITOR)
2839 return -EINVAL;
2840
2841 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2842 return -EOPNOTSUPP;
2843
2844 mumimo_groups =
2845 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
2846
2847 /* bits 0 and 63 are reserved and must be zero */
2848 if ((mumimo_groups[0] & BIT(0)) ||
2849 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7)))
2850 return -EINVAL;
2851
2852 params->vht_mumimo_groups = mumimo_groups;
2853 change = true;
2854 }
2855
2856 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
2857 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2858
2859 if (type != NL80211_IFTYPE_MONITOR)
2860 return -EINVAL;
2861
2862 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2863 return -EOPNOTSUPP;
2864
2865 params->vht_mumimo_follow_addr =
2866 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
2867 change = true;
2868 }
2869
2870 return change ? 1 : 0;
2871 }
2872
2873 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
2874 struct net_device *netdev, u8 use_4addr,
2875 enum nl80211_iftype iftype)
2876 {
2877 if (!use_4addr) {
2878 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
2879 return -EBUSY;
2880 return 0;
2881 }
2882
2883 switch (iftype) {
2884 case NL80211_IFTYPE_AP_VLAN:
2885 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
2886 return 0;
2887 break;
2888 case NL80211_IFTYPE_STATION:
2889 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
2890 return 0;
2891 break;
2892 default:
2893 break;
2894 }
2895
2896 return -EOPNOTSUPP;
2897 }
2898
2899 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
2900 {
2901 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2902 struct vif_params params;
2903 int err;
2904 enum nl80211_iftype otype, ntype;
2905 struct net_device *dev = info->user_ptr[1];
2906 bool change = false;
2907
2908 memset(&params, 0, sizeof(params));
2909
2910 otype = ntype = dev->ieee80211_ptr->iftype;
2911
2912 if (info->attrs[NL80211_ATTR_IFTYPE]) {
2913 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2914 if (otype != ntype)
2915 change = true;
2916 if (ntype > NL80211_IFTYPE_MAX)
2917 return -EINVAL;
2918 }
2919
2920 if (info->attrs[NL80211_ATTR_MESH_ID]) {
2921 struct wireless_dev *wdev = dev->ieee80211_ptr;
2922
2923 if (ntype != NL80211_IFTYPE_MESH_POINT)
2924 return -EINVAL;
2925 if (netif_running(dev))
2926 return -EBUSY;
2927
2928 wdev_lock(wdev);
2929 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2930 IEEE80211_MAX_MESH_ID_LEN);
2931 wdev->mesh_id_up_len =
2932 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2933 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2934 wdev->mesh_id_up_len);
2935 wdev_unlock(wdev);
2936 }
2937
2938 if (info->attrs[NL80211_ATTR_4ADDR]) {
2939 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2940 change = true;
2941 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
2942 if (err)
2943 return err;
2944 } else {
2945 params.use_4addr = -1;
2946 }
2947
2948 err = nl80211_parse_mon_options(rdev, ntype, info, &params);
2949 if (err < 0)
2950 return err;
2951 if (err > 0)
2952 change = true;
2953
2954 if (change)
2955 err = cfg80211_change_iface(rdev, dev, ntype, &params);
2956 else
2957 err = 0;
2958
2959 if (!err && params.use_4addr != -1)
2960 dev->ieee80211_ptr->use_4addr = params.use_4addr;
2961
2962 return err;
2963 }
2964
2965 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
2966 {
2967 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2968 struct vif_params params;
2969 struct wireless_dev *wdev;
2970 struct sk_buff *msg;
2971 int err;
2972 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
2973
2974 /* to avoid failing a new interface creation due to pending removal */
2975 cfg80211_destroy_ifaces(rdev);
2976
2977 memset(&params, 0, sizeof(params));
2978
2979 if (!info->attrs[NL80211_ATTR_IFNAME])
2980 return -EINVAL;
2981
2982 if (info->attrs[NL80211_ATTR_IFTYPE]) {
2983 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2984 if (type > NL80211_IFTYPE_MAX)
2985 return -EINVAL;
2986 }
2987
2988 if (!rdev->ops->add_virtual_intf)
2989 return -EOPNOTSUPP;
2990
2991 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
2992 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
2993 info->attrs[NL80211_ATTR_MAC]) {
2994 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
2995 ETH_ALEN);
2996 if (!is_valid_ether_addr(params.macaddr))
2997 return -EADDRNOTAVAIL;
2998 }
2999
3000 if (info->attrs[NL80211_ATTR_4ADDR]) {
3001 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
3002 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
3003 if (err)
3004 return err;
3005 }
3006
3007 if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0))
3008 return -EOPNOTSUPP;
3009
3010 err = nl80211_parse_mon_options(rdev, type, info, &params);
3011 if (err < 0)
3012 return err;
3013
3014 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3015 if (!msg)
3016 return -ENOMEM;
3017
3018 wdev = rdev_add_virtual_intf(rdev,
3019 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
3020 NET_NAME_USER, type, &params);
3021 if (WARN_ON(!wdev)) {
3022 nlmsg_free(msg);
3023 return -EPROTO;
3024 } else if (IS_ERR(wdev)) {
3025 nlmsg_free(msg);
3026 return PTR_ERR(wdev);
3027 }
3028
3029 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
3030 wdev->owner_nlportid = info->snd_portid;
3031
3032 switch (type) {
3033 case NL80211_IFTYPE_MESH_POINT:
3034 if (!info->attrs[NL80211_ATTR_MESH_ID])
3035 break;
3036 wdev_lock(wdev);
3037 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
3038 IEEE80211_MAX_MESH_ID_LEN);
3039 wdev->mesh_id_up_len =
3040 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
3041 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
3042 wdev->mesh_id_up_len);
3043 wdev_unlock(wdev);
3044 break;
3045 case NL80211_IFTYPE_NAN:
3046 case NL80211_IFTYPE_P2P_DEVICE:
3047 /*
3048 * P2P Device and NAN do not have a netdev, so don't go
3049 * through the netdev notifier and must be added here
3050 */
3051 mutex_init(&wdev->mtx);
3052 INIT_LIST_HEAD(&wdev->event_list);
3053 spin_lock_init(&wdev->event_lock);
3054 INIT_LIST_HEAD(&wdev->mgmt_registrations);
3055 spin_lock_init(&wdev->mgmt_registrations_lock);
3056
3057 wdev->identifier = ++rdev->wdev_id;
3058 list_add_rcu(&wdev->list, &rdev->wiphy.wdev_list);
3059 rdev->devlist_generation++;
3060 break;
3061 default:
3062 break;
3063 }
3064
3065 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
3066 rdev, wdev, false) < 0) {
3067 nlmsg_free(msg);
3068 return -ENOBUFS;
3069 }
3070
3071 /*
3072 * For wdevs which have no associated netdev object (e.g. of type
3073 * NL80211_IFTYPE_P2P_DEVICE), emit the NEW_INTERFACE event here.
3074 * For all other types, the event will be generated from the
3075 * netdev notifier
3076 */
3077 if (!wdev->netdev)
3078 nl80211_notify_iface(rdev, wdev, NL80211_CMD_NEW_INTERFACE);
3079
3080 return genlmsg_reply(msg, info);
3081 }
3082
3083 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
3084 {
3085 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3086 struct wireless_dev *wdev = info->user_ptr[1];
3087
3088 if (!rdev->ops->del_virtual_intf)
3089 return -EOPNOTSUPP;
3090
3091 /*
3092 * If we remove a wireless device without a netdev then clear
3093 * user_ptr[1] so that nl80211_post_doit won't dereference it
3094 * to check if it needs to do dev_put(). Otherwise it crashes
3095 * since the wdev has been freed, unlike with a netdev where
3096 * we need the dev_put() for the netdev to really be freed.
3097 */
3098 if (!wdev->netdev)
3099 info->user_ptr[1] = NULL;
3100
3101 return rdev_del_virtual_intf(rdev, wdev);
3102 }
3103
3104 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
3105 {
3106 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3107 struct net_device *dev = info->user_ptr[1];
3108 u16 noack_map;
3109
3110 if (!info->attrs[NL80211_ATTR_NOACK_MAP])
3111 return -EINVAL;
3112
3113 if (!rdev->ops->set_noack_map)
3114 return -EOPNOTSUPP;
3115
3116 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
3117
3118 return rdev_set_noack_map(rdev, dev, noack_map);
3119 }
3120
3121 struct get_key_cookie {
3122 struct sk_buff *msg;
3123 int error;
3124 int idx;
3125 };
3126
3127 static void get_key_callback(void *c, struct key_params *params)
3128 {
3129 struct nlattr *key;
3130 struct get_key_cookie *cookie = c;
3131
3132 if ((params->key &&
3133 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
3134 params->key_len, params->key)) ||
3135 (params->seq &&
3136 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
3137 params->seq_len, params->seq)) ||
3138 (params->cipher &&
3139 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
3140 params->cipher)))
3141 goto nla_put_failure;
3142
3143 key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
3144 if (!key)
3145 goto nla_put_failure;
3146
3147 if ((params->key &&
3148 nla_put(cookie->msg, NL80211_KEY_DATA,
3149 params->key_len, params->key)) ||
3150 (params->seq &&
3151 nla_put(cookie->msg, NL80211_KEY_SEQ,
3152 params->seq_len, params->seq)) ||
3153 (params->cipher &&
3154 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
3155 params->cipher)))
3156 goto nla_put_failure;
3157
3158 if (nla_put_u8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx))
3159 goto nla_put_failure;
3160
3161 nla_nest_end(cookie->msg, key);
3162
3163 return;
3164 nla_put_failure:
3165 cookie->error = 1;
3166 }
3167
3168 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
3169 {
3170 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3171 int err;
3172 struct net_device *dev = info->user_ptr[1];
3173 u8 key_idx = 0;
3174 const u8 *mac_addr = NULL;
3175 bool pairwise;
3176 struct get_key_cookie cookie = {
3177 .error = 0,
3178 };
3179 void *hdr;
3180 struct sk_buff *msg;
3181
3182 if (info->attrs[NL80211_ATTR_KEY_IDX])
3183 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
3184
3185 if (key_idx > 5)
3186 return -EINVAL;
3187
3188 if (info->attrs[NL80211_ATTR_MAC])
3189 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3190
3191 pairwise = !!mac_addr;
3192 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
3193 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
3194
3195 if (kt >= NUM_NL80211_KEYTYPES)
3196 return -EINVAL;
3197 if (kt != NL80211_KEYTYPE_GROUP &&
3198 kt != NL80211_KEYTYPE_PAIRWISE)
3199 return -EINVAL;
3200 pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
3201 }
3202
3203 if (!rdev->ops->get_key)
3204 return -EOPNOTSUPP;
3205
3206 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3207 return -ENOENT;
3208
3209 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3210 if (!msg)
3211 return -ENOMEM;
3212
3213 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
3214 NL80211_CMD_NEW_KEY);
3215 if (!hdr)
3216 goto nla_put_failure;
3217
3218 cookie.msg = msg;
3219 cookie.idx = key_idx;
3220
3221 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3222 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
3223 goto nla_put_failure;
3224 if (mac_addr &&
3225 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
3226 goto nla_put_failure;
3227
3228 err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
3229 get_key_callback);
3230
3231 if (err)
3232 goto free_msg;
3233
3234 if (cookie.error)
3235 goto nla_put_failure;
3236
3237 genlmsg_end(msg, hdr);
3238 return genlmsg_reply(msg, info);
3239
3240 nla_put_failure:
3241 err = -ENOBUFS;
3242 free_msg:
3243 nlmsg_free(msg);
3244 return err;
3245 }
3246
3247 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
3248 {
3249 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3250 struct key_parse key;
3251 int err;
3252 struct net_device *dev = info->user_ptr[1];
3253
3254 err = nl80211_parse_key(info, &key);
3255 if (err)
3256 return err;
3257
3258 if (key.idx < 0)
3259 return -EINVAL;
3260
3261 /* only support setting default key */
3262 if (!key.def && !key.defmgmt)
3263 return -EINVAL;
3264
3265 wdev_lock(dev->ieee80211_ptr);
3266
3267 if (key.def) {
3268 if (!rdev->ops->set_default_key) {
3269 err = -EOPNOTSUPP;
3270 goto out;
3271 }
3272
3273 err = nl80211_key_allowed(dev->ieee80211_ptr);
3274 if (err)
3275 goto out;
3276
3277 err = rdev_set_default_key(rdev, dev, key.idx,
3278 key.def_uni, key.def_multi);
3279
3280 if (err)
3281 goto out;
3282
3283 #ifdef CONFIG_CFG80211_WEXT
3284 dev->ieee80211_ptr->wext.default_key = key.idx;
3285 #endif
3286 } else {
3287 if (key.def_uni || !key.def_multi) {
3288 err = -EINVAL;
3289 goto out;
3290 }
3291
3292 if (!rdev->ops->set_default_mgmt_key) {
3293 err = -EOPNOTSUPP;
3294 goto out;
3295 }
3296
3297 err = nl80211_key_allowed(dev->ieee80211_ptr);
3298 if (err)
3299 goto out;
3300
3301 err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
3302 if (err)
3303 goto out;
3304
3305 #ifdef CONFIG_CFG80211_WEXT
3306 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
3307 #endif
3308 }
3309
3310 out:
3311 wdev_unlock(dev->ieee80211_ptr);
3312
3313 return err;
3314 }
3315
3316 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
3317 {
3318 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3319 int err;
3320 struct net_device *dev = info->user_ptr[1];
3321 struct key_parse key;
3322 const u8 *mac_addr = NULL;
3323
3324 err = nl80211_parse_key(info, &key);
3325 if (err)
3326 return err;
3327
3328 if (!key.p.key)
3329 return -EINVAL;
3330
3331 if (info->attrs[NL80211_ATTR_MAC])
3332 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3333
3334 if (key.type == -1) {
3335 if (mac_addr)
3336 key.type = NL80211_KEYTYPE_PAIRWISE;
3337 else
3338 key.type = NL80211_KEYTYPE_GROUP;
3339 }
3340
3341 /* for now */
3342 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3343 key.type != NL80211_KEYTYPE_GROUP)
3344 return -EINVAL;
3345
3346 if (!rdev->ops->add_key)
3347 return -EOPNOTSUPP;
3348
3349 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
3350 key.type == NL80211_KEYTYPE_PAIRWISE,
3351 mac_addr))
3352 return -EINVAL;
3353
3354 wdev_lock(dev->ieee80211_ptr);
3355 err = nl80211_key_allowed(dev->ieee80211_ptr);
3356 if (!err)
3357 err = rdev_add_key(rdev, dev, key.idx,
3358 key.type == NL80211_KEYTYPE_PAIRWISE,
3359 mac_addr, &key.p);
3360 wdev_unlock(dev->ieee80211_ptr);
3361
3362 return err;
3363 }
3364
3365 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
3366 {
3367 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3368 int err;
3369 struct net_device *dev = info->user_ptr[1];
3370 u8 *mac_addr = NULL;
3371 struct key_parse key;
3372
3373 err = nl80211_parse_key(info, &key);
3374 if (err)
3375 return err;
3376
3377 if (info->attrs[NL80211_ATTR_MAC])
3378 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3379
3380 if (key.type == -1) {
3381 if (mac_addr)
3382 key.type = NL80211_KEYTYPE_PAIRWISE;
3383 else
3384 key.type = NL80211_KEYTYPE_GROUP;
3385 }
3386
3387 /* for now */
3388 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3389 key.type != NL80211_KEYTYPE_GROUP)
3390 return -EINVAL;
3391
3392 if (!rdev->ops->del_key)
3393 return -EOPNOTSUPP;
3394
3395 wdev_lock(dev->ieee80211_ptr);
3396 err = nl80211_key_allowed(dev->ieee80211_ptr);
3397
3398 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
3399 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3400 err = -ENOENT;
3401
3402 if (!err)
3403 err = rdev_del_key(rdev, dev, key.idx,
3404 key.type == NL80211_KEYTYPE_PAIRWISE,
3405 mac_addr);
3406
3407 #ifdef CONFIG_CFG80211_WEXT
3408 if (!err) {
3409 if (key.idx == dev->ieee80211_ptr->wext.default_key)
3410 dev->ieee80211_ptr->wext.default_key = -1;
3411 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
3412 dev->ieee80211_ptr->wext.default_mgmt_key = -1;
3413 }
3414 #endif
3415 wdev_unlock(dev->ieee80211_ptr);
3416
3417 return err;
3418 }
3419
3420 /* This function returns an error or the number of nested attributes */
3421 static int validate_acl_mac_addrs(struct nlattr *nl_attr)
3422 {
3423 struct nlattr *attr;
3424 int n_entries = 0, tmp;
3425
3426 nla_for_each_nested(attr, nl_attr, tmp) {
3427 if (nla_len(attr) != ETH_ALEN)
3428 return -EINVAL;
3429
3430 n_entries++;
3431 }
3432
3433 return n_entries;
3434 }
3435
3436 /*
3437 * This function parses ACL information and allocates memory for ACL data.
3438 * On successful return, the calling function is responsible to free the
3439 * ACL buffer returned by this function.
3440 */
3441 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
3442 struct genl_info *info)
3443 {
3444 enum nl80211_acl_policy acl_policy;
3445 struct nlattr *attr;
3446 struct cfg80211_acl_data *acl;
3447 int i = 0, n_entries, tmp;
3448
3449 if (!wiphy->max_acl_mac_addrs)
3450 return ERR_PTR(-EOPNOTSUPP);
3451
3452 if (!info->attrs[NL80211_ATTR_ACL_POLICY])
3453 return ERR_PTR(-EINVAL);
3454
3455 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
3456 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
3457 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
3458 return ERR_PTR(-EINVAL);
3459
3460 if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
3461 return ERR_PTR(-EINVAL);
3462
3463 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
3464 if (n_entries < 0)
3465 return ERR_PTR(n_entries);
3466
3467 if (n_entries > wiphy->max_acl_mac_addrs)
3468 return ERR_PTR(-ENOTSUPP);
3469
3470 acl = kzalloc(sizeof(*acl) + (sizeof(struct mac_address) * n_entries),
3471 GFP_KERNEL);
3472 if (!acl)
3473 return ERR_PTR(-ENOMEM);
3474
3475 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
3476 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
3477 i++;
3478 }
3479
3480 acl->n_acl_entries = n_entries;
3481 acl->acl_policy = acl_policy;
3482
3483 return acl;
3484 }
3485
3486 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
3487 {
3488 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3489 struct net_device *dev = info->user_ptr[1];
3490 struct cfg80211_acl_data *acl;
3491 int err;
3492
3493 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3494 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3495 return -EOPNOTSUPP;
3496
3497 if (!dev->ieee80211_ptr->beacon_interval)
3498 return -EINVAL;
3499
3500 acl = parse_acl_data(&rdev->wiphy, info);
3501 if (IS_ERR(acl))
3502 return PTR_ERR(acl);
3503
3504 err = rdev_set_mac_acl(rdev, dev, acl);
3505
3506 kfree(acl);
3507
3508 return err;
3509 }
3510
3511 static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
3512 u8 *rates, u8 rates_len)
3513 {
3514 u8 i;
3515 u32 mask = 0;
3516
3517 for (i = 0; i < rates_len; i++) {
3518 int rate = (rates[i] & 0x7f) * 5;
3519 int ridx;
3520
3521 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
3522 struct ieee80211_rate *srate =
3523 &sband->bitrates[ridx];
3524 if (rate == srate->bitrate) {
3525 mask |= 1 << ridx;
3526 break;
3527 }
3528 }
3529 if (ridx == sband->n_bitrates)
3530 return 0; /* rate not found */
3531 }
3532
3533 return mask;
3534 }
3535
3536 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
3537 u8 *rates, u8 rates_len,
3538 u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
3539 {
3540 u8 i;
3541
3542 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
3543
3544 for (i = 0; i < rates_len; i++) {
3545 int ridx, rbit;
3546
3547 ridx = rates[i] / 8;
3548 rbit = BIT(rates[i] % 8);
3549
3550 /* check validity */
3551 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
3552 return false;
3553
3554 /* check availability */
3555 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN);
3556 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
3557 mcs[ridx] |= rbit;
3558 else
3559 return false;
3560 }
3561
3562 return true;
3563 }
3564
3565 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
3566 {
3567 u16 mcs_mask = 0;
3568
3569 switch (vht_mcs_map) {
3570 case IEEE80211_VHT_MCS_NOT_SUPPORTED:
3571 break;
3572 case IEEE80211_VHT_MCS_SUPPORT_0_7:
3573 mcs_mask = 0x00FF;
3574 break;
3575 case IEEE80211_VHT_MCS_SUPPORT_0_8:
3576 mcs_mask = 0x01FF;
3577 break;
3578 case IEEE80211_VHT_MCS_SUPPORT_0_9:
3579 mcs_mask = 0x03FF;
3580 break;
3581 default:
3582 break;
3583 }
3584
3585 return mcs_mask;
3586 }
3587
3588 static void vht_build_mcs_mask(u16 vht_mcs_map,
3589 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
3590 {
3591 u8 nss;
3592
3593 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
3594 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
3595 vht_mcs_map >>= 2;
3596 }
3597 }
3598
3599 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
3600 struct nl80211_txrate_vht *txrate,
3601 u16 mcs[NL80211_VHT_NSS_MAX])
3602 {
3603 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3604 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
3605 u8 i;
3606
3607 if (!sband->vht_cap.vht_supported)
3608 return false;
3609
3610 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
3611
3612 /* Build vht_mcs_mask from VHT capabilities */
3613 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
3614
3615 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
3616 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
3617 mcs[i] = txrate->mcs[i];
3618 else
3619 return false;
3620 }
3621
3622 return true;
3623 }
3624
3625 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
3626 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
3627 .len = NL80211_MAX_SUPP_RATES },
3628 [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
3629 .len = NL80211_MAX_SUPP_HT_RATES },
3630 [NL80211_TXRATE_VHT] = { .len = sizeof(struct nl80211_txrate_vht)},
3631 [NL80211_TXRATE_GI] = { .type = NLA_U8 },
3632 };
3633
3634 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
3635 struct cfg80211_bitrate_mask *mask)
3636 {
3637 struct nlattr *tb[NL80211_TXRATE_MAX + 1];
3638 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3639 int rem, i;
3640 struct nlattr *tx_rates;
3641 struct ieee80211_supported_band *sband;
3642 u16 vht_tx_mcs_map;
3643
3644 memset(mask, 0, sizeof(*mask));
3645 /* Default to all rates enabled */
3646 for (i = 0; i < NUM_NL80211_BANDS; i++) {
3647 sband = rdev->wiphy.bands[i];
3648
3649 if (!sband)
3650 continue;
3651
3652 mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
3653 memcpy(mask->control[i].ht_mcs,
3654 sband->ht_cap.mcs.rx_mask,
3655 sizeof(mask->control[i].ht_mcs));
3656
3657 if (!sband->vht_cap.vht_supported)
3658 continue;
3659
3660 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3661 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
3662 }
3663
3664 /* if no rates are given set it back to the defaults */
3665 if (!info->attrs[NL80211_ATTR_TX_RATES])
3666 goto out;
3667
3668 /* The nested attribute uses enum nl80211_band as the index. This maps
3669 * directly to the enum nl80211_band values used in cfg80211.
3670 */
3671 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
3672 nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
3673 enum nl80211_band band = nla_type(tx_rates);
3674 int err;
3675
3676 if (band < 0 || band >= NUM_NL80211_BANDS)
3677 return -EINVAL;
3678 sband = rdev->wiphy.bands[band];
3679 if (sband == NULL)
3680 return -EINVAL;
3681 err = nla_parse_nested(tb, NL80211_TXRATE_MAX, tx_rates,
3682 nl80211_txattr_policy, info->extack);
3683 if (err)
3684 return err;
3685 if (tb[NL80211_TXRATE_LEGACY]) {
3686 mask->control[band].legacy = rateset_to_mask(
3687 sband,
3688 nla_data(tb[NL80211_TXRATE_LEGACY]),
3689 nla_len(tb[NL80211_TXRATE_LEGACY]));
3690 if ((mask->control[band].legacy == 0) &&
3691 nla_len(tb[NL80211_TXRATE_LEGACY]))
3692 return -EINVAL;
3693 }
3694 if (tb[NL80211_TXRATE_HT]) {
3695 if (!ht_rateset_to_mask(
3696 sband,
3697 nla_data(tb[NL80211_TXRATE_HT]),
3698 nla_len(tb[NL80211_TXRATE_HT]),
3699 mask->control[band].ht_mcs))
3700 return -EINVAL;
3701 }
3702 if (tb[NL80211_TXRATE_VHT]) {
3703 if (!vht_set_mcs_mask(
3704 sband,
3705 nla_data(tb[NL80211_TXRATE_VHT]),
3706 mask->control[band].vht_mcs))
3707 return -EINVAL;
3708 }
3709 if (tb[NL80211_TXRATE_GI]) {
3710 mask->control[band].gi =
3711 nla_get_u8(tb[NL80211_TXRATE_GI]);
3712 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
3713 return -EINVAL;
3714 }
3715
3716 if (mask->control[band].legacy == 0) {
3717 /* don't allow empty legacy rates if HT or VHT
3718 * are not even supported.
3719 */
3720 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
3721 rdev->wiphy.bands[band]->vht_cap.vht_supported))
3722 return -EINVAL;
3723
3724 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
3725 if (mask->control[band].ht_mcs[i])
3726 goto out;
3727
3728 for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
3729 if (mask->control[band].vht_mcs[i])
3730 goto out;
3731
3732 /* legacy and mcs rates may not be both empty */
3733 return -EINVAL;
3734 }
3735 }
3736
3737 out:
3738 return 0;
3739 }
3740
3741 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
3742 enum nl80211_band band,
3743 struct cfg80211_bitrate_mask *beacon_rate)
3744 {
3745 u32 count_ht, count_vht, i;
3746 u32 rate = beacon_rate->control[band].legacy;
3747
3748 /* Allow only one rate */
3749 if (hweight32(rate) > 1)
3750 return -EINVAL;
3751
3752 count_ht = 0;
3753 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
3754 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
3755 return -EINVAL;
3756 } else if (beacon_rate->control[band].ht_mcs[i]) {
3757 count_ht++;
3758 if (count_ht > 1)
3759 return -EINVAL;
3760 }
3761 if (count_ht && rate)
3762 return -EINVAL;
3763 }
3764
3765 count_vht = 0;
3766 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
3767 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
3768 return -EINVAL;
3769 } else if (beacon_rate->control[band].vht_mcs[i]) {
3770 count_vht++;
3771 if (count_vht > 1)
3772 return -EINVAL;
3773 }
3774 if (count_vht && rate)
3775 return -EINVAL;
3776 }
3777
3778 if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
3779 return -EINVAL;
3780
3781 if (rate &&
3782 !wiphy_ext_feature_isset(&rdev->wiphy,
3783 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
3784 return -EINVAL;
3785 if (count_ht &&
3786 !wiphy_ext_feature_isset(&rdev->wiphy,
3787 NL80211_EXT_FEATURE_BEACON_RATE_HT))
3788 return -EINVAL;
3789 if (count_vht &&
3790 !wiphy_ext_feature_isset(&rdev->wiphy,
3791 NL80211_EXT_FEATURE_BEACON_RATE_VHT))
3792 return -EINVAL;
3793
3794 return 0;
3795 }
3796
3797 static int nl80211_parse_beacon(struct nlattr *attrs[],
3798 struct cfg80211_beacon_data *bcn)
3799 {
3800 bool haveinfo = false;
3801
3802 if (!is_valid_ie_attr(attrs[NL80211_ATTR_BEACON_TAIL]) ||
3803 !is_valid_ie_attr(attrs[NL80211_ATTR_IE]) ||
3804 !is_valid_ie_attr(attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
3805 !is_valid_ie_attr(attrs[NL80211_ATTR_IE_ASSOC_RESP]))
3806 return -EINVAL;
3807
3808 memset(bcn, 0, sizeof(*bcn));
3809
3810 if (attrs[NL80211_ATTR_BEACON_HEAD]) {
3811 int ret = validate_beacon_head(attrs[NL80211_ATTR_BEACON_HEAD],
3812 NULL);
3813
3814 if (ret)
3815 return ret;
3816
3817 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
3818 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
3819 if (!bcn->head_len)
3820 return -EINVAL;
3821 haveinfo = true;
3822 }
3823
3824 if (attrs[NL80211_ATTR_BEACON_TAIL]) {
3825 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
3826 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
3827 haveinfo = true;
3828 }
3829
3830 if (!haveinfo)
3831 return -EINVAL;
3832
3833 if (attrs[NL80211_ATTR_IE]) {
3834 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
3835 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
3836 }
3837
3838 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
3839 bcn->proberesp_ies =
3840 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
3841 bcn->proberesp_ies_len =
3842 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
3843 }
3844
3845 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
3846 bcn->assocresp_ies =
3847 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
3848 bcn->assocresp_ies_len =
3849 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
3850 }
3851
3852 if (attrs[NL80211_ATTR_PROBE_RESP]) {
3853 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
3854 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
3855 }
3856
3857 return 0;
3858 }
3859
3860 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
3861 const u8 *rates)
3862 {
3863 int i;
3864
3865 if (!rates)
3866 return;
3867
3868 for (i = 0; i < rates[1]; i++) {
3869 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
3870 params->ht_required = true;
3871 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
3872 params->vht_required = true;
3873 }
3874 }
3875
3876 /*
3877 * Since the nl80211 API didn't include, from the beginning, attributes about
3878 * HT/VHT requirements/capabilities, we parse them out of the IEs for the
3879 * benefit of drivers that rebuild IEs in the firmware.
3880 */
3881 static void nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
3882 {
3883 const struct cfg80211_beacon_data *bcn = &params->beacon;
3884 size_t ies_len = bcn->tail_len;
3885 const u8 *ies = bcn->tail;
3886 const u8 *rates;
3887 const u8 *cap;
3888
3889 rates = cfg80211_find_ie(WLAN_EID_SUPP_RATES, ies, ies_len);
3890 nl80211_check_ap_rate_selectors(params, rates);
3891
3892 rates = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
3893 nl80211_check_ap_rate_selectors(params, rates);
3894
3895 cap = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies, ies_len);
3896 if (cap && cap[1] >= sizeof(*params->ht_cap))
3897 params->ht_cap = (void *)(cap + 2);
3898 cap = cfg80211_find_ie(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
3899 if (cap && cap[1] >= sizeof(*params->vht_cap))
3900 params->vht_cap = (void *)(cap + 2);
3901 }
3902
3903 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
3904 struct cfg80211_ap_settings *params)
3905 {
3906 struct wireless_dev *wdev;
3907 bool ret = false;
3908
3909 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
3910 if (wdev->iftype != NL80211_IFTYPE_AP &&
3911 wdev->iftype != NL80211_IFTYPE_P2P_GO)
3912 continue;
3913
3914 if (!wdev->preset_chandef.chan)
3915 continue;
3916
3917 params->chandef = wdev->preset_chandef;
3918 ret = true;
3919 break;
3920 }
3921
3922 return ret;
3923 }
3924
3925 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
3926 enum nl80211_auth_type auth_type,
3927 enum nl80211_commands cmd)
3928 {
3929 if (auth_type > NL80211_AUTHTYPE_MAX)
3930 return false;
3931
3932 switch (cmd) {
3933 case NL80211_CMD_AUTHENTICATE:
3934 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
3935 auth_type == NL80211_AUTHTYPE_SAE)
3936 return false;
3937 if (!wiphy_ext_feature_isset(&rdev->wiphy,
3938 NL80211_EXT_FEATURE_FILS_STA) &&
3939 (auth_type == NL80211_AUTHTYPE_FILS_SK ||
3940 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3941 auth_type == NL80211_AUTHTYPE_FILS_PK))
3942 return false;
3943 return true;
3944 case NL80211_CMD_CONNECT:
3945 /* SAE not supported yet */
3946 if (auth_type == NL80211_AUTHTYPE_SAE)
3947 return false;
3948 /* FILS with SK PFS or PK not supported yet */
3949 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3950 auth_type == NL80211_AUTHTYPE_FILS_PK)
3951 return false;
3952 if (!wiphy_ext_feature_isset(
3953 &rdev->wiphy,
3954 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
3955 auth_type == NL80211_AUTHTYPE_FILS_SK)
3956 return false;
3957 return true;
3958 case NL80211_CMD_START_AP:
3959 /* SAE not supported yet */
3960 if (auth_type == NL80211_AUTHTYPE_SAE)
3961 return false;
3962 /* FILS not supported yet */
3963 if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
3964 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3965 auth_type == NL80211_AUTHTYPE_FILS_PK)
3966 return false;
3967 return true;
3968 default:
3969 return false;
3970 }
3971 }
3972
3973 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
3974 {
3975 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3976 struct net_device *dev = info->user_ptr[1];
3977 struct wireless_dev *wdev = dev->ieee80211_ptr;
3978 struct cfg80211_ap_settings params;
3979 int err;
3980
3981 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3982 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3983 return -EOPNOTSUPP;
3984
3985 if (!rdev->ops->start_ap)
3986 return -EOPNOTSUPP;
3987
3988 if (wdev->beacon_interval)
3989 return -EALREADY;
3990
3991 memset(&params, 0, sizeof(params));
3992
3993 /* these are required for START_AP */
3994 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
3995 !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
3996 !info->attrs[NL80211_ATTR_BEACON_HEAD])
3997 return -EINVAL;
3998
3999 err = nl80211_parse_beacon(info->attrs, &params.beacon);
4000 if (err)
4001 return err;
4002
4003 params.beacon_interval =
4004 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
4005 params.dtim_period =
4006 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
4007
4008 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
4009 params.beacon_interval);
4010 if (err)
4011 return err;
4012
4013 /*
4014 * In theory, some of these attributes should be required here
4015 * but since they were not used when the command was originally
4016 * added, keep them optional for old user space programs to let
4017 * them continue to work with drivers that do not need the
4018 * additional information -- drivers must check!
4019 */
4020 if (info->attrs[NL80211_ATTR_SSID]) {
4021 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
4022 params.ssid_len =
4023 nla_len(info->attrs[NL80211_ATTR_SSID]);
4024 if (params.ssid_len == 0 ||
4025 params.ssid_len > IEEE80211_MAX_SSID_LEN)
4026 return -EINVAL;
4027 }
4028
4029 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
4030 params.hidden_ssid = nla_get_u32(
4031 info->attrs[NL80211_ATTR_HIDDEN_SSID]);
4032 if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
4033 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
4034 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
4035 return -EINVAL;
4036 }
4037
4038 params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
4039
4040 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
4041 params.auth_type = nla_get_u32(
4042 info->attrs[NL80211_ATTR_AUTH_TYPE]);
4043 if (!nl80211_valid_auth_type(rdev, params.auth_type,
4044 NL80211_CMD_START_AP))
4045 return -EINVAL;
4046 } else
4047 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
4048
4049 err = nl80211_crypto_settings(rdev, info, &params.crypto,
4050 NL80211_MAX_NR_CIPHER_SUITES);
4051 if (err)
4052 return err;
4053
4054 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
4055 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
4056 return -EOPNOTSUPP;
4057 params.inactivity_timeout = nla_get_u16(
4058 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
4059 }
4060
4061 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
4062 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4063 return -EINVAL;
4064 params.p2p_ctwindow =
4065 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
4066 if (params.p2p_ctwindow > 127)
4067 return -EINVAL;
4068 if (params.p2p_ctwindow != 0 &&
4069 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
4070 return -EINVAL;
4071 }
4072
4073 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
4074 u8 tmp;
4075
4076 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4077 return -EINVAL;
4078 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
4079 if (tmp > 1)
4080 return -EINVAL;
4081 params.p2p_opp_ps = tmp;
4082 if (params.p2p_opp_ps != 0 &&
4083 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
4084 return -EINVAL;
4085 }
4086
4087 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
4088 err = nl80211_parse_chandef(rdev, info, &params.chandef);
4089 if (err)
4090 return err;
4091 } else if (wdev->preset_chandef.chan) {
4092 params.chandef = wdev->preset_chandef;
4093 } else if (!nl80211_get_ap_channel(rdev, &params))
4094 return -EINVAL;
4095
4096 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
4097 wdev->iftype))
4098 return -EINVAL;
4099
4100 if (info->attrs[NL80211_ATTR_TX_RATES]) {
4101 err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
4102 if (err)
4103 return err;
4104
4105 err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
4106 &params.beacon_rate);
4107 if (err)
4108 return err;
4109 }
4110
4111 if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
4112 params.smps_mode =
4113 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
4114 switch (params.smps_mode) {
4115 case NL80211_SMPS_OFF:
4116 break;
4117 case NL80211_SMPS_STATIC:
4118 if (!(rdev->wiphy.features &
4119 NL80211_FEATURE_STATIC_SMPS))
4120 return -EINVAL;
4121 break;
4122 case NL80211_SMPS_DYNAMIC:
4123 if (!(rdev->wiphy.features &
4124 NL80211_FEATURE_DYNAMIC_SMPS))
4125 return -EINVAL;
4126 break;
4127 default:
4128 return -EINVAL;
4129 }
4130 } else {
4131 params.smps_mode = NL80211_SMPS_OFF;
4132 }
4133
4134 params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
4135 if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
4136 return -EOPNOTSUPP;
4137
4138 if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
4139 params.acl = parse_acl_data(&rdev->wiphy, info);
4140 if (IS_ERR(params.acl))
4141 return PTR_ERR(params.acl);
4142 }
4143
4144 nl80211_calculate_ap_params(&params);
4145
4146 wdev_lock(wdev);
4147 err = rdev_start_ap(rdev, dev, &params);
4148 if (!err) {
4149 wdev->preset_chandef = params.chandef;
4150 wdev->beacon_interval = params.beacon_interval;
4151 wdev->chandef = params.chandef;
4152 wdev->ssid_len = params.ssid_len;
4153 memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
4154 }
4155 wdev_unlock(wdev);
4156
4157 kfree(params.acl);
4158
4159 return err;
4160 }
4161
4162 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
4163 {
4164 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4165 struct net_device *dev = info->user_ptr[1];
4166 struct wireless_dev *wdev = dev->ieee80211_ptr;
4167 struct cfg80211_beacon_data params;
4168 int err;
4169
4170 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4171 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4172 return -EOPNOTSUPP;
4173
4174 if (!rdev->ops->change_beacon)
4175 return -EOPNOTSUPP;
4176
4177 if (!wdev->beacon_interval)
4178 return -EINVAL;
4179
4180 err = nl80211_parse_beacon(info->attrs, &params);
4181 if (err)
4182 return err;
4183
4184 wdev_lock(wdev);
4185 err = rdev_change_beacon(rdev, dev, &params);
4186 wdev_unlock(wdev);
4187
4188 return err;
4189 }
4190
4191 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
4192 {
4193 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4194 struct net_device *dev = info->user_ptr[1];
4195
4196 return cfg80211_stop_ap(rdev, dev, false);
4197 }
4198
4199 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
4200 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
4201 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
4202 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
4203 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
4204 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
4205 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
4206 };
4207
4208 static int parse_station_flags(struct genl_info *info,
4209 enum nl80211_iftype iftype,
4210 struct station_parameters *params)
4211 {
4212 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
4213 struct nlattr *nla;
4214 int flag;
4215
4216 /*
4217 * Try parsing the new attribute first so userspace
4218 * can specify both for older kernels.
4219 */
4220 nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
4221 if (nla) {
4222 struct nl80211_sta_flag_update *sta_flags;
4223
4224 sta_flags = nla_data(nla);
4225 params->sta_flags_mask = sta_flags->mask;
4226 params->sta_flags_set = sta_flags->set;
4227 params->sta_flags_set &= params->sta_flags_mask;
4228 if ((params->sta_flags_mask |
4229 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
4230 return -EINVAL;
4231 return 0;
4232 }
4233
4234 /* if present, parse the old attribute */
4235
4236 nla = info->attrs[NL80211_ATTR_STA_FLAGS];
4237 if (!nla)
4238 return 0;
4239
4240 if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX, nla,
4241 sta_flags_policy, info->extack))
4242 return -EINVAL;
4243
4244 /*
4245 * Only allow certain flags for interface types so that
4246 * other attributes are silently ignored. Remember that
4247 * this is backward compatibility code with old userspace
4248 * and shouldn't be hit in other cases anyway.
4249 */
4250 switch (iftype) {
4251 case NL80211_IFTYPE_AP:
4252 case NL80211_IFTYPE_AP_VLAN:
4253 case NL80211_IFTYPE_P2P_GO:
4254 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4255 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4256 BIT(NL80211_STA_FLAG_WME) |
4257 BIT(NL80211_STA_FLAG_MFP);
4258 break;
4259 case NL80211_IFTYPE_P2P_CLIENT:
4260 case NL80211_IFTYPE_STATION:
4261 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4262 BIT(NL80211_STA_FLAG_TDLS_PEER);
4263 break;
4264 case NL80211_IFTYPE_MESH_POINT:
4265 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4266 BIT(NL80211_STA_FLAG_MFP) |
4267 BIT(NL80211_STA_FLAG_AUTHORIZED);
4268 break;
4269 default:
4270 return -EINVAL;
4271 }
4272
4273 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
4274 if (flags[flag]) {
4275 params->sta_flags_set |= (1<<flag);
4276
4277 /* no longer support new API additions in old API */
4278 if (flag > NL80211_STA_FLAG_MAX_OLD_API)
4279 return -EINVAL;
4280 }
4281 }
4282
4283 return 0;
4284 }
4285
4286 static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
4287 int attr)
4288 {
4289 struct nlattr *rate;
4290 u32 bitrate;
4291 u16 bitrate_compat;
4292 enum nl80211_rate_info rate_flg;
4293
4294 rate = nla_nest_start(msg, attr);
4295 if (!rate)
4296 return false;
4297
4298 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
4299 bitrate = cfg80211_calculate_bitrate(info);
4300 /* report 16-bit bitrate only if we can */
4301 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
4302 if (bitrate > 0 &&
4303 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
4304 return false;
4305 if (bitrate_compat > 0 &&
4306 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
4307 return false;
4308
4309 switch (info->bw) {
4310 case RATE_INFO_BW_5:
4311 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
4312 break;
4313 case RATE_INFO_BW_10:
4314 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
4315 break;
4316 default:
4317 WARN_ON(1);
4318 /* fall through */
4319 case RATE_INFO_BW_20:
4320 rate_flg = 0;
4321 break;
4322 case RATE_INFO_BW_40:
4323 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
4324 break;
4325 case RATE_INFO_BW_80:
4326 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
4327 break;
4328 case RATE_INFO_BW_160:
4329 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
4330 break;
4331 }
4332
4333 if (rate_flg && nla_put_flag(msg, rate_flg))
4334 return false;
4335
4336 if (info->flags & RATE_INFO_FLAGS_MCS) {
4337 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
4338 return false;
4339 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4340 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4341 return false;
4342 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
4343 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
4344 return false;
4345 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
4346 return false;
4347 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4348 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4349 return false;
4350 }
4351
4352 nla_nest_end(msg, rate);
4353 return true;
4354 }
4355
4356 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
4357 int id)
4358 {
4359 void *attr;
4360 int i = 0;
4361
4362 if (!mask)
4363 return true;
4364
4365 attr = nla_nest_start(msg, id);
4366 if (!attr)
4367 return false;
4368
4369 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
4370 if (!(mask & BIT(i)))
4371 continue;
4372
4373 if (nla_put_u8(msg, i, signal[i]))
4374 return false;
4375 }
4376
4377 nla_nest_end(msg, attr);
4378
4379 return true;
4380 }
4381
4382 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
4383 u32 seq, int flags,
4384 struct cfg80211_registered_device *rdev,
4385 struct net_device *dev,
4386 const u8 *mac_addr, struct station_info *sinfo)
4387 {
4388 void *hdr;
4389 struct nlattr *sinfoattr, *bss_param;
4390
4391 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
4392 if (!hdr)
4393 return -1;
4394
4395 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
4396 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
4397 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
4398 goto nla_put_failure;
4399
4400 sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
4401 if (!sinfoattr)
4402 goto nla_put_failure;
4403
4404 #define PUT_SINFO(attr, memb, type) do { \
4405 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \
4406 if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
4407 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \
4408 sinfo->memb)) \
4409 goto nla_put_failure; \
4410 } while (0)
4411 #define PUT_SINFO_U64(attr, memb) do { \
4412 if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
4413 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \
4414 sinfo->memb, NL80211_STA_INFO_PAD)) \
4415 goto nla_put_failure; \
4416 } while (0)
4417
4418 PUT_SINFO(CONNECTED_TIME, connected_time, u32);
4419 PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
4420
4421 if (sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES) |
4422 BIT(NL80211_STA_INFO_RX_BYTES64)) &&
4423 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
4424 (u32)sinfo->rx_bytes))
4425 goto nla_put_failure;
4426
4427 if (sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES) |
4428 BIT(NL80211_STA_INFO_TX_BYTES64)) &&
4429 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
4430 (u32)sinfo->tx_bytes))
4431 goto nla_put_failure;
4432
4433 PUT_SINFO_U64(RX_BYTES64, rx_bytes);
4434 PUT_SINFO_U64(TX_BYTES64, tx_bytes);
4435 PUT_SINFO(LLID, llid, u16);
4436 PUT_SINFO(PLID, plid, u16);
4437 PUT_SINFO(PLINK_STATE, plink_state, u8);
4438 PUT_SINFO_U64(RX_DURATION, rx_duration);
4439
4440 switch (rdev->wiphy.signal_type) {
4441 case CFG80211_SIGNAL_TYPE_MBM:
4442 PUT_SINFO(SIGNAL, signal, u8);
4443 PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
4444 break;
4445 default:
4446 break;
4447 }
4448 if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL)) {
4449 if (!nl80211_put_signal(msg, sinfo->chains,
4450 sinfo->chain_signal,
4451 NL80211_STA_INFO_CHAIN_SIGNAL))
4452 goto nla_put_failure;
4453 }
4454 if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
4455 if (!nl80211_put_signal(msg, sinfo->chains,
4456 sinfo->chain_signal_avg,
4457 NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
4458 goto nla_put_failure;
4459 }
4460 if (sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE)) {
4461 if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
4462 NL80211_STA_INFO_TX_BITRATE))
4463 goto nla_put_failure;
4464 }
4465 if (sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE)) {
4466 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
4467 NL80211_STA_INFO_RX_BITRATE))
4468 goto nla_put_failure;
4469 }
4470
4471 PUT_SINFO(RX_PACKETS, rx_packets, u32);
4472 PUT_SINFO(TX_PACKETS, tx_packets, u32);
4473 PUT_SINFO(TX_RETRIES, tx_retries, u32);
4474 PUT_SINFO(TX_FAILED, tx_failed, u32);
4475 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
4476 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
4477 PUT_SINFO(LOCAL_PM, local_pm, u32);
4478 PUT_SINFO(PEER_PM, peer_pm, u32);
4479 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
4480
4481 if (sinfo->filled & BIT(NL80211_STA_INFO_BSS_PARAM)) {
4482 bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
4483 if (!bss_param)
4484 goto nla_put_failure;
4485
4486 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
4487 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
4488 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
4489 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
4490 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
4491 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
4492 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
4493 sinfo->bss_param.dtim_period) ||
4494 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
4495 sinfo->bss_param.beacon_interval))
4496 goto nla_put_failure;
4497
4498 nla_nest_end(msg, bss_param);
4499 }
4500 if ((sinfo->filled & BIT(NL80211_STA_INFO_STA_FLAGS)) &&
4501 nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
4502 sizeof(struct nl80211_sta_flag_update),
4503 &sinfo->sta_flags))
4504 goto nla_put_failure;
4505
4506 PUT_SINFO_U64(T_OFFSET, t_offset);
4507 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
4508 PUT_SINFO_U64(BEACON_RX, rx_beacon);
4509 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
4510
4511 #undef PUT_SINFO
4512 #undef PUT_SINFO_U64
4513
4514 if (sinfo->filled & BIT(NL80211_STA_INFO_TID_STATS)) {
4515 struct nlattr *tidsattr;
4516 int tid;
4517
4518 tidsattr = nla_nest_start(msg, NL80211_STA_INFO_TID_STATS);
4519 if (!tidsattr)
4520 goto nla_put_failure;
4521
4522 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
4523 struct cfg80211_tid_stats *tidstats;
4524 struct nlattr *tidattr;
4525
4526 tidstats = &sinfo->pertid[tid];
4527
4528 if (!tidstats->filled)
4529 continue;
4530
4531 tidattr = nla_nest_start(msg, tid + 1);
4532 if (!tidattr)
4533 goto nla_put_failure;
4534
4535 #define PUT_TIDVAL_U64(attr, memb) do { \
4536 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \
4537 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \
4538 tidstats->memb, NL80211_TID_STATS_PAD)) \
4539 goto nla_put_failure; \
4540 } while (0)
4541
4542 PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
4543 PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
4544 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
4545 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
4546
4547 #undef PUT_TIDVAL_U64
4548 nla_nest_end(msg, tidattr);
4549 }
4550
4551 nla_nest_end(msg, tidsattr);
4552 }
4553
4554 nla_nest_end(msg, sinfoattr);
4555
4556 if (sinfo->assoc_req_ies_len &&
4557 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
4558 sinfo->assoc_req_ies))
4559 goto nla_put_failure;
4560
4561 genlmsg_end(msg, hdr);
4562 return 0;
4563
4564 nla_put_failure:
4565 genlmsg_cancel(msg, hdr);
4566 return -EMSGSIZE;
4567 }
4568
4569 static int nl80211_dump_station(struct sk_buff *skb,
4570 struct netlink_callback *cb)
4571 {
4572 struct station_info sinfo;
4573 struct cfg80211_registered_device *rdev;
4574 struct wireless_dev *wdev;
4575 u8 mac_addr[ETH_ALEN];
4576 int sta_idx = cb->args[2];
4577 int err;
4578
4579 rtnl_lock();
4580 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
4581 if (err)
4582 goto out_err;
4583
4584 if (!wdev->netdev) {
4585 err = -EINVAL;
4586 goto out_err;
4587 }
4588
4589 if (!rdev->ops->dump_station) {
4590 err = -EOPNOTSUPP;
4591 goto out_err;
4592 }
4593
4594 while (1) {
4595 memset(&sinfo, 0, sizeof(sinfo));
4596 err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
4597 mac_addr, &sinfo);
4598 if (err == -ENOENT)
4599 break;
4600 if (err)
4601 goto out_err;
4602
4603 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
4604 NETLINK_CB(cb->skb).portid,
4605 cb->nlh->nlmsg_seq, NLM_F_MULTI,
4606 rdev, wdev->netdev, mac_addr,
4607 &sinfo) < 0)
4608 goto out;
4609
4610 sta_idx++;
4611 }
4612
4613 out:
4614 cb->args[2] = sta_idx;
4615 err = skb->len;
4616 out_err:
4617 rtnl_unlock();
4618
4619 return err;
4620 }
4621
4622 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
4623 {
4624 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4625 struct net_device *dev = info->user_ptr[1];
4626 struct station_info sinfo;
4627 struct sk_buff *msg;
4628 u8 *mac_addr = NULL;
4629 int err;
4630
4631 memset(&sinfo, 0, sizeof(sinfo));
4632
4633 if (!info->attrs[NL80211_ATTR_MAC])
4634 return -EINVAL;
4635
4636 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4637
4638 if (!rdev->ops->get_station)
4639 return -EOPNOTSUPP;
4640
4641 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
4642 if (err)
4643 return err;
4644
4645 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4646 if (!msg)
4647 return -ENOMEM;
4648
4649 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
4650 info->snd_portid, info->snd_seq, 0,
4651 rdev, dev, mac_addr, &sinfo) < 0) {
4652 nlmsg_free(msg);
4653 return -ENOBUFS;
4654 }
4655
4656 return genlmsg_reply(msg, info);
4657 }
4658
4659 int cfg80211_check_station_change(struct wiphy *wiphy,
4660 struct station_parameters *params,
4661 enum cfg80211_station_type statype)
4662 {
4663 if (params->listen_interval != -1 &&
4664 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4665 return -EINVAL;
4666
4667 if (params->support_p2p_ps != -1 &&
4668 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4669 return -EINVAL;
4670
4671 if (params->aid &&
4672 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
4673 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4674 return -EINVAL;
4675
4676 /* When you run into this, adjust the code below for the new flag */
4677 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
4678
4679 switch (statype) {
4680 case CFG80211_STA_MESH_PEER_KERNEL:
4681 case CFG80211_STA_MESH_PEER_USER:
4682 /*
4683 * No ignoring the TDLS flag here -- the userspace mesh
4684 * code doesn't have the bug of including TDLS in the
4685 * mask everywhere.
4686 */
4687 if (params->sta_flags_mask &
4688 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4689 BIT(NL80211_STA_FLAG_MFP) |
4690 BIT(NL80211_STA_FLAG_AUTHORIZED)))
4691 return -EINVAL;
4692 break;
4693 case CFG80211_STA_TDLS_PEER_SETUP:
4694 case CFG80211_STA_TDLS_PEER_ACTIVE:
4695 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
4696 return -EINVAL;
4697 /* ignore since it can't change */
4698 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4699 break;
4700 default:
4701 /* disallow mesh-specific things */
4702 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
4703 return -EINVAL;
4704 if (params->local_pm)
4705 return -EINVAL;
4706 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4707 return -EINVAL;
4708 }
4709
4710 if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4711 statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
4712 /* TDLS can't be set, ... */
4713 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
4714 return -EINVAL;
4715 /*
4716 * ... but don't bother the driver with it. This works around
4717 * a hostapd/wpa_supplicant issue -- it always includes the
4718 * TLDS_PEER flag in the mask even for AP mode.
4719 */
4720 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4721 }
4722
4723 if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4724 statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
4725 /* reject other things that can't change */
4726 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
4727 return -EINVAL;
4728 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
4729 return -EINVAL;
4730 if (params->supported_rates)
4731 return -EINVAL;
4732 if (params->ext_capab || params->ht_capa || params->vht_capa)
4733 return -EINVAL;
4734 }
4735
4736 if (statype != CFG80211_STA_AP_CLIENT &&
4737 statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
4738 if (params->vlan)
4739 return -EINVAL;
4740 }
4741
4742 switch (statype) {
4743 case CFG80211_STA_AP_MLME_CLIENT:
4744 /* Use this only for authorizing/unauthorizing a station */
4745 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
4746 return -EOPNOTSUPP;
4747 break;
4748 case CFG80211_STA_AP_CLIENT:
4749 case CFG80211_STA_AP_CLIENT_UNASSOC:
4750 /* accept only the listed bits */
4751 if (params->sta_flags_mask &
4752 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4753 BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4754 BIT(NL80211_STA_FLAG_ASSOCIATED) |
4755 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4756 BIT(NL80211_STA_FLAG_WME) |
4757 BIT(NL80211_STA_FLAG_MFP)))
4758 return -EINVAL;
4759
4760 /* but authenticated/associated only if driver handles it */
4761 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
4762 params->sta_flags_mask &
4763 (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4764 BIT(NL80211_STA_FLAG_ASSOCIATED)))
4765 return -EINVAL;
4766 break;
4767 case CFG80211_STA_IBSS:
4768 case CFG80211_STA_AP_STA:
4769 /* reject any changes other than AUTHORIZED */
4770 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
4771 return -EINVAL;
4772 break;
4773 case CFG80211_STA_TDLS_PEER_SETUP:
4774 /* reject any changes other than AUTHORIZED or WME */
4775 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4776 BIT(NL80211_STA_FLAG_WME)))
4777 return -EINVAL;
4778 /* force (at least) rates when authorizing */
4779 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
4780 !params->supported_rates)
4781 return -EINVAL;
4782 break;
4783 case CFG80211_STA_TDLS_PEER_ACTIVE:
4784 /* reject any changes */
4785 return -EINVAL;
4786 case CFG80211_STA_MESH_PEER_KERNEL:
4787 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4788 return -EINVAL;
4789 break;
4790 case CFG80211_STA_MESH_PEER_USER:
4791 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
4792 params->plink_action != NL80211_PLINK_ACTION_BLOCK)
4793 return -EINVAL;
4794 break;
4795 }
4796
4797 /*
4798 * Older kernel versions ignored this attribute entirely, so don't
4799 * reject attempts to update it but mark it as unused instead so the
4800 * driver won't look at the data.
4801 */
4802 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
4803 statype != CFG80211_STA_TDLS_PEER_SETUP)
4804 params->opmode_notif_used = false;
4805
4806 return 0;
4807 }
4808 EXPORT_SYMBOL(cfg80211_check_station_change);
4809
4810 /*
4811 * Get vlan interface making sure it is running and on the right wiphy.
4812 */
4813 static struct net_device *get_vlan(struct genl_info *info,
4814 struct cfg80211_registered_device *rdev)
4815 {
4816 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
4817 struct net_device *v;
4818 int ret;
4819
4820 if (!vlanattr)
4821 return NULL;
4822
4823 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
4824 if (!v)
4825 return ERR_PTR(-ENODEV);
4826
4827 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
4828 ret = -EINVAL;
4829 goto error;
4830 }
4831
4832 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
4833 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4834 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
4835 ret = -EINVAL;
4836 goto error;
4837 }
4838
4839 if (!netif_running(v)) {
4840 ret = -ENETDOWN;
4841 goto error;
4842 }
4843
4844 return v;
4845 error:
4846 dev_put(v);
4847 return ERR_PTR(ret);
4848 }
4849
4850 static const struct nla_policy
4851 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
4852 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
4853 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
4854 };
4855
4856 static int nl80211_parse_sta_wme(struct genl_info *info,
4857 struct station_parameters *params)
4858 {
4859 struct nlattr *tb[NL80211_STA_WME_MAX + 1];
4860 struct nlattr *nla;
4861 int err;
4862
4863 /* parse WME attributes if present */
4864 if (!info->attrs[NL80211_ATTR_STA_WME])
4865 return 0;
4866
4867 nla = info->attrs[NL80211_ATTR_STA_WME];
4868 err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
4869 nl80211_sta_wme_policy, info->extack);
4870 if (err)
4871 return err;
4872
4873 if (tb[NL80211_STA_WME_UAPSD_QUEUES])
4874 params->uapsd_queues = nla_get_u8(
4875 tb[NL80211_STA_WME_UAPSD_QUEUES]);
4876 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
4877 return -EINVAL;
4878
4879 if (tb[NL80211_STA_WME_MAX_SP])
4880 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
4881
4882 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
4883 return -EINVAL;
4884
4885 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
4886
4887 return 0;
4888 }
4889
4890 static int nl80211_parse_sta_channel_info(struct genl_info *info,
4891 struct station_parameters *params)
4892 {
4893 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
4894 params->supported_channels =
4895 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4896 params->supported_channels_len =
4897 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4898 /*
4899 * Need to include at least one (first channel, number of
4900 * channels) tuple for each subband, and must have proper
4901 * tuples for the rest of the data as well.
4902 */
4903 if (params->supported_channels_len < 2)
4904 return -EINVAL;
4905 if (params->supported_channels_len % 2)
4906 return -EINVAL;
4907 }
4908
4909 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
4910 params->supported_oper_classes =
4911 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4912 params->supported_oper_classes_len =
4913 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4914 /*
4915 * The value of the Length field of the Supported Operating
4916 * Classes element is between 2 and 253.
4917 */
4918 if (params->supported_oper_classes_len < 2 ||
4919 params->supported_oper_classes_len > 253)
4920 return -EINVAL;
4921 }
4922 return 0;
4923 }
4924
4925 static int nl80211_set_station_tdls(struct genl_info *info,
4926 struct station_parameters *params)
4927 {
4928 int err;
4929 /* Dummy STA entry gets updated once the peer capabilities are known */
4930 if (info->attrs[NL80211_ATTR_PEER_AID])
4931 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
4932 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
4933 params->ht_capa =
4934 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
4935 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
4936 params->vht_capa =
4937 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
4938
4939 err = nl80211_parse_sta_channel_info(info, params);
4940 if (err)
4941 return err;
4942
4943 return nl80211_parse_sta_wme(info, params);
4944 }
4945
4946 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
4947 {
4948 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4949 struct net_device *dev = info->user_ptr[1];
4950 struct station_parameters params;
4951 u8 *mac_addr;
4952 int err;
4953
4954 memset(&params, 0, sizeof(params));
4955
4956 if (!rdev->ops->change_station)
4957 return -EOPNOTSUPP;
4958
4959 /*
4960 * AID and listen_interval properties can be set only for unassociated
4961 * station. Include these parameters here and will check them in
4962 * cfg80211_check_station_change().
4963 */
4964 if (info->attrs[NL80211_ATTR_STA_AID])
4965 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
4966
4967 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
4968 params.listen_interval =
4969 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
4970 else
4971 params.listen_interval = -1;
4972
4973 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
4974 u8 tmp;
4975
4976 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
4977 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
4978 return -EINVAL;
4979
4980 params.support_p2p_ps = tmp;
4981 } else {
4982 params.support_p2p_ps = -1;
4983 }
4984
4985 if (!info->attrs[NL80211_ATTR_MAC])
4986 return -EINVAL;
4987
4988 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4989
4990 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
4991 params.supported_rates =
4992 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4993 params.supported_rates_len =
4994 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4995 }
4996
4997 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
4998 params.capability =
4999 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5000 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5001 }
5002
5003 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5004 params.ext_capab =
5005 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5006 params.ext_capab_len =
5007 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5008 }
5009
5010 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5011 return -EINVAL;
5012
5013 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
5014 params.plink_action =
5015 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
5016 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
5017 return -EINVAL;
5018 }
5019
5020 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
5021 params.plink_state =
5022 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
5023 if (params.plink_state >= NUM_NL80211_PLINK_STATES)
5024 return -EINVAL;
5025 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) {
5026 params.peer_aid = nla_get_u16(
5027 info->attrs[NL80211_ATTR_MESH_PEER_AID]);
5028 if (params.peer_aid > IEEE80211_MAX_AID)
5029 return -EINVAL;
5030 }
5031 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
5032 }
5033
5034 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) {
5035 enum nl80211_mesh_power_mode pm = nla_get_u32(
5036 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
5037
5038 if (pm <= NL80211_MESH_POWER_UNKNOWN ||
5039 pm > NL80211_MESH_POWER_MAX)
5040 return -EINVAL;
5041
5042 params.local_pm = pm;
5043 }
5044
5045 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5046 params.opmode_notif_used = true;
5047 params.opmode_notif =
5048 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5049 }
5050
5051 /* Include parameters for TDLS peer (will check later) */
5052 err = nl80211_set_station_tdls(info, &params);
5053 if (err)
5054 return err;
5055
5056 params.vlan = get_vlan(info, rdev);
5057 if (IS_ERR(params.vlan))
5058 return PTR_ERR(params.vlan);
5059
5060 switch (dev->ieee80211_ptr->iftype) {
5061 case NL80211_IFTYPE_AP:
5062 case NL80211_IFTYPE_AP_VLAN:
5063 case NL80211_IFTYPE_P2P_GO:
5064 case NL80211_IFTYPE_P2P_CLIENT:
5065 case NL80211_IFTYPE_STATION:
5066 case NL80211_IFTYPE_ADHOC:
5067 case NL80211_IFTYPE_MESH_POINT:
5068 break;
5069 default:
5070 err = -EOPNOTSUPP;
5071 goto out_put_vlan;
5072 }
5073
5074 /* driver will call cfg80211_check_station_change() */
5075 err = rdev_change_station(rdev, dev, mac_addr, &params);
5076
5077 out_put_vlan:
5078 if (params.vlan)
5079 dev_put(params.vlan);
5080
5081 return err;
5082 }
5083
5084 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
5085 {
5086 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5087 int err;
5088 struct net_device *dev = info->user_ptr[1];
5089 struct station_parameters params;
5090 u8 *mac_addr = NULL;
5091 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5092 BIT(NL80211_STA_FLAG_ASSOCIATED);
5093
5094 memset(&params, 0, sizeof(params));
5095
5096 if (!rdev->ops->add_station)
5097 return -EOPNOTSUPP;
5098
5099 if (!info->attrs[NL80211_ATTR_MAC])
5100 return -EINVAL;
5101
5102 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
5103 return -EINVAL;
5104
5105 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
5106 return -EINVAL;
5107
5108 if (!info->attrs[NL80211_ATTR_STA_AID] &&
5109 !info->attrs[NL80211_ATTR_PEER_AID])
5110 return -EINVAL;
5111
5112 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5113 params.supported_rates =
5114 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5115 params.supported_rates_len =
5116 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5117 params.listen_interval =
5118 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
5119
5120 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
5121 u8 tmp;
5122
5123 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
5124 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
5125 return -EINVAL;
5126
5127 params.support_p2p_ps = tmp;
5128 } else {
5129 /*
5130 * if not specified, assume it's supported for P2P GO interface,
5131 * and is NOT supported for AP interface
5132 */
5133 params.support_p2p_ps =
5134 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
5135 }
5136
5137 if (info->attrs[NL80211_ATTR_PEER_AID])
5138 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
5139 else
5140 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
5141 if (!params.aid || params.aid > IEEE80211_MAX_AID)
5142 return -EINVAL;
5143
5144 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
5145 params.capability =
5146 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5147 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5148 }
5149
5150 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5151 params.ext_capab =
5152 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5153 params.ext_capab_len =
5154 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5155 }
5156
5157 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
5158 params.ht_capa =
5159 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5160
5161 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
5162 params.vht_capa =
5163 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
5164
5165 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5166 params.opmode_notif_used = true;
5167 params.opmode_notif =
5168 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5169 }
5170
5171 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
5172 params.plink_action =
5173 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
5174 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
5175 return -EINVAL;
5176 }
5177
5178 err = nl80211_parse_sta_channel_info(info, &params);
5179 if (err)
5180 return err;
5181
5182 err = nl80211_parse_sta_wme(info, &params);
5183 if (err)
5184 return err;
5185
5186 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5187 return -EINVAL;
5188
5189 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
5190 * as userspace might just pass through the capabilities from the IEs
5191 * directly, rather than enforcing this restriction and returning an
5192 * error in this case.
5193 */
5194 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
5195 params.ht_capa = NULL;
5196 params.vht_capa = NULL;
5197 }
5198
5199 /* When you run into this, adjust the code below for the new flag */
5200 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
5201
5202 switch (dev->ieee80211_ptr->iftype) {
5203 case NL80211_IFTYPE_AP:
5204 case NL80211_IFTYPE_AP_VLAN:
5205 case NL80211_IFTYPE_P2P_GO:
5206 /* ignore WME attributes if iface/sta is not capable */
5207 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
5208 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
5209 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5210
5211 /* TDLS peers cannot be added */
5212 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5213 info->attrs[NL80211_ATTR_PEER_AID])
5214 return -EINVAL;
5215 /* but don't bother the driver with it */
5216 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5217
5218 /* allow authenticated/associated only if driver handles it */
5219 if (!(rdev->wiphy.features &
5220 NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
5221 params.sta_flags_mask & auth_assoc)
5222 return -EINVAL;
5223
5224 /* Older userspace, or userspace wanting to be compatible with
5225 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
5226 * and assoc flags in the mask, but assumes the station will be
5227 * added as associated anyway since this was the required driver
5228 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
5229 * introduced.
5230 * In order to not bother drivers with this quirk in the API
5231 * set the flags in both the mask and set for new stations in
5232 * this case.
5233 */
5234 if (!(params.sta_flags_mask & auth_assoc)) {
5235 params.sta_flags_mask |= auth_assoc;
5236 params.sta_flags_set |= auth_assoc;
5237 }
5238
5239 /* must be last in here for error handling */
5240 params.vlan = get_vlan(info, rdev);
5241 if (IS_ERR(params.vlan))
5242 return PTR_ERR(params.vlan);
5243 break;
5244 case NL80211_IFTYPE_MESH_POINT:
5245 /* ignore uAPSD data */
5246 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5247
5248 /* associated is disallowed */
5249 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
5250 return -EINVAL;
5251 /* TDLS peers cannot be added */
5252 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5253 info->attrs[NL80211_ATTR_PEER_AID])
5254 return -EINVAL;
5255 break;
5256 case NL80211_IFTYPE_STATION:
5257 case NL80211_IFTYPE_P2P_CLIENT:
5258 /* ignore uAPSD data */
5259 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5260
5261 /* these are disallowed */
5262 if (params.sta_flags_mask &
5263 (BIT(NL80211_STA_FLAG_ASSOCIATED) |
5264 BIT(NL80211_STA_FLAG_AUTHENTICATED)))
5265 return -EINVAL;
5266 /* Only TDLS peers can be added */
5267 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
5268 return -EINVAL;
5269 /* Can only add if TDLS ... */
5270 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
5271 return -EOPNOTSUPP;
5272 /* ... with external setup is supported */
5273 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
5274 return -EOPNOTSUPP;
5275 /*
5276 * Older wpa_supplicant versions always mark the TDLS peer
5277 * as authorized, but it shouldn't yet be.
5278 */
5279 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
5280 break;
5281 default:
5282 return -EOPNOTSUPP;
5283 }
5284
5285 /* be aware of params.vlan when changing code here */
5286
5287 err = rdev_add_station(rdev, dev, mac_addr, &params);
5288
5289 if (params.vlan)
5290 dev_put(params.vlan);
5291 return err;
5292 }
5293
5294 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
5295 {
5296 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5297 struct net_device *dev = info->user_ptr[1];
5298 struct station_del_parameters params;
5299
5300 memset(&params, 0, sizeof(params));
5301
5302 if (info->attrs[NL80211_ATTR_MAC])
5303 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
5304
5305 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5306 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
5307 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
5308 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5309 return -EINVAL;
5310
5311 if (!rdev->ops->del_station)
5312 return -EOPNOTSUPP;
5313
5314 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
5315 params.subtype =
5316 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
5317 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
5318 params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
5319 return -EINVAL;
5320 } else {
5321 /* Default to Deauthentication frame */
5322 params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
5323 }
5324
5325 if (info->attrs[NL80211_ATTR_REASON_CODE]) {
5326 params.reason_code =
5327 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5328 if (params.reason_code == 0)
5329 return -EINVAL; /* 0 is reserved */
5330 } else {
5331 /* Default to reason code 2 */
5332 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
5333 }
5334
5335 return rdev_del_station(rdev, dev, &params);
5336 }
5337
5338 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
5339 int flags, struct net_device *dev,
5340 u8 *dst, u8 *next_hop,
5341 struct mpath_info *pinfo)
5342 {
5343 void *hdr;
5344 struct nlattr *pinfoattr;
5345
5346 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
5347 if (!hdr)
5348 return -1;
5349
5350 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5351 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
5352 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
5353 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
5354 goto nla_put_failure;
5355
5356 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
5357 if (!pinfoattr)
5358 goto nla_put_failure;
5359 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
5360 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
5361 pinfo->frame_qlen))
5362 goto nla_put_failure;
5363 if (((pinfo->filled & MPATH_INFO_SN) &&
5364 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
5365 ((pinfo->filled & MPATH_INFO_METRIC) &&
5366 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
5367 pinfo->metric)) ||
5368 ((pinfo->filled & MPATH_INFO_EXPTIME) &&
5369 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
5370 pinfo->exptime)) ||
5371 ((pinfo->filled & MPATH_INFO_FLAGS) &&
5372 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
5373 pinfo->flags)) ||
5374 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
5375 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
5376 pinfo->discovery_timeout)) ||
5377 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
5378 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
5379 pinfo->discovery_retries)))
5380 goto nla_put_failure;
5381
5382 nla_nest_end(msg, pinfoattr);
5383
5384 genlmsg_end(msg, hdr);
5385 return 0;
5386
5387 nla_put_failure:
5388 genlmsg_cancel(msg, hdr);
5389 return -EMSGSIZE;
5390 }
5391
5392 static int nl80211_dump_mpath(struct sk_buff *skb,
5393 struct netlink_callback *cb)
5394 {
5395 struct mpath_info pinfo;
5396 struct cfg80211_registered_device *rdev;
5397 struct wireless_dev *wdev;
5398 u8 dst[ETH_ALEN];
5399 u8 next_hop[ETH_ALEN];
5400 int path_idx = cb->args[2];
5401 int err;
5402
5403 rtnl_lock();
5404 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
5405 if (err)
5406 goto out_err;
5407
5408 if (!rdev->ops->dump_mpath) {
5409 err = -EOPNOTSUPP;
5410 goto out_err;
5411 }
5412
5413 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5414 err = -EOPNOTSUPP;
5415 goto out_err;
5416 }
5417
5418 while (1) {
5419 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
5420 next_hop, &pinfo);
5421 if (err == -ENOENT)
5422 break;
5423 if (err)
5424 goto out_err;
5425
5426 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
5427 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5428 wdev->netdev, dst, next_hop,
5429 &pinfo) < 0)
5430 goto out;
5431
5432 path_idx++;
5433 }
5434
5435 out:
5436 cb->args[2] = path_idx;
5437 err = skb->len;
5438 out_err:
5439 rtnl_unlock();
5440 return err;
5441 }
5442
5443 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
5444 {
5445 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5446 int err;
5447 struct net_device *dev = info->user_ptr[1];
5448 struct mpath_info pinfo;
5449 struct sk_buff *msg;
5450 u8 *dst = NULL;
5451 u8 next_hop[ETH_ALEN];
5452
5453 memset(&pinfo, 0, sizeof(pinfo));
5454
5455 if (!info->attrs[NL80211_ATTR_MAC])
5456 return -EINVAL;
5457
5458 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5459
5460 if (!rdev->ops->get_mpath)
5461 return -EOPNOTSUPP;
5462
5463 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5464 return -EOPNOTSUPP;
5465
5466 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
5467 if (err)
5468 return err;
5469
5470 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5471 if (!msg)
5472 return -ENOMEM;
5473
5474 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
5475 dev, dst, next_hop, &pinfo) < 0) {
5476 nlmsg_free(msg);
5477 return -ENOBUFS;
5478 }
5479
5480 return genlmsg_reply(msg, info);
5481 }
5482
5483 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
5484 {
5485 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5486 struct net_device *dev = info->user_ptr[1];
5487 u8 *dst = NULL;
5488 u8 *next_hop = NULL;
5489
5490 if (!info->attrs[NL80211_ATTR_MAC])
5491 return -EINVAL;
5492
5493 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5494 return -EINVAL;
5495
5496 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5497 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5498
5499 if (!rdev->ops->change_mpath)
5500 return -EOPNOTSUPP;
5501
5502 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5503 return -EOPNOTSUPP;
5504
5505 return rdev_change_mpath(rdev, dev, dst, next_hop);
5506 }
5507
5508 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
5509 {
5510 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5511 struct net_device *dev = info->user_ptr[1];
5512 u8 *dst = NULL;
5513 u8 *next_hop = NULL;
5514
5515 if (!info->attrs[NL80211_ATTR_MAC])
5516 return -EINVAL;
5517
5518 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5519 return -EINVAL;
5520
5521 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5522 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5523
5524 if (!rdev->ops->add_mpath)
5525 return -EOPNOTSUPP;
5526
5527 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5528 return -EOPNOTSUPP;
5529
5530 return rdev_add_mpath(rdev, dev, dst, next_hop);
5531 }
5532
5533 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
5534 {
5535 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5536 struct net_device *dev = info->user_ptr[1];
5537 u8 *dst = NULL;
5538
5539 if (info->attrs[NL80211_ATTR_MAC])
5540 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5541
5542 if (!rdev->ops->del_mpath)
5543 return -EOPNOTSUPP;
5544
5545 return rdev_del_mpath(rdev, dev, dst);
5546 }
5547
5548 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
5549 {
5550 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5551 int err;
5552 struct net_device *dev = info->user_ptr[1];
5553 struct mpath_info pinfo;
5554 struct sk_buff *msg;
5555 u8 *dst = NULL;
5556 u8 mpp[ETH_ALEN];
5557
5558 memset(&pinfo, 0, sizeof(pinfo));
5559
5560 if (!info->attrs[NL80211_ATTR_MAC])
5561 return -EINVAL;
5562
5563 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5564
5565 if (!rdev->ops->get_mpp)
5566 return -EOPNOTSUPP;
5567
5568 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5569 return -EOPNOTSUPP;
5570
5571 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
5572 if (err)
5573 return err;
5574
5575 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5576 if (!msg)
5577 return -ENOMEM;
5578
5579 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
5580 dev, dst, mpp, &pinfo) < 0) {
5581 nlmsg_free(msg);
5582 return -ENOBUFS;
5583 }
5584
5585 return genlmsg_reply(msg, info);
5586 }
5587
5588 static int nl80211_dump_mpp(struct sk_buff *skb,
5589 struct netlink_callback *cb)
5590 {
5591 struct mpath_info pinfo;
5592 struct cfg80211_registered_device *rdev;
5593 struct wireless_dev *wdev;
5594 u8 dst[ETH_ALEN];
5595 u8 mpp[ETH_ALEN];
5596 int path_idx = cb->args[2];
5597 int err;
5598
5599 rtnl_lock();
5600 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
5601 if (err)
5602 goto out_err;
5603
5604 if (!rdev->ops->dump_mpp) {
5605 err = -EOPNOTSUPP;
5606 goto out_err;
5607 }
5608
5609 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5610 err = -EOPNOTSUPP;
5611 goto out_err;
5612 }
5613
5614 while (1) {
5615 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
5616 mpp, &pinfo);
5617 if (err == -ENOENT)
5618 break;
5619 if (err)
5620 goto out_err;
5621
5622 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
5623 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5624 wdev->netdev, dst, mpp,
5625 &pinfo) < 0)
5626 goto out;
5627
5628 path_idx++;
5629 }
5630
5631 out:
5632 cb->args[2] = path_idx;
5633 err = skb->len;
5634 out_err:
5635 rtnl_unlock();
5636 return err;
5637 }
5638
5639 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
5640 {
5641 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5642 struct net_device *dev = info->user_ptr[1];
5643 struct wireless_dev *wdev = dev->ieee80211_ptr;
5644 struct bss_parameters params;
5645 int err;
5646
5647 memset(&params, 0, sizeof(params));
5648 /* default to not changing parameters */
5649 params.use_cts_prot = -1;
5650 params.use_short_preamble = -1;
5651 params.use_short_slot_time = -1;
5652 params.ap_isolate = -1;
5653 params.ht_opmode = -1;
5654 params.p2p_ctwindow = -1;
5655 params.p2p_opp_ps = -1;
5656
5657 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
5658 params.use_cts_prot =
5659 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
5660 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
5661 params.use_short_preamble =
5662 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
5663 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
5664 params.use_short_slot_time =
5665 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
5666 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
5667 params.basic_rates =
5668 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5669 params.basic_rates_len =
5670 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5671 }
5672 if (info->attrs[NL80211_ATTR_AP_ISOLATE])
5673 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
5674 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
5675 params.ht_opmode =
5676 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
5677
5678 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
5679 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5680 return -EINVAL;
5681 params.p2p_ctwindow =
5682 nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
5683 if (params.p2p_ctwindow < 0)
5684 return -EINVAL;
5685 if (params.p2p_ctwindow != 0 &&
5686 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
5687 return -EINVAL;
5688 }
5689
5690 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
5691 u8 tmp;
5692
5693 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5694 return -EINVAL;
5695 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
5696 if (tmp > 1)
5697 return -EINVAL;
5698 params.p2p_opp_ps = tmp;
5699 if (params.p2p_opp_ps &&
5700 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
5701 return -EINVAL;
5702 }
5703
5704 if (!rdev->ops->change_bss)
5705 return -EOPNOTSUPP;
5706
5707 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5708 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5709 return -EOPNOTSUPP;
5710
5711 wdev_lock(wdev);
5712 err = rdev_change_bss(rdev, dev, &params);
5713 wdev_unlock(wdev);
5714
5715 return err;
5716 }
5717
5718 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
5719 {
5720 char *data = NULL;
5721 bool is_indoor;
5722 enum nl80211_user_reg_hint_type user_reg_hint_type;
5723 u32 owner_nlportid;
5724
5725 /*
5726 * You should only get this when cfg80211 hasn't yet initialized
5727 * completely when built-in to the kernel right between the time
5728 * window between nl80211_init() and regulatory_init(), if that is
5729 * even possible.
5730 */
5731 if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
5732 return -EINPROGRESS;
5733
5734 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
5735 user_reg_hint_type =
5736 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
5737 else
5738 user_reg_hint_type = NL80211_USER_REG_HINT_USER;
5739
5740 switch (user_reg_hint_type) {
5741 case NL80211_USER_REG_HINT_USER:
5742 case NL80211_USER_REG_HINT_CELL_BASE:
5743 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
5744 return -EINVAL;
5745
5746 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
5747 return regulatory_hint_user(data, user_reg_hint_type);
5748 case NL80211_USER_REG_HINT_INDOOR:
5749 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
5750 owner_nlportid = info->snd_portid;
5751 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
5752 } else {
5753 owner_nlportid = 0;
5754 is_indoor = true;
5755 }
5756
5757 return regulatory_hint_indoor(is_indoor, owner_nlportid);
5758 default:
5759 return -EINVAL;
5760 }
5761 }
5762
5763 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info)
5764 {
5765 return reg_reload_regdb();
5766 }
5767
5768 static int nl80211_get_mesh_config(struct sk_buff *skb,
5769 struct genl_info *info)
5770 {
5771 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5772 struct net_device *dev = info->user_ptr[1];
5773 struct wireless_dev *wdev = dev->ieee80211_ptr;
5774 struct mesh_config cur_params;
5775 int err = 0;
5776 void *hdr;
5777 struct nlattr *pinfoattr;
5778 struct sk_buff *msg;
5779
5780 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
5781 return -EOPNOTSUPP;
5782
5783 if (!rdev->ops->get_mesh_config)
5784 return -EOPNOTSUPP;
5785
5786 wdev_lock(wdev);
5787 /* If not connected, get default parameters */
5788 if (!wdev->mesh_id_len)
5789 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
5790 else
5791 err = rdev_get_mesh_config(rdev, dev, &cur_params);
5792 wdev_unlock(wdev);
5793
5794 if (err)
5795 return err;
5796
5797 /* Draw up a netlink message to send back */
5798 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5799 if (!msg)
5800 return -ENOMEM;
5801 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
5802 NL80211_CMD_GET_MESH_CONFIG);
5803 if (!hdr)
5804 goto out;
5805 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
5806 if (!pinfoattr)
5807 goto nla_put_failure;
5808 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5809 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
5810 cur_params.dot11MeshRetryTimeout) ||
5811 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
5812 cur_params.dot11MeshConfirmTimeout) ||
5813 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
5814 cur_params.dot11MeshHoldingTimeout) ||
5815 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
5816 cur_params.dot11MeshMaxPeerLinks) ||
5817 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
5818 cur_params.dot11MeshMaxRetries) ||
5819 nla_put_u8(msg, NL80211_MESHCONF_TTL,
5820 cur_params.dot11MeshTTL) ||
5821 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
5822 cur_params.element_ttl) ||
5823 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
5824 cur_params.auto_open_plinks) ||
5825 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
5826 cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
5827 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
5828 cur_params.dot11MeshHWMPmaxPREQretries) ||
5829 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
5830 cur_params.path_refresh_time) ||
5831 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
5832 cur_params.min_discovery_timeout) ||
5833 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
5834 cur_params.dot11MeshHWMPactivePathTimeout) ||
5835 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
5836 cur_params.dot11MeshHWMPpreqMinInterval) ||
5837 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
5838 cur_params.dot11MeshHWMPperrMinInterval) ||
5839 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
5840 cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
5841 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
5842 cur_params.dot11MeshHWMPRootMode) ||
5843 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
5844 cur_params.dot11MeshHWMPRannInterval) ||
5845 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
5846 cur_params.dot11MeshGateAnnouncementProtocol) ||
5847 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
5848 cur_params.dot11MeshForwarding) ||
5849 nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
5850 cur_params.rssi_threshold) ||
5851 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
5852 cur_params.ht_opmode) ||
5853 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
5854 cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
5855 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
5856 cur_params.dot11MeshHWMProotInterval) ||
5857 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
5858 cur_params.dot11MeshHWMPconfirmationInterval) ||
5859 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
5860 cur_params.power_mode) ||
5861 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
5862 cur_params.dot11MeshAwakeWindowDuration) ||
5863 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
5864 cur_params.plink_timeout))
5865 goto nla_put_failure;
5866 nla_nest_end(msg, pinfoattr);
5867 genlmsg_end(msg, hdr);
5868 return genlmsg_reply(msg, info);
5869
5870 nla_put_failure:
5871 genlmsg_cancel(msg, hdr);
5872 out:
5873 nlmsg_free(msg);
5874 return -ENOBUFS;
5875 }
5876
5877 static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
5878 [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
5879 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
5880 [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
5881 [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
5882 [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
5883 [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
5884 [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
5885 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
5886 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
5887 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
5888 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
5889 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
5890 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
5891 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
5892 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
5893 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
5894 [NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
5895 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
5896 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
5897 [NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
5898 [NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
5899 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
5900 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
5901 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
5902 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
5903 [NL80211_MESHCONF_POWER_MODE] = { .type = NLA_U32 },
5904 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
5905 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
5906 };
5907
5908 static const struct nla_policy
5909 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
5910 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
5911 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
5912 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
5913 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
5914 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
5915 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
5916 [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
5917 .len = IEEE80211_MAX_DATA_LEN },
5918 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
5919 };
5920
5921 static int nl80211_check_bool(const struct nlattr *nla, u8 min, u8 max, bool *out)
5922 {
5923 u8 val = nla_get_u8(nla);
5924 if (val < min || val > max)
5925 return -EINVAL;
5926 *out = val;
5927 return 0;
5928 }
5929
5930 static int nl80211_check_u8(const struct nlattr *nla, u8 min, u8 max, u8 *out)
5931 {
5932 u8 val = nla_get_u8(nla);
5933 if (val < min || val > max)
5934 return -EINVAL;
5935 *out = val;
5936 return 0;
5937 }
5938
5939 static int nl80211_check_u16(const struct nlattr *nla, u16 min, u16 max, u16 *out)
5940 {
5941 u16 val = nla_get_u16(nla);
5942 if (val < min || val > max)
5943 return -EINVAL;
5944 *out = val;
5945 return 0;
5946 }
5947
5948 static int nl80211_check_u32(const struct nlattr *nla, u32 min, u32 max, u32 *out)
5949 {
5950 u32 val = nla_get_u32(nla);
5951 if (val < min || val > max)
5952 return -EINVAL;
5953 *out = val;
5954 return 0;
5955 }
5956
5957 static int nl80211_check_s32(const struct nlattr *nla, s32 min, s32 max, s32 *out)
5958 {
5959 s32 val = nla_get_s32(nla);
5960 if (val < min || val > max)
5961 return -EINVAL;
5962 *out = val;
5963 return 0;
5964 }
5965
5966 static int nl80211_check_power_mode(const struct nlattr *nla,
5967 enum nl80211_mesh_power_mode min,
5968 enum nl80211_mesh_power_mode max,
5969 enum nl80211_mesh_power_mode *out)
5970 {
5971 u32 val = nla_get_u32(nla);
5972 if (val < min || val > max)
5973 return -EINVAL;
5974 *out = val;
5975 return 0;
5976 }
5977
5978 static int nl80211_parse_mesh_config(struct genl_info *info,
5979 struct mesh_config *cfg,
5980 u32 *mask_out)
5981 {
5982 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
5983 u32 mask = 0;
5984 u16 ht_opmode;
5985
5986 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, min, max, mask, attr, fn) \
5987 do { \
5988 if (tb[attr]) { \
5989 if (fn(tb[attr], min, max, &cfg->param)) \
5990 return -EINVAL; \
5991 mask |= (1 << (attr - 1)); \
5992 } \
5993 } while (0)
5994
5995 if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
5996 return -EINVAL;
5997 if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
5998 info->attrs[NL80211_ATTR_MESH_CONFIG],
5999 nl80211_meshconf_params_policy, info->extack))
6000 return -EINVAL;
6001
6002 /* This makes sure that there aren't more than 32 mesh config
6003 * parameters (otherwise our bitfield scheme would not work.) */
6004 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
6005
6006 /* Fill in the params struct */
6007 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, 1, 255,
6008 mask, NL80211_MESHCONF_RETRY_TIMEOUT,
6009 nl80211_check_u16);
6010 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, 1, 255,
6011 mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
6012 nl80211_check_u16);
6013 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, 1, 255,
6014 mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
6015 nl80211_check_u16);
6016 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, 0, 255,
6017 mask, NL80211_MESHCONF_MAX_PEER_LINKS,
6018 nl80211_check_u16);
6019 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, 0, 16,
6020 mask, NL80211_MESHCONF_MAX_RETRIES,
6021 nl80211_check_u8);
6022 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, 1, 255,
6023 mask, NL80211_MESHCONF_TTL, nl80211_check_u8);
6024 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, 1, 255,
6025 mask, NL80211_MESHCONF_ELEMENT_TTL,
6026 nl80211_check_u8);
6027 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, 0, 1,
6028 mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
6029 nl80211_check_bool);
6030 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
6031 1, 255, mask,
6032 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
6033 nl80211_check_u32);
6034 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, 0, 255,
6035 mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
6036 nl80211_check_u8);
6037 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, 1, 65535,
6038 mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
6039 nl80211_check_u32);
6040 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, 1, 65535,
6041 mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
6042 nl80211_check_u16);
6043 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
6044 1, 65535, mask,
6045 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
6046 nl80211_check_u32);
6047 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
6048 1, 65535, mask,
6049 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
6050 nl80211_check_u16);
6051 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
6052 1, 65535, mask,
6053 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
6054 nl80211_check_u16);
6055 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6056 dot11MeshHWMPnetDiameterTraversalTime,
6057 1, 65535, mask,
6058 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
6059 nl80211_check_u16);
6060 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, 0, 4,
6061 mask, NL80211_MESHCONF_HWMP_ROOTMODE,
6062 nl80211_check_u8);
6063 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, 1, 65535,
6064 mask, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
6065 nl80211_check_u16);
6066 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6067 dot11MeshGateAnnouncementProtocol, 0, 1,
6068 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
6069 nl80211_check_bool);
6070 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, 0, 1,
6071 mask, NL80211_MESHCONF_FORWARDING,
6072 nl80211_check_bool);
6073 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, -255, 0,
6074 mask, NL80211_MESHCONF_RSSI_THRESHOLD,
6075 nl80211_check_s32);
6076 /*
6077 * Check HT operation mode based on
6078 * IEEE 802.11-2016 9.4.2.57 HT Operation element.
6079 */
6080 if (tb[NL80211_MESHCONF_HT_OPMODE]) {
6081 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
6082
6083 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
6084 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
6085 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
6086 return -EINVAL;
6087
6088 /* NON_HT_STA bit is reserved, but some programs set it */
6089 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT;
6090
6091 cfg->ht_opmode = ht_opmode;
6092 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
6093 }
6094 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
6095 1, 65535, mask,
6096 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
6097 nl80211_check_u32);
6098 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, 1, 65535,
6099 mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
6100 nl80211_check_u16);
6101 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6102 dot11MeshHWMPconfirmationInterval,
6103 1, 65535, mask,
6104 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
6105 nl80211_check_u16);
6106 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode,
6107 NL80211_MESH_POWER_ACTIVE,
6108 NL80211_MESH_POWER_MAX,
6109 mask, NL80211_MESHCONF_POWER_MODE,
6110 nl80211_check_power_mode);
6111 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration,
6112 0, 65535, mask,
6113 NL80211_MESHCONF_AWAKE_WINDOW, nl80211_check_u16);
6114 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, 0, 0xffffffff,
6115 mask, NL80211_MESHCONF_PLINK_TIMEOUT,
6116 nl80211_check_u32);
6117 if (mask_out)
6118 *mask_out = mask;
6119
6120 return 0;
6121
6122 #undef FILL_IN_MESH_PARAM_IF_SET
6123 }
6124
6125 static int nl80211_parse_mesh_setup(struct genl_info *info,
6126 struct mesh_setup *setup)
6127 {
6128 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6129 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
6130
6131 if (!info->attrs[NL80211_ATTR_MESH_SETUP])
6132 return -EINVAL;
6133 if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
6134 info->attrs[NL80211_ATTR_MESH_SETUP],
6135 nl80211_mesh_setup_params_policy, info->extack))
6136 return -EINVAL;
6137
6138 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
6139 setup->sync_method =
6140 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
6141 IEEE80211_SYNC_METHOD_VENDOR :
6142 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
6143
6144 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
6145 setup->path_sel_proto =
6146 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
6147 IEEE80211_PATH_PROTOCOL_VENDOR :
6148 IEEE80211_PATH_PROTOCOL_HWMP;
6149
6150 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
6151 setup->path_metric =
6152 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
6153 IEEE80211_PATH_METRIC_VENDOR :
6154 IEEE80211_PATH_METRIC_AIRTIME;
6155
6156 if (tb[NL80211_MESH_SETUP_IE]) {
6157 struct nlattr *ieattr =
6158 tb[NL80211_MESH_SETUP_IE];
6159 if (!is_valid_ie_attr(ieattr))
6160 return -EINVAL;
6161 setup->ie = nla_data(ieattr);
6162 setup->ie_len = nla_len(ieattr);
6163 }
6164 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
6165 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
6166 return -EINVAL;
6167 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
6168 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
6169 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
6170 if (setup->is_secure)
6171 setup->user_mpm = true;
6172
6173 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
6174 if (!setup->user_mpm)
6175 return -EINVAL;
6176 setup->auth_id =
6177 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
6178 }
6179
6180 return 0;
6181 }
6182
6183 static int nl80211_update_mesh_config(struct sk_buff *skb,
6184 struct genl_info *info)
6185 {
6186 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6187 struct net_device *dev = info->user_ptr[1];
6188 struct wireless_dev *wdev = dev->ieee80211_ptr;
6189 struct mesh_config cfg;
6190 u32 mask;
6191 int err;
6192
6193 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
6194 return -EOPNOTSUPP;
6195
6196 if (!rdev->ops->update_mesh_config)
6197 return -EOPNOTSUPP;
6198
6199 err = nl80211_parse_mesh_config(info, &cfg, &mask);
6200 if (err)
6201 return err;
6202
6203 wdev_lock(wdev);
6204 if (!wdev->mesh_id_len)
6205 err = -ENOLINK;
6206
6207 if (!err)
6208 err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
6209
6210 wdev_unlock(wdev);
6211
6212 return err;
6213 }
6214
6215 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
6216 struct sk_buff *msg)
6217 {
6218 struct nlattr *nl_reg_rules;
6219 unsigned int i;
6220
6221 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
6222 (regdom->dfs_region &&
6223 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
6224 goto nla_put_failure;
6225
6226 nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
6227 if (!nl_reg_rules)
6228 goto nla_put_failure;
6229
6230 for (i = 0; i < regdom->n_reg_rules; i++) {
6231 struct nlattr *nl_reg_rule;
6232 const struct ieee80211_reg_rule *reg_rule;
6233 const struct ieee80211_freq_range *freq_range;
6234 const struct ieee80211_power_rule *power_rule;
6235 unsigned int max_bandwidth_khz;
6236
6237 reg_rule = &regdom->reg_rules[i];
6238 freq_range = &reg_rule->freq_range;
6239 power_rule = &reg_rule->power_rule;
6240
6241 nl_reg_rule = nla_nest_start(msg, i);
6242 if (!nl_reg_rule)
6243 goto nla_put_failure;
6244
6245 max_bandwidth_khz = freq_range->max_bandwidth_khz;
6246 if (!max_bandwidth_khz)
6247 max_bandwidth_khz = reg_get_max_bandwidth(regdom,
6248 reg_rule);
6249
6250 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
6251 reg_rule->flags) ||
6252 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
6253 freq_range->start_freq_khz) ||
6254 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
6255 freq_range->end_freq_khz) ||
6256 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
6257 max_bandwidth_khz) ||
6258 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
6259 power_rule->max_antenna_gain) ||
6260 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
6261 power_rule->max_eirp) ||
6262 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
6263 reg_rule->dfs_cac_ms))
6264 goto nla_put_failure;
6265
6266 nla_nest_end(msg, nl_reg_rule);
6267 }
6268
6269 nla_nest_end(msg, nl_reg_rules);
6270 return 0;
6271
6272 nla_put_failure:
6273 return -EMSGSIZE;
6274 }
6275
6276 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
6277 {
6278 const struct ieee80211_regdomain *regdom = NULL;
6279 struct cfg80211_registered_device *rdev;
6280 struct wiphy *wiphy = NULL;
6281 struct sk_buff *msg;
6282 void *hdr;
6283
6284 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6285 if (!msg)
6286 return -ENOBUFS;
6287
6288 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6289 NL80211_CMD_GET_REG);
6290 if (!hdr)
6291 goto put_failure;
6292
6293 if (info->attrs[NL80211_ATTR_WIPHY]) {
6294 bool self_managed;
6295
6296 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
6297 if (IS_ERR(rdev)) {
6298 nlmsg_free(msg);
6299 return PTR_ERR(rdev);
6300 }
6301
6302 wiphy = &rdev->wiphy;
6303 self_managed = wiphy->regulatory_flags &
6304 REGULATORY_WIPHY_SELF_MANAGED;
6305 regdom = get_wiphy_regdom(wiphy);
6306
6307 /* a self-managed-reg device must have a private regdom */
6308 if (WARN_ON(!regdom && self_managed)) {
6309 nlmsg_free(msg);
6310 return -EINVAL;
6311 }
6312
6313 if (regdom &&
6314 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6315 goto nla_put_failure;
6316 }
6317
6318 if (!wiphy && reg_last_request_cell_base() &&
6319 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6320 NL80211_USER_REG_HINT_CELL_BASE))
6321 goto nla_put_failure;
6322
6323 rcu_read_lock();
6324
6325 if (!regdom)
6326 regdom = rcu_dereference(cfg80211_regdomain);
6327
6328 if (nl80211_put_regdom(regdom, msg))
6329 goto nla_put_failure_rcu;
6330
6331 rcu_read_unlock();
6332
6333 genlmsg_end(msg, hdr);
6334 return genlmsg_reply(msg, info);
6335
6336 nla_put_failure_rcu:
6337 rcu_read_unlock();
6338 nla_put_failure:
6339 genlmsg_cancel(msg, hdr);
6340 put_failure:
6341 nlmsg_free(msg);
6342 return -EMSGSIZE;
6343 }
6344
6345 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
6346 u32 seq, int flags, struct wiphy *wiphy,
6347 const struct ieee80211_regdomain *regdom)
6348 {
6349 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
6350 NL80211_CMD_GET_REG);
6351
6352 if (!hdr)
6353 return -1;
6354
6355 genl_dump_check_consistent(cb, hdr);
6356
6357 if (nl80211_put_regdom(regdom, msg))
6358 goto nla_put_failure;
6359
6360 if (!wiphy && reg_last_request_cell_base() &&
6361 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6362 NL80211_USER_REG_HINT_CELL_BASE))
6363 goto nla_put_failure;
6364
6365 if (wiphy &&
6366 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6367 goto nla_put_failure;
6368
6369 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
6370 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
6371 goto nla_put_failure;
6372
6373 genlmsg_end(msg, hdr);
6374 return 0;
6375
6376 nla_put_failure:
6377 genlmsg_cancel(msg, hdr);
6378 return -EMSGSIZE;
6379 }
6380
6381 static int nl80211_get_reg_dump(struct sk_buff *skb,
6382 struct netlink_callback *cb)
6383 {
6384 const struct ieee80211_regdomain *regdom = NULL;
6385 struct cfg80211_registered_device *rdev;
6386 int err, reg_idx, start = cb->args[2];
6387
6388 rtnl_lock();
6389
6390 if (cfg80211_regdomain && start == 0) {
6391 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6392 NLM_F_MULTI, NULL,
6393 rtnl_dereference(cfg80211_regdomain));
6394 if (err < 0)
6395 goto out_err;
6396 }
6397
6398 /* the global regdom is idx 0 */
6399 reg_idx = 1;
6400 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
6401 regdom = get_wiphy_regdom(&rdev->wiphy);
6402 if (!regdom)
6403 continue;
6404
6405 if (++reg_idx <= start)
6406 continue;
6407
6408 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6409 NLM_F_MULTI, &rdev->wiphy, regdom);
6410 if (err < 0) {
6411 reg_idx--;
6412 break;
6413 }
6414 }
6415
6416 cb->args[2] = reg_idx;
6417 err = skb->len;
6418 out_err:
6419 rtnl_unlock();
6420 return err;
6421 }
6422
6423 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
6424 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
6425 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
6426 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
6427 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
6428 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
6429 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
6430 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
6431 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 },
6432 };
6433
6434 static int parse_reg_rule(struct nlattr *tb[],
6435 struct ieee80211_reg_rule *reg_rule)
6436 {
6437 struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
6438 struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
6439
6440 if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
6441 return -EINVAL;
6442 if (!tb[NL80211_ATTR_FREQ_RANGE_START])
6443 return -EINVAL;
6444 if (!tb[NL80211_ATTR_FREQ_RANGE_END])
6445 return -EINVAL;
6446 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
6447 return -EINVAL;
6448 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
6449 return -EINVAL;
6450
6451 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
6452
6453 freq_range->start_freq_khz =
6454 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
6455 freq_range->end_freq_khz =
6456 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
6457 freq_range->max_bandwidth_khz =
6458 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
6459
6460 power_rule->max_eirp =
6461 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
6462
6463 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
6464 power_rule->max_antenna_gain =
6465 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
6466
6467 if (tb[NL80211_ATTR_DFS_CAC_TIME])
6468 reg_rule->dfs_cac_ms =
6469 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
6470
6471 return 0;
6472 }
6473
6474 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
6475 {
6476 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
6477 struct nlattr *nl_reg_rule;
6478 char *alpha2;
6479 int rem_reg_rules, r;
6480 u32 num_rules = 0, rule_idx = 0, size_of_regd;
6481 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
6482 struct ieee80211_regdomain *rd;
6483
6484 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
6485 return -EINVAL;
6486
6487 if (!info->attrs[NL80211_ATTR_REG_RULES])
6488 return -EINVAL;
6489
6490 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
6491
6492 if (info->attrs[NL80211_ATTR_DFS_REGION])
6493 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
6494
6495 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
6496 rem_reg_rules) {
6497 num_rules++;
6498 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
6499 return -EINVAL;
6500 }
6501
6502 if (!reg_is_valid_request(alpha2))
6503 return -EINVAL;
6504
6505 size_of_regd = sizeof(struct ieee80211_regdomain) +
6506 num_rules * sizeof(struct ieee80211_reg_rule);
6507
6508 rd = kzalloc(size_of_regd, GFP_KERNEL);
6509 if (!rd)
6510 return -ENOMEM;
6511
6512 rd->n_reg_rules = num_rules;
6513 rd->alpha2[0] = alpha2[0];
6514 rd->alpha2[1] = alpha2[1];
6515
6516 /*
6517 * Disable DFS master mode if the DFS region was
6518 * not supported or known on this kernel.
6519 */
6520 if (reg_supported_dfs_region(dfs_region))
6521 rd->dfs_region = dfs_region;
6522
6523 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
6524 rem_reg_rules) {
6525 r = nla_parse_nested(tb, NL80211_REG_RULE_ATTR_MAX,
6526 nl_reg_rule, reg_rule_policy,
6527 info->extack);
6528 if (r)
6529 goto bad_reg;
6530 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
6531 if (r)
6532 goto bad_reg;
6533
6534 rule_idx++;
6535
6536 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
6537 r = -EINVAL;
6538 goto bad_reg;
6539 }
6540 }
6541
6542 /* set_regdom takes ownership of rd */
6543 return set_regdom(rd, REGD_SOURCE_CRDA);
6544 bad_reg:
6545 kfree(rd);
6546 return r;
6547 }
6548 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */
6549
6550 static int validate_scan_freqs(struct nlattr *freqs)
6551 {
6552 struct nlattr *attr1, *attr2;
6553 int n_channels = 0, tmp1, tmp2;
6554
6555 nla_for_each_nested(attr1, freqs, tmp1)
6556 if (nla_len(attr1) != sizeof(u32))
6557 return 0;
6558
6559 nla_for_each_nested(attr1, freqs, tmp1) {
6560 n_channels++;
6561 /*
6562 * Some hardware has a limited channel list for
6563 * scanning, and it is pretty much nonsensical
6564 * to scan for a channel twice, so disallow that
6565 * and don't require drivers to check that the
6566 * channel list they get isn't longer than what
6567 * they can scan, as long as they can scan all
6568 * the channels they registered at once.
6569 */
6570 nla_for_each_nested(attr2, freqs, tmp2)
6571 if (attr1 != attr2 &&
6572 nla_get_u32(attr1) == nla_get_u32(attr2))
6573 return 0;
6574 }
6575
6576 return n_channels;
6577 }
6578
6579 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
6580 {
6581 return b < NUM_NL80211_BANDS && wiphy->bands[b];
6582 }
6583
6584 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
6585 struct cfg80211_bss_selection *bss_select)
6586 {
6587 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
6588 struct nlattr *nest;
6589 int err;
6590 bool found = false;
6591 int i;
6592
6593 /* only process one nested attribute */
6594 nest = nla_data(nla);
6595 if (!nla_ok(nest, nla_len(nest)))
6596 return -EINVAL;
6597
6598 err = nla_parse_nested(attr, NL80211_BSS_SELECT_ATTR_MAX, nest,
6599 nl80211_bss_select_policy, NULL);
6600 if (err)
6601 return err;
6602
6603 /* only one attribute may be given */
6604 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
6605 if (attr[i]) {
6606 if (found)
6607 return -EINVAL;
6608 found = true;
6609 }
6610 }
6611
6612 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
6613
6614 if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
6615 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
6616
6617 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
6618 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
6619 bss_select->param.band_pref =
6620 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
6621 if (!is_band_valid(wiphy, bss_select->param.band_pref))
6622 return -EINVAL;
6623 }
6624
6625 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
6626 struct nl80211_bss_select_rssi_adjust *adj_param;
6627
6628 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
6629 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
6630 bss_select->param.adjust.band = adj_param->band;
6631 bss_select->param.adjust.delta = adj_param->delta;
6632 if (!is_band_valid(wiphy, bss_select->param.adjust.band))
6633 return -EINVAL;
6634 }
6635
6636 /* user-space did not provide behaviour attribute */
6637 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
6638 return -EINVAL;
6639
6640 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
6641 return -EINVAL;
6642
6643 return 0;
6644 }
6645
6646 static int nl80211_parse_random_mac(struct nlattr **attrs,
6647 u8 *mac_addr, u8 *mac_addr_mask)
6648 {
6649 int i;
6650
6651 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
6652 eth_zero_addr(mac_addr);
6653 eth_zero_addr(mac_addr_mask);
6654 mac_addr[0] = 0x2;
6655 mac_addr_mask[0] = 0x3;
6656
6657 return 0;
6658 }
6659
6660 /* need both or none */
6661 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
6662 return -EINVAL;
6663
6664 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
6665 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
6666
6667 /* don't allow or configure an mcast address */
6668 if (!is_multicast_ether_addr(mac_addr_mask) ||
6669 is_multicast_ether_addr(mac_addr))
6670 return -EINVAL;
6671
6672 /*
6673 * allow users to pass a MAC address that has bits set outside
6674 * of the mask, but don't bother drivers with having to deal
6675 * with such bits
6676 */
6677 for (i = 0; i < ETH_ALEN; i++)
6678 mac_addr[i] &= mac_addr_mask[i];
6679
6680 return 0;
6681 }
6682
6683 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev)
6684 {
6685 ASSERT_WDEV_LOCK(wdev);
6686
6687 if (!cfg80211_beaconing_iface_active(wdev))
6688 return true;
6689
6690 if (!(wdev->chandef.chan->flags & IEEE80211_CHAN_RADAR))
6691 return true;
6692
6693 return regulatory_pre_cac_allowed(wdev->wiphy);
6694 }
6695
6696 static int
6697 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev,
6698 void *request, struct nlattr **attrs,
6699 bool is_sched_scan)
6700 {
6701 u8 *mac_addr, *mac_addr_mask;
6702 u32 *flags;
6703 enum nl80211_feature_flags randomness_flag;
6704
6705 if (!attrs[NL80211_ATTR_SCAN_FLAGS])
6706 return 0;
6707
6708 if (is_sched_scan) {
6709 struct cfg80211_sched_scan_request *req = request;
6710
6711 randomness_flag = wdev ?
6712 NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR :
6713 NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
6714 flags = &req->flags;
6715 mac_addr = req->mac_addr;
6716 mac_addr_mask = req->mac_addr_mask;
6717 } else {
6718 struct cfg80211_scan_request *req = request;
6719
6720 randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
6721 flags = &req->flags;
6722 mac_addr = req->mac_addr;
6723 mac_addr_mask = req->mac_addr_mask;
6724 }
6725
6726 *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]);
6727
6728 if ((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
6729 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN))
6730 return -EOPNOTSUPP;
6731
6732 if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
6733 int err;
6734
6735 if (!(wiphy->features & randomness_flag) ||
6736 (wdev && wdev->current_bss))
6737 return -EOPNOTSUPP;
6738
6739 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask);
6740 if (err)
6741 return err;
6742 }
6743
6744 if ((*flags & NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME) &&
6745 !wiphy_ext_feature_isset(wiphy,
6746 NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME))
6747 return -EOPNOTSUPP;
6748
6749 if ((*flags & NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP) &&
6750 !wiphy_ext_feature_isset(wiphy,
6751 NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP))
6752 return -EOPNOTSUPP;
6753
6754 if ((*flags & NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) &&
6755 !wiphy_ext_feature_isset(wiphy,
6756 NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION))
6757 return -EOPNOTSUPP;
6758
6759 if ((*flags & NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE) &&
6760 !wiphy_ext_feature_isset(wiphy,
6761 NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE))
6762 return -EOPNOTSUPP;
6763
6764 return 0;
6765 }
6766
6767 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
6768 {
6769 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6770 struct wireless_dev *wdev = info->user_ptr[1];
6771 struct cfg80211_scan_request *request;
6772 struct nlattr *attr;
6773 struct wiphy *wiphy;
6774 int err, tmp, n_ssids = 0, n_channels, i;
6775 size_t ie_len;
6776
6777 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
6778 return -EINVAL;
6779
6780 wiphy = &rdev->wiphy;
6781
6782 if (wdev->iftype == NL80211_IFTYPE_NAN)
6783 return -EOPNOTSUPP;
6784
6785 if (!rdev->ops->scan)
6786 return -EOPNOTSUPP;
6787
6788 if (rdev->scan_req || rdev->scan_msg) {
6789 err = -EBUSY;
6790 goto unlock;
6791 }
6792
6793 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6794 n_channels = validate_scan_freqs(
6795 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
6796 if (!n_channels) {
6797 err = -EINVAL;
6798 goto unlock;
6799 }
6800 } else {
6801 n_channels = ieee80211_get_num_supported_channels(wiphy);
6802 }
6803
6804 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
6805 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
6806 n_ssids++;
6807
6808 if (n_ssids > wiphy->max_scan_ssids) {
6809 err = -EINVAL;
6810 goto unlock;
6811 }
6812
6813 if (info->attrs[NL80211_ATTR_IE])
6814 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
6815 else
6816 ie_len = 0;
6817
6818 if (ie_len > wiphy->max_scan_ie_len) {
6819 err = -EINVAL;
6820 goto unlock;
6821 }
6822
6823 request = kzalloc(sizeof(*request)
6824 + sizeof(*request->ssids) * n_ssids
6825 + sizeof(*request->channels) * n_channels
6826 + ie_len, GFP_KERNEL);
6827 if (!request) {
6828 err = -ENOMEM;
6829 goto unlock;
6830 }
6831
6832 if (n_ssids)
6833 request->ssids = (void *)&request->channels[n_channels];
6834 request->n_ssids = n_ssids;
6835 if (ie_len) {
6836 if (n_ssids)
6837 request->ie = (void *)(request->ssids + n_ssids);
6838 else
6839 request->ie = (void *)(request->channels + n_channels);
6840 }
6841
6842 i = 0;
6843 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6844 /* user specified, bail out if channel not found */
6845 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
6846 struct ieee80211_channel *chan;
6847
6848 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
6849
6850 if (!chan) {
6851 err = -EINVAL;
6852 goto out_free;
6853 }
6854
6855 /* ignore disabled channels */
6856 if (chan->flags & IEEE80211_CHAN_DISABLED)
6857 continue;
6858
6859 request->channels[i] = chan;
6860 i++;
6861 }
6862 } else {
6863 enum nl80211_band band;
6864
6865 /* all channels */
6866 for (band = 0; band < NUM_NL80211_BANDS; band++) {
6867 int j;
6868
6869 if (!wiphy->bands[band])
6870 continue;
6871 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
6872 struct ieee80211_channel *chan;
6873
6874 chan = &wiphy->bands[band]->channels[j];
6875
6876 if (chan->flags & IEEE80211_CHAN_DISABLED)
6877 continue;
6878
6879 request->channels[i] = chan;
6880 i++;
6881 }
6882 }
6883 }
6884
6885 if (!i) {
6886 err = -EINVAL;
6887 goto out_free;
6888 }
6889
6890 request->n_channels = i;
6891
6892 wdev_lock(wdev);
6893 if (!cfg80211_off_channel_oper_allowed(wdev)) {
6894 struct ieee80211_channel *chan;
6895
6896 if (request->n_channels != 1) {
6897 wdev_unlock(wdev);
6898 err = -EBUSY;
6899 goto out_free;
6900 }
6901
6902 chan = request->channels[0];
6903 if (chan->center_freq != wdev->chandef.chan->center_freq) {
6904 wdev_unlock(wdev);
6905 err = -EBUSY;
6906 goto out_free;
6907 }
6908 }
6909 wdev_unlock(wdev);
6910
6911 i = 0;
6912 if (n_ssids) {
6913 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
6914 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
6915 err = -EINVAL;
6916 goto out_free;
6917 }
6918 request->ssids[i].ssid_len = nla_len(attr);
6919 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
6920 i++;
6921 }
6922 }
6923
6924 if (info->attrs[NL80211_ATTR_IE]) {
6925 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
6926 memcpy((void *)request->ie,
6927 nla_data(info->attrs[NL80211_ATTR_IE]),
6928 request->ie_len);
6929 }
6930
6931 for (i = 0; i < NUM_NL80211_BANDS; i++)
6932 if (wiphy->bands[i])
6933 request->rates[i] =
6934 (1 << wiphy->bands[i]->n_bitrates) - 1;
6935
6936 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
6937 nla_for_each_nested(attr,
6938 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
6939 tmp) {
6940 enum nl80211_band band = nla_type(attr);
6941
6942 if (band < 0 || band >= NUM_NL80211_BANDS) {
6943 err = -EINVAL;
6944 goto out_free;
6945 }
6946
6947 if (!wiphy->bands[band])
6948 continue;
6949
6950 err = ieee80211_get_ratemask(wiphy->bands[band],
6951 nla_data(attr),
6952 nla_len(attr),
6953 &request->rates[band]);
6954 if (err)
6955 goto out_free;
6956 }
6957 }
6958
6959 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
6960 if (!wiphy_ext_feature_isset(wiphy,
6961 NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
6962 err = -EOPNOTSUPP;
6963 goto out_free;
6964 }
6965
6966 request->duration =
6967 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
6968 request->duration_mandatory =
6969 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
6970 }
6971
6972 err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs,
6973 false);
6974 if (err)
6975 goto out_free;
6976
6977 request->no_cck =
6978 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
6979
6980 /* Initial implementation used NL80211_ATTR_MAC to set the specific
6981 * BSSID to scan for. This was problematic because that same attribute
6982 * was already used for another purpose (local random MAC address). The
6983 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
6984 * compatibility with older userspace components, also use the
6985 * NL80211_ATTR_MAC value here if it can be determined to be used for
6986 * the specific BSSID use case instead of the random MAC address
6987 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
6988 */
6989 if (info->attrs[NL80211_ATTR_BSSID])
6990 memcpy(request->bssid,
6991 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
6992 else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
6993 info->attrs[NL80211_ATTR_MAC])
6994 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
6995 ETH_ALEN);
6996 else
6997 eth_broadcast_addr(request->bssid);
6998
6999 request->wdev = wdev;
7000 request->wiphy = &rdev->wiphy;
7001 request->scan_start = jiffies;
7002
7003 rdev->scan_req = request;
7004 err = rdev_scan(rdev, request);
7005
7006 if (!err) {
7007 nl80211_send_scan_start(rdev, wdev);
7008 if (wdev->netdev)
7009 dev_hold(wdev->netdev);
7010 } else {
7011 out_free:
7012 rdev->scan_req = NULL;
7013 kfree(request);
7014 }
7015
7016 unlock:
7017 return err;
7018 }
7019
7020 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
7021 {
7022 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7023 struct wireless_dev *wdev = info->user_ptr[1];
7024
7025 if (!rdev->ops->abort_scan)
7026 return -EOPNOTSUPP;
7027
7028 if (rdev->scan_msg)
7029 return 0;
7030
7031 if (!rdev->scan_req)
7032 return -ENOENT;
7033
7034 rdev_abort_scan(rdev, wdev);
7035 return 0;
7036 }
7037
7038 static int
7039 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
7040 struct cfg80211_sched_scan_request *request,
7041 struct nlattr **attrs)
7042 {
7043 int tmp, err, i = 0;
7044 struct nlattr *attr;
7045
7046 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7047 u32 interval;
7048
7049 /*
7050 * If scan plans are not specified,
7051 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
7052 * case one scan plan will be set with the specified scan
7053 * interval and infinite number of iterations.
7054 */
7055 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
7056 if (!interval)
7057 return -EINVAL;
7058
7059 request->scan_plans[0].interval =
7060 DIV_ROUND_UP(interval, MSEC_PER_SEC);
7061 if (!request->scan_plans[0].interval)
7062 return -EINVAL;
7063
7064 if (request->scan_plans[0].interval >
7065 wiphy->max_sched_scan_plan_interval)
7066 request->scan_plans[0].interval =
7067 wiphy->max_sched_scan_plan_interval;
7068
7069 return 0;
7070 }
7071
7072 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
7073 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
7074
7075 if (WARN_ON(i >= n_plans))
7076 return -EINVAL;
7077
7078 err = nla_parse_nested(plan, NL80211_SCHED_SCAN_PLAN_MAX,
7079 attr, nl80211_plan_policy, NULL);
7080 if (err)
7081 return err;
7082
7083 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
7084 return -EINVAL;
7085
7086 request->scan_plans[i].interval =
7087 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
7088 if (!request->scan_plans[i].interval ||
7089 request->scan_plans[i].interval >
7090 wiphy->max_sched_scan_plan_interval)
7091 return -EINVAL;
7092
7093 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
7094 request->scan_plans[i].iterations =
7095 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
7096 if (!request->scan_plans[i].iterations ||
7097 (request->scan_plans[i].iterations >
7098 wiphy->max_sched_scan_plan_iterations))
7099 return -EINVAL;
7100 } else if (i < n_plans - 1) {
7101 /*
7102 * All scan plans but the last one must specify
7103 * a finite number of iterations
7104 */
7105 return -EINVAL;
7106 }
7107
7108 i++;
7109 }
7110
7111 /*
7112 * The last scan plan must not specify the number of
7113 * iterations, it is supposed to run infinitely
7114 */
7115 if (request->scan_plans[n_plans - 1].iterations)
7116 return -EINVAL;
7117
7118 return 0;
7119 }
7120
7121 static struct cfg80211_sched_scan_request *
7122 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
7123 struct nlattr **attrs, int max_match_sets)
7124 {
7125 struct cfg80211_sched_scan_request *request;
7126 struct nlattr *attr;
7127 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
7128 enum nl80211_band band;
7129 size_t ie_len;
7130 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
7131 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
7132
7133 if (!is_valid_ie_attr(attrs[NL80211_ATTR_IE]))
7134 return ERR_PTR(-EINVAL);
7135
7136 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7137 n_channels = validate_scan_freqs(
7138 attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
7139 if (!n_channels)
7140 return ERR_PTR(-EINVAL);
7141 } else {
7142 n_channels = ieee80211_get_num_supported_channels(wiphy);
7143 }
7144
7145 if (attrs[NL80211_ATTR_SCAN_SSIDS])
7146 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
7147 tmp)
7148 n_ssids++;
7149
7150 if (n_ssids > wiphy->max_sched_scan_ssids)
7151 return ERR_PTR(-EINVAL);
7152
7153 /*
7154 * First, count the number of 'real' matchsets. Due to an issue with
7155 * the old implementation, matchsets containing only the RSSI attribute
7156 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
7157 * RSSI for all matchsets, rather than their own matchset for reporting
7158 * all APs with a strong RSSI. This is needed to be compatible with
7159 * older userspace that treated a matchset with only the RSSI as the
7160 * global RSSI for all other matchsets - if there are other matchsets.
7161 */
7162 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
7163 nla_for_each_nested(attr,
7164 attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
7165 tmp) {
7166 struct nlattr *rssi;
7167
7168 err = nla_parse_nested(tb,
7169 NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7170 attr, nl80211_match_policy,
7171 NULL);
7172 if (err)
7173 return ERR_PTR(err);
7174
7175 /* SSID and BSSID are mutually exclusive */
7176 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] &&
7177 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID])
7178 return ERR_PTR(-EINVAL);
7179
7180 /* add other standalone attributes here */
7181 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] ||
7182 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) {
7183 n_match_sets++;
7184 continue;
7185 }
7186 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7187 if (rssi)
7188 default_match_rssi = nla_get_s32(rssi);
7189 }
7190 }
7191
7192 /* However, if there's no other matchset, add the RSSI one */
7193 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
7194 n_match_sets = 1;
7195
7196 if (n_match_sets > max_match_sets)
7197 return ERR_PTR(-EINVAL);
7198
7199 if (attrs[NL80211_ATTR_IE])
7200 ie_len = nla_len(attrs[NL80211_ATTR_IE]);
7201 else
7202 ie_len = 0;
7203
7204 if (ie_len > wiphy->max_sched_scan_ie_len)
7205 return ERR_PTR(-EINVAL);
7206
7207 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7208 /*
7209 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
7210 * each scan plan already specifies its own interval
7211 */
7212 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7213 return ERR_PTR(-EINVAL);
7214
7215 nla_for_each_nested(attr,
7216 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
7217 n_plans++;
7218 } else {
7219 /*
7220 * The scan interval attribute is kept for backward
7221 * compatibility. If no scan plans are specified and sched scan
7222 * interval is specified, one scan plan will be set with this
7223 * scan interval and infinite number of iterations.
7224 */
7225 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7226 return ERR_PTR(-EINVAL);
7227
7228 n_plans = 1;
7229 }
7230
7231 if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
7232 return ERR_PTR(-EINVAL);
7233
7234 if (!wiphy_ext_feature_isset(
7235 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
7236 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
7237 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
7238 return ERR_PTR(-EINVAL);
7239
7240 request = kzalloc(sizeof(*request)
7241 + sizeof(*request->ssids) * n_ssids
7242 + sizeof(*request->match_sets) * n_match_sets
7243 + sizeof(*request->scan_plans) * n_plans
7244 + sizeof(*request->channels) * n_channels
7245 + ie_len, GFP_KERNEL);
7246 if (!request)
7247 return ERR_PTR(-ENOMEM);
7248
7249 if (n_ssids)
7250 request->ssids = (void *)&request->channels[n_channels];
7251 request->n_ssids = n_ssids;
7252 if (ie_len) {
7253 if (n_ssids)
7254 request->ie = (void *)(request->ssids + n_ssids);
7255 else
7256 request->ie = (void *)(request->channels + n_channels);
7257 }
7258
7259 if (n_match_sets) {
7260 if (request->ie)
7261 request->match_sets = (void *)(request->ie + ie_len);
7262 else if (n_ssids)
7263 request->match_sets =
7264 (void *)(request->ssids + n_ssids);
7265 else
7266 request->match_sets =
7267 (void *)(request->channels + n_channels);
7268 }
7269 request->n_match_sets = n_match_sets;
7270
7271 if (n_match_sets)
7272 request->scan_plans = (void *)(request->match_sets +
7273 n_match_sets);
7274 else if (request->ie)
7275 request->scan_plans = (void *)(request->ie + ie_len);
7276 else if (n_ssids)
7277 request->scan_plans = (void *)(request->ssids + n_ssids);
7278 else
7279 request->scan_plans = (void *)(request->channels + n_channels);
7280
7281 request->n_scan_plans = n_plans;
7282
7283 i = 0;
7284 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7285 /* user specified, bail out if channel not found */
7286 nla_for_each_nested(attr,
7287 attrs[NL80211_ATTR_SCAN_FREQUENCIES],
7288 tmp) {
7289 struct ieee80211_channel *chan;
7290
7291 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
7292
7293 if (!chan) {
7294 err = -EINVAL;
7295 goto out_free;
7296 }
7297
7298 /* ignore disabled channels */
7299 if (chan->flags & IEEE80211_CHAN_DISABLED)
7300 continue;
7301
7302 request->channels[i] = chan;
7303 i++;
7304 }
7305 } else {
7306 /* all channels */
7307 for (band = 0; band < NUM_NL80211_BANDS; band++) {
7308 int j;
7309
7310 if (!wiphy->bands[band])
7311 continue;
7312 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
7313 struct ieee80211_channel *chan;
7314
7315 chan = &wiphy->bands[band]->channels[j];
7316
7317 if (chan->flags & IEEE80211_CHAN_DISABLED)
7318 continue;
7319
7320 request->channels[i] = chan;
7321 i++;
7322 }
7323 }
7324 }
7325
7326 if (!i) {
7327 err = -EINVAL;
7328 goto out_free;
7329 }
7330
7331 request->n_channels = i;
7332
7333 i = 0;
7334 if (n_ssids) {
7335 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
7336 tmp) {
7337 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
7338 err = -EINVAL;
7339 goto out_free;
7340 }
7341 request->ssids[i].ssid_len = nla_len(attr);
7342 memcpy(request->ssids[i].ssid, nla_data(attr),
7343 nla_len(attr));
7344 i++;
7345 }
7346 }
7347
7348 i = 0;
7349 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
7350 nla_for_each_nested(attr,
7351 attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
7352 tmp) {
7353 struct nlattr *ssid, *bssid, *rssi;
7354
7355 err = nla_parse_nested(tb,
7356 NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7357 attr, nl80211_match_policy,
7358 NULL);
7359 if (err)
7360 goto out_free;
7361 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
7362 bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID];
7363 if (ssid || bssid) {
7364 if (WARN_ON(i >= n_match_sets)) {
7365 /* this indicates a programming error,
7366 * the loop above should have verified
7367 * things properly
7368 */
7369 err = -EINVAL;
7370 goto out_free;
7371 }
7372
7373 if (ssid) {
7374 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
7375 err = -EINVAL;
7376 goto out_free;
7377 }
7378 memcpy(request->match_sets[i].ssid.ssid,
7379 nla_data(ssid), nla_len(ssid));
7380 request->match_sets[i].ssid.ssid_len =
7381 nla_len(ssid);
7382 }
7383 if (bssid) {
7384 if (nla_len(bssid) != ETH_ALEN) {
7385 err = -EINVAL;
7386 goto out_free;
7387 }
7388 memcpy(request->match_sets[i].bssid,
7389 nla_data(bssid), ETH_ALEN);
7390 }
7391
7392 /* special attribute - old implementation w/a */
7393 request->match_sets[i].rssi_thold =
7394 default_match_rssi;
7395 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7396 if (rssi)
7397 request->match_sets[i].rssi_thold =
7398 nla_get_s32(rssi);
7399 }
7400 i++;
7401 }
7402
7403 /* there was no other matchset, so the RSSI one is alone */
7404 if (i == 0 && n_match_sets)
7405 request->match_sets[0].rssi_thold = default_match_rssi;
7406
7407 request->min_rssi_thold = INT_MAX;
7408 for (i = 0; i < n_match_sets; i++)
7409 request->min_rssi_thold =
7410 min(request->match_sets[i].rssi_thold,
7411 request->min_rssi_thold);
7412 } else {
7413 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
7414 }
7415
7416 if (ie_len) {
7417 request->ie_len = ie_len;
7418 memcpy((void *)request->ie,
7419 nla_data(attrs[NL80211_ATTR_IE]),
7420 request->ie_len);
7421 }
7422
7423 err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true);
7424 if (err)
7425 goto out_free;
7426
7427 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
7428 request->delay =
7429 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
7430
7431 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
7432 request->relative_rssi = nla_get_s8(
7433 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
7434 request->relative_rssi_set = true;
7435 }
7436
7437 if (request->relative_rssi_set &&
7438 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
7439 struct nl80211_bss_select_rssi_adjust *rssi_adjust;
7440
7441 rssi_adjust = nla_data(
7442 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
7443 request->rssi_adjust.band = rssi_adjust->band;
7444 request->rssi_adjust.delta = rssi_adjust->delta;
7445 if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
7446 err = -EINVAL;
7447 goto out_free;
7448 }
7449 }
7450
7451 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
7452 if (err)
7453 goto out_free;
7454
7455 request->scan_start = jiffies;
7456
7457 return request;
7458
7459 out_free:
7460 kfree(request);
7461 return ERR_PTR(err);
7462 }
7463
7464 static int nl80211_start_sched_scan(struct sk_buff *skb,
7465 struct genl_info *info)
7466 {
7467 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7468 struct net_device *dev = info->user_ptr[1];
7469 struct wireless_dev *wdev = dev->ieee80211_ptr;
7470 struct cfg80211_sched_scan_request *sched_scan_req;
7471 bool want_multi;
7472 int err;
7473
7474 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
7475 return -EOPNOTSUPP;
7476
7477 want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
7478 err = cfg80211_sched_scan_req_possible(rdev, want_multi);
7479 if (err)
7480 return err;
7481
7482 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
7483 info->attrs,
7484 rdev->wiphy.max_match_sets);
7485
7486 err = PTR_ERR_OR_ZERO(sched_scan_req);
7487 if (err)
7488 goto out_err;
7489
7490 /* leave request id zero for legacy request
7491 * or if driver does not support multi-scheduled scan
7492 */
7493 if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) {
7494 while (!sched_scan_req->reqid)
7495 sched_scan_req->reqid = rdev->wiphy.cookie_counter++;
7496 }
7497
7498 err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
7499 if (err)
7500 goto out_free;
7501
7502 sched_scan_req->dev = dev;
7503 sched_scan_req->wiphy = &rdev->wiphy;
7504
7505 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
7506 sched_scan_req->owner_nlportid = info->snd_portid;
7507
7508 cfg80211_add_sched_scan_req(rdev, sched_scan_req);
7509
7510 nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
7511 return 0;
7512
7513 out_free:
7514 kfree(sched_scan_req);
7515 out_err:
7516 return err;
7517 }
7518
7519 static int nl80211_stop_sched_scan(struct sk_buff *skb,
7520 struct genl_info *info)
7521 {
7522 struct cfg80211_sched_scan_request *req;
7523 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7524 u64 cookie;
7525
7526 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
7527 return -EOPNOTSUPP;
7528
7529 if (info->attrs[NL80211_ATTR_COOKIE]) {
7530 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
7531 return __cfg80211_stop_sched_scan(rdev, cookie, false);
7532 }
7533
7534 req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
7535 struct cfg80211_sched_scan_request,
7536 list);
7537 if (!req || req->reqid ||
7538 (req->owner_nlportid &&
7539 req->owner_nlportid != info->snd_portid))
7540 return -ENOENT;
7541
7542 return cfg80211_stop_sched_scan_req(rdev, req, false);
7543 }
7544
7545 static int nl80211_start_radar_detection(struct sk_buff *skb,
7546 struct genl_info *info)
7547 {
7548 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7549 struct net_device *dev = info->user_ptr[1];
7550 struct wireless_dev *wdev = dev->ieee80211_ptr;
7551 struct cfg80211_chan_def chandef;
7552 enum nl80211_dfs_regions dfs_region;
7553 unsigned int cac_time_ms;
7554 int err;
7555
7556 dfs_region = reg_get_dfs_region(wdev->wiphy);
7557 if (dfs_region == NL80211_DFS_UNSET)
7558 return -EINVAL;
7559
7560 err = nl80211_parse_chandef(rdev, info, &chandef);
7561 if (err)
7562 return err;
7563
7564 if (netif_carrier_ok(dev))
7565 return -EBUSY;
7566
7567 if (wdev->cac_started)
7568 return -EBUSY;
7569
7570 err = cfg80211_chandef_dfs_required(wdev->wiphy, &chandef,
7571 wdev->iftype);
7572 if (err < 0)
7573 return err;
7574
7575 if (err == 0)
7576 return -EINVAL;
7577
7578 if (!cfg80211_chandef_dfs_usable(wdev->wiphy, &chandef))
7579 return -EINVAL;
7580
7581 if (!rdev->ops->start_radar_detection)
7582 return -EOPNOTSUPP;
7583
7584 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
7585 if (WARN_ON(!cac_time_ms))
7586 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
7587
7588 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
7589 if (!err) {
7590 wdev->chandef = chandef;
7591 wdev->cac_started = true;
7592 wdev->cac_start_time = jiffies;
7593 wdev->cac_time_ms = cac_time_ms;
7594 }
7595 return err;
7596 }
7597
7598 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
7599 {
7600 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7601 struct net_device *dev = info->user_ptr[1];
7602 struct wireless_dev *wdev = dev->ieee80211_ptr;
7603 struct cfg80211_csa_settings params;
7604 /* csa_attrs is defined static to avoid waste of stack size - this
7605 * function is called under RTNL lock, so this should not be a problem.
7606 */
7607 static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
7608 int err;
7609 bool need_new_beacon = false;
7610 bool need_handle_dfs_flag = true;
7611 int len, i;
7612 u32 cs_count;
7613
7614 if (!rdev->ops->channel_switch ||
7615 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
7616 return -EOPNOTSUPP;
7617
7618 switch (dev->ieee80211_ptr->iftype) {
7619 case NL80211_IFTYPE_AP:
7620 case NL80211_IFTYPE_P2P_GO:
7621 need_new_beacon = true;
7622 /* For all modes except AP the handle_dfs flag needs to be
7623 * supplied to tell the kernel that userspace will handle radar
7624 * events when they happen. Otherwise a switch to a channel
7625 * requiring DFS will be rejected.
7626 */
7627 need_handle_dfs_flag = false;
7628
7629 /* useless if AP is not running */
7630 if (!wdev->beacon_interval)
7631 return -ENOTCONN;
7632 break;
7633 case NL80211_IFTYPE_ADHOC:
7634 if (!wdev->ssid_len)
7635 return -ENOTCONN;
7636 break;
7637 case NL80211_IFTYPE_MESH_POINT:
7638 if (!wdev->mesh_id_len)
7639 return -ENOTCONN;
7640 break;
7641 default:
7642 return -EOPNOTSUPP;
7643 }
7644
7645 memset(&params, 0, sizeof(params));
7646
7647 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
7648 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
7649 return -EINVAL;
7650
7651 /* only important for AP, IBSS and mesh create IEs internally */
7652 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
7653 return -EINVAL;
7654
7655 /* Even though the attribute is u32, the specification says
7656 * u8, so let's make sure we don't overflow.
7657 */
7658 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
7659 if (cs_count > 255)
7660 return -EINVAL;
7661
7662 params.count = cs_count;
7663
7664 if (!need_new_beacon)
7665 goto skip_beacons;
7666
7667 err = nl80211_parse_beacon(info->attrs, &params.beacon_after);
7668 if (err)
7669 return err;
7670
7671 err = nla_parse_nested(csa_attrs, NL80211_ATTR_MAX,
7672 info->attrs[NL80211_ATTR_CSA_IES],
7673 nl80211_policy, info->extack);
7674 if (err)
7675 return err;
7676
7677 err = nl80211_parse_beacon(csa_attrs, &params.beacon_csa);
7678 if (err)
7679 return err;
7680
7681 if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
7682 return -EINVAL;
7683
7684 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7685 if (!len || (len % sizeof(u16)))
7686 return -EINVAL;
7687
7688 params.n_counter_offsets_beacon = len / sizeof(u16);
7689 if (rdev->wiphy.max_num_csa_counters &&
7690 (params.n_counter_offsets_beacon >
7691 rdev->wiphy.max_num_csa_counters))
7692 return -EINVAL;
7693
7694 params.counter_offsets_beacon =
7695 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7696
7697 /* sanity checks - counters should fit and be the same */
7698 for (i = 0; i < params.n_counter_offsets_beacon; i++) {
7699 u16 offset = params.counter_offsets_beacon[i];
7700
7701 if (offset >= params.beacon_csa.tail_len)
7702 return -EINVAL;
7703
7704 if (params.beacon_csa.tail[offset] != params.count)
7705 return -EINVAL;
7706 }
7707
7708 if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
7709 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7710 if (!len || (len % sizeof(u16)))
7711 return -EINVAL;
7712
7713 params.n_counter_offsets_presp = len / sizeof(u16);
7714 if (rdev->wiphy.max_num_csa_counters &&
7715 (params.n_counter_offsets_presp >
7716 rdev->wiphy.max_num_csa_counters))
7717 return -EINVAL;
7718
7719 params.counter_offsets_presp =
7720 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7721
7722 /* sanity checks - counters should fit and be the same */
7723 for (i = 0; i < params.n_counter_offsets_presp; i++) {
7724 u16 offset = params.counter_offsets_presp[i];
7725
7726 if (offset >= params.beacon_csa.probe_resp_len)
7727 return -EINVAL;
7728
7729 if (params.beacon_csa.probe_resp[offset] !=
7730 params.count)
7731 return -EINVAL;
7732 }
7733 }
7734
7735 skip_beacons:
7736 err = nl80211_parse_chandef(rdev, info, &params.chandef);
7737 if (err)
7738 return err;
7739
7740 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
7741 wdev->iftype))
7742 return -EINVAL;
7743
7744 err = cfg80211_chandef_dfs_required(wdev->wiphy,
7745 &params.chandef,
7746 wdev->iftype);
7747 if (err < 0)
7748 return err;
7749
7750 if (err > 0) {
7751 params.radar_required = true;
7752 if (need_handle_dfs_flag &&
7753 !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) {
7754 return -EINVAL;
7755 }
7756 }
7757
7758 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
7759 params.block_tx = true;
7760
7761 wdev_lock(wdev);
7762 err = rdev_channel_switch(rdev, dev, &params);
7763 wdev_unlock(wdev);
7764
7765 return err;
7766 }
7767
7768 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
7769 u32 seq, int flags,
7770 struct cfg80211_registered_device *rdev,
7771 struct wireless_dev *wdev,
7772 struct cfg80211_internal_bss *intbss)
7773 {
7774 struct cfg80211_bss *res = &intbss->pub;
7775 const struct cfg80211_bss_ies *ies;
7776 void *hdr;
7777 struct nlattr *bss;
7778
7779 ASSERT_WDEV_LOCK(wdev);
7780
7781 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
7782 NL80211_CMD_NEW_SCAN_RESULTS);
7783 if (!hdr)
7784 return -1;
7785
7786 genl_dump_check_consistent(cb, hdr);
7787
7788 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
7789 goto nla_put_failure;
7790 if (wdev->netdev &&
7791 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
7792 goto nla_put_failure;
7793 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
7794 NL80211_ATTR_PAD))
7795 goto nla_put_failure;
7796
7797 bss = nla_nest_start(msg, NL80211_ATTR_BSS);
7798 if (!bss)
7799 goto nla_put_failure;
7800 if ((!is_zero_ether_addr(res->bssid) &&
7801 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
7802 goto nla_put_failure;
7803
7804 rcu_read_lock();
7805 /* indicate whether we have probe response data or not */
7806 if (rcu_access_pointer(res->proberesp_ies) &&
7807 nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
7808 goto fail_unlock_rcu;
7809
7810 /* this pointer prefers to be pointed to probe response data
7811 * but is always valid
7812 */
7813 ies = rcu_dereference(res->ies);
7814 if (ies) {
7815 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
7816 NL80211_BSS_PAD))
7817 goto fail_unlock_rcu;
7818 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
7819 ies->len, ies->data))
7820 goto fail_unlock_rcu;
7821 }
7822
7823 /* and this pointer is always (unless driver didn't know) beacon data */
7824 ies = rcu_dereference(res->beacon_ies);
7825 if (ies && ies->from_beacon) {
7826 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
7827 NL80211_BSS_PAD))
7828 goto fail_unlock_rcu;
7829 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
7830 ies->len, ies->data))
7831 goto fail_unlock_rcu;
7832 }
7833 rcu_read_unlock();
7834
7835 if (res->beacon_interval &&
7836 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
7837 goto nla_put_failure;
7838 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
7839 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
7840 nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
7841 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
7842 jiffies_to_msecs(jiffies - intbss->ts)))
7843 goto nla_put_failure;
7844
7845 if (intbss->parent_tsf &&
7846 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
7847 intbss->parent_tsf, NL80211_BSS_PAD) ||
7848 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
7849 intbss->parent_bssid)))
7850 goto nla_put_failure;
7851
7852 if (intbss->ts_boottime &&
7853 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
7854 intbss->ts_boottime, NL80211_BSS_PAD))
7855 goto nla_put_failure;
7856
7857 switch (rdev->wiphy.signal_type) {
7858 case CFG80211_SIGNAL_TYPE_MBM:
7859 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
7860 goto nla_put_failure;
7861 break;
7862 case CFG80211_SIGNAL_TYPE_UNSPEC:
7863 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
7864 goto nla_put_failure;
7865 break;
7866 default:
7867 break;
7868 }
7869
7870 switch (wdev->iftype) {
7871 case NL80211_IFTYPE_P2P_CLIENT:
7872 case NL80211_IFTYPE_STATION:
7873 if (intbss == wdev->current_bss &&
7874 nla_put_u32(msg, NL80211_BSS_STATUS,
7875 NL80211_BSS_STATUS_ASSOCIATED))
7876 goto nla_put_failure;
7877 break;
7878 case NL80211_IFTYPE_ADHOC:
7879 if (intbss == wdev->current_bss &&
7880 nla_put_u32(msg, NL80211_BSS_STATUS,
7881 NL80211_BSS_STATUS_IBSS_JOINED))
7882 goto nla_put_failure;
7883 break;
7884 default:
7885 break;
7886 }
7887
7888 nla_nest_end(msg, bss);
7889
7890 genlmsg_end(msg, hdr);
7891 return 0;
7892
7893 fail_unlock_rcu:
7894 rcu_read_unlock();
7895 nla_put_failure:
7896 genlmsg_cancel(msg, hdr);
7897 return -EMSGSIZE;
7898 }
7899
7900 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
7901 {
7902 struct cfg80211_registered_device *rdev;
7903 struct cfg80211_internal_bss *scan;
7904 struct wireless_dev *wdev;
7905 int start = cb->args[2], idx = 0;
7906 int err;
7907
7908 rtnl_lock();
7909 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
7910 if (err) {
7911 rtnl_unlock();
7912 return err;
7913 }
7914
7915 wdev_lock(wdev);
7916 spin_lock_bh(&rdev->bss_lock);
7917 cfg80211_bss_expire(rdev);
7918
7919 cb->seq = rdev->bss_generation;
7920
7921 list_for_each_entry(scan, &rdev->bss_list, list) {
7922 if (++idx <= start)
7923 continue;
7924 if (nl80211_send_bss(skb, cb,
7925 cb->nlh->nlmsg_seq, NLM_F_MULTI,
7926 rdev, wdev, scan) < 0) {
7927 idx--;
7928 break;
7929 }
7930 }
7931
7932 spin_unlock_bh(&rdev->bss_lock);
7933 wdev_unlock(wdev);
7934
7935 cb->args[2] = idx;
7936 rtnl_unlock();
7937
7938 return skb->len;
7939 }
7940
7941 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
7942 int flags, struct net_device *dev,
7943 bool allow_radio_stats,
7944 struct survey_info *survey)
7945 {
7946 void *hdr;
7947 struct nlattr *infoattr;
7948
7949 /* skip radio stats if userspace didn't request them */
7950 if (!survey->channel && !allow_radio_stats)
7951 return 0;
7952
7953 hdr = nl80211hdr_put(msg, portid, seq, flags,
7954 NL80211_CMD_NEW_SURVEY_RESULTS);
7955 if (!hdr)
7956 return -ENOMEM;
7957
7958 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
7959 goto nla_put_failure;
7960
7961 infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
7962 if (!infoattr)
7963 goto nla_put_failure;
7964
7965 if (survey->channel &&
7966 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
7967 survey->channel->center_freq))
7968 goto nla_put_failure;
7969
7970 if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
7971 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
7972 goto nla_put_failure;
7973 if ((survey->filled & SURVEY_INFO_IN_USE) &&
7974 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
7975 goto nla_put_failure;
7976 if ((survey->filled & SURVEY_INFO_TIME) &&
7977 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
7978 survey->time, NL80211_SURVEY_INFO_PAD))
7979 goto nla_put_failure;
7980 if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
7981 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
7982 survey->time_busy, NL80211_SURVEY_INFO_PAD))
7983 goto nla_put_failure;
7984 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
7985 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
7986 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
7987 goto nla_put_failure;
7988 if ((survey->filled & SURVEY_INFO_TIME_RX) &&
7989 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
7990 survey->time_rx, NL80211_SURVEY_INFO_PAD))
7991 goto nla_put_failure;
7992 if ((survey->filled & SURVEY_INFO_TIME_TX) &&
7993 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
7994 survey->time_tx, NL80211_SURVEY_INFO_PAD))
7995 goto nla_put_failure;
7996 if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
7997 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
7998 survey->time_scan, NL80211_SURVEY_INFO_PAD))
7999 goto nla_put_failure;
8000
8001 nla_nest_end(msg, infoattr);
8002
8003 genlmsg_end(msg, hdr);
8004 return 0;
8005
8006 nla_put_failure:
8007 genlmsg_cancel(msg, hdr);
8008 return -EMSGSIZE;
8009 }
8010
8011 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
8012 {
8013 struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
8014 struct survey_info survey;
8015 struct cfg80211_registered_device *rdev;
8016 struct wireless_dev *wdev;
8017 int survey_idx = cb->args[2];
8018 int res;
8019 bool radio_stats;
8020
8021 rtnl_lock();
8022 res = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
8023 if (res)
8024 goto out_err;
8025
8026 /* prepare_wdev_dump parsed the attributes */
8027 radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
8028
8029 if (!wdev->netdev) {
8030 res = -EINVAL;
8031 goto out_err;
8032 }
8033
8034 if (!rdev->ops->dump_survey) {
8035 res = -EOPNOTSUPP;
8036 goto out_err;
8037 }
8038
8039 while (1) {
8040 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
8041 if (res == -ENOENT)
8042 break;
8043 if (res)
8044 goto out_err;
8045
8046 /* don't send disabled channels, but do send non-channel data */
8047 if (survey.channel &&
8048 survey.channel->flags & IEEE80211_CHAN_DISABLED) {
8049 survey_idx++;
8050 continue;
8051 }
8052
8053 if (nl80211_send_survey(skb,
8054 NETLINK_CB(cb->skb).portid,
8055 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8056 wdev->netdev, radio_stats, &survey) < 0)
8057 goto out;
8058 survey_idx++;
8059 }
8060
8061 out:
8062 cb->args[2] = survey_idx;
8063 res = skb->len;
8064 out_err:
8065 rtnl_unlock();
8066 return res;
8067 }
8068
8069 static bool nl80211_valid_wpa_versions(u32 wpa_versions)
8070 {
8071 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
8072 NL80211_WPA_VERSION_2));
8073 }
8074
8075 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
8076 {
8077 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8078 struct net_device *dev = info->user_ptr[1];
8079 struct ieee80211_channel *chan;
8080 const u8 *bssid, *ssid, *ie = NULL, *auth_data = NULL;
8081 int err, ssid_len, ie_len = 0, auth_data_len = 0;
8082 enum nl80211_auth_type auth_type;
8083 struct key_parse key;
8084 bool local_state_change;
8085
8086 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8087 return -EINVAL;
8088
8089 if (!info->attrs[NL80211_ATTR_MAC])
8090 return -EINVAL;
8091
8092 if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
8093 return -EINVAL;
8094
8095 if (!info->attrs[NL80211_ATTR_SSID])
8096 return -EINVAL;
8097
8098 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
8099 return -EINVAL;
8100
8101 err = nl80211_parse_key(info, &key);
8102 if (err)
8103 return err;
8104
8105 if (key.idx >= 0) {
8106 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
8107 return -EINVAL;
8108 if (!key.p.key || !key.p.key_len)
8109 return -EINVAL;
8110 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
8111 key.p.key_len != WLAN_KEY_LEN_WEP40) &&
8112 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
8113 key.p.key_len != WLAN_KEY_LEN_WEP104))
8114 return -EINVAL;
8115 if (key.idx > 3)
8116 return -EINVAL;
8117 } else {
8118 key.p.key_len = 0;
8119 key.p.key = NULL;
8120 }
8121
8122 if (key.idx >= 0) {
8123 int i;
8124 bool ok = false;
8125
8126 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
8127 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
8128 ok = true;
8129 break;
8130 }
8131 }
8132 if (!ok)
8133 return -EINVAL;
8134 }
8135
8136 if (!rdev->ops->auth)
8137 return -EOPNOTSUPP;
8138
8139 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8140 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8141 return -EOPNOTSUPP;
8142
8143 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8144 chan = nl80211_get_valid_chan(&rdev->wiphy,
8145 info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8146 if (!chan)
8147 return -EINVAL;
8148
8149 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8150 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8151
8152 if (info->attrs[NL80211_ATTR_IE]) {
8153 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8154 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8155 }
8156
8157 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
8158 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
8159 return -EINVAL;
8160
8161 if ((auth_type == NL80211_AUTHTYPE_SAE ||
8162 auth_type == NL80211_AUTHTYPE_FILS_SK ||
8163 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
8164 auth_type == NL80211_AUTHTYPE_FILS_PK) &&
8165 !info->attrs[NL80211_ATTR_AUTH_DATA])
8166 return -EINVAL;
8167
8168 if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
8169 if (auth_type != NL80211_AUTHTYPE_SAE &&
8170 auth_type != NL80211_AUTHTYPE_FILS_SK &&
8171 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
8172 auth_type != NL80211_AUTHTYPE_FILS_PK)
8173 return -EINVAL;
8174 auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
8175 auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
8176 /* need to include at least Auth Transaction and Status Code */
8177 if (auth_data_len < 4)
8178 return -EINVAL;
8179 }
8180
8181 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8182
8183 /*
8184 * Since we no longer track auth state, ignore
8185 * requests to only change local state.
8186 */
8187 if (local_state_change)
8188 return 0;
8189
8190 wdev_lock(dev->ieee80211_ptr);
8191 err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
8192 ssid, ssid_len, ie, ie_len,
8193 key.p.key, key.p.key_len, key.idx,
8194 auth_data, auth_data_len);
8195 wdev_unlock(dev->ieee80211_ptr);
8196 return err;
8197 }
8198
8199 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
8200 struct genl_info *info,
8201 struct cfg80211_crypto_settings *settings,
8202 int cipher_limit)
8203 {
8204 memset(settings, 0, sizeof(*settings));
8205
8206 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
8207
8208 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
8209 u16 proto;
8210
8211 proto = nla_get_u16(
8212 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
8213 settings->control_port_ethertype = cpu_to_be16(proto);
8214 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
8215 proto != ETH_P_PAE)
8216 return -EINVAL;
8217 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
8218 settings->control_port_no_encrypt = true;
8219 } else
8220 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
8221
8222 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
8223 void *data;
8224 int len, i;
8225
8226 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
8227 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
8228 settings->n_ciphers_pairwise = len / sizeof(u32);
8229
8230 if (len % sizeof(u32))
8231 return -EINVAL;
8232
8233 if (settings->n_ciphers_pairwise > cipher_limit)
8234 return -EINVAL;
8235
8236 memcpy(settings->ciphers_pairwise, data, len);
8237
8238 for (i = 0; i < settings->n_ciphers_pairwise; i++)
8239 if (!cfg80211_supported_cipher_suite(
8240 &rdev->wiphy,
8241 settings->ciphers_pairwise[i]))
8242 return -EINVAL;
8243 }
8244
8245 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
8246 settings->cipher_group =
8247 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
8248 if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
8249 settings->cipher_group))
8250 return -EINVAL;
8251 }
8252
8253 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
8254 settings->wpa_versions =
8255 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
8256 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
8257 return -EINVAL;
8258 }
8259
8260 if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
8261 void *data;
8262 int len;
8263
8264 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
8265 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
8266 settings->n_akm_suites = len / sizeof(u32);
8267
8268 if (len % sizeof(u32))
8269 return -EINVAL;
8270
8271 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
8272 return -EINVAL;
8273
8274 memcpy(settings->akm_suites, data, len);
8275 }
8276
8277 if (info->attrs[NL80211_ATTR_PMK]) {
8278 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN)
8279 return -EINVAL;
8280 if (!wiphy_ext_feature_isset(&rdev->wiphy,
8281 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK))
8282 return -EINVAL;
8283 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]);
8284 }
8285
8286 return 0;
8287 }
8288
8289 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
8290 {
8291 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8292 struct net_device *dev = info->user_ptr[1];
8293 struct ieee80211_channel *chan;
8294 struct cfg80211_assoc_request req = {};
8295 const u8 *bssid, *ssid;
8296 int err, ssid_len = 0;
8297
8298 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8299 return -EINVAL;
8300
8301 if (!info->attrs[NL80211_ATTR_MAC] ||
8302 !info->attrs[NL80211_ATTR_SSID] ||
8303 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
8304 return -EINVAL;
8305
8306 if (!rdev->ops->assoc)
8307 return -EOPNOTSUPP;
8308
8309 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8310 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8311 return -EOPNOTSUPP;
8312
8313 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8314
8315 chan = nl80211_get_valid_chan(&rdev->wiphy,
8316 info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8317 if (!chan)
8318 return -EINVAL;
8319
8320 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8321 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8322
8323 if (info->attrs[NL80211_ATTR_IE]) {
8324 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8325 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8326 }
8327
8328 if (info->attrs[NL80211_ATTR_USE_MFP]) {
8329 enum nl80211_mfp mfp =
8330 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
8331 if (mfp == NL80211_MFP_REQUIRED)
8332 req.use_mfp = true;
8333 else if (mfp != NL80211_MFP_NO)
8334 return -EINVAL;
8335 }
8336
8337 if (info->attrs[NL80211_ATTR_PREV_BSSID])
8338 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
8339
8340 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
8341 req.flags |= ASSOC_REQ_DISABLE_HT;
8342
8343 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8344 memcpy(&req.ht_capa_mask,
8345 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8346 sizeof(req.ht_capa_mask));
8347
8348 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8349 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8350 return -EINVAL;
8351 memcpy(&req.ht_capa,
8352 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8353 sizeof(req.ht_capa));
8354 }
8355
8356 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
8357 req.flags |= ASSOC_REQ_DISABLE_VHT;
8358
8359 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
8360 memcpy(&req.vht_capa_mask,
8361 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
8362 sizeof(req.vht_capa_mask));
8363
8364 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
8365 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
8366 return -EINVAL;
8367 memcpy(&req.vht_capa,
8368 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
8369 sizeof(req.vht_capa));
8370 }
8371
8372 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
8373 if (!((rdev->wiphy.features &
8374 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
8375 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
8376 !wiphy_ext_feature_isset(&rdev->wiphy,
8377 NL80211_EXT_FEATURE_RRM))
8378 return -EINVAL;
8379 req.flags |= ASSOC_REQ_USE_RRM;
8380 }
8381
8382 if (info->attrs[NL80211_ATTR_FILS_KEK]) {
8383 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
8384 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
8385 if (!info->attrs[NL80211_ATTR_FILS_NONCES])
8386 return -EINVAL;
8387 req.fils_nonces =
8388 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
8389 }
8390
8391 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
8392 if (!err) {
8393 wdev_lock(dev->ieee80211_ptr);
8394
8395 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
8396 ssid, ssid_len, &req);
8397
8398 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
8399 dev->ieee80211_ptr->conn_owner_nlportid =
8400 info->snd_portid;
8401 memcpy(dev->ieee80211_ptr->disconnect_bssid,
8402 bssid, ETH_ALEN);
8403 }
8404
8405 wdev_unlock(dev->ieee80211_ptr);
8406 }
8407
8408 return err;
8409 }
8410
8411 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
8412 {
8413 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8414 struct net_device *dev = info->user_ptr[1];
8415 const u8 *ie = NULL, *bssid;
8416 int ie_len = 0, err;
8417 u16 reason_code;
8418 bool local_state_change;
8419
8420 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8421 return -EINVAL;
8422
8423 if (!info->attrs[NL80211_ATTR_MAC])
8424 return -EINVAL;
8425
8426 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8427 return -EINVAL;
8428
8429 if (!rdev->ops->deauth)
8430 return -EOPNOTSUPP;
8431
8432 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8433 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8434 return -EOPNOTSUPP;
8435
8436 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8437
8438 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8439 if (reason_code == 0) {
8440 /* Reason Code 0 is reserved */
8441 return -EINVAL;
8442 }
8443
8444 if (info->attrs[NL80211_ATTR_IE]) {
8445 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8446 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8447 }
8448
8449 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8450
8451 wdev_lock(dev->ieee80211_ptr);
8452 err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
8453 local_state_change);
8454 wdev_unlock(dev->ieee80211_ptr);
8455 return err;
8456 }
8457
8458 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
8459 {
8460 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8461 struct net_device *dev = info->user_ptr[1];
8462 const u8 *ie = NULL, *bssid;
8463 int ie_len = 0, err;
8464 u16 reason_code;
8465 bool local_state_change;
8466
8467 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8468 return -EINVAL;
8469
8470 if (!info->attrs[NL80211_ATTR_MAC])
8471 return -EINVAL;
8472
8473 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8474 return -EINVAL;
8475
8476 if (!rdev->ops->disassoc)
8477 return -EOPNOTSUPP;
8478
8479 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8480 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8481 return -EOPNOTSUPP;
8482
8483 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8484
8485 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8486 if (reason_code == 0) {
8487 /* Reason Code 0 is reserved */
8488 return -EINVAL;
8489 }
8490
8491 if (info->attrs[NL80211_ATTR_IE]) {
8492 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8493 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8494 }
8495
8496 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8497
8498 wdev_lock(dev->ieee80211_ptr);
8499 err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
8500 local_state_change);
8501 wdev_unlock(dev->ieee80211_ptr);
8502 return err;
8503 }
8504
8505 static bool
8506 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
8507 int mcast_rate[NUM_NL80211_BANDS],
8508 int rateval)
8509 {
8510 struct wiphy *wiphy = &rdev->wiphy;
8511 bool found = false;
8512 int band, i;
8513
8514 for (band = 0; band < NUM_NL80211_BANDS; band++) {
8515 struct ieee80211_supported_band *sband;
8516
8517 sband = wiphy->bands[band];
8518 if (!sband)
8519 continue;
8520
8521 for (i = 0; i < sband->n_bitrates; i++) {
8522 if (sband->bitrates[i].bitrate == rateval) {
8523 mcast_rate[band] = i + 1;
8524 found = true;
8525 break;
8526 }
8527 }
8528 }
8529
8530 return found;
8531 }
8532
8533 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
8534 {
8535 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8536 struct net_device *dev = info->user_ptr[1];
8537 struct cfg80211_ibss_params ibss;
8538 struct wiphy *wiphy;
8539 struct cfg80211_cached_keys *connkeys = NULL;
8540 int err;
8541
8542 memset(&ibss, 0, sizeof(ibss));
8543
8544 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8545 return -EINVAL;
8546
8547 if (!info->attrs[NL80211_ATTR_SSID] ||
8548 !nla_len(info->attrs[NL80211_ATTR_SSID]))
8549 return -EINVAL;
8550
8551 ibss.beacon_interval = 100;
8552
8553 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
8554 ibss.beacon_interval =
8555 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
8556
8557 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
8558 ibss.beacon_interval);
8559 if (err)
8560 return err;
8561
8562 if (!rdev->ops->join_ibss)
8563 return -EOPNOTSUPP;
8564
8565 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8566 return -EOPNOTSUPP;
8567
8568 wiphy = &rdev->wiphy;
8569
8570 if (info->attrs[NL80211_ATTR_MAC]) {
8571 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8572
8573 if (!is_valid_ether_addr(ibss.bssid))
8574 return -EINVAL;
8575 }
8576 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8577 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8578
8579 if (info->attrs[NL80211_ATTR_IE]) {
8580 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8581 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8582 }
8583
8584 err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
8585 if (err)
8586 return err;
8587
8588 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
8589 NL80211_IFTYPE_ADHOC))
8590 return -EINVAL;
8591
8592 switch (ibss.chandef.width) {
8593 case NL80211_CHAN_WIDTH_5:
8594 case NL80211_CHAN_WIDTH_10:
8595 case NL80211_CHAN_WIDTH_20_NOHT:
8596 break;
8597 case NL80211_CHAN_WIDTH_20:
8598 case NL80211_CHAN_WIDTH_40:
8599 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8600 return -EINVAL;
8601 break;
8602 case NL80211_CHAN_WIDTH_80:
8603 case NL80211_CHAN_WIDTH_80P80:
8604 case NL80211_CHAN_WIDTH_160:
8605 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8606 return -EINVAL;
8607 if (!wiphy_ext_feature_isset(&rdev->wiphy,
8608 NL80211_EXT_FEATURE_VHT_IBSS))
8609 return -EINVAL;
8610 break;
8611 default:
8612 return -EINVAL;
8613 }
8614
8615 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
8616 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
8617
8618 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
8619 u8 *rates =
8620 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8621 int n_rates =
8622 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8623 struct ieee80211_supported_band *sband =
8624 wiphy->bands[ibss.chandef.chan->band];
8625
8626 err = ieee80211_get_ratemask(sband, rates, n_rates,
8627 &ibss.basic_rates);
8628 if (err)
8629 return err;
8630 }
8631
8632 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8633 memcpy(&ibss.ht_capa_mask,
8634 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8635 sizeof(ibss.ht_capa_mask));
8636
8637 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8638 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8639 return -EINVAL;
8640 memcpy(&ibss.ht_capa,
8641 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8642 sizeof(ibss.ht_capa));
8643 }
8644
8645 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
8646 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
8647 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
8648 return -EINVAL;
8649
8650 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
8651 bool no_ht = false;
8652
8653 connkeys = nl80211_parse_connkeys(rdev,
8654 info->attrs[NL80211_ATTR_KEYS],
8655 &no_ht);
8656 if (IS_ERR(connkeys))
8657 return PTR_ERR(connkeys);
8658
8659 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
8660 no_ht) {
8661 kzfree(connkeys);
8662 return -EINVAL;
8663 }
8664 }
8665
8666 ibss.control_port =
8667 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
8668
8669 ibss.userspace_handles_dfs =
8670 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
8671
8672 err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
8673 if (err)
8674 kzfree(connkeys);
8675 return err;
8676 }
8677
8678 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
8679 {
8680 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8681 struct net_device *dev = info->user_ptr[1];
8682
8683 if (!rdev->ops->leave_ibss)
8684 return -EOPNOTSUPP;
8685
8686 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8687 return -EOPNOTSUPP;
8688
8689 return cfg80211_leave_ibss(rdev, dev, false);
8690 }
8691
8692 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
8693 {
8694 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8695 struct net_device *dev = info->user_ptr[1];
8696 int mcast_rate[NUM_NL80211_BANDS];
8697 u32 nla_rate;
8698 int err;
8699
8700 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
8701 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
8702 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
8703 return -EOPNOTSUPP;
8704
8705 if (!rdev->ops->set_mcast_rate)
8706 return -EOPNOTSUPP;
8707
8708 memset(mcast_rate, 0, sizeof(mcast_rate));
8709
8710 if (!info->attrs[NL80211_ATTR_MCAST_RATE])
8711 return -EINVAL;
8712
8713 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
8714 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
8715 return -EINVAL;
8716
8717 err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
8718
8719 return err;
8720 }
8721
8722 static struct sk_buff *
8723 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
8724 struct wireless_dev *wdev, int approxlen,
8725 u32 portid, u32 seq, enum nl80211_commands cmd,
8726 enum nl80211_attrs attr,
8727 const struct nl80211_vendor_cmd_info *info,
8728 gfp_t gfp)
8729 {
8730 struct sk_buff *skb;
8731 void *hdr;
8732 struct nlattr *data;
8733
8734 skb = nlmsg_new(approxlen + 100, gfp);
8735 if (!skb)
8736 return NULL;
8737
8738 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
8739 if (!hdr) {
8740 kfree_skb(skb);
8741 return NULL;
8742 }
8743
8744 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
8745 goto nla_put_failure;
8746
8747 if (info) {
8748 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
8749 info->vendor_id))
8750 goto nla_put_failure;
8751 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
8752 info->subcmd))
8753 goto nla_put_failure;
8754 }
8755
8756 if (wdev) {
8757 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
8758 wdev_id(wdev), NL80211_ATTR_PAD))
8759 goto nla_put_failure;
8760 if (wdev->netdev &&
8761 nla_put_u32(skb, NL80211_ATTR_IFINDEX,
8762 wdev->netdev->ifindex))
8763 goto nla_put_failure;
8764 }
8765
8766 data = nla_nest_start(skb, attr);
8767 if (!data)
8768 goto nla_put_failure;
8769
8770 ((void **)skb->cb)[0] = rdev;
8771 ((void **)skb->cb)[1] = hdr;
8772 ((void **)skb->cb)[2] = data;
8773
8774 return skb;
8775
8776 nla_put_failure:
8777 kfree_skb(skb);
8778 return NULL;
8779 }
8780
8781 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
8782 struct wireless_dev *wdev,
8783 enum nl80211_commands cmd,
8784 enum nl80211_attrs attr,
8785 int vendor_event_idx,
8786 int approxlen, gfp_t gfp)
8787 {
8788 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
8789 const struct nl80211_vendor_cmd_info *info;
8790
8791 switch (cmd) {
8792 case NL80211_CMD_TESTMODE:
8793 if (WARN_ON(vendor_event_idx != -1))
8794 return NULL;
8795 info = NULL;
8796 break;
8797 case NL80211_CMD_VENDOR:
8798 if (WARN_ON(vendor_event_idx < 0 ||
8799 vendor_event_idx >= wiphy->n_vendor_events))
8800 return NULL;
8801 info = &wiphy->vendor_events[vendor_event_idx];
8802 break;
8803 default:
8804 WARN_ON(1);
8805 return NULL;
8806 }
8807
8808 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, 0, 0,
8809 cmd, attr, info, gfp);
8810 }
8811 EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
8812
8813 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
8814 {
8815 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
8816 void *hdr = ((void **)skb->cb)[1];
8817 struct nlattr *data = ((void **)skb->cb)[2];
8818 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
8819
8820 /* clear CB data for netlink core to own from now on */
8821 memset(skb->cb, 0, sizeof(skb->cb));
8822
8823 nla_nest_end(skb, data);
8824 genlmsg_end(skb, hdr);
8825
8826 if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
8827 mcgrp = NL80211_MCGRP_VENDOR;
8828
8829 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), skb, 0,
8830 mcgrp, gfp);
8831 }
8832 EXPORT_SYMBOL(__cfg80211_send_event_skb);
8833
8834 #ifdef CONFIG_NL80211_TESTMODE
8835 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
8836 {
8837 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8838 struct wireless_dev *wdev =
8839 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
8840 int err;
8841
8842 if (!rdev->ops->testmode_cmd)
8843 return -EOPNOTSUPP;
8844
8845 if (IS_ERR(wdev)) {
8846 err = PTR_ERR(wdev);
8847 if (err != -EINVAL)
8848 return err;
8849 wdev = NULL;
8850 } else if (wdev->wiphy != &rdev->wiphy) {
8851 return -EINVAL;
8852 }
8853
8854 if (!info->attrs[NL80211_ATTR_TESTDATA])
8855 return -EINVAL;
8856
8857 rdev->cur_cmd_info = info;
8858 err = rdev_testmode_cmd(rdev, wdev,
8859 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
8860 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
8861 rdev->cur_cmd_info = NULL;
8862
8863 return err;
8864 }
8865
8866 static int nl80211_testmode_dump(struct sk_buff *skb,
8867 struct netlink_callback *cb)
8868 {
8869 struct cfg80211_registered_device *rdev;
8870 int err;
8871 long phy_idx;
8872 void *data = NULL;
8873 int data_len = 0;
8874
8875 rtnl_lock();
8876
8877 if (cb->args[0]) {
8878 /*
8879 * 0 is a valid index, but not valid for args[0],
8880 * so we need to offset by 1.
8881 */
8882 phy_idx = cb->args[0] - 1;
8883
8884 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
8885 if (!rdev) {
8886 err = -ENOENT;
8887 goto out_err;
8888 }
8889 } else {
8890 struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
8891
8892 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
8893 attrbuf, nl80211_fam.maxattr,
8894 nl80211_policy, NULL);
8895 if (err)
8896 goto out_err;
8897
8898 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
8899 if (IS_ERR(rdev)) {
8900 err = PTR_ERR(rdev);
8901 goto out_err;
8902 }
8903 phy_idx = rdev->wiphy_idx;
8904
8905 if (attrbuf[NL80211_ATTR_TESTDATA])
8906 cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
8907 }
8908
8909 if (cb->args[1]) {
8910 data = nla_data((void *)cb->args[1]);
8911 data_len = nla_len((void *)cb->args[1]);
8912 }
8913
8914 if (!rdev->ops->testmode_dump) {
8915 err = -EOPNOTSUPP;
8916 goto out_err;
8917 }
8918
8919 while (1) {
8920 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
8921 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8922 NL80211_CMD_TESTMODE);
8923 struct nlattr *tmdata;
8924
8925 if (!hdr)
8926 break;
8927
8928 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
8929 genlmsg_cancel(skb, hdr);
8930 break;
8931 }
8932
8933 tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
8934 if (!tmdata) {
8935 genlmsg_cancel(skb, hdr);
8936 break;
8937 }
8938 err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
8939 nla_nest_end(skb, tmdata);
8940
8941 if (err == -ENOBUFS || err == -ENOENT) {
8942 genlmsg_cancel(skb, hdr);
8943 break;
8944 } else if (err) {
8945 genlmsg_cancel(skb, hdr);
8946 goto out_err;
8947 }
8948
8949 genlmsg_end(skb, hdr);
8950 }
8951
8952 err = skb->len;
8953 /* see above */
8954 cb->args[0] = phy_idx + 1;
8955 out_err:
8956 rtnl_unlock();
8957 return err;
8958 }
8959 #endif
8960
8961 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
8962 {
8963 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8964 struct net_device *dev = info->user_ptr[1];
8965 struct cfg80211_connect_params connect;
8966 struct wiphy *wiphy;
8967 struct cfg80211_cached_keys *connkeys = NULL;
8968 int err;
8969
8970 memset(&connect, 0, sizeof(connect));
8971
8972 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8973 return -EINVAL;
8974
8975 if (!info->attrs[NL80211_ATTR_SSID] ||
8976 !nla_len(info->attrs[NL80211_ATTR_SSID]))
8977 return -EINVAL;
8978
8979 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
8980 connect.auth_type =
8981 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
8982 if (!nl80211_valid_auth_type(rdev, connect.auth_type,
8983 NL80211_CMD_CONNECT))
8984 return -EINVAL;
8985 } else
8986 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
8987
8988 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
8989
8990 if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] &&
8991 !wiphy_ext_feature_isset(&rdev->wiphy,
8992 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
8993 return -EINVAL;
8994 connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS];
8995
8996 err = nl80211_crypto_settings(rdev, info, &connect.crypto,
8997 NL80211_MAX_NR_CIPHER_SUITES);
8998 if (err)
8999 return err;
9000
9001 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9002 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9003 return -EOPNOTSUPP;
9004
9005 wiphy = &rdev->wiphy;
9006
9007 connect.bg_scan_period = -1;
9008 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
9009 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
9010 connect.bg_scan_period =
9011 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
9012 }
9013
9014 if (info->attrs[NL80211_ATTR_MAC])
9015 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9016 else if (info->attrs[NL80211_ATTR_MAC_HINT])
9017 connect.bssid_hint =
9018 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
9019 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9020 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9021
9022 if (info->attrs[NL80211_ATTR_IE]) {
9023 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9024 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9025 }
9026
9027 if (info->attrs[NL80211_ATTR_USE_MFP]) {
9028 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
9029 if (connect.mfp == NL80211_MFP_OPTIONAL &&
9030 !wiphy_ext_feature_isset(&rdev->wiphy,
9031 NL80211_EXT_FEATURE_MFP_OPTIONAL))
9032 return -EOPNOTSUPP;
9033
9034 if (connect.mfp != NL80211_MFP_REQUIRED &&
9035 connect.mfp != NL80211_MFP_NO &&
9036 connect.mfp != NL80211_MFP_OPTIONAL)
9037 return -EINVAL;
9038 } else {
9039 connect.mfp = NL80211_MFP_NO;
9040 }
9041
9042 if (info->attrs[NL80211_ATTR_PREV_BSSID])
9043 connect.prev_bssid =
9044 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
9045
9046 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9047 connect.channel = nl80211_get_valid_chan(
9048 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
9049 if (!connect.channel)
9050 return -EINVAL;
9051 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
9052 connect.channel_hint = nl80211_get_valid_chan(
9053 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
9054 if (!connect.channel_hint)
9055 return -EINVAL;
9056 }
9057
9058 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
9059 connkeys = nl80211_parse_connkeys(rdev,
9060 info->attrs[NL80211_ATTR_KEYS], NULL);
9061 if (IS_ERR(connkeys))
9062 return PTR_ERR(connkeys);
9063 }
9064
9065 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
9066 connect.flags |= ASSOC_REQ_DISABLE_HT;
9067
9068 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9069 memcpy(&connect.ht_capa_mask,
9070 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
9071 sizeof(connect.ht_capa_mask));
9072
9073 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
9074 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
9075 kzfree(connkeys);
9076 return -EINVAL;
9077 }
9078 memcpy(&connect.ht_capa,
9079 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
9080 sizeof(connect.ht_capa));
9081 }
9082
9083 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
9084 connect.flags |= ASSOC_REQ_DISABLE_VHT;
9085
9086 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
9087 memcpy(&connect.vht_capa_mask,
9088 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
9089 sizeof(connect.vht_capa_mask));
9090
9091 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
9092 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
9093 kzfree(connkeys);
9094 return -EINVAL;
9095 }
9096 memcpy(&connect.vht_capa,
9097 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
9098 sizeof(connect.vht_capa));
9099 }
9100
9101 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
9102 if (!((rdev->wiphy.features &
9103 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
9104 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
9105 !wiphy_ext_feature_isset(&rdev->wiphy,
9106 NL80211_EXT_FEATURE_RRM)) {
9107 kzfree(connkeys);
9108 return -EINVAL;
9109 }
9110 connect.flags |= ASSOC_REQ_USE_RRM;
9111 }
9112
9113 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
9114 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
9115 kzfree(connkeys);
9116 return -EOPNOTSUPP;
9117 }
9118
9119 if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
9120 /* bss selection makes no sense if bssid is set */
9121 if (connect.bssid) {
9122 kzfree(connkeys);
9123 return -EINVAL;
9124 }
9125
9126 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
9127 wiphy, &connect.bss_select);
9128 if (err) {
9129 kzfree(connkeys);
9130 return err;
9131 }
9132 }
9133
9134 if (wiphy_ext_feature_isset(&rdev->wiphy,
9135 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
9136 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
9137 info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
9138 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
9139 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9140 connect.fils_erp_username =
9141 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
9142 connect.fils_erp_username_len =
9143 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
9144 connect.fils_erp_realm =
9145 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
9146 connect.fils_erp_realm_len =
9147 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
9148 connect.fils_erp_next_seq_num =
9149 nla_get_u16(
9150 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
9151 connect.fils_erp_rrk =
9152 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
9153 connect.fils_erp_rrk_len =
9154 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
9155 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
9156 info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
9157 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
9158 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9159 kzfree(connkeys);
9160 return -EINVAL;
9161 }
9162
9163 wdev_lock(dev->ieee80211_ptr);
9164
9165 err = cfg80211_connect(rdev, dev, &connect, connkeys,
9166 connect.prev_bssid);
9167 if (err)
9168 kzfree(connkeys);
9169
9170 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9171 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
9172 if (connect.bssid)
9173 memcpy(dev->ieee80211_ptr->disconnect_bssid,
9174 connect.bssid, ETH_ALEN);
9175 else
9176 memset(dev->ieee80211_ptr->disconnect_bssid,
9177 0, ETH_ALEN);
9178 }
9179
9180 wdev_unlock(dev->ieee80211_ptr);
9181
9182 return err;
9183 }
9184
9185 static int nl80211_update_connect_params(struct sk_buff *skb,
9186 struct genl_info *info)
9187 {
9188 struct cfg80211_connect_params connect = {};
9189 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9190 struct net_device *dev = info->user_ptr[1];
9191 struct wireless_dev *wdev = dev->ieee80211_ptr;
9192 u32 changed = 0;
9193 int ret;
9194
9195 if (!rdev->ops->update_connect_params)
9196 return -EOPNOTSUPP;
9197
9198 if (info->attrs[NL80211_ATTR_IE]) {
9199 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
9200 return -EINVAL;
9201 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9202 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9203 changed |= UPDATE_ASSOC_IES;
9204 }
9205
9206 wdev_lock(dev->ieee80211_ptr);
9207 if (!wdev->current_bss)
9208 ret = -ENOLINK;
9209 else
9210 ret = rdev_update_connect_params(rdev, dev, &connect, changed);
9211 wdev_unlock(dev->ieee80211_ptr);
9212
9213 return ret;
9214 }
9215
9216 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
9217 {
9218 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9219 struct net_device *dev = info->user_ptr[1];
9220 u16 reason;
9221 int ret;
9222
9223 if (!info->attrs[NL80211_ATTR_REASON_CODE])
9224 reason = WLAN_REASON_DEAUTH_LEAVING;
9225 else
9226 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9227
9228 if (reason == 0)
9229 return -EINVAL;
9230
9231 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9232 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9233 return -EOPNOTSUPP;
9234
9235 wdev_lock(dev->ieee80211_ptr);
9236 ret = cfg80211_disconnect(rdev, dev, reason, true);
9237 wdev_unlock(dev->ieee80211_ptr);
9238 return ret;
9239 }
9240
9241 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
9242 {
9243 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9244 struct net *net;
9245 int err;
9246
9247 if (info->attrs[NL80211_ATTR_PID]) {
9248 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
9249
9250 net = get_net_ns_by_pid(pid);
9251 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
9252 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
9253
9254 net = get_net_ns_by_fd(fd);
9255 } else {
9256 return -EINVAL;
9257 }
9258
9259 if (IS_ERR(net))
9260 return PTR_ERR(net);
9261
9262 err = 0;
9263
9264 /* check if anything to do */
9265 if (!net_eq(wiphy_net(&rdev->wiphy), net))
9266 err = cfg80211_switch_netns(rdev, net);
9267
9268 put_net(net);
9269 return err;
9270 }
9271
9272 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
9273 {
9274 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9275 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
9276 struct cfg80211_pmksa *pmksa) = NULL;
9277 struct net_device *dev = info->user_ptr[1];
9278 struct cfg80211_pmksa pmksa;
9279
9280 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
9281
9282 if (!info->attrs[NL80211_ATTR_PMKID])
9283 return -EINVAL;
9284
9285 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
9286
9287 if (info->attrs[NL80211_ATTR_MAC]) {
9288 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9289 } else if (info->attrs[NL80211_ATTR_SSID] &&
9290 info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
9291 (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA ||
9292 info->attrs[NL80211_ATTR_PMK])) {
9293 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9294 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9295 pmksa.cache_id =
9296 nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
9297 } else {
9298 return -EINVAL;
9299 }
9300 if (info->attrs[NL80211_ATTR_PMK]) {
9301 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
9302 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
9303 }
9304
9305 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9306 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9307 return -EOPNOTSUPP;
9308
9309 switch (info->genlhdr->cmd) {
9310 case NL80211_CMD_SET_PMKSA:
9311 rdev_ops = rdev->ops->set_pmksa;
9312 break;
9313 case NL80211_CMD_DEL_PMKSA:
9314 rdev_ops = rdev->ops->del_pmksa;
9315 break;
9316 default:
9317 WARN_ON(1);
9318 break;
9319 }
9320
9321 if (!rdev_ops)
9322 return -EOPNOTSUPP;
9323
9324 return rdev_ops(&rdev->wiphy, dev, &pmksa);
9325 }
9326
9327 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
9328 {
9329 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9330 struct net_device *dev = info->user_ptr[1];
9331
9332 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9333 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9334 return -EOPNOTSUPP;
9335
9336 if (!rdev->ops->flush_pmksa)
9337 return -EOPNOTSUPP;
9338
9339 return rdev_flush_pmksa(rdev, dev);
9340 }
9341
9342 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
9343 {
9344 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9345 struct net_device *dev = info->user_ptr[1];
9346 u8 action_code, dialog_token;
9347 u32 peer_capability = 0;
9348 u16 status_code;
9349 u8 *peer;
9350 bool initiator;
9351
9352 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
9353 !rdev->ops->tdls_mgmt)
9354 return -EOPNOTSUPP;
9355
9356 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
9357 !info->attrs[NL80211_ATTR_STATUS_CODE] ||
9358 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
9359 !info->attrs[NL80211_ATTR_IE] ||
9360 !info->attrs[NL80211_ATTR_MAC])
9361 return -EINVAL;
9362
9363 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
9364 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
9365 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
9366 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
9367 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
9368 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
9369 peer_capability =
9370 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
9371
9372 return rdev_tdls_mgmt(rdev, dev, peer, action_code,
9373 dialog_token, status_code, peer_capability,
9374 initiator,
9375 nla_data(info->attrs[NL80211_ATTR_IE]),
9376 nla_len(info->attrs[NL80211_ATTR_IE]));
9377 }
9378
9379 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
9380 {
9381 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9382 struct net_device *dev = info->user_ptr[1];
9383 enum nl80211_tdls_operation operation;
9384 u8 *peer;
9385
9386 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
9387 !rdev->ops->tdls_oper)
9388 return -EOPNOTSUPP;
9389
9390 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
9391 !info->attrs[NL80211_ATTR_MAC])
9392 return -EINVAL;
9393
9394 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
9395 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
9396
9397 return rdev_tdls_oper(rdev, dev, peer, operation);
9398 }
9399
9400 static int nl80211_remain_on_channel(struct sk_buff *skb,
9401 struct genl_info *info)
9402 {
9403 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9404 struct wireless_dev *wdev = info->user_ptr[1];
9405 struct cfg80211_chan_def chandef;
9406 const struct cfg80211_chan_def *compat_chandef;
9407 struct sk_buff *msg;
9408 void *hdr;
9409 u64 cookie;
9410 u32 duration;
9411 int err;
9412
9413 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
9414 !info->attrs[NL80211_ATTR_DURATION])
9415 return -EINVAL;
9416
9417 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
9418
9419 if (!rdev->ops->remain_on_channel ||
9420 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
9421 return -EOPNOTSUPP;
9422
9423 /*
9424 * We should be on that channel for at least a minimum amount of
9425 * time (10ms) but no longer than the driver supports.
9426 */
9427 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9428 duration > rdev->wiphy.max_remain_on_channel_duration)
9429 return -EINVAL;
9430
9431 err = nl80211_parse_chandef(rdev, info, &chandef);
9432 if (err)
9433 return err;
9434
9435 wdev_lock(wdev);
9436 if (!cfg80211_off_channel_oper_allowed(wdev) &&
9437 !cfg80211_chandef_identical(&wdev->chandef, &chandef)) {
9438 compat_chandef = cfg80211_chandef_compatible(&wdev->chandef,
9439 &chandef);
9440 if (compat_chandef != &chandef) {
9441 wdev_unlock(wdev);
9442 return -EBUSY;
9443 }
9444 }
9445 wdev_unlock(wdev);
9446
9447 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9448 if (!msg)
9449 return -ENOMEM;
9450
9451 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9452 NL80211_CMD_REMAIN_ON_CHANNEL);
9453 if (!hdr) {
9454 err = -ENOBUFS;
9455 goto free_msg;
9456 }
9457
9458 err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
9459 duration, &cookie);
9460
9461 if (err)
9462 goto free_msg;
9463
9464 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
9465 NL80211_ATTR_PAD))
9466 goto nla_put_failure;
9467
9468 genlmsg_end(msg, hdr);
9469
9470 return genlmsg_reply(msg, info);
9471
9472 nla_put_failure:
9473 err = -ENOBUFS;
9474 free_msg:
9475 nlmsg_free(msg);
9476 return err;
9477 }
9478
9479 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
9480 struct genl_info *info)
9481 {
9482 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9483 struct wireless_dev *wdev = info->user_ptr[1];
9484 u64 cookie;
9485
9486 if (!info->attrs[NL80211_ATTR_COOKIE])
9487 return -EINVAL;
9488
9489 if (!rdev->ops->cancel_remain_on_channel)
9490 return -EOPNOTSUPP;
9491
9492 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
9493
9494 return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
9495 }
9496
9497 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
9498 struct genl_info *info)
9499 {
9500 struct cfg80211_bitrate_mask mask;
9501 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9502 struct net_device *dev = info->user_ptr[1];
9503 int err;
9504
9505 if (!rdev->ops->set_bitrate_mask)
9506 return -EOPNOTSUPP;
9507
9508 err = nl80211_parse_tx_bitrate_mask(info, &mask);
9509 if (err)
9510 return err;
9511
9512 return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
9513 }
9514
9515 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
9516 {
9517 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9518 struct wireless_dev *wdev = info->user_ptr[1];
9519 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
9520
9521 if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
9522 return -EINVAL;
9523
9524 if (info->attrs[NL80211_ATTR_FRAME_TYPE])
9525 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
9526
9527 switch (wdev->iftype) {
9528 case NL80211_IFTYPE_STATION:
9529 case NL80211_IFTYPE_ADHOC:
9530 case NL80211_IFTYPE_P2P_CLIENT:
9531 case NL80211_IFTYPE_AP:
9532 case NL80211_IFTYPE_AP_VLAN:
9533 case NL80211_IFTYPE_MESH_POINT:
9534 case NL80211_IFTYPE_P2P_GO:
9535 case NL80211_IFTYPE_P2P_DEVICE:
9536 break;
9537 case NL80211_IFTYPE_NAN:
9538 default:
9539 return -EOPNOTSUPP;
9540 }
9541
9542 /* not much point in registering if we can't reply */
9543 if (!rdev->ops->mgmt_tx)
9544 return -EOPNOTSUPP;
9545
9546 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
9547 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
9548 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
9549 }
9550
9551 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
9552 {
9553 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9554 struct wireless_dev *wdev = info->user_ptr[1];
9555 struct cfg80211_chan_def chandef;
9556 int err;
9557 void *hdr = NULL;
9558 u64 cookie;
9559 struct sk_buff *msg = NULL;
9560 struct cfg80211_mgmt_tx_params params = {
9561 .dont_wait_for_ack =
9562 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
9563 };
9564
9565 if (!info->attrs[NL80211_ATTR_FRAME])
9566 return -EINVAL;
9567
9568 if (!rdev->ops->mgmt_tx)
9569 return -EOPNOTSUPP;
9570
9571 switch (wdev->iftype) {
9572 case NL80211_IFTYPE_P2P_DEVICE:
9573 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
9574 return -EINVAL;
9575 case NL80211_IFTYPE_STATION:
9576 case NL80211_IFTYPE_ADHOC:
9577 case NL80211_IFTYPE_P2P_CLIENT:
9578 case NL80211_IFTYPE_AP:
9579 case NL80211_IFTYPE_AP_VLAN:
9580 case NL80211_IFTYPE_MESH_POINT:
9581 case NL80211_IFTYPE_P2P_GO:
9582 break;
9583 case NL80211_IFTYPE_NAN:
9584 default:
9585 return -EOPNOTSUPP;
9586 }
9587
9588 if (info->attrs[NL80211_ATTR_DURATION]) {
9589 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
9590 return -EINVAL;
9591 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
9592
9593 /*
9594 * We should wait on the channel for at least a minimum amount
9595 * of time (10ms) but no longer than the driver supports.
9596 */
9597 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9598 params.wait > rdev->wiphy.max_remain_on_channel_duration)
9599 return -EINVAL;
9600 }
9601
9602 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
9603
9604 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
9605 return -EINVAL;
9606
9607 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
9608
9609 /* get the channel if any has been specified, otherwise pass NULL to
9610 * the driver. The latter will use the current one
9611 */
9612 chandef.chan = NULL;
9613 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9614 err = nl80211_parse_chandef(rdev, info, &chandef);
9615 if (err)
9616 return err;
9617 }
9618
9619 if (!chandef.chan && params.offchan)
9620 return -EINVAL;
9621
9622 wdev_lock(wdev);
9623 if (params.offchan && !cfg80211_off_channel_oper_allowed(wdev)) {
9624 wdev_unlock(wdev);
9625 return -EBUSY;
9626 }
9627 wdev_unlock(wdev);
9628
9629 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
9630 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
9631
9632 if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
9633 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9634 int i;
9635
9636 if (len % sizeof(u16))
9637 return -EINVAL;
9638
9639 params.n_csa_offsets = len / sizeof(u16);
9640 params.csa_offsets =
9641 nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9642
9643 /* check that all the offsets fit the frame */
9644 for (i = 0; i < params.n_csa_offsets; i++) {
9645 if (params.csa_offsets[i] >= params.len)
9646 return -EINVAL;
9647 }
9648 }
9649
9650 if (!params.dont_wait_for_ack) {
9651 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9652 if (!msg)
9653 return -ENOMEM;
9654
9655 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9656 NL80211_CMD_FRAME);
9657 if (!hdr) {
9658 err = -ENOBUFS;
9659 goto free_msg;
9660 }
9661 }
9662
9663 params.chan = chandef.chan;
9664 err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
9665 if (err)
9666 goto free_msg;
9667
9668 if (msg) {
9669 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
9670 NL80211_ATTR_PAD))
9671 goto nla_put_failure;
9672
9673 genlmsg_end(msg, hdr);
9674 return genlmsg_reply(msg, info);
9675 }
9676
9677 return 0;
9678
9679 nla_put_failure:
9680 err = -ENOBUFS;
9681 free_msg:
9682 nlmsg_free(msg);
9683 return err;
9684 }
9685
9686 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
9687 {
9688 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9689 struct wireless_dev *wdev = info->user_ptr[1];
9690 u64 cookie;
9691
9692 if (!info->attrs[NL80211_ATTR_COOKIE])
9693 return -EINVAL;
9694
9695 if (!rdev->ops->mgmt_tx_cancel_wait)
9696 return -EOPNOTSUPP;
9697
9698 switch (wdev->iftype) {
9699 case NL80211_IFTYPE_STATION:
9700 case NL80211_IFTYPE_ADHOC:
9701 case NL80211_IFTYPE_P2P_CLIENT:
9702 case NL80211_IFTYPE_AP:
9703 case NL80211_IFTYPE_AP_VLAN:
9704 case NL80211_IFTYPE_P2P_GO:
9705 case NL80211_IFTYPE_P2P_DEVICE:
9706 break;
9707 case NL80211_IFTYPE_NAN:
9708 default:
9709 return -EOPNOTSUPP;
9710 }
9711
9712 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
9713
9714 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
9715 }
9716
9717 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
9718 {
9719 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9720 struct wireless_dev *wdev;
9721 struct net_device *dev = info->user_ptr[1];
9722 u8 ps_state;
9723 bool state;
9724 int err;
9725
9726 if (!info->attrs[NL80211_ATTR_PS_STATE])
9727 return -EINVAL;
9728
9729 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
9730
9731 if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
9732 return -EINVAL;
9733
9734 wdev = dev->ieee80211_ptr;
9735
9736 if (!rdev->ops->set_power_mgmt)
9737 return -EOPNOTSUPP;
9738
9739 state = (ps_state == NL80211_PS_ENABLED) ? true : false;
9740
9741 if (state == wdev->ps)
9742 return 0;
9743
9744 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
9745 if (!err)
9746 wdev->ps = state;
9747 return err;
9748 }
9749
9750 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
9751 {
9752 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9753 enum nl80211_ps_state ps_state;
9754 struct wireless_dev *wdev;
9755 struct net_device *dev = info->user_ptr[1];
9756 struct sk_buff *msg;
9757 void *hdr;
9758 int err;
9759
9760 wdev = dev->ieee80211_ptr;
9761
9762 if (!rdev->ops->set_power_mgmt)
9763 return -EOPNOTSUPP;
9764
9765 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9766 if (!msg)
9767 return -ENOMEM;
9768
9769 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9770 NL80211_CMD_GET_POWER_SAVE);
9771 if (!hdr) {
9772 err = -ENOBUFS;
9773 goto free_msg;
9774 }
9775
9776 if (wdev->ps)
9777 ps_state = NL80211_PS_ENABLED;
9778 else
9779 ps_state = NL80211_PS_DISABLED;
9780
9781 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
9782 goto nla_put_failure;
9783
9784 genlmsg_end(msg, hdr);
9785 return genlmsg_reply(msg, info);
9786
9787 nla_put_failure:
9788 err = -ENOBUFS;
9789 free_msg:
9790 nlmsg_free(msg);
9791 return err;
9792 }
9793
9794 static const struct nla_policy
9795 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
9796 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
9797 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
9798 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
9799 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
9800 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
9801 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
9802 [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
9803 };
9804
9805 static int nl80211_set_cqm_txe(struct genl_info *info,
9806 u32 rate, u32 pkts, u32 intvl)
9807 {
9808 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9809 struct net_device *dev = info->user_ptr[1];
9810 struct wireless_dev *wdev = dev->ieee80211_ptr;
9811
9812 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
9813 return -EINVAL;
9814
9815 if (!rdev->ops->set_cqm_txe_config)
9816 return -EOPNOTSUPP;
9817
9818 if (wdev->iftype != NL80211_IFTYPE_STATION &&
9819 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9820 return -EOPNOTSUPP;
9821
9822 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
9823 }
9824
9825 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
9826 struct net_device *dev)
9827 {
9828 struct wireless_dev *wdev = dev->ieee80211_ptr;
9829 s32 last, low, high;
9830 u32 hyst;
9831 int i, n, low_index;
9832 int err;
9833
9834 /* RSSI reporting disabled? */
9835 if (!wdev->cqm_config)
9836 return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);
9837
9838 /*
9839 * Obtain current RSSI value if possible, if not and no RSSI threshold
9840 * event has been received yet, we should receive an event after a
9841 * connection is established and enough beacons received to calculate
9842 * the average.
9843 */
9844 if (!wdev->cqm_config->last_rssi_event_value && wdev->current_bss &&
9845 rdev->ops->get_station) {
9846 struct station_info sinfo = {};
9847 u8 *mac_addr;
9848
9849 mac_addr = wdev->current_bss->pub.bssid;
9850
9851 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
9852 if (err)
9853 return err;
9854
9855 if (sinfo.filled & BIT(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
9856 wdev->cqm_config->last_rssi_event_value =
9857 (s8) sinfo.rx_beacon_signal_avg;
9858 }
9859
9860 last = wdev->cqm_config->last_rssi_event_value;
9861 hyst = wdev->cqm_config->rssi_hyst;
9862 n = wdev->cqm_config->n_rssi_thresholds;
9863
9864 for (i = 0; i < n; i++) {
9865 i = array_index_nospec(i, n);
9866 if (last < wdev->cqm_config->rssi_thresholds[i])
9867 break;
9868 }
9869
9870 low_index = i - 1;
9871 if (low_index >= 0) {
9872 low_index = array_index_nospec(low_index, n);
9873 low = wdev->cqm_config->rssi_thresholds[low_index] - hyst;
9874 } else {
9875 low = S32_MIN;
9876 }
9877 if (i < n) {
9878 i = array_index_nospec(i, n);
9879 high = wdev->cqm_config->rssi_thresholds[i] + hyst - 1;
9880 } else {
9881 high = S32_MAX;
9882 }
9883
9884 return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
9885 }
9886
9887 static int nl80211_set_cqm_rssi(struct genl_info *info,
9888 const s32 *thresholds, int n_thresholds,
9889 u32 hysteresis)
9890 {
9891 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9892 struct net_device *dev = info->user_ptr[1];
9893 struct wireless_dev *wdev = dev->ieee80211_ptr;
9894 int i, err;
9895 s32 prev = S32_MIN;
9896
9897 /* Check all values negative and sorted */
9898 for (i = 0; i < n_thresholds; i++) {
9899 if (thresholds[i] > 0 || thresholds[i] <= prev)
9900 return -EINVAL;
9901
9902 prev = thresholds[i];
9903 }
9904
9905 if (wdev->iftype != NL80211_IFTYPE_STATION &&
9906 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9907 return -EOPNOTSUPP;
9908
9909 wdev_lock(wdev);
9910 cfg80211_cqm_config_free(wdev);
9911 wdev_unlock(wdev);
9912
9913 if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) {
9914 if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */
9915 return rdev_set_cqm_rssi_config(rdev, dev, 0, 0);
9916
9917 return rdev_set_cqm_rssi_config(rdev, dev,
9918 thresholds[0], hysteresis);
9919 }
9920
9921 if (!wiphy_ext_feature_isset(&rdev->wiphy,
9922 NL80211_EXT_FEATURE_CQM_RSSI_LIST))
9923 return -EOPNOTSUPP;
9924
9925 if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
9926 n_thresholds = 0;
9927
9928 wdev_lock(wdev);
9929 if (n_thresholds) {
9930 struct cfg80211_cqm_config *cqm_config;
9931
9932 cqm_config = kzalloc(sizeof(struct cfg80211_cqm_config) +
9933 n_thresholds * sizeof(s32), GFP_KERNEL);
9934 if (!cqm_config) {
9935 err = -ENOMEM;
9936 goto unlock;
9937 }
9938
9939 cqm_config->rssi_hyst = hysteresis;
9940 cqm_config->n_rssi_thresholds = n_thresholds;
9941 memcpy(cqm_config->rssi_thresholds, thresholds,
9942 n_thresholds * sizeof(s32));
9943
9944 wdev->cqm_config = cqm_config;
9945 }
9946
9947 err = cfg80211_cqm_rssi_update(rdev, dev);
9948
9949 unlock:
9950 wdev_unlock(wdev);
9951
9952 return err;
9953 }
9954
9955 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
9956 {
9957 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
9958 struct nlattr *cqm;
9959 int err;
9960
9961 cqm = info->attrs[NL80211_ATTR_CQM];
9962 if (!cqm)
9963 return -EINVAL;
9964
9965 err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
9966 nl80211_attr_cqm_policy, info->extack);
9967 if (err)
9968 return err;
9969
9970 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
9971 attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
9972 const s32 *thresholds =
9973 nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
9974 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
9975 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
9976
9977 if (len % 4)
9978 return -EINVAL;
9979
9980 return nl80211_set_cqm_rssi(info, thresholds, len / 4,
9981 hysteresis);
9982 }
9983
9984 if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
9985 attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
9986 attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
9987 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
9988 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
9989 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
9990
9991 return nl80211_set_cqm_txe(info, rate, pkts, intvl);
9992 }
9993
9994 return -EINVAL;
9995 }
9996
9997 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
9998 {
9999 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10000 struct net_device *dev = info->user_ptr[1];
10001 struct ocb_setup setup = {};
10002 int err;
10003
10004 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
10005 if (err)
10006 return err;
10007
10008 return cfg80211_join_ocb(rdev, dev, &setup);
10009 }
10010
10011 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
10012 {
10013 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10014 struct net_device *dev = info->user_ptr[1];
10015
10016 return cfg80211_leave_ocb(rdev, dev);
10017 }
10018
10019 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
10020 {
10021 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10022 struct net_device *dev = info->user_ptr[1];
10023 struct mesh_config cfg;
10024 struct mesh_setup setup;
10025 int err;
10026
10027 /* start with default */
10028 memcpy(&cfg, &default_mesh_config, sizeof(cfg));
10029 memcpy(&setup, &default_mesh_setup, sizeof(setup));
10030
10031 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
10032 /* and parse parameters if given */
10033 err = nl80211_parse_mesh_config(info, &cfg, NULL);
10034 if (err)
10035 return err;
10036 }
10037
10038 if (!info->attrs[NL80211_ATTR_MESH_ID] ||
10039 !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
10040 return -EINVAL;
10041
10042 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
10043 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
10044
10045 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
10046 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
10047 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
10048 return -EINVAL;
10049
10050 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
10051 setup.beacon_interval =
10052 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
10053
10054 err = cfg80211_validate_beacon_int(rdev,
10055 NL80211_IFTYPE_MESH_POINT,
10056 setup.beacon_interval);
10057 if (err)
10058 return err;
10059 }
10060
10061 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
10062 setup.dtim_period =
10063 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
10064 if (setup.dtim_period < 1 || setup.dtim_period > 100)
10065 return -EINVAL;
10066 }
10067
10068 if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
10069 /* parse additional setup parameters if given */
10070 err = nl80211_parse_mesh_setup(info, &setup);
10071 if (err)
10072 return err;
10073 }
10074
10075 if (setup.user_mpm)
10076 cfg.auto_open_plinks = false;
10077
10078 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
10079 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
10080 if (err)
10081 return err;
10082 } else {
10083 /* cfg80211_join_mesh() will sort it out */
10084 setup.chandef.chan = NULL;
10085 }
10086
10087 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
10088 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
10089 int n_rates =
10090 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
10091 struct ieee80211_supported_band *sband;
10092
10093 if (!setup.chandef.chan)
10094 return -EINVAL;
10095
10096 sband = rdev->wiphy.bands[setup.chandef.chan->band];
10097
10098 err = ieee80211_get_ratemask(sband, rates, n_rates,
10099 &setup.basic_rates);
10100 if (err)
10101 return err;
10102 }
10103
10104 if (info->attrs[NL80211_ATTR_TX_RATES]) {
10105 err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
10106 if (err)
10107 return err;
10108
10109 if (!setup.chandef.chan)
10110 return -EINVAL;
10111
10112 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
10113 &setup.beacon_rate);
10114 if (err)
10115 return err;
10116 }
10117
10118 setup.userspace_handles_dfs =
10119 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
10120
10121 return cfg80211_join_mesh(rdev, dev, &setup, &cfg);
10122 }
10123
10124 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
10125 {
10126 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10127 struct net_device *dev = info->user_ptr[1];
10128
10129 return cfg80211_leave_mesh(rdev, dev);
10130 }
10131
10132 #ifdef CONFIG_PM
10133 static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
10134 struct cfg80211_registered_device *rdev)
10135 {
10136 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
10137 struct nlattr *nl_pats, *nl_pat;
10138 int i, pat_len;
10139
10140 if (!wowlan->n_patterns)
10141 return 0;
10142
10143 nl_pats = nla_nest_start(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
10144 if (!nl_pats)
10145 return -ENOBUFS;
10146
10147 for (i = 0; i < wowlan->n_patterns; i++) {
10148 nl_pat = nla_nest_start(msg, i + 1);
10149 if (!nl_pat)
10150 return -ENOBUFS;
10151 pat_len = wowlan->patterns[i].pattern_len;
10152 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
10153 wowlan->patterns[i].mask) ||
10154 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
10155 wowlan->patterns[i].pattern) ||
10156 nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
10157 wowlan->patterns[i].pkt_offset))
10158 return -ENOBUFS;
10159 nla_nest_end(msg, nl_pat);
10160 }
10161 nla_nest_end(msg, nl_pats);
10162
10163 return 0;
10164 }
10165
10166 static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
10167 struct cfg80211_wowlan_tcp *tcp)
10168 {
10169 struct nlattr *nl_tcp;
10170
10171 if (!tcp)
10172 return 0;
10173
10174 nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
10175 if (!nl_tcp)
10176 return -ENOBUFS;
10177
10178 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
10179 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
10180 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
10181 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
10182 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
10183 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
10184 tcp->payload_len, tcp->payload) ||
10185 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
10186 tcp->data_interval) ||
10187 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
10188 tcp->wake_len, tcp->wake_data) ||
10189 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
10190 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
10191 return -ENOBUFS;
10192
10193 if (tcp->payload_seq.len &&
10194 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
10195 sizeof(tcp->payload_seq), &tcp->payload_seq))
10196 return -ENOBUFS;
10197
10198 if (tcp->payload_tok.len &&
10199 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
10200 sizeof(tcp->payload_tok) + tcp->tokens_size,
10201 &tcp->payload_tok))
10202 return -ENOBUFS;
10203
10204 nla_nest_end(msg, nl_tcp);
10205
10206 return 0;
10207 }
10208
10209 static int nl80211_send_wowlan_nd(struct sk_buff *msg,
10210 struct cfg80211_sched_scan_request *req)
10211 {
10212 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
10213 int i;
10214
10215 if (!req)
10216 return 0;
10217
10218 nd = nla_nest_start(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
10219 if (!nd)
10220 return -ENOBUFS;
10221
10222 if (req->n_scan_plans == 1 &&
10223 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
10224 req->scan_plans[0].interval * 1000))
10225 return -ENOBUFS;
10226
10227 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
10228 return -ENOBUFS;
10229
10230 if (req->relative_rssi_set) {
10231 struct nl80211_bss_select_rssi_adjust rssi_adjust;
10232
10233 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
10234 req->relative_rssi))
10235 return -ENOBUFS;
10236
10237 rssi_adjust.band = req->rssi_adjust.band;
10238 rssi_adjust.delta = req->rssi_adjust.delta;
10239 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
10240 sizeof(rssi_adjust), &rssi_adjust))
10241 return -ENOBUFS;
10242 }
10243
10244 freqs = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
10245 if (!freqs)
10246 return -ENOBUFS;
10247
10248 for (i = 0; i < req->n_channels; i++) {
10249 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
10250 return -ENOBUFS;
10251 }
10252
10253 nla_nest_end(msg, freqs);
10254
10255 if (req->n_match_sets) {
10256 matches = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_MATCH);
10257 if (!matches)
10258 return -ENOBUFS;
10259
10260 for (i = 0; i < req->n_match_sets; i++) {
10261 match = nla_nest_start(msg, i);
10262 if (!match)
10263 return -ENOBUFS;
10264
10265 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
10266 req->match_sets[i].ssid.ssid_len,
10267 req->match_sets[i].ssid.ssid))
10268 return -ENOBUFS;
10269 nla_nest_end(msg, match);
10270 }
10271 nla_nest_end(msg, matches);
10272 }
10273
10274 scan_plans = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
10275 if (!scan_plans)
10276 return -ENOBUFS;
10277
10278 for (i = 0; i < req->n_scan_plans; i++) {
10279 scan_plan = nla_nest_start(msg, i + 1);
10280 if (!scan_plan)
10281 return -ENOBUFS;
10282
10283 if (!scan_plan ||
10284 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
10285 req->scan_plans[i].interval) ||
10286 (req->scan_plans[i].iterations &&
10287 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
10288 req->scan_plans[i].iterations)))
10289 return -ENOBUFS;
10290 nla_nest_end(msg, scan_plan);
10291 }
10292 nla_nest_end(msg, scan_plans);
10293
10294 nla_nest_end(msg, nd);
10295
10296 return 0;
10297 }
10298
10299 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
10300 {
10301 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10302 struct sk_buff *msg;
10303 void *hdr;
10304 u32 size = NLMSG_DEFAULT_SIZE;
10305
10306 if (!rdev->wiphy.wowlan)
10307 return -EOPNOTSUPP;
10308
10309 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
10310 /* adjust size to have room for all the data */
10311 size += rdev->wiphy.wowlan_config->tcp->tokens_size +
10312 rdev->wiphy.wowlan_config->tcp->payload_len +
10313 rdev->wiphy.wowlan_config->tcp->wake_len +
10314 rdev->wiphy.wowlan_config->tcp->wake_len / 8;
10315 }
10316
10317 msg = nlmsg_new(size, GFP_KERNEL);
10318 if (!msg)
10319 return -ENOMEM;
10320
10321 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10322 NL80211_CMD_GET_WOWLAN);
10323 if (!hdr)
10324 goto nla_put_failure;
10325
10326 if (rdev->wiphy.wowlan_config) {
10327 struct nlattr *nl_wowlan;
10328
10329 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
10330 if (!nl_wowlan)
10331 goto nla_put_failure;
10332
10333 if ((rdev->wiphy.wowlan_config->any &&
10334 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
10335 (rdev->wiphy.wowlan_config->disconnect &&
10336 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
10337 (rdev->wiphy.wowlan_config->magic_pkt &&
10338 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
10339 (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
10340 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
10341 (rdev->wiphy.wowlan_config->eap_identity_req &&
10342 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
10343 (rdev->wiphy.wowlan_config->four_way_handshake &&
10344 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
10345 (rdev->wiphy.wowlan_config->rfkill_release &&
10346 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
10347 goto nla_put_failure;
10348
10349 if (nl80211_send_wowlan_patterns(msg, rdev))
10350 goto nla_put_failure;
10351
10352 if (nl80211_send_wowlan_tcp(msg,
10353 rdev->wiphy.wowlan_config->tcp))
10354 goto nla_put_failure;
10355
10356 if (nl80211_send_wowlan_nd(
10357 msg,
10358 rdev->wiphy.wowlan_config->nd_config))
10359 goto nla_put_failure;
10360
10361 nla_nest_end(msg, nl_wowlan);
10362 }
10363
10364 genlmsg_end(msg, hdr);
10365 return genlmsg_reply(msg, info);
10366
10367 nla_put_failure:
10368 nlmsg_free(msg);
10369 return -ENOBUFS;
10370 }
10371
10372 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
10373 struct nlattr *attr,
10374 struct cfg80211_wowlan *trig)
10375 {
10376 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
10377 struct cfg80211_wowlan_tcp *cfg;
10378 struct nl80211_wowlan_tcp_data_token *tok = NULL;
10379 struct nl80211_wowlan_tcp_data_seq *seq = NULL;
10380 u32 size;
10381 u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
10382 int err, port;
10383
10384 if (!rdev->wiphy.wowlan->tcp)
10385 return -EINVAL;
10386
10387 err = nla_parse_nested(tb, MAX_NL80211_WOWLAN_TCP, attr,
10388 nl80211_wowlan_tcp_policy, NULL);
10389 if (err)
10390 return err;
10391
10392 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
10393 !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
10394 !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
10395 !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
10396 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
10397 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
10398 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
10399 !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
10400 return -EINVAL;
10401
10402 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
10403 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
10404 return -EINVAL;
10405
10406 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
10407 rdev->wiphy.wowlan->tcp->data_interval_max ||
10408 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
10409 return -EINVAL;
10410
10411 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
10412 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
10413 return -EINVAL;
10414
10415 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
10416 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
10417 return -EINVAL;
10418
10419 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
10420 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
10421
10422 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
10423 tokens_size = tokln - sizeof(*tok);
10424
10425 if (!tok->len || tokens_size % tok->len)
10426 return -EINVAL;
10427 if (!rdev->wiphy.wowlan->tcp->tok)
10428 return -EINVAL;
10429 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
10430 return -EINVAL;
10431 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
10432 return -EINVAL;
10433 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
10434 return -EINVAL;
10435 if (tok->offset + tok->len > data_size)
10436 return -EINVAL;
10437 }
10438
10439 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
10440 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
10441 if (!rdev->wiphy.wowlan->tcp->seq)
10442 return -EINVAL;
10443 if (seq->len == 0 || seq->len > 4)
10444 return -EINVAL;
10445 if (seq->len + seq->offset > data_size)
10446 return -EINVAL;
10447 }
10448
10449 size = sizeof(*cfg);
10450 size += data_size;
10451 size += wake_size + wake_mask_size;
10452 size += tokens_size;
10453
10454 cfg = kzalloc(size, GFP_KERNEL);
10455 if (!cfg)
10456 return -ENOMEM;
10457 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
10458 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
10459 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
10460 ETH_ALEN);
10461 if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
10462 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
10463 else
10464 port = 0;
10465 #ifdef CONFIG_INET
10466 /* allocate a socket and port for it and use it */
10467 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
10468 IPPROTO_TCP, &cfg->sock, 1);
10469 if (err) {
10470 kfree(cfg);
10471 return err;
10472 }
10473 if (inet_csk_get_port(cfg->sock->sk, port)) {
10474 sock_release(cfg->sock);
10475 kfree(cfg);
10476 return -EADDRINUSE;
10477 }
10478 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
10479 #else
10480 if (!port) {
10481 kfree(cfg);
10482 return -EINVAL;
10483 }
10484 cfg->src_port = port;
10485 #endif
10486
10487 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
10488 cfg->payload_len = data_size;
10489 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
10490 memcpy((void *)cfg->payload,
10491 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
10492 data_size);
10493 if (seq)
10494 cfg->payload_seq = *seq;
10495 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
10496 cfg->wake_len = wake_size;
10497 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
10498 memcpy((void *)cfg->wake_data,
10499 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
10500 wake_size);
10501 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
10502 data_size + wake_size;
10503 memcpy((void *)cfg->wake_mask,
10504 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
10505 wake_mask_size);
10506 if (tok) {
10507 cfg->tokens_size = tokens_size;
10508 memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
10509 }
10510
10511 trig->tcp = cfg;
10512
10513 return 0;
10514 }
10515
10516 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
10517 const struct wiphy_wowlan_support *wowlan,
10518 struct nlattr *attr,
10519 struct cfg80211_wowlan *trig)
10520 {
10521 struct nlattr **tb;
10522 int err;
10523
10524 tb = kzalloc(NUM_NL80211_ATTR * sizeof(*tb), GFP_KERNEL);
10525 if (!tb)
10526 return -ENOMEM;
10527
10528 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
10529 err = -EOPNOTSUPP;
10530 goto out;
10531 }
10532
10533 err = nla_parse_nested(tb, NL80211_ATTR_MAX, attr, nl80211_policy,
10534 NULL);
10535 if (err)
10536 goto out;
10537
10538 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
10539 wowlan->max_nd_match_sets);
10540 err = PTR_ERR_OR_ZERO(trig->nd_config);
10541 if (err)
10542 trig->nd_config = NULL;
10543
10544 out:
10545 kfree(tb);
10546 return err;
10547 }
10548
10549 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
10550 {
10551 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10552 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
10553 struct cfg80211_wowlan new_triggers = {};
10554 struct cfg80211_wowlan *ntrig;
10555 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
10556 int err, i;
10557 bool prev_enabled = rdev->wiphy.wowlan_config;
10558 bool regular = false;
10559
10560 if (!wowlan)
10561 return -EOPNOTSUPP;
10562
10563 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
10564 cfg80211_rdev_free_wowlan(rdev);
10565 rdev->wiphy.wowlan_config = NULL;
10566 goto set_wakeup;
10567 }
10568
10569 err = nla_parse_nested(tb, MAX_NL80211_WOWLAN_TRIG,
10570 info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
10571 nl80211_wowlan_policy, info->extack);
10572 if (err)
10573 return err;
10574
10575 if (tb[NL80211_WOWLAN_TRIG_ANY]) {
10576 if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
10577 return -EINVAL;
10578 new_triggers.any = true;
10579 }
10580
10581 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
10582 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
10583 return -EINVAL;
10584 new_triggers.disconnect = true;
10585 regular = true;
10586 }
10587
10588 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
10589 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
10590 return -EINVAL;
10591 new_triggers.magic_pkt = true;
10592 regular = true;
10593 }
10594
10595 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
10596 return -EINVAL;
10597
10598 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
10599 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
10600 return -EINVAL;
10601 new_triggers.gtk_rekey_failure = true;
10602 regular = true;
10603 }
10604
10605 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
10606 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
10607 return -EINVAL;
10608 new_triggers.eap_identity_req = true;
10609 regular = true;
10610 }
10611
10612 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
10613 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
10614 return -EINVAL;
10615 new_triggers.four_way_handshake = true;
10616 regular = true;
10617 }
10618
10619 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
10620 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
10621 return -EINVAL;
10622 new_triggers.rfkill_release = true;
10623 regular = true;
10624 }
10625
10626 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
10627 struct nlattr *pat;
10628 int n_patterns = 0;
10629 int rem, pat_len, mask_len, pkt_offset;
10630 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
10631
10632 regular = true;
10633
10634 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
10635 rem)
10636 n_patterns++;
10637 if (n_patterns > wowlan->n_patterns)
10638 return -EINVAL;
10639
10640 new_triggers.patterns = kcalloc(n_patterns,
10641 sizeof(new_triggers.patterns[0]),
10642 GFP_KERNEL);
10643 if (!new_triggers.patterns)
10644 return -ENOMEM;
10645
10646 new_triggers.n_patterns = n_patterns;
10647 i = 0;
10648
10649 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
10650 rem) {
10651 u8 *mask_pat;
10652
10653 err = nla_parse_nested(pat_tb, MAX_NL80211_PKTPAT, pat,
10654 nl80211_packet_pattern_policy,
10655 info->extack);
10656 if (err)
10657 goto error;
10658
10659 err = -EINVAL;
10660 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10661 !pat_tb[NL80211_PKTPAT_PATTERN])
10662 goto error;
10663 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
10664 mask_len = DIV_ROUND_UP(pat_len, 8);
10665 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
10666 goto error;
10667 if (pat_len > wowlan->pattern_max_len ||
10668 pat_len < wowlan->pattern_min_len)
10669 goto error;
10670
10671 if (!pat_tb[NL80211_PKTPAT_OFFSET])
10672 pkt_offset = 0;
10673 else
10674 pkt_offset = nla_get_u32(
10675 pat_tb[NL80211_PKTPAT_OFFSET]);
10676 if (pkt_offset > wowlan->max_pkt_offset)
10677 goto error;
10678 new_triggers.patterns[i].pkt_offset = pkt_offset;
10679
10680 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10681 if (!mask_pat) {
10682 err = -ENOMEM;
10683 goto error;
10684 }
10685 new_triggers.patterns[i].mask = mask_pat;
10686 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
10687 mask_len);
10688 mask_pat += mask_len;
10689 new_triggers.patterns[i].pattern = mask_pat;
10690 new_triggers.patterns[i].pattern_len = pat_len;
10691 memcpy(mask_pat,
10692 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
10693 pat_len);
10694 i++;
10695 }
10696 }
10697
10698 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
10699 regular = true;
10700 err = nl80211_parse_wowlan_tcp(
10701 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
10702 &new_triggers);
10703 if (err)
10704 goto error;
10705 }
10706
10707 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
10708 regular = true;
10709 err = nl80211_parse_wowlan_nd(
10710 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
10711 &new_triggers);
10712 if (err)
10713 goto error;
10714 }
10715
10716 /* The 'any' trigger means the device continues operating more or less
10717 * as in its normal operation mode and wakes up the host on most of the
10718 * normal interrupts (like packet RX, ...)
10719 * It therefore makes little sense to combine with the more constrained
10720 * wakeup trigger modes.
10721 */
10722 if (new_triggers.any && regular) {
10723 err = -EINVAL;
10724 goto error;
10725 }
10726
10727 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
10728 if (!ntrig) {
10729 err = -ENOMEM;
10730 goto error;
10731 }
10732 cfg80211_rdev_free_wowlan(rdev);
10733 rdev->wiphy.wowlan_config = ntrig;
10734
10735 set_wakeup:
10736 if (rdev->ops->set_wakeup &&
10737 prev_enabled != !!rdev->wiphy.wowlan_config)
10738 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
10739
10740 return 0;
10741 error:
10742 for (i = 0; i < new_triggers.n_patterns; i++)
10743 kfree(new_triggers.patterns[i].mask);
10744 kfree(new_triggers.patterns);
10745 if (new_triggers.tcp && new_triggers.tcp->sock)
10746 sock_release(new_triggers.tcp->sock);
10747 kfree(new_triggers.tcp);
10748 kfree(new_triggers.nd_config);
10749 return err;
10750 }
10751 #endif
10752
10753 static int nl80211_send_coalesce_rules(struct sk_buff *msg,
10754 struct cfg80211_registered_device *rdev)
10755 {
10756 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
10757 int i, j, pat_len;
10758 struct cfg80211_coalesce_rules *rule;
10759
10760 if (!rdev->coalesce->n_rules)
10761 return 0;
10762
10763 nl_rules = nla_nest_start(msg, NL80211_ATTR_COALESCE_RULE);
10764 if (!nl_rules)
10765 return -ENOBUFS;
10766
10767 for (i = 0; i < rdev->coalesce->n_rules; i++) {
10768 nl_rule = nla_nest_start(msg, i + 1);
10769 if (!nl_rule)
10770 return -ENOBUFS;
10771
10772 rule = &rdev->coalesce->rules[i];
10773 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
10774 rule->delay))
10775 return -ENOBUFS;
10776
10777 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
10778 rule->condition))
10779 return -ENOBUFS;
10780
10781 nl_pats = nla_nest_start(msg,
10782 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
10783 if (!nl_pats)
10784 return -ENOBUFS;
10785
10786 for (j = 0; j < rule->n_patterns; j++) {
10787 nl_pat = nla_nest_start(msg, j + 1);
10788 if (!nl_pat)
10789 return -ENOBUFS;
10790 pat_len = rule->patterns[j].pattern_len;
10791 if (nla_put(msg, NL80211_PKTPAT_MASK,
10792 DIV_ROUND_UP(pat_len, 8),
10793 rule->patterns[j].mask) ||
10794 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
10795 rule->patterns[j].pattern) ||
10796 nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
10797 rule->patterns[j].pkt_offset))
10798 return -ENOBUFS;
10799 nla_nest_end(msg, nl_pat);
10800 }
10801 nla_nest_end(msg, nl_pats);
10802 nla_nest_end(msg, nl_rule);
10803 }
10804 nla_nest_end(msg, nl_rules);
10805
10806 return 0;
10807 }
10808
10809 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
10810 {
10811 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10812 struct sk_buff *msg;
10813 void *hdr;
10814
10815 if (!rdev->wiphy.coalesce)
10816 return -EOPNOTSUPP;
10817
10818 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10819 if (!msg)
10820 return -ENOMEM;
10821
10822 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10823 NL80211_CMD_GET_COALESCE);
10824 if (!hdr)
10825 goto nla_put_failure;
10826
10827 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
10828 goto nla_put_failure;
10829
10830 genlmsg_end(msg, hdr);
10831 return genlmsg_reply(msg, info);
10832
10833 nla_put_failure:
10834 nlmsg_free(msg);
10835 return -ENOBUFS;
10836 }
10837
10838 void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
10839 {
10840 struct cfg80211_coalesce *coalesce = rdev->coalesce;
10841 int i, j;
10842 struct cfg80211_coalesce_rules *rule;
10843
10844 if (!coalesce)
10845 return;
10846
10847 for (i = 0; i < coalesce->n_rules; i++) {
10848 rule = &coalesce->rules[i];
10849 for (j = 0; j < rule->n_patterns; j++)
10850 kfree(rule->patterns[j].mask);
10851 kfree(rule->patterns);
10852 }
10853 kfree(coalesce->rules);
10854 kfree(coalesce);
10855 rdev->coalesce = NULL;
10856 }
10857
10858 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
10859 struct nlattr *rule,
10860 struct cfg80211_coalesce_rules *new_rule)
10861 {
10862 int err, i;
10863 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10864 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
10865 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
10866 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
10867
10868 err = nla_parse_nested(tb, NL80211_ATTR_COALESCE_RULE_MAX, rule,
10869 nl80211_coalesce_policy, NULL);
10870 if (err)
10871 return err;
10872
10873 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
10874 new_rule->delay =
10875 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
10876 if (new_rule->delay > coalesce->max_delay)
10877 return -EINVAL;
10878
10879 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
10880 new_rule->condition =
10881 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
10882 if (new_rule->condition != NL80211_COALESCE_CONDITION_MATCH &&
10883 new_rule->condition != NL80211_COALESCE_CONDITION_NO_MATCH)
10884 return -EINVAL;
10885
10886 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
10887 return -EINVAL;
10888
10889 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10890 rem)
10891 n_patterns++;
10892 if (n_patterns > coalesce->n_patterns)
10893 return -EINVAL;
10894
10895 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
10896 GFP_KERNEL);
10897 if (!new_rule->patterns)
10898 return -ENOMEM;
10899
10900 new_rule->n_patterns = n_patterns;
10901 i = 0;
10902
10903 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10904 rem) {
10905 u8 *mask_pat;
10906
10907 err = nla_parse_nested(pat_tb, MAX_NL80211_PKTPAT, pat,
10908 nl80211_packet_pattern_policy, NULL);
10909 if (err)
10910 return err;
10911
10912 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10913 !pat_tb[NL80211_PKTPAT_PATTERN])
10914 return -EINVAL;
10915 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
10916 mask_len = DIV_ROUND_UP(pat_len, 8);
10917 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
10918 return -EINVAL;
10919 if (pat_len > coalesce->pattern_max_len ||
10920 pat_len < coalesce->pattern_min_len)
10921 return -EINVAL;
10922
10923 if (!pat_tb[NL80211_PKTPAT_OFFSET])
10924 pkt_offset = 0;
10925 else
10926 pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
10927 if (pkt_offset > coalesce->max_pkt_offset)
10928 return -EINVAL;
10929 new_rule->patterns[i].pkt_offset = pkt_offset;
10930
10931 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10932 if (!mask_pat)
10933 return -ENOMEM;
10934
10935 new_rule->patterns[i].mask = mask_pat;
10936 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
10937 mask_len);
10938
10939 mask_pat += mask_len;
10940 new_rule->patterns[i].pattern = mask_pat;
10941 new_rule->patterns[i].pattern_len = pat_len;
10942 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
10943 pat_len);
10944 i++;
10945 }
10946
10947 return 0;
10948 }
10949
10950 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
10951 {
10952 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10953 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10954 struct cfg80211_coalesce new_coalesce = {};
10955 struct cfg80211_coalesce *n_coalesce;
10956 int err, rem_rule, n_rules = 0, i, j;
10957 struct nlattr *rule;
10958 struct cfg80211_coalesce_rules *tmp_rule;
10959
10960 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
10961 return -EOPNOTSUPP;
10962
10963 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
10964 cfg80211_rdev_free_coalesce(rdev);
10965 rdev_set_coalesce(rdev, NULL);
10966 return 0;
10967 }
10968
10969 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10970 rem_rule)
10971 n_rules++;
10972 if (n_rules > coalesce->n_rules)
10973 return -EINVAL;
10974
10975 new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
10976 GFP_KERNEL);
10977 if (!new_coalesce.rules)
10978 return -ENOMEM;
10979
10980 new_coalesce.n_rules = n_rules;
10981 i = 0;
10982
10983 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10984 rem_rule) {
10985 err = nl80211_parse_coalesce_rule(rdev, rule,
10986 &new_coalesce.rules[i]);
10987 if (err)
10988 goto error;
10989
10990 i++;
10991 }
10992
10993 err = rdev_set_coalesce(rdev, &new_coalesce);
10994 if (err)
10995 goto error;
10996
10997 n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
10998 if (!n_coalesce) {
10999 err = -ENOMEM;
11000 goto error;
11001 }
11002 cfg80211_rdev_free_coalesce(rdev);
11003 rdev->coalesce = n_coalesce;
11004
11005 return 0;
11006 error:
11007 for (i = 0; i < new_coalesce.n_rules; i++) {
11008 tmp_rule = &new_coalesce.rules[i];
11009 for (j = 0; j < tmp_rule->n_patterns; j++)
11010 kfree(tmp_rule->patterns[j].mask);
11011 kfree(tmp_rule->patterns);
11012 }
11013 kfree(new_coalesce.rules);
11014
11015 return err;
11016 }
11017
11018 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
11019 {
11020 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11021 struct net_device *dev = info->user_ptr[1];
11022 struct wireless_dev *wdev = dev->ieee80211_ptr;
11023 struct nlattr *tb[NUM_NL80211_REKEY_DATA];
11024 struct cfg80211_gtk_rekey_data rekey_data;
11025 int err;
11026
11027 if (!info->attrs[NL80211_ATTR_REKEY_DATA])
11028 return -EINVAL;
11029
11030 err = nla_parse_nested(tb, MAX_NL80211_REKEY_DATA,
11031 info->attrs[NL80211_ATTR_REKEY_DATA],
11032 nl80211_rekey_policy, info->extack);
11033 if (err)
11034 return err;
11035
11036 if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] ||
11037 !tb[NL80211_REKEY_DATA_KCK])
11038 return -EINVAL;
11039 if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
11040 return -ERANGE;
11041 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
11042 return -ERANGE;
11043 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
11044 return -ERANGE;
11045
11046 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
11047 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
11048 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
11049
11050 wdev_lock(wdev);
11051 if (!wdev->current_bss) {
11052 err = -ENOTCONN;
11053 goto out;
11054 }
11055
11056 if (!rdev->ops->set_rekey_data) {
11057 err = -EOPNOTSUPP;
11058 goto out;
11059 }
11060
11061 err = rdev_set_rekey_data(rdev, dev, &rekey_data);
11062 out:
11063 wdev_unlock(wdev);
11064 return err;
11065 }
11066
11067 static int nl80211_register_unexpected_frame(struct sk_buff *skb,
11068 struct genl_info *info)
11069 {
11070 struct net_device *dev = info->user_ptr[1];
11071 struct wireless_dev *wdev = dev->ieee80211_ptr;
11072
11073 if (wdev->iftype != NL80211_IFTYPE_AP &&
11074 wdev->iftype != NL80211_IFTYPE_P2P_GO)
11075 return -EINVAL;
11076
11077 if (wdev->ap_unexpected_nlportid)
11078 return -EBUSY;
11079
11080 wdev->ap_unexpected_nlportid = info->snd_portid;
11081 return 0;
11082 }
11083
11084 static int nl80211_probe_client(struct sk_buff *skb,
11085 struct genl_info *info)
11086 {
11087 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11088 struct net_device *dev = info->user_ptr[1];
11089 struct wireless_dev *wdev = dev->ieee80211_ptr;
11090 struct sk_buff *msg;
11091 void *hdr;
11092 const u8 *addr;
11093 u64 cookie;
11094 int err;
11095
11096 if (wdev->iftype != NL80211_IFTYPE_AP &&
11097 wdev->iftype != NL80211_IFTYPE_P2P_GO)
11098 return -EOPNOTSUPP;
11099
11100 if (!info->attrs[NL80211_ATTR_MAC])
11101 return -EINVAL;
11102
11103 if (!rdev->ops->probe_client)
11104 return -EOPNOTSUPP;
11105
11106 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11107 if (!msg)
11108 return -ENOMEM;
11109
11110 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11111 NL80211_CMD_PROBE_CLIENT);
11112 if (!hdr) {
11113 err = -ENOBUFS;
11114 goto free_msg;
11115 }
11116
11117 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
11118
11119 err = rdev_probe_client(rdev, dev, addr, &cookie);
11120 if (err)
11121 goto free_msg;
11122
11123 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
11124 NL80211_ATTR_PAD))
11125 goto nla_put_failure;
11126
11127 genlmsg_end(msg, hdr);
11128
11129 return genlmsg_reply(msg, info);
11130
11131 nla_put_failure:
11132 err = -ENOBUFS;
11133 free_msg:
11134 nlmsg_free(msg);
11135 return err;
11136 }
11137
11138 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
11139 {
11140 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11141 struct cfg80211_beacon_registration *reg, *nreg;
11142 int rv;
11143
11144 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
11145 return -EOPNOTSUPP;
11146
11147 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
11148 if (!nreg)
11149 return -ENOMEM;
11150
11151 /* First, check if already registered. */
11152 spin_lock_bh(&rdev->beacon_registrations_lock);
11153 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
11154 if (reg->nlportid == info->snd_portid) {
11155 rv = -EALREADY;
11156 goto out_err;
11157 }
11158 }
11159 /* Add it to the list */
11160 nreg->nlportid = info->snd_portid;
11161 list_add(&nreg->list, &rdev->beacon_registrations);
11162
11163 spin_unlock_bh(&rdev->beacon_registrations_lock);
11164
11165 return 0;
11166 out_err:
11167 spin_unlock_bh(&rdev->beacon_registrations_lock);
11168 kfree(nreg);
11169 return rv;
11170 }
11171
11172 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
11173 {
11174 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11175 struct wireless_dev *wdev = info->user_ptr[1];
11176 int err;
11177
11178 if (!rdev->ops->start_p2p_device)
11179 return -EOPNOTSUPP;
11180
11181 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
11182 return -EOPNOTSUPP;
11183
11184 if (wdev_running(wdev))
11185 return 0;
11186
11187 if (rfkill_blocked(rdev->rfkill))
11188 return -ERFKILL;
11189
11190 err = rdev_start_p2p_device(rdev, wdev);
11191 if (err)
11192 return err;
11193
11194 wdev->is_running = true;
11195 rdev->opencount++;
11196
11197 return 0;
11198 }
11199
11200 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
11201 {
11202 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11203 struct wireless_dev *wdev = info->user_ptr[1];
11204
11205 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
11206 return -EOPNOTSUPP;
11207
11208 if (!rdev->ops->stop_p2p_device)
11209 return -EOPNOTSUPP;
11210
11211 cfg80211_stop_p2p_device(rdev, wdev);
11212
11213 return 0;
11214 }
11215
11216 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
11217 {
11218 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11219 struct wireless_dev *wdev = info->user_ptr[1];
11220 struct cfg80211_nan_conf conf = {};
11221 int err;
11222
11223 if (wdev->iftype != NL80211_IFTYPE_NAN)
11224 return -EOPNOTSUPP;
11225
11226 if (wdev_running(wdev))
11227 return -EEXIST;
11228
11229 if (rfkill_blocked(rdev->rfkill))
11230 return -ERFKILL;
11231
11232 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
11233 return -EINVAL;
11234
11235 conf.master_pref =
11236 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
11237 if (!conf.master_pref)
11238 return -EINVAL;
11239
11240 if (info->attrs[NL80211_ATTR_BANDS]) {
11241 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
11242
11243 if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
11244 return -EOPNOTSUPP;
11245
11246 if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
11247 return -EINVAL;
11248
11249 conf.bands = bands;
11250 }
11251
11252 err = rdev_start_nan(rdev, wdev, &conf);
11253 if (err)
11254 return err;
11255
11256 wdev->is_running = true;
11257 rdev->opencount++;
11258
11259 return 0;
11260 }
11261
11262 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
11263 {
11264 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11265 struct wireless_dev *wdev = info->user_ptr[1];
11266
11267 if (wdev->iftype != NL80211_IFTYPE_NAN)
11268 return -EOPNOTSUPP;
11269
11270 cfg80211_stop_nan(rdev, wdev);
11271
11272 return 0;
11273 }
11274
11275 static int validate_nan_filter(struct nlattr *filter_attr)
11276 {
11277 struct nlattr *attr;
11278 int len = 0, n_entries = 0, rem;
11279
11280 nla_for_each_nested(attr, filter_attr, rem) {
11281 len += nla_len(attr);
11282 n_entries++;
11283 }
11284
11285 if (len >= U8_MAX)
11286 return -EINVAL;
11287
11288 return n_entries;
11289 }
11290
11291 static int handle_nan_filter(struct nlattr *attr_filter,
11292 struct cfg80211_nan_func *func,
11293 bool tx)
11294 {
11295 struct nlattr *attr;
11296 int n_entries, rem, i;
11297 struct cfg80211_nan_func_filter *filter;
11298
11299 n_entries = validate_nan_filter(attr_filter);
11300 if (n_entries < 0)
11301 return n_entries;
11302
11303 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
11304
11305 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
11306 if (!filter)
11307 return -ENOMEM;
11308
11309 i = 0;
11310 nla_for_each_nested(attr, attr_filter, rem) {
11311 filter[i].filter = nla_memdup(attr, GFP_KERNEL);
11312 filter[i].len = nla_len(attr);
11313 i++;
11314 }
11315 if (tx) {
11316 func->num_tx_filters = n_entries;
11317 func->tx_filters = filter;
11318 } else {
11319 func->num_rx_filters = n_entries;
11320 func->rx_filters = filter;
11321 }
11322
11323 return 0;
11324 }
11325
11326 static int nl80211_nan_add_func(struct sk_buff *skb,
11327 struct genl_info *info)
11328 {
11329 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11330 struct wireless_dev *wdev = info->user_ptr[1];
11331 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
11332 struct cfg80211_nan_func *func;
11333 struct sk_buff *msg = NULL;
11334 void *hdr = NULL;
11335 int err = 0;
11336
11337 if (wdev->iftype != NL80211_IFTYPE_NAN)
11338 return -EOPNOTSUPP;
11339
11340 if (!wdev_running(wdev))
11341 return -ENOTCONN;
11342
11343 if (!info->attrs[NL80211_ATTR_NAN_FUNC])
11344 return -EINVAL;
11345
11346 err = nla_parse_nested(tb, NL80211_NAN_FUNC_ATTR_MAX,
11347 info->attrs[NL80211_ATTR_NAN_FUNC],
11348 nl80211_nan_func_policy, info->extack);
11349 if (err)
11350 return err;
11351
11352 func = kzalloc(sizeof(*func), GFP_KERNEL);
11353 if (!func)
11354 return -ENOMEM;
11355
11356 func->cookie = wdev->wiphy->cookie_counter++;
11357
11358 if (!tb[NL80211_NAN_FUNC_TYPE] ||
11359 nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
11360 err = -EINVAL;
11361 goto out;
11362 }
11363
11364
11365 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
11366
11367 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
11368 err = -EINVAL;
11369 goto out;
11370 }
11371
11372 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
11373 sizeof(func->service_id));
11374
11375 func->close_range =
11376 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
11377
11378 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
11379 func->serv_spec_info_len =
11380 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
11381 func->serv_spec_info =
11382 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
11383 func->serv_spec_info_len,
11384 GFP_KERNEL);
11385 if (!func->serv_spec_info) {
11386 err = -ENOMEM;
11387 goto out;
11388 }
11389 }
11390
11391 if (tb[NL80211_NAN_FUNC_TTL])
11392 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
11393
11394 switch (func->type) {
11395 case NL80211_NAN_FUNC_PUBLISH:
11396 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
11397 err = -EINVAL;
11398 goto out;
11399 }
11400
11401 func->publish_type =
11402 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
11403 func->publish_bcast =
11404 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
11405
11406 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
11407 func->publish_bcast) {
11408 err = -EINVAL;
11409 goto out;
11410 }
11411 break;
11412 case NL80211_NAN_FUNC_SUBSCRIBE:
11413 func->subscribe_active =
11414 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
11415 break;
11416 case NL80211_NAN_FUNC_FOLLOW_UP:
11417 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
11418 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
11419 !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
11420 err = -EINVAL;
11421 goto out;
11422 }
11423
11424 func->followup_id =
11425 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
11426 func->followup_reqid =
11427 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
11428 memcpy(func->followup_dest.addr,
11429 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
11430 sizeof(func->followup_dest.addr));
11431 if (func->ttl) {
11432 err = -EINVAL;
11433 goto out;
11434 }
11435 break;
11436 default:
11437 err = -EINVAL;
11438 goto out;
11439 }
11440
11441 if (tb[NL80211_NAN_FUNC_SRF]) {
11442 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
11443
11444 err = nla_parse_nested(srf_tb, NL80211_NAN_SRF_ATTR_MAX,
11445 tb[NL80211_NAN_FUNC_SRF],
11446 nl80211_nan_srf_policy, info->extack);
11447 if (err)
11448 goto out;
11449
11450 func->srf_include =
11451 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
11452
11453 if (srf_tb[NL80211_NAN_SRF_BF]) {
11454 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
11455 !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
11456 err = -EINVAL;
11457 goto out;
11458 }
11459
11460 func->srf_bf_len =
11461 nla_len(srf_tb[NL80211_NAN_SRF_BF]);
11462 func->srf_bf =
11463 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
11464 func->srf_bf_len, GFP_KERNEL);
11465 if (!func->srf_bf) {
11466 err = -ENOMEM;
11467 goto out;
11468 }
11469
11470 func->srf_bf_idx =
11471 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
11472 } else {
11473 struct nlattr *attr, *mac_attr =
11474 srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
11475 int n_entries, rem, i = 0;
11476
11477 if (!mac_attr) {
11478 err = -EINVAL;
11479 goto out;
11480 }
11481
11482 n_entries = validate_acl_mac_addrs(mac_attr);
11483 if (n_entries <= 0) {
11484 err = -EINVAL;
11485 goto out;
11486 }
11487
11488 func->srf_num_macs = n_entries;
11489 func->srf_macs =
11490 kzalloc(sizeof(*func->srf_macs) * n_entries,
11491 GFP_KERNEL);
11492 if (!func->srf_macs) {
11493 err = -ENOMEM;
11494 goto out;
11495 }
11496
11497 nla_for_each_nested(attr, mac_attr, rem)
11498 memcpy(func->srf_macs[i++].addr, nla_data(attr),
11499 sizeof(*func->srf_macs));
11500 }
11501 }
11502
11503 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
11504 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
11505 func, true);
11506 if (err)
11507 goto out;
11508 }
11509
11510 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
11511 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
11512 func, false);
11513 if (err)
11514 goto out;
11515 }
11516
11517 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11518 if (!msg) {
11519 err = -ENOMEM;
11520 goto out;
11521 }
11522
11523 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11524 NL80211_CMD_ADD_NAN_FUNCTION);
11525 /* This can't really happen - we just allocated 4KB */
11526 if (WARN_ON(!hdr)) {
11527 err = -ENOMEM;
11528 goto out;
11529 }
11530
11531 err = rdev_add_nan_func(rdev, wdev, func);
11532 out:
11533 if (err < 0) {
11534 cfg80211_free_nan_func(func);
11535 nlmsg_free(msg);
11536 return err;
11537 }
11538
11539 /* propagate the instance id and cookie to userspace */
11540 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
11541 NL80211_ATTR_PAD))
11542 goto nla_put_failure;
11543
11544 func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
11545 if (!func_attr)
11546 goto nla_put_failure;
11547
11548 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
11549 func->instance_id))
11550 goto nla_put_failure;
11551
11552 nla_nest_end(msg, func_attr);
11553
11554 genlmsg_end(msg, hdr);
11555 return genlmsg_reply(msg, info);
11556
11557 nla_put_failure:
11558 nlmsg_free(msg);
11559 return -ENOBUFS;
11560 }
11561
11562 static int nl80211_nan_del_func(struct sk_buff *skb,
11563 struct genl_info *info)
11564 {
11565 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11566 struct wireless_dev *wdev = info->user_ptr[1];
11567 u64 cookie;
11568
11569 if (wdev->iftype != NL80211_IFTYPE_NAN)
11570 return -EOPNOTSUPP;
11571
11572 if (!wdev_running(wdev))
11573 return -ENOTCONN;
11574
11575 if (!info->attrs[NL80211_ATTR_COOKIE])
11576 return -EINVAL;
11577
11578 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
11579
11580 rdev_del_nan_func(rdev, wdev, cookie);
11581
11582 return 0;
11583 }
11584
11585 static int nl80211_nan_change_config(struct sk_buff *skb,
11586 struct genl_info *info)
11587 {
11588 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11589 struct wireless_dev *wdev = info->user_ptr[1];
11590 struct cfg80211_nan_conf conf = {};
11591 u32 changed = 0;
11592
11593 if (wdev->iftype != NL80211_IFTYPE_NAN)
11594 return -EOPNOTSUPP;
11595
11596 if (!wdev_running(wdev))
11597 return -ENOTCONN;
11598
11599 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
11600 conf.master_pref =
11601 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
11602 if (conf.master_pref <= 1 || conf.master_pref == 255)
11603 return -EINVAL;
11604
11605 changed |= CFG80211_NAN_CONF_CHANGED_PREF;
11606 }
11607
11608 if (info->attrs[NL80211_ATTR_BANDS]) {
11609 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
11610
11611 if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
11612 return -EOPNOTSUPP;
11613
11614 if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
11615 return -EINVAL;
11616
11617 conf.bands = bands;
11618 changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
11619 }
11620
11621 if (!changed)
11622 return -EINVAL;
11623
11624 return rdev_nan_change_conf(rdev, wdev, &conf, changed);
11625 }
11626
11627 void cfg80211_nan_match(struct wireless_dev *wdev,
11628 struct cfg80211_nan_match_params *match, gfp_t gfp)
11629 {
11630 struct wiphy *wiphy = wdev->wiphy;
11631 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11632 struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
11633 struct sk_buff *msg;
11634 void *hdr;
11635
11636 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
11637 return;
11638
11639 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
11640 if (!msg)
11641 return;
11642
11643 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
11644 if (!hdr) {
11645 nlmsg_free(msg);
11646 return;
11647 }
11648
11649 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11650 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
11651 wdev->netdev->ifindex)) ||
11652 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
11653 NL80211_ATTR_PAD))
11654 goto nla_put_failure;
11655
11656 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
11657 NL80211_ATTR_PAD) ||
11658 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
11659 goto nla_put_failure;
11660
11661 match_attr = nla_nest_start(msg, NL80211_ATTR_NAN_MATCH);
11662 if (!match_attr)
11663 goto nla_put_failure;
11664
11665 local_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_LOCAL);
11666 if (!local_func_attr)
11667 goto nla_put_failure;
11668
11669 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
11670 goto nla_put_failure;
11671
11672 nla_nest_end(msg, local_func_attr);
11673
11674 peer_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_PEER);
11675 if (!peer_func_attr)
11676 goto nla_put_failure;
11677
11678 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
11679 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
11680 goto nla_put_failure;
11681
11682 if (match->info && match->info_len &&
11683 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
11684 match->info))
11685 goto nla_put_failure;
11686
11687 nla_nest_end(msg, peer_func_attr);
11688 nla_nest_end(msg, match_attr);
11689 genlmsg_end(msg, hdr);
11690
11691 if (!wdev->owner_nlportid)
11692 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11693 msg, 0, NL80211_MCGRP_NAN, gfp);
11694 else
11695 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11696 wdev->owner_nlportid);
11697
11698 return;
11699
11700 nla_put_failure:
11701 nlmsg_free(msg);
11702 }
11703 EXPORT_SYMBOL(cfg80211_nan_match);
11704
11705 void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
11706 u8 inst_id,
11707 enum nl80211_nan_func_term_reason reason,
11708 u64 cookie, gfp_t gfp)
11709 {
11710 struct wiphy *wiphy = wdev->wiphy;
11711 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11712 struct sk_buff *msg;
11713 struct nlattr *func_attr;
11714 void *hdr;
11715
11716 if (WARN_ON(!inst_id))
11717 return;
11718
11719 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
11720 if (!msg)
11721 return;
11722
11723 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
11724 if (!hdr) {
11725 nlmsg_free(msg);
11726 return;
11727 }
11728
11729 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11730 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
11731 wdev->netdev->ifindex)) ||
11732 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
11733 NL80211_ATTR_PAD))
11734 goto nla_put_failure;
11735
11736 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
11737 NL80211_ATTR_PAD))
11738 goto nla_put_failure;
11739
11740 func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
11741 if (!func_attr)
11742 goto nla_put_failure;
11743
11744 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
11745 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
11746 goto nla_put_failure;
11747
11748 nla_nest_end(msg, func_attr);
11749 genlmsg_end(msg, hdr);
11750
11751 if (!wdev->owner_nlportid)
11752 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11753 msg, 0, NL80211_MCGRP_NAN, gfp);
11754 else
11755 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11756 wdev->owner_nlportid);
11757
11758 return;
11759
11760 nla_put_failure:
11761 nlmsg_free(msg);
11762 }
11763 EXPORT_SYMBOL(cfg80211_nan_func_terminated);
11764
11765 static int nl80211_get_protocol_features(struct sk_buff *skb,
11766 struct genl_info *info)
11767 {
11768 void *hdr;
11769 struct sk_buff *msg;
11770
11771 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11772 if (!msg)
11773 return -ENOMEM;
11774
11775 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11776 NL80211_CMD_GET_PROTOCOL_FEATURES);
11777 if (!hdr)
11778 goto nla_put_failure;
11779
11780 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
11781 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
11782 goto nla_put_failure;
11783
11784 genlmsg_end(msg, hdr);
11785 return genlmsg_reply(msg, info);
11786
11787 nla_put_failure:
11788 kfree_skb(msg);
11789 return -ENOBUFS;
11790 }
11791
11792 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
11793 {
11794 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11795 struct cfg80211_update_ft_ies_params ft_params;
11796 struct net_device *dev = info->user_ptr[1];
11797
11798 if (!rdev->ops->update_ft_ies)
11799 return -EOPNOTSUPP;
11800
11801 if (!info->attrs[NL80211_ATTR_MDID] ||
11802 !info->attrs[NL80211_ATTR_IE] ||
11803 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
11804 return -EINVAL;
11805
11806 memset(&ft_params, 0, sizeof(ft_params));
11807 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
11808 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
11809 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
11810
11811 return rdev_update_ft_ies(rdev, dev, &ft_params);
11812 }
11813
11814 static int nl80211_crit_protocol_start(struct sk_buff *skb,
11815 struct genl_info *info)
11816 {
11817 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11818 struct wireless_dev *wdev = info->user_ptr[1];
11819 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
11820 u16 duration;
11821 int ret;
11822
11823 if (!rdev->ops->crit_proto_start)
11824 return -EOPNOTSUPP;
11825
11826 if (WARN_ON(!rdev->ops->crit_proto_stop))
11827 return -EINVAL;
11828
11829 if (rdev->crit_proto_nlportid)
11830 return -EBUSY;
11831
11832 /* determine protocol if provided */
11833 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
11834 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
11835
11836 if (proto >= NUM_NL80211_CRIT_PROTO)
11837 return -EINVAL;
11838
11839 /* timeout must be provided */
11840 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
11841 return -EINVAL;
11842
11843 duration =
11844 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
11845
11846 if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
11847 return -ERANGE;
11848
11849 ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
11850 if (!ret)
11851 rdev->crit_proto_nlportid = info->snd_portid;
11852
11853 return ret;
11854 }
11855
11856 static int nl80211_crit_protocol_stop(struct sk_buff *skb,
11857 struct genl_info *info)
11858 {
11859 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11860 struct wireless_dev *wdev = info->user_ptr[1];
11861
11862 if (!rdev->ops->crit_proto_stop)
11863 return -EOPNOTSUPP;
11864
11865 if (rdev->crit_proto_nlportid) {
11866 rdev->crit_proto_nlportid = 0;
11867 rdev_crit_proto_stop(rdev, wdev);
11868 }
11869 return 0;
11870 }
11871
11872 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
11873 {
11874 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11875 struct wireless_dev *wdev =
11876 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
11877 int i, err;
11878 u32 vid, subcmd;
11879
11880 if (!rdev->wiphy.vendor_commands)
11881 return -EOPNOTSUPP;
11882
11883 if (IS_ERR(wdev)) {
11884 err = PTR_ERR(wdev);
11885 if (err != -EINVAL)
11886 return err;
11887 wdev = NULL;
11888 } else if (wdev->wiphy != &rdev->wiphy) {
11889 return -EINVAL;
11890 }
11891
11892 if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
11893 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
11894 return -EINVAL;
11895
11896 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
11897 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
11898 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
11899 const struct wiphy_vendor_command *vcmd;
11900 void *data = NULL;
11901 int len = 0;
11902
11903 vcmd = &rdev->wiphy.vendor_commands[i];
11904
11905 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11906 continue;
11907
11908 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
11909 WIPHY_VENDOR_CMD_NEED_NETDEV)) {
11910 if (!wdev)
11911 return -EINVAL;
11912 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
11913 !wdev->netdev)
11914 return -EINVAL;
11915
11916 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
11917 if (!wdev_running(wdev))
11918 return -ENETDOWN;
11919 }
11920
11921 if (!vcmd->doit)
11922 return -EOPNOTSUPP;
11923 } else {
11924 wdev = NULL;
11925 }
11926
11927 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
11928 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11929 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11930 }
11931
11932 rdev->cur_cmd_info = info;
11933 err = rdev->wiphy.vendor_commands[i].doit(&rdev->wiphy, wdev,
11934 data, len);
11935 rdev->cur_cmd_info = NULL;
11936 return err;
11937 }
11938
11939 return -EOPNOTSUPP;
11940 }
11941
11942 static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
11943 struct netlink_callback *cb,
11944 struct cfg80211_registered_device **rdev,
11945 struct wireless_dev **wdev)
11946 {
11947 struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
11948 u32 vid, subcmd;
11949 unsigned int i;
11950 int vcmd_idx = -1;
11951 int err;
11952 void *data = NULL;
11953 unsigned int data_len = 0;
11954
11955 if (cb->args[0]) {
11956 /* subtract the 1 again here */
11957 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
11958 struct wireless_dev *tmp;
11959
11960 if (!wiphy)
11961 return -ENODEV;
11962 *rdev = wiphy_to_rdev(wiphy);
11963 *wdev = NULL;
11964
11965 if (cb->args[1]) {
11966 list_for_each_entry(tmp, &wiphy->wdev_list, list) {
11967 if (tmp->identifier == cb->args[1] - 1) {
11968 *wdev = tmp;
11969 break;
11970 }
11971 }
11972 }
11973
11974 /* keep rtnl locked in successful case */
11975 return 0;
11976 }
11977
11978 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize, attrbuf,
11979 nl80211_fam.maxattr, nl80211_policy, NULL);
11980 if (err)
11981 return err;
11982
11983 if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
11984 !attrbuf[NL80211_ATTR_VENDOR_SUBCMD])
11985 return -EINVAL;
11986
11987 *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk), attrbuf);
11988 if (IS_ERR(*wdev))
11989 *wdev = NULL;
11990
11991 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
11992 if (IS_ERR(*rdev))
11993 return PTR_ERR(*rdev);
11994
11995 vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
11996 subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
11997
11998 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
11999 const struct wiphy_vendor_command *vcmd;
12000
12001 vcmd = &(*rdev)->wiphy.vendor_commands[i];
12002
12003 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
12004 continue;
12005
12006 if (!vcmd->dumpit)
12007 return -EOPNOTSUPP;
12008
12009 vcmd_idx = i;
12010 break;
12011 }
12012
12013 if (vcmd_idx < 0)
12014 return -EOPNOTSUPP;
12015
12016 if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
12017 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
12018 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
12019 }
12020
12021 /* 0 is the first index - add 1 to parse only once */
12022 cb->args[0] = (*rdev)->wiphy_idx + 1;
12023 /* add 1 to know if it was NULL */
12024 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
12025 cb->args[2] = vcmd_idx;
12026 cb->args[3] = (unsigned long)data;
12027 cb->args[4] = data_len;
12028
12029 /* keep rtnl locked in successful case */
12030 return 0;
12031 }
12032
12033 static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
12034 struct netlink_callback *cb)
12035 {
12036 struct cfg80211_registered_device *rdev;
12037 struct wireless_dev *wdev;
12038 unsigned int vcmd_idx;
12039 const struct wiphy_vendor_command *vcmd;
12040 void *data;
12041 int data_len;
12042 int err;
12043 struct nlattr *vendor_data;
12044
12045 rtnl_lock();
12046 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
12047 if (err)
12048 goto out;
12049
12050 vcmd_idx = cb->args[2];
12051 data = (void *)cb->args[3];
12052 data_len = cb->args[4];
12053 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
12054
12055 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
12056 WIPHY_VENDOR_CMD_NEED_NETDEV)) {
12057 if (!wdev) {
12058 err = -EINVAL;
12059 goto out;
12060 }
12061 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
12062 !wdev->netdev) {
12063 err = -EINVAL;
12064 goto out;
12065 }
12066
12067 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
12068 if (!wdev_running(wdev)) {
12069 err = -ENETDOWN;
12070 goto out;
12071 }
12072 }
12073 }
12074
12075 while (1) {
12076 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
12077 cb->nlh->nlmsg_seq, NLM_F_MULTI,
12078 NL80211_CMD_VENDOR);
12079 if (!hdr)
12080 break;
12081
12082 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12083 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
12084 wdev_id(wdev),
12085 NL80211_ATTR_PAD))) {
12086 genlmsg_cancel(skb, hdr);
12087 break;
12088 }
12089
12090 vendor_data = nla_nest_start(skb, NL80211_ATTR_VENDOR_DATA);
12091 if (!vendor_data) {
12092 genlmsg_cancel(skb, hdr);
12093 break;
12094 }
12095
12096 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
12097 (unsigned long *)&cb->args[5]);
12098 nla_nest_end(skb, vendor_data);
12099
12100 if (err == -ENOBUFS || err == -ENOENT) {
12101 genlmsg_cancel(skb, hdr);
12102 break;
12103 } else if (err) {
12104 genlmsg_cancel(skb, hdr);
12105 goto out;
12106 }
12107
12108 genlmsg_end(skb, hdr);
12109 }
12110
12111 err = skb->len;
12112 out:
12113 rtnl_unlock();
12114 return err;
12115 }
12116
12117 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
12118 enum nl80211_commands cmd,
12119 enum nl80211_attrs attr,
12120 int approxlen)
12121 {
12122 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
12123
12124 if (WARN_ON(!rdev->cur_cmd_info))
12125 return NULL;
12126
12127 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
12128 rdev->cur_cmd_info->snd_portid,
12129 rdev->cur_cmd_info->snd_seq,
12130 cmd, attr, NULL, GFP_KERNEL);
12131 }
12132 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
12133
12134 int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
12135 {
12136 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
12137 void *hdr = ((void **)skb->cb)[1];
12138 struct nlattr *data = ((void **)skb->cb)[2];
12139
12140 /* clear CB data for netlink core to own from now on */
12141 memset(skb->cb, 0, sizeof(skb->cb));
12142
12143 if (WARN_ON(!rdev->cur_cmd_info)) {
12144 kfree_skb(skb);
12145 return -EINVAL;
12146 }
12147
12148 nla_nest_end(skb, data);
12149 genlmsg_end(skb, hdr);
12150 return genlmsg_reply(skb, rdev->cur_cmd_info);
12151 }
12152 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
12153
12154 static int nl80211_set_qos_map(struct sk_buff *skb,
12155 struct genl_info *info)
12156 {
12157 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12158 struct cfg80211_qos_map *qos_map = NULL;
12159 struct net_device *dev = info->user_ptr[1];
12160 u8 *pos, len, num_des, des_len, des;
12161 int ret;
12162
12163 if (!rdev->ops->set_qos_map)
12164 return -EOPNOTSUPP;
12165
12166 if (info->attrs[NL80211_ATTR_QOS_MAP]) {
12167 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
12168 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
12169
12170 if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
12171 len > IEEE80211_QOS_MAP_LEN_MAX)
12172 return -EINVAL;
12173
12174 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
12175 if (!qos_map)
12176 return -ENOMEM;
12177
12178 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
12179 if (num_des) {
12180 des_len = num_des *
12181 sizeof(struct cfg80211_dscp_exception);
12182 memcpy(qos_map->dscp_exception, pos, des_len);
12183 qos_map->num_des = num_des;
12184 for (des = 0; des < num_des; des++) {
12185 if (qos_map->dscp_exception[des].up > 7) {
12186 kfree(qos_map);
12187 return -EINVAL;
12188 }
12189 }
12190 pos += des_len;
12191 }
12192 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
12193 }
12194
12195 wdev_lock(dev->ieee80211_ptr);
12196 ret = nl80211_key_allowed(dev->ieee80211_ptr);
12197 if (!ret)
12198 ret = rdev_set_qos_map(rdev, dev, qos_map);
12199 wdev_unlock(dev->ieee80211_ptr);
12200
12201 kfree(qos_map);
12202 return ret;
12203 }
12204
12205 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
12206 {
12207 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12208 struct net_device *dev = info->user_ptr[1];
12209 struct wireless_dev *wdev = dev->ieee80211_ptr;
12210 const u8 *peer;
12211 u8 tsid, up;
12212 u16 admitted_time = 0;
12213 int err;
12214
12215 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
12216 return -EOPNOTSUPP;
12217
12218 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
12219 !info->attrs[NL80211_ATTR_USER_PRIO])
12220 return -EINVAL;
12221
12222 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
12223 if (tsid >= IEEE80211_NUM_TIDS)
12224 return -EINVAL;
12225
12226 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
12227 if (up >= IEEE80211_NUM_UPS)
12228 return -EINVAL;
12229
12230 /* WMM uses TIDs 0-7 even for TSPEC */
12231 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
12232 /* TODO: handle 802.11 TSPEC/admission control
12233 * need more attributes for that (e.g. BA session requirement);
12234 * change the WMM adminssion test above to allow both then
12235 */
12236 return -EINVAL;
12237 }
12238
12239 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12240
12241 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
12242 admitted_time =
12243 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
12244 if (!admitted_time)
12245 return -EINVAL;
12246 }
12247
12248 wdev_lock(wdev);
12249 switch (wdev->iftype) {
12250 case NL80211_IFTYPE_STATION:
12251 case NL80211_IFTYPE_P2P_CLIENT:
12252 if (wdev->current_bss)
12253 break;
12254 err = -ENOTCONN;
12255 goto out;
12256 default:
12257 err = -EOPNOTSUPP;
12258 goto out;
12259 }
12260
12261 err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
12262
12263 out:
12264 wdev_unlock(wdev);
12265 return err;
12266 }
12267
12268 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
12269 {
12270 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12271 struct net_device *dev = info->user_ptr[1];
12272 struct wireless_dev *wdev = dev->ieee80211_ptr;
12273 const u8 *peer;
12274 u8 tsid;
12275 int err;
12276
12277 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
12278 return -EINVAL;
12279
12280 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
12281 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12282
12283 wdev_lock(wdev);
12284 err = rdev_del_tx_ts(rdev, dev, tsid, peer);
12285 wdev_unlock(wdev);
12286
12287 return err;
12288 }
12289
12290 static int nl80211_tdls_channel_switch(struct sk_buff *skb,
12291 struct genl_info *info)
12292 {
12293 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12294 struct net_device *dev = info->user_ptr[1];
12295 struct wireless_dev *wdev = dev->ieee80211_ptr;
12296 struct cfg80211_chan_def chandef = {};
12297 const u8 *addr;
12298 u8 oper_class;
12299 int err;
12300
12301 if (!rdev->ops->tdls_channel_switch ||
12302 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
12303 return -EOPNOTSUPP;
12304
12305 switch (dev->ieee80211_ptr->iftype) {
12306 case NL80211_IFTYPE_STATION:
12307 case NL80211_IFTYPE_P2P_CLIENT:
12308 break;
12309 default:
12310 return -EOPNOTSUPP;
12311 }
12312
12313 if (!info->attrs[NL80211_ATTR_MAC] ||
12314 !info->attrs[NL80211_ATTR_OPER_CLASS])
12315 return -EINVAL;
12316
12317 err = nl80211_parse_chandef(rdev, info, &chandef);
12318 if (err)
12319 return err;
12320
12321 /*
12322 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
12323 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
12324 * specification is not defined for them.
12325 */
12326 if (chandef.chan->band == NL80211_BAND_2GHZ &&
12327 chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
12328 chandef.width != NL80211_CHAN_WIDTH_20)
12329 return -EINVAL;
12330
12331 /* we will be active on the TDLS link */
12332 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
12333 wdev->iftype))
12334 return -EINVAL;
12335
12336 /* don't allow switching to DFS channels */
12337 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
12338 return -EINVAL;
12339
12340 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
12341 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
12342
12343 wdev_lock(wdev);
12344 err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
12345 wdev_unlock(wdev);
12346
12347 return err;
12348 }
12349
12350 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
12351 struct genl_info *info)
12352 {
12353 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12354 struct net_device *dev = info->user_ptr[1];
12355 struct wireless_dev *wdev = dev->ieee80211_ptr;
12356 const u8 *addr;
12357
12358 if (!rdev->ops->tdls_channel_switch ||
12359 !rdev->ops->tdls_cancel_channel_switch ||
12360 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
12361 return -EOPNOTSUPP;
12362
12363 switch (dev->ieee80211_ptr->iftype) {
12364 case NL80211_IFTYPE_STATION:
12365 case NL80211_IFTYPE_P2P_CLIENT:
12366 break;
12367 default:
12368 return -EOPNOTSUPP;
12369 }
12370
12371 if (!info->attrs[NL80211_ATTR_MAC])
12372 return -EINVAL;
12373
12374 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
12375
12376 wdev_lock(wdev);
12377 rdev_tdls_cancel_channel_switch(rdev, dev, addr);
12378 wdev_unlock(wdev);
12379
12380 return 0;
12381 }
12382
12383 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
12384 struct genl_info *info)
12385 {
12386 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12387 struct net_device *dev = info->user_ptr[1];
12388 struct wireless_dev *wdev = dev->ieee80211_ptr;
12389 const struct nlattr *nla;
12390 bool enabled;
12391
12392 if (!rdev->ops->set_multicast_to_unicast)
12393 return -EOPNOTSUPP;
12394
12395 if (wdev->iftype != NL80211_IFTYPE_AP &&
12396 wdev->iftype != NL80211_IFTYPE_P2P_GO)
12397 return -EOPNOTSUPP;
12398
12399 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
12400 enabled = nla_get_flag(nla);
12401
12402 return rdev_set_multicast_to_unicast(rdev, dev, enabled);
12403 }
12404
12405 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info)
12406 {
12407 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12408 struct net_device *dev = info->user_ptr[1];
12409 struct wireless_dev *wdev = dev->ieee80211_ptr;
12410 struct cfg80211_pmk_conf pmk_conf = {};
12411 int ret;
12412
12413 if (wdev->iftype != NL80211_IFTYPE_STATION &&
12414 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
12415 return -EOPNOTSUPP;
12416
12417 if (!wiphy_ext_feature_isset(&rdev->wiphy,
12418 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
12419 return -EOPNOTSUPP;
12420
12421 if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK])
12422 return -EINVAL;
12423
12424 wdev_lock(wdev);
12425 if (!wdev->current_bss) {
12426 ret = -ENOTCONN;
12427 goto out;
12428 }
12429
12430 pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
12431 if (memcmp(pmk_conf.aa, wdev->current_bss->pub.bssid, ETH_ALEN)) {
12432 ret = -EINVAL;
12433 goto out;
12434 }
12435
12436 pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
12437 pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
12438 if (pmk_conf.pmk_len != WLAN_PMK_LEN &&
12439 pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) {
12440 ret = -EINVAL;
12441 goto out;
12442 }
12443
12444 if (info->attrs[NL80211_ATTR_PMKR0_NAME]) {
12445 int r0_name_len = nla_len(info->attrs[NL80211_ATTR_PMKR0_NAME]);
12446
12447 if (r0_name_len != WLAN_PMK_NAME_LEN) {
12448 ret = -EINVAL;
12449 goto out;
12450 }
12451
12452 pmk_conf.pmk_r0_name =
12453 nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]);
12454 }
12455
12456 ret = rdev_set_pmk(rdev, dev, &pmk_conf);
12457 out:
12458 wdev_unlock(wdev);
12459 return ret;
12460 }
12461
12462 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info)
12463 {
12464 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12465 struct net_device *dev = info->user_ptr[1];
12466 struct wireless_dev *wdev = dev->ieee80211_ptr;
12467 const u8 *aa;
12468 int ret;
12469
12470 if (wdev->iftype != NL80211_IFTYPE_STATION &&
12471 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
12472 return -EOPNOTSUPP;
12473
12474 if (!wiphy_ext_feature_isset(&rdev->wiphy,
12475 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
12476 return -EOPNOTSUPP;
12477
12478 if (!info->attrs[NL80211_ATTR_MAC])
12479 return -EINVAL;
12480
12481 wdev_lock(wdev);
12482 aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
12483 ret = rdev_del_pmk(rdev, dev, aa);
12484 wdev_unlock(wdev);
12485
12486 return ret;
12487 }
12488
12489 #define NL80211_FLAG_NEED_WIPHY 0x01
12490 #define NL80211_FLAG_NEED_NETDEV 0x02
12491 #define NL80211_FLAG_NEED_RTNL 0x04
12492 #define NL80211_FLAG_CHECK_NETDEV_UP 0x08
12493 #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
12494 NL80211_FLAG_CHECK_NETDEV_UP)
12495 #define NL80211_FLAG_NEED_WDEV 0x10
12496 /* If a netdev is associated, it must be UP, P2P must be started */
12497 #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
12498 NL80211_FLAG_CHECK_NETDEV_UP)
12499 #define NL80211_FLAG_CLEAR_SKB 0x20
12500
12501 static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
12502 struct genl_info *info)
12503 {
12504 struct cfg80211_registered_device *rdev;
12505 struct wireless_dev *wdev;
12506 struct net_device *dev;
12507 bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
12508
12509 if (rtnl)
12510 rtnl_lock();
12511
12512 if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
12513 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
12514 if (IS_ERR(rdev)) {
12515 if (rtnl)
12516 rtnl_unlock();
12517 return PTR_ERR(rdev);
12518 }
12519 info->user_ptr[0] = rdev;
12520 } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
12521 ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
12522 ASSERT_RTNL();
12523
12524 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
12525 info->attrs);
12526 if (IS_ERR(wdev)) {
12527 if (rtnl)
12528 rtnl_unlock();
12529 return PTR_ERR(wdev);
12530 }
12531
12532 dev = wdev->netdev;
12533 rdev = wiphy_to_rdev(wdev->wiphy);
12534
12535 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
12536 if (!dev) {
12537 if (rtnl)
12538 rtnl_unlock();
12539 return -EINVAL;
12540 }
12541
12542 info->user_ptr[1] = dev;
12543 } else {
12544 info->user_ptr[1] = wdev;
12545 }
12546
12547 if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
12548 !wdev_running(wdev)) {
12549 if (rtnl)
12550 rtnl_unlock();
12551 return -ENETDOWN;
12552 }
12553
12554 if (dev)
12555 dev_hold(dev);
12556
12557 info->user_ptr[0] = rdev;
12558 }
12559
12560 return 0;
12561 }
12562
12563 static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
12564 struct genl_info *info)
12565 {
12566 if (info->user_ptr[1]) {
12567 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
12568 struct wireless_dev *wdev = info->user_ptr[1];
12569
12570 if (wdev->netdev)
12571 dev_put(wdev->netdev);
12572 } else {
12573 dev_put(info->user_ptr[1]);
12574 }
12575 }
12576
12577 if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
12578 rtnl_unlock();
12579
12580 /* If needed, clear the netlink message payload from the SKB
12581 * as it might contain key data that shouldn't stick around on
12582 * the heap after the SKB is freed. The netlink message header
12583 * is still needed for further processing, so leave it intact.
12584 */
12585 if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
12586 struct nlmsghdr *nlh = nlmsg_hdr(skb);
12587
12588 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
12589 }
12590 }
12591
12592 static const struct genl_ops nl80211_ops[] = {
12593 {
12594 .cmd = NL80211_CMD_GET_WIPHY,
12595 .doit = nl80211_get_wiphy,
12596 .dumpit = nl80211_dump_wiphy,
12597 .done = nl80211_dump_wiphy_done,
12598 .policy = nl80211_policy,
12599 /* can be retrieved by unprivileged users */
12600 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12601 NL80211_FLAG_NEED_RTNL,
12602 },
12603 {
12604 .cmd = NL80211_CMD_SET_WIPHY,
12605 .doit = nl80211_set_wiphy,
12606 .policy = nl80211_policy,
12607 .flags = GENL_UNS_ADMIN_PERM,
12608 .internal_flags = NL80211_FLAG_NEED_RTNL,
12609 },
12610 {
12611 .cmd = NL80211_CMD_GET_INTERFACE,
12612 .doit = nl80211_get_interface,
12613 .dumpit = nl80211_dump_interface,
12614 .policy = nl80211_policy,
12615 /* can be retrieved by unprivileged users */
12616 .internal_flags = NL80211_FLAG_NEED_WDEV |
12617 NL80211_FLAG_NEED_RTNL,
12618 },
12619 {
12620 .cmd = NL80211_CMD_SET_INTERFACE,
12621 .doit = nl80211_set_interface,
12622 .policy = nl80211_policy,
12623 .flags = GENL_UNS_ADMIN_PERM,
12624 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12625 NL80211_FLAG_NEED_RTNL,
12626 },
12627 {
12628 .cmd = NL80211_CMD_NEW_INTERFACE,
12629 .doit = nl80211_new_interface,
12630 .policy = nl80211_policy,
12631 .flags = GENL_UNS_ADMIN_PERM,
12632 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12633 NL80211_FLAG_NEED_RTNL,
12634 },
12635 {
12636 .cmd = NL80211_CMD_DEL_INTERFACE,
12637 .doit = nl80211_del_interface,
12638 .policy = nl80211_policy,
12639 .flags = GENL_UNS_ADMIN_PERM,
12640 .internal_flags = NL80211_FLAG_NEED_WDEV |
12641 NL80211_FLAG_NEED_RTNL,
12642 },
12643 {
12644 .cmd = NL80211_CMD_GET_KEY,
12645 .doit = nl80211_get_key,
12646 .policy = nl80211_policy,
12647 .flags = GENL_UNS_ADMIN_PERM,
12648 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12649 NL80211_FLAG_NEED_RTNL,
12650 },
12651 {
12652 .cmd = NL80211_CMD_SET_KEY,
12653 .doit = nl80211_set_key,
12654 .policy = nl80211_policy,
12655 .flags = GENL_UNS_ADMIN_PERM,
12656 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12657 NL80211_FLAG_NEED_RTNL |
12658 NL80211_FLAG_CLEAR_SKB,
12659 },
12660 {
12661 .cmd = NL80211_CMD_NEW_KEY,
12662 .doit = nl80211_new_key,
12663 .policy = nl80211_policy,
12664 .flags = GENL_UNS_ADMIN_PERM,
12665 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12666 NL80211_FLAG_NEED_RTNL |
12667 NL80211_FLAG_CLEAR_SKB,
12668 },
12669 {
12670 .cmd = NL80211_CMD_DEL_KEY,
12671 .doit = nl80211_del_key,
12672 .policy = nl80211_policy,
12673 .flags = GENL_UNS_ADMIN_PERM,
12674 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12675 NL80211_FLAG_NEED_RTNL,
12676 },
12677 {
12678 .cmd = NL80211_CMD_SET_BEACON,
12679 .policy = nl80211_policy,
12680 .flags = GENL_UNS_ADMIN_PERM,
12681 .doit = nl80211_set_beacon,
12682 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12683 NL80211_FLAG_NEED_RTNL,
12684 },
12685 {
12686 .cmd = NL80211_CMD_START_AP,
12687 .policy = nl80211_policy,
12688 .flags = GENL_UNS_ADMIN_PERM,
12689 .doit = nl80211_start_ap,
12690 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12691 NL80211_FLAG_NEED_RTNL,
12692 },
12693 {
12694 .cmd = NL80211_CMD_STOP_AP,
12695 .policy = nl80211_policy,
12696 .flags = GENL_UNS_ADMIN_PERM,
12697 .doit = nl80211_stop_ap,
12698 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12699 NL80211_FLAG_NEED_RTNL,
12700 },
12701 {
12702 .cmd = NL80211_CMD_GET_STATION,
12703 .doit = nl80211_get_station,
12704 .dumpit = nl80211_dump_station,
12705 .policy = nl80211_policy,
12706 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12707 NL80211_FLAG_NEED_RTNL,
12708 },
12709 {
12710 .cmd = NL80211_CMD_SET_STATION,
12711 .doit = nl80211_set_station,
12712 .policy = nl80211_policy,
12713 .flags = GENL_UNS_ADMIN_PERM,
12714 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12715 NL80211_FLAG_NEED_RTNL,
12716 },
12717 {
12718 .cmd = NL80211_CMD_NEW_STATION,
12719 .doit = nl80211_new_station,
12720 .policy = nl80211_policy,
12721 .flags = GENL_UNS_ADMIN_PERM,
12722 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12723 NL80211_FLAG_NEED_RTNL,
12724 },
12725 {
12726 .cmd = NL80211_CMD_DEL_STATION,
12727 .doit = nl80211_del_station,
12728 .policy = nl80211_policy,
12729 .flags = GENL_UNS_ADMIN_PERM,
12730 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12731 NL80211_FLAG_NEED_RTNL,
12732 },
12733 {
12734 .cmd = NL80211_CMD_GET_MPATH,
12735 .doit = nl80211_get_mpath,
12736 .dumpit = nl80211_dump_mpath,
12737 .policy = nl80211_policy,
12738 .flags = GENL_UNS_ADMIN_PERM,
12739 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12740 NL80211_FLAG_NEED_RTNL,
12741 },
12742 {
12743 .cmd = NL80211_CMD_GET_MPP,
12744 .doit = nl80211_get_mpp,
12745 .dumpit = nl80211_dump_mpp,
12746 .policy = nl80211_policy,
12747 .flags = GENL_UNS_ADMIN_PERM,
12748 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12749 NL80211_FLAG_NEED_RTNL,
12750 },
12751 {
12752 .cmd = NL80211_CMD_SET_MPATH,
12753 .doit = nl80211_set_mpath,
12754 .policy = nl80211_policy,
12755 .flags = GENL_UNS_ADMIN_PERM,
12756 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12757 NL80211_FLAG_NEED_RTNL,
12758 },
12759 {
12760 .cmd = NL80211_CMD_NEW_MPATH,
12761 .doit = nl80211_new_mpath,
12762 .policy = nl80211_policy,
12763 .flags = GENL_UNS_ADMIN_PERM,
12764 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12765 NL80211_FLAG_NEED_RTNL,
12766 },
12767 {
12768 .cmd = NL80211_CMD_DEL_MPATH,
12769 .doit = nl80211_del_mpath,
12770 .policy = nl80211_policy,
12771 .flags = GENL_UNS_ADMIN_PERM,
12772 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12773 NL80211_FLAG_NEED_RTNL,
12774 },
12775 {
12776 .cmd = NL80211_CMD_SET_BSS,
12777 .doit = nl80211_set_bss,
12778 .policy = nl80211_policy,
12779 .flags = GENL_UNS_ADMIN_PERM,
12780 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12781 NL80211_FLAG_NEED_RTNL,
12782 },
12783 {
12784 .cmd = NL80211_CMD_GET_REG,
12785 .doit = nl80211_get_reg_do,
12786 .dumpit = nl80211_get_reg_dump,
12787 .policy = nl80211_policy,
12788 .internal_flags = NL80211_FLAG_NEED_RTNL,
12789 /* can be retrieved by unprivileged users */
12790 },
12791 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
12792 {
12793 .cmd = NL80211_CMD_SET_REG,
12794 .doit = nl80211_set_reg,
12795 .policy = nl80211_policy,
12796 .flags = GENL_ADMIN_PERM,
12797 .internal_flags = NL80211_FLAG_NEED_RTNL,
12798 },
12799 #endif
12800 {
12801 .cmd = NL80211_CMD_REQ_SET_REG,
12802 .doit = nl80211_req_set_reg,
12803 .policy = nl80211_policy,
12804 .flags = GENL_ADMIN_PERM,
12805 },
12806 {
12807 .cmd = NL80211_CMD_RELOAD_REGDB,
12808 .doit = nl80211_reload_regdb,
12809 .policy = nl80211_policy,
12810 .flags = GENL_ADMIN_PERM,
12811 },
12812 {
12813 .cmd = NL80211_CMD_GET_MESH_CONFIG,
12814 .doit = nl80211_get_mesh_config,
12815 .policy = nl80211_policy,
12816 /* can be retrieved by unprivileged users */
12817 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12818 NL80211_FLAG_NEED_RTNL,
12819 },
12820 {
12821 .cmd = NL80211_CMD_SET_MESH_CONFIG,
12822 .doit = nl80211_update_mesh_config,
12823 .policy = nl80211_policy,
12824 .flags = GENL_UNS_ADMIN_PERM,
12825 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12826 NL80211_FLAG_NEED_RTNL,
12827 },
12828 {
12829 .cmd = NL80211_CMD_TRIGGER_SCAN,
12830 .doit = nl80211_trigger_scan,
12831 .policy = nl80211_policy,
12832 .flags = GENL_UNS_ADMIN_PERM,
12833 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12834 NL80211_FLAG_NEED_RTNL,
12835 },
12836 {
12837 .cmd = NL80211_CMD_ABORT_SCAN,
12838 .doit = nl80211_abort_scan,
12839 .policy = nl80211_policy,
12840 .flags = GENL_UNS_ADMIN_PERM,
12841 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12842 NL80211_FLAG_NEED_RTNL,
12843 },
12844 {
12845 .cmd = NL80211_CMD_GET_SCAN,
12846 .policy = nl80211_policy,
12847 .dumpit = nl80211_dump_scan,
12848 },
12849 {
12850 .cmd = NL80211_CMD_START_SCHED_SCAN,
12851 .doit = nl80211_start_sched_scan,
12852 .policy = nl80211_policy,
12853 .flags = GENL_UNS_ADMIN_PERM,
12854 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12855 NL80211_FLAG_NEED_RTNL,
12856 },
12857 {
12858 .cmd = NL80211_CMD_STOP_SCHED_SCAN,
12859 .doit = nl80211_stop_sched_scan,
12860 .policy = nl80211_policy,
12861 .flags = GENL_UNS_ADMIN_PERM,
12862 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12863 NL80211_FLAG_NEED_RTNL,
12864 },
12865 {
12866 .cmd = NL80211_CMD_AUTHENTICATE,
12867 .doit = nl80211_authenticate,
12868 .policy = nl80211_policy,
12869 .flags = GENL_UNS_ADMIN_PERM,
12870 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12871 NL80211_FLAG_NEED_RTNL |
12872 NL80211_FLAG_CLEAR_SKB,
12873 },
12874 {
12875 .cmd = NL80211_CMD_ASSOCIATE,
12876 .doit = nl80211_associate,
12877 .policy = nl80211_policy,
12878 .flags = GENL_UNS_ADMIN_PERM,
12879 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12880 NL80211_FLAG_NEED_RTNL |
12881 NL80211_FLAG_CLEAR_SKB,
12882 },
12883 {
12884 .cmd = NL80211_CMD_DEAUTHENTICATE,
12885 .doit = nl80211_deauthenticate,
12886 .policy = nl80211_policy,
12887 .flags = GENL_UNS_ADMIN_PERM,
12888 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12889 NL80211_FLAG_NEED_RTNL,
12890 },
12891 {
12892 .cmd = NL80211_CMD_DISASSOCIATE,
12893 .doit = nl80211_disassociate,
12894 .policy = nl80211_policy,
12895 .flags = GENL_UNS_ADMIN_PERM,
12896 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12897 NL80211_FLAG_NEED_RTNL,
12898 },
12899 {
12900 .cmd = NL80211_CMD_JOIN_IBSS,
12901 .doit = nl80211_join_ibss,
12902 .policy = nl80211_policy,
12903 .flags = GENL_UNS_ADMIN_PERM,
12904 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12905 NL80211_FLAG_NEED_RTNL,
12906 },
12907 {
12908 .cmd = NL80211_CMD_LEAVE_IBSS,
12909 .doit = nl80211_leave_ibss,
12910 .policy = nl80211_policy,
12911 .flags = GENL_UNS_ADMIN_PERM,
12912 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12913 NL80211_FLAG_NEED_RTNL,
12914 },
12915 #ifdef CONFIG_NL80211_TESTMODE
12916 {
12917 .cmd = NL80211_CMD_TESTMODE,
12918 .doit = nl80211_testmode_do,
12919 .dumpit = nl80211_testmode_dump,
12920 .policy = nl80211_policy,
12921 .flags = GENL_UNS_ADMIN_PERM,
12922 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12923 NL80211_FLAG_NEED_RTNL,
12924 },
12925 #endif
12926 {
12927 .cmd = NL80211_CMD_CONNECT,
12928 .doit = nl80211_connect,
12929 .policy = nl80211_policy,
12930 .flags = GENL_UNS_ADMIN_PERM,
12931 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12932 NL80211_FLAG_NEED_RTNL |
12933 NL80211_FLAG_CLEAR_SKB,
12934 },
12935 {
12936 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
12937 .doit = nl80211_update_connect_params,
12938 .policy = nl80211_policy,
12939 .flags = GENL_ADMIN_PERM,
12940 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12941 NL80211_FLAG_NEED_RTNL |
12942 NL80211_FLAG_CLEAR_SKB,
12943 },
12944 {
12945 .cmd = NL80211_CMD_DISCONNECT,
12946 .doit = nl80211_disconnect,
12947 .policy = nl80211_policy,
12948 .flags = GENL_UNS_ADMIN_PERM,
12949 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12950 NL80211_FLAG_NEED_RTNL,
12951 },
12952 {
12953 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
12954 .doit = nl80211_wiphy_netns,
12955 .policy = nl80211_policy,
12956 .flags = GENL_UNS_ADMIN_PERM,
12957 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12958 NL80211_FLAG_NEED_RTNL,
12959 },
12960 {
12961 .cmd = NL80211_CMD_GET_SURVEY,
12962 .policy = nl80211_policy,
12963 .dumpit = nl80211_dump_survey,
12964 },
12965 {
12966 .cmd = NL80211_CMD_SET_PMKSA,
12967 .doit = nl80211_setdel_pmksa,
12968 .policy = nl80211_policy,
12969 .flags = GENL_UNS_ADMIN_PERM,
12970 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12971 NL80211_FLAG_NEED_RTNL |
12972 NL80211_FLAG_CLEAR_SKB,
12973 },
12974 {
12975 .cmd = NL80211_CMD_DEL_PMKSA,
12976 .doit = nl80211_setdel_pmksa,
12977 .policy = nl80211_policy,
12978 .flags = GENL_UNS_ADMIN_PERM,
12979 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12980 NL80211_FLAG_NEED_RTNL,
12981 },
12982 {
12983 .cmd = NL80211_CMD_FLUSH_PMKSA,
12984 .doit = nl80211_flush_pmksa,
12985 .policy = nl80211_policy,
12986 .flags = GENL_UNS_ADMIN_PERM,
12987 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12988 NL80211_FLAG_NEED_RTNL,
12989 },
12990 {
12991 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
12992 .doit = nl80211_remain_on_channel,
12993 .policy = nl80211_policy,
12994 .flags = GENL_UNS_ADMIN_PERM,
12995 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12996 NL80211_FLAG_NEED_RTNL,
12997 },
12998 {
12999 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
13000 .doit = nl80211_cancel_remain_on_channel,
13001 .policy = nl80211_policy,
13002 .flags = GENL_UNS_ADMIN_PERM,
13003 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13004 NL80211_FLAG_NEED_RTNL,
13005 },
13006 {
13007 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
13008 .doit = nl80211_set_tx_bitrate_mask,
13009 .policy = nl80211_policy,
13010 .flags = GENL_UNS_ADMIN_PERM,
13011 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13012 NL80211_FLAG_NEED_RTNL,
13013 },
13014 {
13015 .cmd = NL80211_CMD_REGISTER_FRAME,
13016 .doit = nl80211_register_mgmt,
13017 .policy = nl80211_policy,
13018 .flags = GENL_UNS_ADMIN_PERM,
13019 .internal_flags = NL80211_FLAG_NEED_WDEV |
13020 NL80211_FLAG_NEED_RTNL,
13021 },
13022 {
13023 .cmd = NL80211_CMD_FRAME,
13024 .doit = nl80211_tx_mgmt,
13025 .policy = nl80211_policy,
13026 .flags = GENL_UNS_ADMIN_PERM,
13027 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13028 NL80211_FLAG_NEED_RTNL,
13029 },
13030 {
13031 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
13032 .doit = nl80211_tx_mgmt_cancel_wait,
13033 .policy = nl80211_policy,
13034 .flags = GENL_UNS_ADMIN_PERM,
13035 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13036 NL80211_FLAG_NEED_RTNL,
13037 },
13038 {
13039 .cmd = NL80211_CMD_SET_POWER_SAVE,
13040 .doit = nl80211_set_power_save,
13041 .policy = nl80211_policy,
13042 .flags = GENL_UNS_ADMIN_PERM,
13043 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13044 NL80211_FLAG_NEED_RTNL,
13045 },
13046 {
13047 .cmd = NL80211_CMD_GET_POWER_SAVE,
13048 .doit = nl80211_get_power_save,
13049 .policy = nl80211_policy,
13050 /* can be retrieved by unprivileged users */
13051 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13052 NL80211_FLAG_NEED_RTNL,
13053 },
13054 {
13055 .cmd = NL80211_CMD_SET_CQM,
13056 .doit = nl80211_set_cqm,
13057 .policy = nl80211_policy,
13058 .flags = GENL_UNS_ADMIN_PERM,
13059 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13060 NL80211_FLAG_NEED_RTNL,
13061 },
13062 {
13063 .cmd = NL80211_CMD_SET_CHANNEL,
13064 .doit = nl80211_set_channel,
13065 .policy = nl80211_policy,
13066 .flags = GENL_UNS_ADMIN_PERM,
13067 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13068 NL80211_FLAG_NEED_RTNL,
13069 },
13070 {
13071 .cmd = NL80211_CMD_SET_WDS_PEER,
13072 .doit = nl80211_set_wds_peer,
13073 .policy = nl80211_policy,
13074 .flags = GENL_UNS_ADMIN_PERM,
13075 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13076 NL80211_FLAG_NEED_RTNL,
13077 },
13078 {
13079 .cmd = NL80211_CMD_JOIN_MESH,
13080 .doit = nl80211_join_mesh,
13081 .policy = nl80211_policy,
13082 .flags = GENL_UNS_ADMIN_PERM,
13083 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13084 NL80211_FLAG_NEED_RTNL,
13085 },
13086 {
13087 .cmd = NL80211_CMD_LEAVE_MESH,
13088 .doit = nl80211_leave_mesh,
13089 .policy = nl80211_policy,
13090 .flags = GENL_UNS_ADMIN_PERM,
13091 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13092 NL80211_FLAG_NEED_RTNL,
13093 },
13094 {
13095 .cmd = NL80211_CMD_JOIN_OCB,
13096 .doit = nl80211_join_ocb,
13097 .policy = nl80211_policy,
13098 .flags = GENL_UNS_ADMIN_PERM,
13099 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13100 NL80211_FLAG_NEED_RTNL,
13101 },
13102 {
13103 .cmd = NL80211_CMD_LEAVE_OCB,
13104 .doit = nl80211_leave_ocb,
13105 .policy = nl80211_policy,
13106 .flags = GENL_UNS_ADMIN_PERM,
13107 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13108 NL80211_FLAG_NEED_RTNL,
13109 },
13110 #ifdef CONFIG_PM
13111 {
13112 .cmd = NL80211_CMD_GET_WOWLAN,
13113 .doit = nl80211_get_wowlan,
13114 .policy = nl80211_policy,
13115 /* can be retrieved by unprivileged users */
13116 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13117 NL80211_FLAG_NEED_RTNL,
13118 },
13119 {
13120 .cmd = NL80211_CMD_SET_WOWLAN,
13121 .doit = nl80211_set_wowlan,
13122 .policy = nl80211_policy,
13123 .flags = GENL_UNS_ADMIN_PERM,
13124 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13125 NL80211_FLAG_NEED_RTNL,
13126 },
13127 #endif
13128 {
13129 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
13130 .doit = nl80211_set_rekey_data,
13131 .policy = nl80211_policy,
13132 .flags = GENL_UNS_ADMIN_PERM,
13133 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13134 NL80211_FLAG_NEED_RTNL |
13135 NL80211_FLAG_CLEAR_SKB,
13136 },
13137 {
13138 .cmd = NL80211_CMD_TDLS_MGMT,
13139 .doit = nl80211_tdls_mgmt,
13140 .policy = nl80211_policy,
13141 .flags = GENL_UNS_ADMIN_PERM,
13142 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13143 NL80211_FLAG_NEED_RTNL,
13144 },
13145 {
13146 .cmd = NL80211_CMD_TDLS_OPER,
13147 .doit = nl80211_tdls_oper,
13148 .policy = nl80211_policy,
13149 .flags = GENL_UNS_ADMIN_PERM,
13150 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13151 NL80211_FLAG_NEED_RTNL,
13152 },
13153 {
13154 .cmd = NL80211_CMD_UNEXPECTED_FRAME,
13155 .doit = nl80211_register_unexpected_frame,
13156 .policy = nl80211_policy,
13157 .flags = GENL_UNS_ADMIN_PERM,
13158 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13159 NL80211_FLAG_NEED_RTNL,
13160 },
13161 {
13162 .cmd = NL80211_CMD_PROBE_CLIENT,
13163 .doit = nl80211_probe_client,
13164 .policy = nl80211_policy,
13165 .flags = GENL_UNS_ADMIN_PERM,
13166 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13167 NL80211_FLAG_NEED_RTNL,
13168 },
13169 {
13170 .cmd = NL80211_CMD_REGISTER_BEACONS,
13171 .doit = nl80211_register_beacons,
13172 .policy = nl80211_policy,
13173 .flags = GENL_UNS_ADMIN_PERM,
13174 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13175 NL80211_FLAG_NEED_RTNL,
13176 },
13177 {
13178 .cmd = NL80211_CMD_SET_NOACK_MAP,
13179 .doit = nl80211_set_noack_map,
13180 .policy = nl80211_policy,
13181 .flags = GENL_UNS_ADMIN_PERM,
13182 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13183 NL80211_FLAG_NEED_RTNL,
13184 },
13185 {
13186 .cmd = NL80211_CMD_START_P2P_DEVICE,
13187 .doit = nl80211_start_p2p_device,
13188 .policy = nl80211_policy,
13189 .flags = GENL_UNS_ADMIN_PERM,
13190 .internal_flags = NL80211_FLAG_NEED_WDEV |
13191 NL80211_FLAG_NEED_RTNL,
13192 },
13193 {
13194 .cmd = NL80211_CMD_STOP_P2P_DEVICE,
13195 .doit = nl80211_stop_p2p_device,
13196 .policy = nl80211_policy,
13197 .flags = GENL_UNS_ADMIN_PERM,
13198 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13199 NL80211_FLAG_NEED_RTNL,
13200 },
13201 {
13202 .cmd = NL80211_CMD_START_NAN,
13203 .doit = nl80211_start_nan,
13204 .policy = nl80211_policy,
13205 .flags = GENL_ADMIN_PERM,
13206 .internal_flags = NL80211_FLAG_NEED_WDEV |
13207 NL80211_FLAG_NEED_RTNL,
13208 },
13209 {
13210 .cmd = NL80211_CMD_STOP_NAN,
13211 .doit = nl80211_stop_nan,
13212 .policy = nl80211_policy,
13213 .flags = GENL_ADMIN_PERM,
13214 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13215 NL80211_FLAG_NEED_RTNL,
13216 },
13217 {
13218 .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
13219 .doit = nl80211_nan_add_func,
13220 .policy = nl80211_policy,
13221 .flags = GENL_ADMIN_PERM,
13222 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13223 NL80211_FLAG_NEED_RTNL,
13224 },
13225 {
13226 .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
13227 .doit = nl80211_nan_del_func,
13228 .policy = nl80211_policy,
13229 .flags = GENL_ADMIN_PERM,
13230 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13231 NL80211_FLAG_NEED_RTNL,
13232 },
13233 {
13234 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
13235 .doit = nl80211_nan_change_config,
13236 .policy = nl80211_policy,
13237 .flags = GENL_ADMIN_PERM,
13238 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13239 NL80211_FLAG_NEED_RTNL,
13240 },
13241 {
13242 .cmd = NL80211_CMD_SET_MCAST_RATE,
13243 .doit = nl80211_set_mcast_rate,
13244 .policy = nl80211_policy,
13245 .flags = GENL_UNS_ADMIN_PERM,
13246 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13247 NL80211_FLAG_NEED_RTNL,
13248 },
13249 {
13250 .cmd = NL80211_CMD_SET_MAC_ACL,
13251 .doit = nl80211_set_mac_acl,
13252 .policy = nl80211_policy,
13253 .flags = GENL_UNS_ADMIN_PERM,
13254 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13255 NL80211_FLAG_NEED_RTNL,
13256 },
13257 {
13258 .cmd = NL80211_CMD_RADAR_DETECT,
13259 .doit = nl80211_start_radar_detection,
13260 .policy = nl80211_policy,
13261 .flags = GENL_UNS_ADMIN_PERM,
13262 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13263 NL80211_FLAG_NEED_RTNL,
13264 },
13265 {
13266 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
13267 .doit = nl80211_get_protocol_features,
13268 .policy = nl80211_policy,
13269 },
13270 {
13271 .cmd = NL80211_CMD_UPDATE_FT_IES,
13272 .doit = nl80211_update_ft_ies,
13273 .policy = nl80211_policy,
13274 .flags = GENL_UNS_ADMIN_PERM,
13275 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13276 NL80211_FLAG_NEED_RTNL,
13277 },
13278 {
13279 .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
13280 .doit = nl80211_crit_protocol_start,
13281 .policy = nl80211_policy,
13282 .flags = GENL_UNS_ADMIN_PERM,
13283 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13284 NL80211_FLAG_NEED_RTNL,
13285 },
13286 {
13287 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
13288 .doit = nl80211_crit_protocol_stop,
13289 .policy = nl80211_policy,
13290 .flags = GENL_UNS_ADMIN_PERM,
13291 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13292 NL80211_FLAG_NEED_RTNL,
13293 },
13294 {
13295 .cmd = NL80211_CMD_GET_COALESCE,
13296 .doit = nl80211_get_coalesce,
13297 .policy = nl80211_policy,
13298 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13299 NL80211_FLAG_NEED_RTNL,
13300 },
13301 {
13302 .cmd = NL80211_CMD_SET_COALESCE,
13303 .doit = nl80211_set_coalesce,
13304 .policy = nl80211_policy,
13305 .flags = GENL_UNS_ADMIN_PERM,
13306 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13307 NL80211_FLAG_NEED_RTNL,
13308 },
13309 {
13310 .cmd = NL80211_CMD_CHANNEL_SWITCH,
13311 .doit = nl80211_channel_switch,
13312 .policy = nl80211_policy,
13313 .flags = GENL_UNS_ADMIN_PERM,
13314 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13315 NL80211_FLAG_NEED_RTNL,
13316 },
13317 {
13318 .cmd = NL80211_CMD_VENDOR,
13319 .doit = nl80211_vendor_cmd,
13320 .dumpit = nl80211_vendor_cmd_dump,
13321 .policy = nl80211_policy,
13322 .flags = GENL_UNS_ADMIN_PERM,
13323 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13324 NL80211_FLAG_NEED_RTNL |
13325 NL80211_FLAG_CLEAR_SKB,
13326 },
13327 {
13328 .cmd = NL80211_CMD_SET_QOS_MAP,
13329 .doit = nl80211_set_qos_map,
13330 .policy = nl80211_policy,
13331 .flags = GENL_UNS_ADMIN_PERM,
13332 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13333 NL80211_FLAG_NEED_RTNL,
13334 },
13335 {
13336 .cmd = NL80211_CMD_ADD_TX_TS,
13337 .doit = nl80211_add_tx_ts,
13338 .policy = nl80211_policy,
13339 .flags = GENL_UNS_ADMIN_PERM,
13340 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13341 NL80211_FLAG_NEED_RTNL,
13342 },
13343 {
13344 .cmd = NL80211_CMD_DEL_TX_TS,
13345 .doit = nl80211_del_tx_ts,
13346 .policy = nl80211_policy,
13347 .flags = GENL_UNS_ADMIN_PERM,
13348 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13349 NL80211_FLAG_NEED_RTNL,
13350 },
13351 {
13352 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
13353 .doit = nl80211_tdls_channel_switch,
13354 .policy = nl80211_policy,
13355 .flags = GENL_UNS_ADMIN_PERM,
13356 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13357 NL80211_FLAG_NEED_RTNL,
13358 },
13359 {
13360 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
13361 .doit = nl80211_tdls_cancel_channel_switch,
13362 .policy = nl80211_policy,
13363 .flags = GENL_UNS_ADMIN_PERM,
13364 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13365 NL80211_FLAG_NEED_RTNL,
13366 },
13367 {
13368 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
13369 .doit = nl80211_set_multicast_to_unicast,
13370 .policy = nl80211_policy,
13371 .flags = GENL_UNS_ADMIN_PERM,
13372 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13373 NL80211_FLAG_NEED_RTNL,
13374 },
13375 {
13376 .cmd = NL80211_CMD_SET_PMK,
13377 .doit = nl80211_set_pmk,
13378 .policy = nl80211_policy,
13379 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13380 NL80211_FLAG_NEED_RTNL |
13381 NL80211_FLAG_CLEAR_SKB,
13382 },
13383 {
13384 .cmd = NL80211_CMD_DEL_PMK,
13385 .doit = nl80211_del_pmk,
13386 .policy = nl80211_policy,
13387 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13388 NL80211_FLAG_NEED_RTNL,
13389 },
13390
13391 };
13392
13393 static struct genl_family nl80211_fam __ro_after_init = {
13394 .name = NL80211_GENL_NAME, /* have users key off the name instead */
13395 .hdrsize = 0, /* no private header */
13396 .version = 1, /* no particular meaning now */
13397 .maxattr = NL80211_ATTR_MAX,
13398 .netnsok = true,
13399 .pre_doit = nl80211_pre_doit,
13400 .post_doit = nl80211_post_doit,
13401 .module = THIS_MODULE,
13402 .ops = nl80211_ops,
13403 .n_ops = ARRAY_SIZE(nl80211_ops),
13404 .mcgrps = nl80211_mcgrps,
13405 .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
13406 };
13407
13408 /* notification functions */
13409
13410 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
13411 enum nl80211_commands cmd)
13412 {
13413 struct sk_buff *msg;
13414 struct nl80211_dump_wiphy_state state = {};
13415
13416 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
13417 cmd != NL80211_CMD_DEL_WIPHY);
13418
13419 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13420 if (!msg)
13421 return;
13422
13423 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
13424 nlmsg_free(msg);
13425 return;
13426 }
13427
13428 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13429 NL80211_MCGRP_CONFIG, GFP_KERNEL);
13430 }
13431
13432 void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
13433 struct wireless_dev *wdev,
13434 enum nl80211_commands cmd)
13435 {
13436 struct sk_buff *msg;
13437
13438 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
13439 cmd != NL80211_CMD_DEL_INTERFACE);
13440
13441 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13442 if (!msg)
13443 return;
13444
13445 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev,
13446 cmd == NL80211_CMD_DEL_INTERFACE) < 0) {
13447 nlmsg_free(msg);
13448 return;
13449 }
13450
13451 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13452 NL80211_MCGRP_CONFIG, GFP_KERNEL);
13453 }
13454
13455 static int nl80211_add_scan_req(struct sk_buff *msg,
13456 struct cfg80211_registered_device *rdev)
13457 {
13458 struct cfg80211_scan_request *req = rdev->scan_req;
13459 struct nlattr *nest;
13460 int i;
13461
13462 if (WARN_ON(!req))
13463 return 0;
13464
13465 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
13466 if (!nest)
13467 goto nla_put_failure;
13468 for (i = 0; i < req->n_ssids; i++) {
13469 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
13470 goto nla_put_failure;
13471 }
13472 nla_nest_end(msg, nest);
13473
13474 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
13475 if (!nest)
13476 goto nla_put_failure;
13477 for (i = 0; i < req->n_channels; i++) {
13478 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
13479 goto nla_put_failure;
13480 }
13481 nla_nest_end(msg, nest);
13482
13483 if (req->ie &&
13484 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
13485 goto nla_put_failure;
13486
13487 if (req->flags &&
13488 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
13489 goto nla_put_failure;
13490
13491 if (req->info.scan_start_tsf &&
13492 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
13493 req->info.scan_start_tsf, NL80211_BSS_PAD) ||
13494 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
13495 req->info.tsf_bssid)))
13496 goto nla_put_failure;
13497
13498 return 0;
13499 nla_put_failure:
13500 return -ENOBUFS;
13501 }
13502
13503 static int nl80211_prep_scan_msg(struct sk_buff *msg,
13504 struct cfg80211_registered_device *rdev,
13505 struct wireless_dev *wdev,
13506 u32 portid, u32 seq, int flags,
13507 u32 cmd)
13508 {
13509 void *hdr;
13510
13511 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
13512 if (!hdr)
13513 return -1;
13514
13515 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13516 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13517 wdev->netdev->ifindex)) ||
13518 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13519 NL80211_ATTR_PAD))
13520 goto nla_put_failure;
13521
13522 /* ignore errors and send incomplete event anyway */
13523 nl80211_add_scan_req(msg, rdev);
13524
13525 genlmsg_end(msg, hdr);
13526 return 0;
13527
13528 nla_put_failure:
13529 genlmsg_cancel(msg, hdr);
13530 return -EMSGSIZE;
13531 }
13532
13533 static int
13534 nl80211_prep_sched_scan_msg(struct sk_buff *msg,
13535 struct cfg80211_sched_scan_request *req, u32 cmd)
13536 {
13537 void *hdr;
13538
13539 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13540 if (!hdr)
13541 return -1;
13542
13543 if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
13544 wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
13545 nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
13546 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
13547 NL80211_ATTR_PAD))
13548 goto nla_put_failure;
13549
13550 genlmsg_end(msg, hdr);
13551 return 0;
13552
13553 nla_put_failure:
13554 genlmsg_cancel(msg, hdr);
13555 return -EMSGSIZE;
13556 }
13557
13558 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
13559 struct wireless_dev *wdev)
13560 {
13561 struct sk_buff *msg;
13562
13563 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13564 if (!msg)
13565 return;
13566
13567 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
13568 NL80211_CMD_TRIGGER_SCAN) < 0) {
13569 nlmsg_free(msg);
13570 return;
13571 }
13572
13573 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13574 NL80211_MCGRP_SCAN, GFP_KERNEL);
13575 }
13576
13577 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
13578 struct wireless_dev *wdev, bool aborted)
13579 {
13580 struct sk_buff *msg;
13581
13582 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13583 if (!msg)
13584 return NULL;
13585
13586 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
13587 aborted ? NL80211_CMD_SCAN_ABORTED :
13588 NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
13589 nlmsg_free(msg);
13590 return NULL;
13591 }
13592
13593 return msg;
13594 }
13595
13596 /* send message created by nl80211_build_scan_msg() */
13597 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
13598 struct sk_buff *msg)
13599 {
13600 if (!msg)
13601 return;
13602
13603 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13604 NL80211_MCGRP_SCAN, GFP_KERNEL);
13605 }
13606
13607 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
13608 {
13609 struct sk_buff *msg;
13610
13611 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13612 if (!msg)
13613 return;
13614
13615 if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
13616 nlmsg_free(msg);
13617 return;
13618 }
13619
13620 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
13621 NL80211_MCGRP_SCAN, GFP_KERNEL);
13622 }
13623
13624 static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
13625 struct regulatory_request *request)
13626 {
13627 /* Userspace can always count this one always being set */
13628 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
13629 goto nla_put_failure;
13630
13631 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
13632 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13633 NL80211_REGDOM_TYPE_WORLD))
13634 goto nla_put_failure;
13635 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
13636 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13637 NL80211_REGDOM_TYPE_CUSTOM_WORLD))
13638 goto nla_put_failure;
13639 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
13640 request->intersect) {
13641 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13642 NL80211_REGDOM_TYPE_INTERSECTION))
13643 goto nla_put_failure;
13644 } else {
13645 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13646 NL80211_REGDOM_TYPE_COUNTRY) ||
13647 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
13648 request->alpha2))
13649 goto nla_put_failure;
13650 }
13651
13652 if (request->wiphy_idx != WIPHY_IDX_INVALID) {
13653 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
13654
13655 if (wiphy &&
13656 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
13657 goto nla_put_failure;
13658
13659 if (wiphy &&
13660 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
13661 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
13662 goto nla_put_failure;
13663 }
13664
13665 return true;
13666
13667 nla_put_failure:
13668 return false;
13669 }
13670
13671 /*
13672 * This can happen on global regulatory changes or device specific settings
13673 * based on custom regulatory domains.
13674 */
13675 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
13676 struct regulatory_request *request)
13677 {
13678 struct sk_buff *msg;
13679 void *hdr;
13680
13681 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13682 if (!msg)
13683 return;
13684
13685 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
13686 if (!hdr) {
13687 nlmsg_free(msg);
13688 return;
13689 }
13690
13691 if (nl80211_reg_change_event_fill(msg, request) == false)
13692 goto nla_put_failure;
13693
13694 genlmsg_end(msg, hdr);
13695
13696 rcu_read_lock();
13697 genlmsg_multicast_allns(&nl80211_fam, msg, 0,
13698 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
13699 rcu_read_unlock();
13700
13701 return;
13702
13703 nla_put_failure:
13704 genlmsg_cancel(msg, hdr);
13705 nlmsg_free(msg);
13706 }
13707
13708 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
13709 struct net_device *netdev,
13710 const u8 *buf, size_t len,
13711 enum nl80211_commands cmd, gfp_t gfp,
13712 int uapsd_queues)
13713 {
13714 struct sk_buff *msg;
13715 void *hdr;
13716
13717 msg = nlmsg_new(100 + len, gfp);
13718 if (!msg)
13719 return;
13720
13721 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13722 if (!hdr) {
13723 nlmsg_free(msg);
13724 return;
13725 }
13726
13727 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13728 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13729 nla_put(msg, NL80211_ATTR_FRAME, len, buf))
13730 goto nla_put_failure;
13731
13732 if (uapsd_queues >= 0) {
13733 struct nlattr *nla_wmm =
13734 nla_nest_start(msg, NL80211_ATTR_STA_WME);
13735 if (!nla_wmm)
13736 goto nla_put_failure;
13737
13738 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
13739 uapsd_queues))
13740 goto nla_put_failure;
13741
13742 nla_nest_end(msg, nla_wmm);
13743 }
13744
13745 genlmsg_end(msg, hdr);
13746
13747 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13748 NL80211_MCGRP_MLME, gfp);
13749 return;
13750
13751 nla_put_failure:
13752 genlmsg_cancel(msg, hdr);
13753 nlmsg_free(msg);
13754 }
13755
13756 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
13757 struct net_device *netdev, const u8 *buf,
13758 size_t len, gfp_t gfp)
13759 {
13760 nl80211_send_mlme_event(rdev, netdev, buf, len,
13761 NL80211_CMD_AUTHENTICATE, gfp, -1);
13762 }
13763
13764 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
13765 struct net_device *netdev, const u8 *buf,
13766 size_t len, gfp_t gfp, int uapsd_queues)
13767 {
13768 nl80211_send_mlme_event(rdev, netdev, buf, len,
13769 NL80211_CMD_ASSOCIATE, gfp, uapsd_queues);
13770 }
13771
13772 void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
13773 struct net_device *netdev, const u8 *buf,
13774 size_t len, gfp_t gfp)
13775 {
13776 nl80211_send_mlme_event(rdev, netdev, buf, len,
13777 NL80211_CMD_DEAUTHENTICATE, gfp, -1);
13778 }
13779
13780 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
13781 struct net_device *netdev, const u8 *buf,
13782 size_t len, gfp_t gfp)
13783 {
13784 nl80211_send_mlme_event(rdev, netdev, buf, len,
13785 NL80211_CMD_DISASSOCIATE, gfp, -1);
13786 }
13787
13788 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
13789 size_t len)
13790 {
13791 struct wireless_dev *wdev = dev->ieee80211_ptr;
13792 struct wiphy *wiphy = wdev->wiphy;
13793 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13794 const struct ieee80211_mgmt *mgmt = (void *)buf;
13795 u32 cmd;
13796
13797 if (WARN_ON(len < 2))
13798 return;
13799
13800 if (ieee80211_is_deauth(mgmt->frame_control))
13801 cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
13802 else
13803 cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
13804
13805 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
13806 nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1);
13807 }
13808 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
13809
13810 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
13811 struct net_device *netdev, int cmd,
13812 const u8 *addr, gfp_t gfp)
13813 {
13814 struct sk_buff *msg;
13815 void *hdr;
13816
13817 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13818 if (!msg)
13819 return;
13820
13821 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13822 if (!hdr) {
13823 nlmsg_free(msg);
13824 return;
13825 }
13826
13827 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13828 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13829 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
13830 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
13831 goto nla_put_failure;
13832
13833 genlmsg_end(msg, hdr);
13834
13835 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13836 NL80211_MCGRP_MLME, gfp);
13837 return;
13838
13839 nla_put_failure:
13840 genlmsg_cancel(msg, hdr);
13841 nlmsg_free(msg);
13842 }
13843
13844 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
13845 struct net_device *netdev, const u8 *addr,
13846 gfp_t gfp)
13847 {
13848 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
13849 addr, gfp);
13850 }
13851
13852 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
13853 struct net_device *netdev, const u8 *addr,
13854 gfp_t gfp)
13855 {
13856 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
13857 addr, gfp);
13858 }
13859
13860 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
13861 struct net_device *netdev,
13862 struct cfg80211_connect_resp_params *cr,
13863 gfp_t gfp)
13864 {
13865 struct sk_buff *msg;
13866 void *hdr;
13867
13868 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
13869 cr->fils_kek_len + cr->pmk_len +
13870 (cr->pmkid ? WLAN_PMKID_LEN : 0), gfp);
13871 if (!msg)
13872 return;
13873
13874 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
13875 if (!hdr) {
13876 nlmsg_free(msg);
13877 return;
13878 }
13879
13880 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13881 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13882 (cr->bssid &&
13883 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cr->bssid)) ||
13884 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
13885 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
13886 cr->status) ||
13887 (cr->status < 0 &&
13888 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
13889 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
13890 cr->timeout_reason))) ||
13891 (cr->req_ie &&
13892 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
13893 (cr->resp_ie &&
13894 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
13895 cr->resp_ie)) ||
13896 (cr->update_erp_next_seq_num &&
13897 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
13898 cr->fils_erp_next_seq_num)) ||
13899 (cr->status == WLAN_STATUS_SUCCESS &&
13900 ((cr->fils_kek &&
13901 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils_kek_len,
13902 cr->fils_kek)) ||
13903 (cr->pmk &&
13904 nla_put(msg, NL80211_ATTR_PMK, cr->pmk_len, cr->pmk)) ||
13905 (cr->pmkid &&
13906 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->pmkid)))))
13907 goto nla_put_failure;
13908
13909 genlmsg_end(msg, hdr);
13910
13911 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13912 NL80211_MCGRP_MLME, gfp);
13913 return;
13914
13915 nla_put_failure:
13916 genlmsg_cancel(msg, hdr);
13917 nlmsg_free(msg);
13918 }
13919
13920 void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
13921 struct net_device *netdev,
13922 struct cfg80211_roam_info *info, gfp_t gfp)
13923 {
13924 struct sk_buff *msg;
13925 void *hdr;
13926 const u8 *bssid = info->bss ? info->bss->bssid : info->bssid;
13927
13928 msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len, gfp);
13929 if (!msg)
13930 return;
13931
13932 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
13933 if (!hdr) {
13934 nlmsg_free(msg);
13935 return;
13936 }
13937
13938 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13939 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13940 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
13941 (info->req_ie &&
13942 nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
13943 info->req_ie)) ||
13944 (info->resp_ie &&
13945 nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
13946 info->resp_ie)))
13947 goto nla_put_failure;
13948
13949 genlmsg_end(msg, hdr);
13950
13951 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13952 NL80211_MCGRP_MLME, gfp);
13953 return;
13954
13955 nla_put_failure:
13956 genlmsg_cancel(msg, hdr);
13957 nlmsg_free(msg);
13958 }
13959
13960 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev,
13961 struct net_device *netdev, const u8 *bssid)
13962 {
13963 struct sk_buff *msg;
13964 void *hdr;
13965
13966 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13967 if (!msg)
13968 return;
13969
13970 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED);
13971 if (!hdr) {
13972 nlmsg_free(msg);
13973 return;
13974 }
13975
13976 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
13977 goto nla_put_failure;
13978
13979 genlmsg_end(msg, hdr);
13980
13981 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13982 NL80211_MCGRP_MLME, GFP_KERNEL);
13983 return;
13984
13985 nla_put_failure:
13986 genlmsg_cancel(msg, hdr);
13987 nlmsg_free(msg);
13988 }
13989
13990 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
13991 struct net_device *netdev, u16 reason,
13992 const u8 *ie, size_t ie_len, bool from_ap)
13993 {
13994 struct sk_buff *msg;
13995 void *hdr;
13996
13997 msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
13998 if (!msg)
13999 return;
14000
14001 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
14002 if (!hdr) {
14003 nlmsg_free(msg);
14004 return;
14005 }
14006
14007 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14008 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14009 (from_ap && reason &&
14010 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
14011 (from_ap &&
14012 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
14013 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
14014 goto nla_put_failure;
14015
14016 genlmsg_end(msg, hdr);
14017
14018 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14019 NL80211_MCGRP_MLME, GFP_KERNEL);
14020 return;
14021
14022 nla_put_failure:
14023 genlmsg_cancel(msg, hdr);
14024 nlmsg_free(msg);
14025 }
14026
14027 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
14028 struct net_device *netdev, const u8 *bssid,
14029 gfp_t gfp)
14030 {
14031 struct sk_buff *msg;
14032 void *hdr;
14033
14034 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14035 if (!msg)
14036 return;
14037
14038 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
14039 if (!hdr) {
14040 nlmsg_free(msg);
14041 return;
14042 }
14043
14044 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14045 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14046 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
14047 goto nla_put_failure;
14048
14049 genlmsg_end(msg, hdr);
14050
14051 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14052 NL80211_MCGRP_MLME, gfp);
14053 return;
14054
14055 nla_put_failure:
14056 genlmsg_cancel(msg, hdr);
14057 nlmsg_free(msg);
14058 }
14059
14060 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
14061 const u8* ie, u8 ie_len, gfp_t gfp)
14062 {
14063 struct wireless_dev *wdev = dev->ieee80211_ptr;
14064 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14065 struct sk_buff *msg;
14066 void *hdr;
14067
14068 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
14069 return;
14070
14071 trace_cfg80211_notify_new_peer_candidate(dev, addr);
14072
14073 msg = nlmsg_new(100 + ie_len, gfp);
14074 if (!msg)
14075 return;
14076
14077 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
14078 if (!hdr) {
14079 nlmsg_free(msg);
14080 return;
14081 }
14082
14083 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14084 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14085 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
14086 (ie_len && ie &&
14087 nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
14088 goto nla_put_failure;
14089
14090 genlmsg_end(msg, hdr);
14091
14092 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14093 NL80211_MCGRP_MLME, gfp);
14094 return;
14095
14096 nla_put_failure:
14097 genlmsg_cancel(msg, hdr);
14098 nlmsg_free(msg);
14099 }
14100 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
14101
14102 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
14103 struct net_device *netdev, const u8 *addr,
14104 enum nl80211_key_type key_type, int key_id,
14105 const u8 *tsc, gfp_t gfp)
14106 {
14107 struct sk_buff *msg;
14108 void *hdr;
14109
14110 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14111 if (!msg)
14112 return;
14113
14114 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
14115 if (!hdr) {
14116 nlmsg_free(msg);
14117 return;
14118 }
14119
14120 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14121 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14122 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
14123 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
14124 (key_id != -1 &&
14125 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
14126 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
14127 goto nla_put_failure;
14128
14129 genlmsg_end(msg, hdr);
14130
14131 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14132 NL80211_MCGRP_MLME, gfp);
14133 return;
14134
14135 nla_put_failure:
14136 genlmsg_cancel(msg, hdr);
14137 nlmsg_free(msg);
14138 }
14139
14140 void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
14141 struct ieee80211_channel *channel_before,
14142 struct ieee80211_channel *channel_after)
14143 {
14144 struct sk_buff *msg;
14145 void *hdr;
14146 struct nlattr *nl_freq;
14147
14148 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
14149 if (!msg)
14150 return;
14151
14152 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
14153 if (!hdr) {
14154 nlmsg_free(msg);
14155 return;
14156 }
14157
14158 /*
14159 * Since we are applying the beacon hint to a wiphy we know its
14160 * wiphy_idx is valid
14161 */
14162 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
14163 goto nla_put_failure;
14164
14165 /* Before */
14166 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
14167 if (!nl_freq)
14168 goto nla_put_failure;
14169 if (nl80211_msg_put_channel(msg, channel_before, false))
14170 goto nla_put_failure;
14171 nla_nest_end(msg, nl_freq);
14172
14173 /* After */
14174 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
14175 if (!nl_freq)
14176 goto nla_put_failure;
14177 if (nl80211_msg_put_channel(msg, channel_after, false))
14178 goto nla_put_failure;
14179 nla_nest_end(msg, nl_freq);
14180
14181 genlmsg_end(msg, hdr);
14182
14183 rcu_read_lock();
14184 genlmsg_multicast_allns(&nl80211_fam, msg, 0,
14185 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
14186 rcu_read_unlock();
14187
14188 return;
14189
14190 nla_put_failure:
14191 genlmsg_cancel(msg, hdr);
14192 nlmsg_free(msg);
14193 }
14194
14195 static void nl80211_send_remain_on_chan_event(
14196 int cmd, struct cfg80211_registered_device *rdev,
14197 struct wireless_dev *wdev, u64 cookie,
14198 struct ieee80211_channel *chan,
14199 unsigned int duration, gfp_t gfp)
14200 {
14201 struct sk_buff *msg;
14202 void *hdr;
14203
14204 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14205 if (!msg)
14206 return;
14207
14208 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
14209 if (!hdr) {
14210 nlmsg_free(msg);
14211 return;
14212 }
14213
14214 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14215 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14216 wdev->netdev->ifindex)) ||
14217 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14218 NL80211_ATTR_PAD) ||
14219 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
14220 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
14221 NL80211_CHAN_NO_HT) ||
14222 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14223 NL80211_ATTR_PAD))
14224 goto nla_put_failure;
14225
14226 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
14227 nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
14228 goto nla_put_failure;
14229
14230 genlmsg_end(msg, hdr);
14231
14232 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14233 NL80211_MCGRP_MLME, gfp);
14234 return;
14235
14236 nla_put_failure:
14237 genlmsg_cancel(msg, hdr);
14238 nlmsg_free(msg);
14239 }
14240
14241 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
14242 struct ieee80211_channel *chan,
14243 unsigned int duration, gfp_t gfp)
14244 {
14245 struct wiphy *wiphy = wdev->wiphy;
14246 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14247
14248 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
14249 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
14250 rdev, wdev, cookie, chan,
14251 duration, gfp);
14252 }
14253 EXPORT_SYMBOL(cfg80211_ready_on_channel);
14254
14255 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
14256 struct ieee80211_channel *chan,
14257 gfp_t gfp)
14258 {
14259 struct wiphy *wiphy = wdev->wiphy;
14260 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14261
14262 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
14263 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
14264 rdev, wdev, cookie, chan, 0, gfp);
14265 }
14266 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
14267
14268 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
14269 struct station_info *sinfo, gfp_t gfp)
14270 {
14271 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
14272 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14273 struct sk_buff *msg;
14274
14275 trace_cfg80211_new_sta(dev, mac_addr, sinfo);
14276
14277 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14278 if (!msg)
14279 return;
14280
14281 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
14282 rdev, dev, mac_addr, sinfo) < 0) {
14283 nlmsg_free(msg);
14284 return;
14285 }
14286
14287 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14288 NL80211_MCGRP_MLME, gfp);
14289 }
14290 EXPORT_SYMBOL(cfg80211_new_sta);
14291
14292 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
14293 struct station_info *sinfo, gfp_t gfp)
14294 {
14295 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
14296 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14297 struct sk_buff *msg;
14298 struct station_info empty_sinfo = {};
14299
14300 if (!sinfo)
14301 sinfo = &empty_sinfo;
14302
14303 trace_cfg80211_del_sta(dev, mac_addr);
14304
14305 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14306 if (!msg)
14307 return;
14308
14309 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
14310 rdev, dev, mac_addr, sinfo) < 0) {
14311 nlmsg_free(msg);
14312 return;
14313 }
14314
14315 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14316 NL80211_MCGRP_MLME, gfp);
14317 }
14318 EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
14319
14320 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
14321 enum nl80211_connect_failed_reason reason,
14322 gfp_t gfp)
14323 {
14324 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
14325 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14326 struct sk_buff *msg;
14327 void *hdr;
14328
14329 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
14330 if (!msg)
14331 return;
14332
14333 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
14334 if (!hdr) {
14335 nlmsg_free(msg);
14336 return;
14337 }
14338
14339 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14340 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
14341 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
14342 goto nla_put_failure;
14343
14344 genlmsg_end(msg, hdr);
14345
14346 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14347 NL80211_MCGRP_MLME, gfp);
14348 return;
14349
14350 nla_put_failure:
14351 genlmsg_cancel(msg, hdr);
14352 nlmsg_free(msg);
14353 }
14354 EXPORT_SYMBOL(cfg80211_conn_failed);
14355
14356 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
14357 const u8 *addr, gfp_t gfp)
14358 {
14359 struct wireless_dev *wdev = dev->ieee80211_ptr;
14360 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14361 struct sk_buff *msg;
14362 void *hdr;
14363 u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid);
14364
14365 if (!nlportid)
14366 return false;
14367
14368 msg = nlmsg_new(100, gfp);
14369 if (!msg)
14370 return true;
14371
14372 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
14373 if (!hdr) {
14374 nlmsg_free(msg);
14375 return true;
14376 }
14377
14378 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14379 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14380 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
14381 goto nla_put_failure;
14382
14383 genlmsg_end(msg, hdr);
14384 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
14385 return true;
14386
14387 nla_put_failure:
14388 genlmsg_cancel(msg, hdr);
14389 nlmsg_free(msg);
14390 return true;
14391 }
14392
14393 bool cfg80211_rx_spurious_frame(struct net_device *dev,
14394 const u8 *addr, gfp_t gfp)
14395 {
14396 struct wireless_dev *wdev = dev->ieee80211_ptr;
14397 bool ret;
14398
14399 trace_cfg80211_rx_spurious_frame(dev, addr);
14400
14401 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
14402 wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
14403 trace_cfg80211_return_bool(false);
14404 return false;
14405 }
14406 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
14407 addr, gfp);
14408 trace_cfg80211_return_bool(ret);
14409 return ret;
14410 }
14411 EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
14412
14413 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
14414 const u8 *addr, gfp_t gfp)
14415 {
14416 struct wireless_dev *wdev = dev->ieee80211_ptr;
14417 bool ret;
14418
14419 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
14420
14421 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
14422 wdev->iftype != NL80211_IFTYPE_P2P_GO &&
14423 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
14424 trace_cfg80211_return_bool(false);
14425 return false;
14426 }
14427 ret = __nl80211_unexpected_frame(dev,
14428 NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
14429 addr, gfp);
14430 trace_cfg80211_return_bool(ret);
14431 return ret;
14432 }
14433 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
14434
14435 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
14436 struct wireless_dev *wdev, u32 nlportid,
14437 int freq, int sig_dbm,
14438 const u8 *buf, size_t len, u32 flags, gfp_t gfp)
14439 {
14440 struct net_device *netdev = wdev->netdev;
14441 struct sk_buff *msg;
14442 void *hdr;
14443
14444 msg = nlmsg_new(100 + len, gfp);
14445 if (!msg)
14446 return -ENOMEM;
14447
14448 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
14449 if (!hdr) {
14450 nlmsg_free(msg);
14451 return -ENOMEM;
14452 }
14453
14454 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14455 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14456 netdev->ifindex)) ||
14457 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14458 NL80211_ATTR_PAD) ||
14459 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
14460 (sig_dbm &&
14461 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
14462 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
14463 (flags &&
14464 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
14465 goto nla_put_failure;
14466
14467 genlmsg_end(msg, hdr);
14468
14469 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
14470
14471 nla_put_failure:
14472 genlmsg_cancel(msg, hdr);
14473 nlmsg_free(msg);
14474 return -ENOBUFS;
14475 }
14476
14477 void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
14478 const u8 *buf, size_t len, bool ack, gfp_t gfp)
14479 {
14480 struct wiphy *wiphy = wdev->wiphy;
14481 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14482 struct net_device *netdev = wdev->netdev;
14483 struct sk_buff *msg;
14484 void *hdr;
14485
14486 trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
14487
14488 msg = nlmsg_new(100 + len, gfp);
14489 if (!msg)
14490 return;
14491
14492 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
14493 if (!hdr) {
14494 nlmsg_free(msg);
14495 return;
14496 }
14497
14498 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14499 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14500 netdev->ifindex)) ||
14501 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14502 NL80211_ATTR_PAD) ||
14503 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
14504 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14505 NL80211_ATTR_PAD) ||
14506 (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
14507 goto nla_put_failure;
14508
14509 genlmsg_end(msg, hdr);
14510
14511 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14512 NL80211_MCGRP_MLME, gfp);
14513 return;
14514
14515 nla_put_failure:
14516 genlmsg_cancel(msg, hdr);
14517 nlmsg_free(msg);
14518 }
14519 EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
14520
14521 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
14522 const char *mac, gfp_t gfp)
14523 {
14524 struct wireless_dev *wdev = dev->ieee80211_ptr;
14525 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14526 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14527 void **cb;
14528
14529 if (!msg)
14530 return NULL;
14531
14532 cb = (void **)msg->cb;
14533
14534 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
14535 if (!cb[0]) {
14536 nlmsg_free(msg);
14537 return NULL;
14538 }
14539
14540 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14541 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
14542 goto nla_put_failure;
14543
14544 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
14545 goto nla_put_failure;
14546
14547 cb[1] = nla_nest_start(msg, NL80211_ATTR_CQM);
14548 if (!cb[1])
14549 goto nla_put_failure;
14550
14551 cb[2] = rdev;
14552
14553 return msg;
14554 nla_put_failure:
14555 nlmsg_free(msg);
14556 return NULL;
14557 }
14558
14559 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
14560 {
14561 void **cb = (void **)msg->cb;
14562 struct cfg80211_registered_device *rdev = cb[2];
14563
14564 nla_nest_end(msg, cb[1]);
14565 genlmsg_end(msg, cb[0]);
14566
14567 memset(msg->cb, 0, sizeof(msg->cb));
14568
14569 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14570 NL80211_MCGRP_MLME, gfp);
14571 }
14572
14573 void cfg80211_cqm_rssi_notify(struct net_device *dev,
14574 enum nl80211_cqm_rssi_threshold_event rssi_event,
14575 s32 rssi_level, gfp_t gfp)
14576 {
14577 struct sk_buff *msg;
14578 struct wireless_dev *wdev = dev->ieee80211_ptr;
14579 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14580
14581 trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
14582
14583 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
14584 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
14585 return;
14586
14587 if (wdev->cqm_config) {
14588 wdev->cqm_config->last_rssi_event_value = rssi_level;
14589
14590 cfg80211_cqm_rssi_update(rdev, dev);
14591
14592 if (rssi_level == 0)
14593 rssi_level = wdev->cqm_config->last_rssi_event_value;
14594 }
14595
14596 msg = cfg80211_prepare_cqm(dev, NULL, gfp);
14597 if (!msg)
14598 return;
14599
14600 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
14601 rssi_event))
14602 goto nla_put_failure;
14603
14604 if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
14605 rssi_level))
14606 goto nla_put_failure;
14607
14608 cfg80211_send_cqm(msg, gfp);
14609
14610 return;
14611
14612 nla_put_failure:
14613 nlmsg_free(msg);
14614 }
14615 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
14616
14617 void cfg80211_cqm_txe_notify(struct net_device *dev,
14618 const u8 *peer, u32 num_packets,
14619 u32 rate, u32 intvl, gfp_t gfp)
14620 {
14621 struct sk_buff *msg;
14622
14623 msg = cfg80211_prepare_cqm(dev, peer, gfp);
14624 if (!msg)
14625 return;
14626
14627 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
14628 goto nla_put_failure;
14629
14630 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
14631 goto nla_put_failure;
14632
14633 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
14634 goto nla_put_failure;
14635
14636 cfg80211_send_cqm(msg, gfp);
14637 return;
14638
14639 nla_put_failure:
14640 nlmsg_free(msg);
14641 }
14642 EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
14643
14644 void cfg80211_cqm_pktloss_notify(struct net_device *dev,
14645 const u8 *peer, u32 num_packets, gfp_t gfp)
14646 {
14647 struct sk_buff *msg;
14648
14649 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
14650
14651 msg = cfg80211_prepare_cqm(dev, peer, gfp);
14652 if (!msg)
14653 return;
14654
14655 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
14656 goto nla_put_failure;
14657
14658 cfg80211_send_cqm(msg, gfp);
14659 return;
14660
14661 nla_put_failure:
14662 nlmsg_free(msg);
14663 }
14664 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
14665
14666 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
14667 {
14668 struct sk_buff *msg;
14669
14670 msg = cfg80211_prepare_cqm(dev, NULL, gfp);
14671 if (!msg)
14672 return;
14673
14674 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
14675 goto nla_put_failure;
14676
14677 cfg80211_send_cqm(msg, gfp);
14678 return;
14679
14680 nla_put_failure:
14681 nlmsg_free(msg);
14682 }
14683 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
14684
14685 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
14686 struct net_device *netdev, const u8 *bssid,
14687 const u8 *replay_ctr, gfp_t gfp)
14688 {
14689 struct sk_buff *msg;
14690 struct nlattr *rekey_attr;
14691 void *hdr;
14692
14693 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14694 if (!msg)
14695 return;
14696
14697 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
14698 if (!hdr) {
14699 nlmsg_free(msg);
14700 return;
14701 }
14702
14703 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14704 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14705 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
14706 goto nla_put_failure;
14707
14708 rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
14709 if (!rekey_attr)
14710 goto nla_put_failure;
14711
14712 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
14713 NL80211_REPLAY_CTR_LEN, replay_ctr))
14714 goto nla_put_failure;
14715
14716 nla_nest_end(msg, rekey_attr);
14717
14718 genlmsg_end(msg, hdr);
14719
14720 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14721 NL80211_MCGRP_MLME, gfp);
14722 return;
14723
14724 nla_put_failure:
14725 genlmsg_cancel(msg, hdr);
14726 nlmsg_free(msg);
14727 }
14728
14729 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
14730 const u8 *replay_ctr, gfp_t gfp)
14731 {
14732 struct wireless_dev *wdev = dev->ieee80211_ptr;
14733 struct wiphy *wiphy = wdev->wiphy;
14734 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14735
14736 trace_cfg80211_gtk_rekey_notify(dev, bssid);
14737 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
14738 }
14739 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
14740
14741 static void
14742 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
14743 struct net_device *netdev, int index,
14744 const u8 *bssid, bool preauth, gfp_t gfp)
14745 {
14746 struct sk_buff *msg;
14747 struct nlattr *attr;
14748 void *hdr;
14749
14750 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14751 if (!msg)
14752 return;
14753
14754 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
14755 if (!hdr) {
14756 nlmsg_free(msg);
14757 return;
14758 }
14759
14760 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14761 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
14762 goto nla_put_failure;
14763
14764 attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
14765 if (!attr)
14766 goto nla_put_failure;
14767
14768 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
14769 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
14770 (preauth &&
14771 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
14772 goto nla_put_failure;
14773
14774 nla_nest_end(msg, attr);
14775
14776 genlmsg_end(msg, hdr);
14777
14778 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14779 NL80211_MCGRP_MLME, gfp);
14780 return;
14781
14782 nla_put_failure:
14783 genlmsg_cancel(msg, hdr);
14784 nlmsg_free(msg);
14785 }
14786
14787 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
14788 const u8 *bssid, bool preauth, gfp_t gfp)
14789 {
14790 struct wireless_dev *wdev = dev->ieee80211_ptr;
14791 struct wiphy *wiphy = wdev->wiphy;
14792 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14793
14794 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
14795 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
14796 }
14797 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
14798
14799 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
14800 struct net_device *netdev,
14801 struct cfg80211_chan_def *chandef,
14802 gfp_t gfp,
14803 enum nl80211_commands notif,
14804 u8 count)
14805 {
14806 struct sk_buff *msg;
14807 void *hdr;
14808
14809 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14810 if (!msg)
14811 return;
14812
14813 hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
14814 if (!hdr) {
14815 nlmsg_free(msg);
14816 return;
14817 }
14818
14819 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
14820 goto nla_put_failure;
14821
14822 if (nl80211_send_chandef(msg, chandef))
14823 goto nla_put_failure;
14824
14825 if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
14826 (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
14827 goto nla_put_failure;
14828
14829 genlmsg_end(msg, hdr);
14830
14831 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14832 NL80211_MCGRP_MLME, gfp);
14833 return;
14834
14835 nla_put_failure:
14836 genlmsg_cancel(msg, hdr);
14837 nlmsg_free(msg);
14838 }
14839
14840 void cfg80211_ch_switch_notify(struct net_device *dev,
14841 struct cfg80211_chan_def *chandef)
14842 {
14843 struct wireless_dev *wdev = dev->ieee80211_ptr;
14844 struct wiphy *wiphy = wdev->wiphy;
14845 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14846
14847 ASSERT_WDEV_LOCK(wdev);
14848
14849 trace_cfg80211_ch_switch_notify(dev, chandef);
14850
14851 wdev->chandef = *chandef;
14852 wdev->preset_chandef = *chandef;
14853
14854 if (wdev->iftype == NL80211_IFTYPE_STATION &&
14855 !WARN_ON(!wdev->current_bss))
14856 wdev->current_bss->pub.channel = chandef->chan;
14857
14858 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
14859 NL80211_CMD_CH_SWITCH_NOTIFY, 0);
14860 }
14861 EXPORT_SYMBOL(cfg80211_ch_switch_notify);
14862
14863 void cfg80211_ch_switch_started_notify(struct net_device *dev,
14864 struct cfg80211_chan_def *chandef,
14865 u8 count)
14866 {
14867 struct wireless_dev *wdev = dev->ieee80211_ptr;
14868 struct wiphy *wiphy = wdev->wiphy;
14869 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14870
14871 trace_cfg80211_ch_switch_started_notify(dev, chandef);
14872
14873 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
14874 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
14875 }
14876 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
14877
14878 void
14879 nl80211_radar_notify(struct cfg80211_registered_device *rdev,
14880 const struct cfg80211_chan_def *chandef,
14881 enum nl80211_radar_event event,
14882 struct net_device *netdev, gfp_t gfp)
14883 {
14884 struct sk_buff *msg;
14885 void *hdr;
14886
14887 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14888 if (!msg)
14889 return;
14890
14891 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
14892 if (!hdr) {
14893 nlmsg_free(msg);
14894 return;
14895 }
14896
14897 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
14898 goto nla_put_failure;
14899
14900 /* NOP and radar events don't need a netdev parameter */
14901 if (netdev) {
14902 struct wireless_dev *wdev = netdev->ieee80211_ptr;
14903
14904 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14905 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14906 NL80211_ATTR_PAD))
14907 goto nla_put_failure;
14908 }
14909
14910 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
14911 goto nla_put_failure;
14912
14913 if (nl80211_send_chandef(msg, chandef))
14914 goto nla_put_failure;
14915
14916 genlmsg_end(msg, hdr);
14917
14918 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14919 NL80211_MCGRP_MLME, gfp);
14920 return;
14921
14922 nla_put_failure:
14923 genlmsg_cancel(msg, hdr);
14924 nlmsg_free(msg);
14925 }
14926
14927 void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
14928 u64 cookie, bool acked, gfp_t gfp)
14929 {
14930 struct wireless_dev *wdev = dev->ieee80211_ptr;
14931 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14932 struct sk_buff *msg;
14933 void *hdr;
14934
14935 trace_cfg80211_probe_status(dev, addr, cookie, acked);
14936
14937 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14938
14939 if (!msg)
14940 return;
14941
14942 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
14943 if (!hdr) {
14944 nlmsg_free(msg);
14945 return;
14946 }
14947
14948 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14949 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14950 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
14951 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14952 NL80211_ATTR_PAD) ||
14953 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)))
14954 goto nla_put_failure;
14955
14956 genlmsg_end(msg, hdr);
14957
14958 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14959 NL80211_MCGRP_MLME, gfp);
14960 return;
14961
14962 nla_put_failure:
14963 genlmsg_cancel(msg, hdr);
14964 nlmsg_free(msg);
14965 }
14966 EXPORT_SYMBOL(cfg80211_probe_status);
14967
14968 void cfg80211_report_obss_beacon(struct wiphy *wiphy,
14969 const u8 *frame, size_t len,
14970 int freq, int sig_dbm)
14971 {
14972 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14973 struct sk_buff *msg;
14974 void *hdr;
14975 struct cfg80211_beacon_registration *reg;
14976
14977 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
14978
14979 spin_lock_bh(&rdev->beacon_registrations_lock);
14980 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
14981 msg = nlmsg_new(len + 100, GFP_ATOMIC);
14982 if (!msg) {
14983 spin_unlock_bh(&rdev->beacon_registrations_lock);
14984 return;
14985 }
14986
14987 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
14988 if (!hdr)
14989 goto nla_put_failure;
14990
14991 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14992 (freq &&
14993 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
14994 (sig_dbm &&
14995 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
14996 nla_put(msg, NL80211_ATTR_FRAME, len, frame))
14997 goto nla_put_failure;
14998
14999 genlmsg_end(msg, hdr);
15000
15001 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
15002 }
15003 spin_unlock_bh(&rdev->beacon_registrations_lock);
15004 return;
15005
15006 nla_put_failure:
15007 spin_unlock_bh(&rdev->beacon_registrations_lock);
15008 if (hdr)
15009 genlmsg_cancel(msg, hdr);
15010 nlmsg_free(msg);
15011 }
15012 EXPORT_SYMBOL(cfg80211_report_obss_beacon);
15013
15014 #ifdef CONFIG_PM
15015 static int cfg80211_net_detect_results(struct sk_buff *msg,
15016 struct cfg80211_wowlan_wakeup *wakeup)
15017 {
15018 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
15019 struct nlattr *nl_results, *nl_match, *nl_freqs;
15020 int i, j;
15021
15022 nl_results = nla_nest_start(
15023 msg, NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
15024 if (!nl_results)
15025 return -EMSGSIZE;
15026
15027 for (i = 0; i < nd->n_matches; i++) {
15028 struct cfg80211_wowlan_nd_match *match = nd->matches[i];
15029
15030 nl_match = nla_nest_start(msg, i);
15031 if (!nl_match)
15032 break;
15033
15034 /* The SSID attribute is optional in nl80211, but for
15035 * simplicity reasons it's always present in the
15036 * cfg80211 structure. If a driver can't pass the
15037 * SSID, that needs to be changed. A zero length SSID
15038 * is still a valid SSID (wildcard), so it cannot be
15039 * used for this purpose.
15040 */
15041 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
15042 match->ssid.ssid)) {
15043 nla_nest_cancel(msg, nl_match);
15044 goto out;
15045 }
15046
15047 if (match->n_channels) {
15048 nl_freqs = nla_nest_start(
15049 msg, NL80211_ATTR_SCAN_FREQUENCIES);
15050 if (!nl_freqs) {
15051 nla_nest_cancel(msg, nl_match);
15052 goto out;
15053 }
15054
15055 for (j = 0; j < match->n_channels; j++) {
15056 if (nla_put_u32(msg, j, match->channels[j])) {
15057 nla_nest_cancel(msg, nl_freqs);
15058 nla_nest_cancel(msg, nl_match);
15059 goto out;
15060 }
15061 }
15062
15063 nla_nest_end(msg, nl_freqs);
15064 }
15065
15066 nla_nest_end(msg, nl_match);
15067 }
15068
15069 out:
15070 nla_nest_end(msg, nl_results);
15071 return 0;
15072 }
15073
15074 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
15075 struct cfg80211_wowlan_wakeup *wakeup,
15076 gfp_t gfp)
15077 {
15078 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15079 struct sk_buff *msg;
15080 void *hdr;
15081 int size = 200;
15082
15083 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
15084
15085 if (wakeup)
15086 size += wakeup->packet_present_len;
15087
15088 msg = nlmsg_new(size, gfp);
15089 if (!msg)
15090 return;
15091
15092 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
15093 if (!hdr)
15094 goto free_msg;
15095
15096 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15097 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15098 NL80211_ATTR_PAD))
15099 goto free_msg;
15100
15101 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15102 wdev->netdev->ifindex))
15103 goto free_msg;
15104
15105 if (wakeup) {
15106 struct nlattr *reasons;
15107
15108 reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
15109 if (!reasons)
15110 goto free_msg;
15111
15112 if (wakeup->disconnect &&
15113 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
15114 goto free_msg;
15115 if (wakeup->magic_pkt &&
15116 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
15117 goto free_msg;
15118 if (wakeup->gtk_rekey_failure &&
15119 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
15120 goto free_msg;
15121 if (wakeup->eap_identity_req &&
15122 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
15123 goto free_msg;
15124 if (wakeup->four_way_handshake &&
15125 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
15126 goto free_msg;
15127 if (wakeup->rfkill_release &&
15128 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
15129 goto free_msg;
15130
15131 if (wakeup->pattern_idx >= 0 &&
15132 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
15133 wakeup->pattern_idx))
15134 goto free_msg;
15135
15136 if (wakeup->tcp_match &&
15137 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
15138 goto free_msg;
15139
15140 if (wakeup->tcp_connlost &&
15141 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
15142 goto free_msg;
15143
15144 if (wakeup->tcp_nomoretokens &&
15145 nla_put_flag(msg,
15146 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
15147 goto free_msg;
15148
15149 if (wakeup->packet) {
15150 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
15151 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
15152
15153 if (!wakeup->packet_80211) {
15154 pkt_attr =
15155 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
15156 len_attr =
15157 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
15158 }
15159
15160 if (wakeup->packet_len &&
15161 nla_put_u32(msg, len_attr, wakeup->packet_len))
15162 goto free_msg;
15163
15164 if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
15165 wakeup->packet))
15166 goto free_msg;
15167 }
15168
15169 if (wakeup->net_detect &&
15170 cfg80211_net_detect_results(msg, wakeup))
15171 goto free_msg;
15172
15173 nla_nest_end(msg, reasons);
15174 }
15175
15176 genlmsg_end(msg, hdr);
15177
15178 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15179 NL80211_MCGRP_MLME, gfp);
15180 return;
15181
15182 free_msg:
15183 nlmsg_free(msg);
15184 }
15185 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
15186 #endif
15187
15188 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
15189 enum nl80211_tdls_operation oper,
15190 u16 reason_code, gfp_t gfp)
15191 {
15192 struct wireless_dev *wdev = dev->ieee80211_ptr;
15193 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15194 struct sk_buff *msg;
15195 void *hdr;
15196
15197 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
15198 reason_code);
15199
15200 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15201 if (!msg)
15202 return;
15203
15204 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
15205 if (!hdr) {
15206 nlmsg_free(msg);
15207 return;
15208 }
15209
15210 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15211 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15212 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
15213 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
15214 (reason_code > 0 &&
15215 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
15216 goto nla_put_failure;
15217
15218 genlmsg_end(msg, hdr);
15219
15220 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15221 NL80211_MCGRP_MLME, gfp);
15222 return;
15223
15224 nla_put_failure:
15225 genlmsg_cancel(msg, hdr);
15226 nlmsg_free(msg);
15227 }
15228 EXPORT_SYMBOL(cfg80211_tdls_oper_request);
15229
15230 static int nl80211_netlink_notify(struct notifier_block * nb,
15231 unsigned long state,
15232 void *_notify)
15233 {
15234 struct netlink_notify *notify = _notify;
15235 struct cfg80211_registered_device *rdev;
15236 struct wireless_dev *wdev;
15237 struct cfg80211_beacon_registration *reg, *tmp;
15238
15239 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
15240 return NOTIFY_DONE;
15241
15242 rcu_read_lock();
15243
15244 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
15245 struct cfg80211_sched_scan_request *sched_scan_req;
15246
15247 list_for_each_entry_rcu(sched_scan_req,
15248 &rdev->sched_scan_req_list,
15249 list) {
15250 if (sched_scan_req->owner_nlportid == notify->portid) {
15251 sched_scan_req->nl_owner_dead = true;
15252 schedule_work(&rdev->sched_scan_stop_wk);
15253 }
15254 }
15255
15256 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
15257 cfg80211_mlme_unregister_socket(wdev, notify->portid);
15258
15259 if (wdev->owner_nlportid == notify->portid) {
15260 wdev->nl_owner_dead = true;
15261 schedule_work(&rdev->destroy_work);
15262 } else if (wdev->conn_owner_nlportid == notify->portid) {
15263 schedule_work(&wdev->disconnect_wk);
15264 }
15265 }
15266
15267 spin_lock_bh(&rdev->beacon_registrations_lock);
15268 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
15269 list) {
15270 if (reg->nlportid == notify->portid) {
15271 list_del(&reg->list);
15272 kfree(reg);
15273 break;
15274 }
15275 }
15276 spin_unlock_bh(&rdev->beacon_registrations_lock);
15277 }
15278
15279 rcu_read_unlock();
15280
15281 /*
15282 * It is possible that the user space process that is controlling the
15283 * indoor setting disappeared, so notify the regulatory core.
15284 */
15285 regulatory_netlink_notify(notify->portid);
15286 return NOTIFY_OK;
15287 }
15288
15289 static struct notifier_block nl80211_netlink_notifier = {
15290 .notifier_call = nl80211_netlink_notify,
15291 };
15292
15293 void cfg80211_ft_event(struct net_device *netdev,
15294 struct cfg80211_ft_event_params *ft_event)
15295 {
15296 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
15297 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15298 struct sk_buff *msg;
15299 void *hdr;
15300
15301 trace_cfg80211_ft_event(wiphy, netdev, ft_event);
15302
15303 if (!ft_event->target_ap)
15304 return;
15305
15306 msg = nlmsg_new(100 + ft_event->ric_ies_len, GFP_KERNEL);
15307 if (!msg)
15308 return;
15309
15310 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
15311 if (!hdr)
15312 goto out;
15313
15314 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15315 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15316 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
15317 goto out;
15318
15319 if (ft_event->ies &&
15320 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
15321 goto out;
15322 if (ft_event->ric_ies &&
15323 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
15324 ft_event->ric_ies))
15325 goto out;
15326
15327 genlmsg_end(msg, hdr);
15328
15329 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15330 NL80211_MCGRP_MLME, GFP_KERNEL);
15331 return;
15332 out:
15333 nlmsg_free(msg);
15334 }
15335 EXPORT_SYMBOL(cfg80211_ft_event);
15336
15337 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
15338 {
15339 struct cfg80211_registered_device *rdev;
15340 struct sk_buff *msg;
15341 void *hdr;
15342 u32 nlportid;
15343
15344 rdev = wiphy_to_rdev(wdev->wiphy);
15345 if (!rdev->crit_proto_nlportid)
15346 return;
15347
15348 nlportid = rdev->crit_proto_nlportid;
15349 rdev->crit_proto_nlportid = 0;
15350
15351 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15352 if (!msg)
15353 return;
15354
15355 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
15356 if (!hdr)
15357 goto nla_put_failure;
15358
15359 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15360 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15361 NL80211_ATTR_PAD))
15362 goto nla_put_failure;
15363
15364 genlmsg_end(msg, hdr);
15365
15366 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15367 return;
15368
15369 nla_put_failure:
15370 if (hdr)
15371 genlmsg_cancel(msg, hdr);
15372 nlmsg_free(msg);
15373 }
15374 EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
15375
15376 void nl80211_send_ap_stopped(struct wireless_dev *wdev)
15377 {
15378 struct wiphy *wiphy = wdev->wiphy;
15379 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15380 struct sk_buff *msg;
15381 void *hdr;
15382
15383 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15384 if (!msg)
15385 return;
15386
15387 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
15388 if (!hdr)
15389 goto out;
15390
15391 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15392 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
15393 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15394 NL80211_ATTR_PAD))
15395 goto out;
15396
15397 genlmsg_end(msg, hdr);
15398
15399 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
15400 NL80211_MCGRP_MLME, GFP_KERNEL);
15401 return;
15402 out:
15403 nlmsg_free(msg);
15404 }
15405
15406 /* initialisation/exit functions */
15407
15408 int __init nl80211_init(void)
15409 {
15410 int err;
15411
15412 err = genl_register_family(&nl80211_fam);
15413 if (err)
15414 return err;
15415
15416 err = netlink_register_notifier(&nl80211_netlink_notifier);
15417 if (err)
15418 goto err_out;
15419
15420 return 0;
15421 err_out:
15422 genl_unregister_family(&nl80211_fam);
15423 return err;
15424 }
15425
15426 void nl80211_exit(void)
15427 {
15428 netlink_unregister_notifier(&nl80211_netlink_notifier);
15429 genl_unregister_family(&nl80211_fam);
15430 }
ubuntu-bionic-kernel mirror