]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - net/wireless/nl80211.c
projects / mirror_ubuntu-artful-kernel.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
nl80211: allow multiple active scheduled scan requests
[mirror_ubuntu-artful-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/etherdevice.h>
20 #include <net/net_namespace.h>
21 #include <net/genetlink.h>
22 #include <net/cfg80211.h>
23 #include <net/sock.h>
24 #include <net/inet_connection_sock.h>
25 #include "core.h"
26 #include "nl80211.h"
27 #include "reg.h"
28 #include "rdev-ops.h"
29
30 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
31 struct genl_info *info,
32 struct cfg80211_crypto_settings *settings,
33 int cipher_limit);
34
35 /* the netlink family */
36 static struct genl_family nl80211_fam;
37
38 /* multicast groups */
39 enum nl80211_multicast_groups {
40 NL80211_MCGRP_CONFIG,
41 NL80211_MCGRP_SCAN,
42 NL80211_MCGRP_REGULATORY,
43 NL80211_MCGRP_MLME,
44 NL80211_MCGRP_VENDOR,
45 NL80211_MCGRP_NAN,
46 NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
47 };
48
49 static const struct genl_multicast_group nl80211_mcgrps[] = {
50 [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
51 [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
52 [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
53 [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
54 [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
55 [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
56 #ifdef CONFIG_NL80211_TESTMODE
57 [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
58 #endif
59 };
60
61 /* returns ERR_PTR values */
62 static struct wireless_dev *
63 __cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
64 {
65 struct cfg80211_registered_device *rdev;
66 struct wireless_dev *result = NULL;
67 bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
68 bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
69 u64 wdev_id;
70 int wiphy_idx = -1;
71 int ifidx = -1;
72
73 ASSERT_RTNL();
74
75 if (!have_ifidx && !have_wdev_id)
76 return ERR_PTR(-EINVAL);
77
78 if (have_ifidx)
79 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
80 if (have_wdev_id) {
81 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
82 wiphy_idx = wdev_id >> 32;
83 }
84
85 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
86 struct wireless_dev *wdev;
87
88 if (wiphy_net(&rdev->wiphy) != netns)
89 continue;
90
91 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
92 continue;
93
94 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
95 if (have_ifidx && wdev->netdev &&
96 wdev->netdev->ifindex == ifidx) {
97 result = wdev;
98 break;
99 }
100 if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
101 result = wdev;
102 break;
103 }
104 }
105
106 if (result)
107 break;
108 }
109
110 if (result)
111 return result;
112 return ERR_PTR(-ENODEV);
113 }
114
115 static struct cfg80211_registered_device *
116 __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
117 {
118 struct cfg80211_registered_device *rdev = NULL, *tmp;
119 struct net_device *netdev;
120
121 ASSERT_RTNL();
122
123 if (!attrs[NL80211_ATTR_WIPHY] &&
124 !attrs[NL80211_ATTR_IFINDEX] &&
125 !attrs[NL80211_ATTR_WDEV])
126 return ERR_PTR(-EINVAL);
127
128 if (attrs[NL80211_ATTR_WIPHY])
129 rdev = cfg80211_rdev_by_wiphy_idx(
130 nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
131
132 if (attrs[NL80211_ATTR_WDEV]) {
133 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
134 struct wireless_dev *wdev;
135 bool found = false;
136
137 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
138 if (tmp) {
139 /* make sure wdev exists */
140 list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
141 if (wdev->identifier != (u32)wdev_id)
142 continue;
143 found = true;
144 break;
145 }
146
147 if (!found)
148 tmp = NULL;
149
150 if (rdev && tmp != rdev)
151 return ERR_PTR(-EINVAL);
152 rdev = tmp;
153 }
154 }
155
156 if (attrs[NL80211_ATTR_IFINDEX]) {
157 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
158
159 netdev = __dev_get_by_index(netns, ifindex);
160 if (netdev) {
161 if (netdev->ieee80211_ptr)
162 tmp = wiphy_to_rdev(
163 netdev->ieee80211_ptr->wiphy);
164 else
165 tmp = NULL;
166
167 /* not wireless device -- return error */
168 if (!tmp)
169 return ERR_PTR(-EINVAL);
170
171 /* mismatch -- return error */
172 if (rdev && tmp != rdev)
173 return ERR_PTR(-EINVAL);
174
175 rdev = tmp;
176 }
177 }
178
179 if (!rdev)
180 return ERR_PTR(-ENODEV);
181
182 if (netns != wiphy_net(&rdev->wiphy))
183 return ERR_PTR(-ENODEV);
184
185 return rdev;
186 }
187
188 /*
189 * This function returns a pointer to the driver
190 * that the genl_info item that is passed refers to.
191 *
192 * The result of this can be a PTR_ERR and hence must
193 * be checked with IS_ERR() for errors.
194 */
195 static struct cfg80211_registered_device *
196 cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
197 {
198 return __cfg80211_rdev_from_attrs(netns, info->attrs);
199 }
200
201 /* policy for the attributes */
202 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
203 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
204 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
205 .len = 20-1 },
206 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
207
208 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
209 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
210 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
211 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
212 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
213
214 [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
215 [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
216 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
217 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
218 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
219 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
220
221 [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
222 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
223 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
224
225 [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
226 [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
227
228 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
229 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
230 .len = WLAN_MAX_KEY_LEN },
231 [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
232 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
233 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
234 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
235 [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
236
237 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
238 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
239 [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
240 .len = IEEE80211_MAX_DATA_LEN },
241 [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
242 .len = IEEE80211_MAX_DATA_LEN },
243 [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
244 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
245 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
246 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
247 .len = NL80211_MAX_SUPP_RATES },
248 [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
249 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
250 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
251 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
252 .len = IEEE80211_MAX_MESH_ID_LEN },
253 [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
254
255 [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
256 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
257
258 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
259 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
260 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
261 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
262 .len = NL80211_MAX_SUPP_RATES },
263 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
264
265 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
266 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
267
268 [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
269
270 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
271 [NL80211_ATTR_IE] = { .type = NLA_BINARY,
272 .len = IEEE80211_MAX_DATA_LEN },
273 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
274 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
275
276 [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
277 .len = IEEE80211_MAX_SSID_LEN },
278 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
279 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
280 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
281 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
282 [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
283 [NL80211_ATTR_STA_FLAGS2] = {
284 .len = sizeof(struct nl80211_sta_flag_update),
285 },
286 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
287 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
288 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
289 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
290 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
291 [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
292 [NL80211_ATTR_PID] = { .type = NLA_U32 },
293 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
294 [NL80211_ATTR_PMKID] = { .type = NLA_BINARY,
295 .len = WLAN_PMKID_LEN },
296 [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
297 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
298 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
299 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
300 .len = IEEE80211_MAX_DATA_LEN },
301 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
302 [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
303 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
304 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
305 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
306 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
307 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
308 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
309 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
310 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
311 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
312 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
313 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
314 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
315 [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
316 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
317 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
318 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
319 [NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
320 [NL80211_ATTR_IE_PROBE_RESP] = { .type = NLA_BINARY,
321 .len = IEEE80211_MAX_DATA_LEN },
322 [NL80211_ATTR_IE_ASSOC_RESP] = { .type = NLA_BINARY,
323 .len = IEEE80211_MAX_DATA_LEN },
324 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
325 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
326 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
327 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
328 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
329 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
330 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
331 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
332 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
333 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
334 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
335 .len = IEEE80211_MAX_DATA_LEN },
336 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
337 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
338 [NL80211_ATTR_HT_CAPABILITY_MASK] = {
339 .len = NL80211_HT_CAPABILITY_LEN
340 },
341 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
342 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
343 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
344 [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
345 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
346 [NL80211_ATTR_AUTH_DATA] = { .type = NLA_BINARY, },
347 [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
348 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
349 [NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
350 [NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
351 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
352 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
353 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
354 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
355 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
356 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
357 [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
358 .len = NL80211_VHT_CAPABILITY_LEN,
359 },
360 [NL80211_ATTR_MDID] = { .type = NLA_U16 },
361 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
362 .len = IEEE80211_MAX_DATA_LEN },
363 [NL80211_ATTR_PEER_AID] = { .type = NLA_U16 },
364 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
365 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
366 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
367 [NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
368 [NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
369 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
370 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
371 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
372 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
373 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
374 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
375 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
376 [NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
377 .len = IEEE80211_QOS_MAP_LEN_MAX },
378 [NL80211_ATTR_MAC_HINT] = { .len = ETH_ALEN },
379 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
380 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
381 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
382 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
383 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
384 [NL80211_ATTR_TSID] = { .type = NLA_U8 },
385 [NL80211_ATTR_USER_PRIO] = { .type = NLA_U8 },
386 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
387 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
388 [NL80211_ATTR_MAC_MASK] = { .len = ETH_ALEN },
389 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
390 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
391 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
392 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
393 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
394 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
395 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = { .type = NLA_U8 },
396 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
397 .len = VHT_MUMIMO_GROUPS_DATA_LEN
398 },
399 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = { .len = ETH_ALEN },
400 [NL80211_ATTR_NAN_MASTER_PREF] = { .type = NLA_U8 },
401 [NL80211_ATTR_BANDS] = { .type = NLA_U32 },
402 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
403 [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
404 .len = FILS_MAX_KEK_LEN },
405 [NL80211_ATTR_FILS_NONCES] = { .len = 2 * FILS_NONCE_LEN },
406 [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
407 [NL80211_ATTR_BSSID] = { .len = ETH_ALEN },
408 [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
409 [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
410 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
411 },
412 [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
413 [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
414 .len = FILS_ERP_MAX_USERNAME_LEN },
415 [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
416 .len = FILS_ERP_MAX_REALM_LEN },
417 [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
418 [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
419 .len = FILS_ERP_MAX_RRK_LEN },
420 [NL80211_ATTR_FILS_CACHE_ID] = { .len = 2 },
421 [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
422 [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
423 };
424
425 /* policy for the key attributes */
426 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
427 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
428 [NL80211_KEY_IDX] = { .type = NLA_U8 },
429 [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
430 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
431 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
432 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
433 [NL80211_KEY_TYPE] = { .type = NLA_U32 },
434 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
435 };
436
437 /* policy for the key default flags */
438 static const struct nla_policy
439 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
440 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
441 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
442 };
443
444 #ifdef CONFIG_PM
445 /* policy for WoWLAN attributes */
446 static const struct nla_policy
447 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
448 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
449 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
450 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
451 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
452 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
453 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
454 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
455 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
456 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
457 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
458 };
459
460 static const struct nla_policy
461 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
462 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
463 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
464 [NL80211_WOWLAN_TCP_DST_MAC] = { .len = ETH_ALEN },
465 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
466 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
467 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .len = 1 },
468 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
469 .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
470 },
471 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
472 .len = sizeof(struct nl80211_wowlan_tcp_data_token)
473 },
474 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
475 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .len = 1 },
476 [NL80211_WOWLAN_TCP_WAKE_MASK] = { .len = 1 },
477 };
478 #endif /* CONFIG_PM */
479
480 /* policy for coalesce rule attributes */
481 static const struct nla_policy
482 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
483 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
484 [NL80211_ATTR_COALESCE_RULE_CONDITION] = { .type = NLA_U32 },
485 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
486 };
487
488 /* policy for GTK rekey offload attributes */
489 static const struct nla_policy
490 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
491 [NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
492 [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
493 [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
494 };
495
496 static const struct nla_policy
497 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
498 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
499 .len = IEEE80211_MAX_SSID_LEN },
500 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
501 };
502
503 static const struct nla_policy
504 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
505 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
506 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
507 };
508
509 static const struct nla_policy
510 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
511 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
512 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
513 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
514 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
515 },
516 };
517
518 /* policy for NAN function attributes */
519 static const struct nla_policy
520 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
521 [NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
522 [NL80211_NAN_FUNC_SERVICE_ID] = { .type = NLA_BINARY,
523 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
524 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
525 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
526 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
527 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
528 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
529 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = { .len = ETH_ALEN },
530 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
531 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
532 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
533 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
534 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
535 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
536 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
537 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
538 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
539 };
540
541 /* policy for Service Response Filter attributes */
542 static const struct nla_policy
543 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
544 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
545 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
546 .len = NL80211_NAN_FUNC_SRF_MAX_LEN },
547 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
548 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
549 };
550
551 static int nl80211_prepare_wdev_dump(struct sk_buff *skb,
552 struct netlink_callback *cb,
553 struct cfg80211_registered_device **rdev,
554 struct wireless_dev **wdev)
555 {
556 int err;
557
558 if (!cb->args[0]) {
559 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
560 genl_family_attrbuf(&nl80211_fam),
561 nl80211_fam.maxattr, nl80211_policy, NULL);
562 if (err)
563 return err;
564
565 *wdev = __cfg80211_wdev_from_attrs(
566 sock_net(skb->sk),
567 genl_family_attrbuf(&nl80211_fam));
568 if (IS_ERR(*wdev))
569 return PTR_ERR(*wdev);
570 *rdev = wiphy_to_rdev((*wdev)->wiphy);
571 /* 0 is the first index - add 1 to parse only once */
572 cb->args[0] = (*rdev)->wiphy_idx + 1;
573 cb->args[1] = (*wdev)->identifier;
574 } else {
575 /* subtract the 1 again here */
576 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
577 struct wireless_dev *tmp;
578
579 if (!wiphy)
580 return -ENODEV;
581 *rdev = wiphy_to_rdev(wiphy);
582 *wdev = NULL;
583
584 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
585 if (tmp->identifier == cb->args[1]) {
586 *wdev = tmp;
587 break;
588 }
589 }
590
591 if (!*wdev)
592 return -ENODEV;
593 }
594
595 return 0;
596 }
597
598 /* IE validation */
599 static bool is_valid_ie_attr(const struct nlattr *attr)
600 {
601 const u8 *pos;
602 int len;
603
604 if (!attr)
605 return true;
606
607 pos = nla_data(attr);
608 len = nla_len(attr);
609
610 while (len) {
611 u8 elemlen;
612
613 if (len < 2)
614 return false;
615 len -= 2;
616
617 elemlen = pos[1];
618 if (elemlen > len)
619 return false;
620
621 len -= elemlen;
622 pos += 2 + elemlen;
623 }
624
625 return true;
626 }
627
628 /* message building helper */
629 static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
630 int flags, u8 cmd)
631 {
632 /* since there is no private header just add the generic one */
633 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
634 }
635
636 static int nl80211_msg_put_channel(struct sk_buff *msg,
637 struct ieee80211_channel *chan,
638 bool large)
639 {
640 /* Some channels must be completely excluded from the
641 * list to protect old user-space tools from breaking
642 */
643 if (!large && chan->flags &
644 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
645 return 0;
646
647 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
648 chan->center_freq))
649 goto nla_put_failure;
650
651 if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
652 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
653 goto nla_put_failure;
654 if (chan->flags & IEEE80211_CHAN_NO_IR) {
655 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
656 goto nla_put_failure;
657 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
658 goto nla_put_failure;
659 }
660 if (chan->flags & IEEE80211_CHAN_RADAR) {
661 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
662 goto nla_put_failure;
663 if (large) {
664 u32 time;
665
666 time = elapsed_jiffies_msecs(chan->dfs_state_entered);
667
668 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
669 chan->dfs_state))
670 goto nla_put_failure;
671 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
672 time))
673 goto nla_put_failure;
674 if (nla_put_u32(msg,
675 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
676 chan->dfs_cac_ms))
677 goto nla_put_failure;
678 }
679 }
680
681 if (large) {
682 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
683 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
684 goto nla_put_failure;
685 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
686 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
687 goto nla_put_failure;
688 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
689 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
690 goto nla_put_failure;
691 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
692 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
693 goto nla_put_failure;
694 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
695 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
696 goto nla_put_failure;
697 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
698 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
699 goto nla_put_failure;
700 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
701 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
702 goto nla_put_failure;
703 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
704 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
705 goto nla_put_failure;
706 }
707
708 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
709 DBM_TO_MBM(chan->max_power)))
710 goto nla_put_failure;
711
712 return 0;
713
714 nla_put_failure:
715 return -ENOBUFS;
716 }
717
718 /* netlink command implementations */
719
720 struct key_parse {
721 struct key_params p;
722 int idx;
723 int type;
724 bool def, defmgmt;
725 bool def_uni, def_multi;
726 };
727
728 static int nl80211_parse_key_new(struct nlattr *key, struct key_parse *k)
729 {
730 struct nlattr *tb[NL80211_KEY_MAX + 1];
731 int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
732 nl80211_key_policy, NULL);
733 if (err)
734 return err;
735
736 k->def = !!tb[NL80211_KEY_DEFAULT];
737 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
738
739 if (k->def) {
740 k->def_uni = true;
741 k->def_multi = true;
742 }
743 if (k->defmgmt)
744 k->def_multi = true;
745
746 if (tb[NL80211_KEY_IDX])
747 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
748
749 if (tb[NL80211_KEY_DATA]) {
750 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
751 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
752 }
753
754 if (tb[NL80211_KEY_SEQ]) {
755 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
756 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
757 }
758
759 if (tb[NL80211_KEY_CIPHER])
760 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
761
762 if (tb[NL80211_KEY_TYPE]) {
763 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
764 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
765 return -EINVAL;
766 }
767
768 if (tb[NL80211_KEY_DEFAULT_TYPES]) {
769 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
770
771 err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
772 tb[NL80211_KEY_DEFAULT_TYPES],
773 nl80211_key_default_policy, NULL);
774 if (err)
775 return err;
776
777 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
778 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
779 }
780
781 return 0;
782 }
783
784 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
785 {
786 if (info->attrs[NL80211_ATTR_KEY_DATA]) {
787 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
788 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
789 }
790
791 if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
792 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
793 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
794 }
795
796 if (info->attrs[NL80211_ATTR_KEY_IDX])
797 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
798
799 if (info->attrs[NL80211_ATTR_KEY_CIPHER])
800 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
801
802 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
803 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
804
805 if (k->def) {
806 k->def_uni = true;
807 k->def_multi = true;
808 }
809 if (k->defmgmt)
810 k->def_multi = true;
811
812 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
813 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
814 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
815 return -EINVAL;
816 }
817
818 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
819 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
820 int err = nla_parse_nested(kdt,
821 NUM_NL80211_KEY_DEFAULT_TYPES - 1,
822 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
823 nl80211_key_default_policy,
824 info->extack);
825 if (err)
826 return err;
827
828 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
829 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
830 }
831
832 return 0;
833 }
834
835 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
836 {
837 int err;
838
839 memset(k, 0, sizeof(*k));
840 k->idx = -1;
841 k->type = -1;
842
843 if (info->attrs[NL80211_ATTR_KEY])
844 err = nl80211_parse_key_new(info->attrs[NL80211_ATTR_KEY], k);
845 else
846 err = nl80211_parse_key_old(info, k);
847
848 if (err)
849 return err;
850
851 if (k->def && k->defmgmt)
852 return -EINVAL;
853
854 if (k->defmgmt) {
855 if (k->def_uni || !k->def_multi)
856 return -EINVAL;
857 }
858
859 if (k->idx != -1) {
860 if (k->defmgmt) {
861 if (k->idx < 4 || k->idx > 5)
862 return -EINVAL;
863 } else if (k->def) {
864 if (k->idx < 0 || k->idx > 3)
865 return -EINVAL;
866 } else {
867 if (k->idx < 0 || k->idx > 5)
868 return -EINVAL;
869 }
870 }
871
872 return 0;
873 }
874
875 static struct cfg80211_cached_keys *
876 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
877 struct nlattr *keys, bool *no_ht)
878 {
879 struct key_parse parse;
880 struct nlattr *key;
881 struct cfg80211_cached_keys *result;
882 int rem, err, def = 0;
883 bool have_key = false;
884
885 nla_for_each_nested(key, keys, rem) {
886 have_key = true;
887 break;
888 }
889
890 if (!have_key)
891 return NULL;
892
893 result = kzalloc(sizeof(*result), GFP_KERNEL);
894 if (!result)
895 return ERR_PTR(-ENOMEM);
896
897 result->def = -1;
898
899 nla_for_each_nested(key, keys, rem) {
900 memset(&parse, 0, sizeof(parse));
901 parse.idx = -1;
902
903 err = nl80211_parse_key_new(key, &parse);
904 if (err)
905 goto error;
906 err = -EINVAL;
907 if (!parse.p.key)
908 goto error;
909 if (parse.idx < 0 || parse.idx > 3)
910 goto error;
911 if (parse.def) {
912 if (def)
913 goto error;
914 def = 1;
915 result->def = parse.idx;
916 if (!parse.def_uni || !parse.def_multi)
917 goto error;
918 } else if (parse.defmgmt)
919 goto error;
920 err = cfg80211_validate_key_settings(rdev, &parse.p,
921 parse.idx, false, NULL);
922 if (err)
923 goto error;
924 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
925 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
926 err = -EINVAL;
927 goto error;
928 }
929 result->params[parse.idx].cipher = parse.p.cipher;
930 result->params[parse.idx].key_len = parse.p.key_len;
931 result->params[parse.idx].key = result->data[parse.idx];
932 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
933
934 /* must be WEP key if we got here */
935 if (no_ht)
936 *no_ht = true;
937 }
938
939 if (result->def < 0) {
940 err = -EINVAL;
941 goto error;
942 }
943
944 return result;
945 error:
946 kfree(result);
947 return ERR_PTR(err);
948 }
949
950 static int nl80211_key_allowed(struct wireless_dev *wdev)
951 {
952 ASSERT_WDEV_LOCK(wdev);
953
954 switch (wdev->iftype) {
955 case NL80211_IFTYPE_AP:
956 case NL80211_IFTYPE_AP_VLAN:
957 case NL80211_IFTYPE_P2P_GO:
958 case NL80211_IFTYPE_MESH_POINT:
959 break;
960 case NL80211_IFTYPE_ADHOC:
961 case NL80211_IFTYPE_STATION:
962 case NL80211_IFTYPE_P2P_CLIENT:
963 if (!wdev->current_bss)
964 return -ENOLINK;
965 break;
966 case NL80211_IFTYPE_UNSPECIFIED:
967 case NL80211_IFTYPE_OCB:
968 case NL80211_IFTYPE_MONITOR:
969 case NL80211_IFTYPE_NAN:
970 case NL80211_IFTYPE_P2P_DEVICE:
971 case NL80211_IFTYPE_WDS:
972 case NUM_NL80211_IFTYPES:
973 return -EINVAL;
974 }
975
976 return 0;
977 }
978
979 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
980 struct nlattr *tb)
981 {
982 struct ieee80211_channel *chan;
983
984 if (tb == NULL)
985 return NULL;
986 chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
987 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
988 return NULL;
989 return chan;
990 }
991
992 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
993 {
994 struct nlattr *nl_modes = nla_nest_start(msg, attr);
995 int i;
996
997 if (!nl_modes)
998 goto nla_put_failure;
999
1000 i = 0;
1001 while (ifmodes) {
1002 if ((ifmodes & 1) && nla_put_flag(msg, i))
1003 goto nla_put_failure;
1004 ifmodes >>= 1;
1005 i++;
1006 }
1007
1008 nla_nest_end(msg, nl_modes);
1009 return 0;
1010
1011 nla_put_failure:
1012 return -ENOBUFS;
1013 }
1014
1015 static int nl80211_put_iface_combinations(struct wiphy *wiphy,
1016 struct sk_buff *msg,
1017 bool large)
1018 {
1019 struct nlattr *nl_combis;
1020 int i, j;
1021
1022 nl_combis = nla_nest_start(msg,
1023 NL80211_ATTR_INTERFACE_COMBINATIONS);
1024 if (!nl_combis)
1025 goto nla_put_failure;
1026
1027 for (i = 0; i < wiphy->n_iface_combinations; i++) {
1028 const struct ieee80211_iface_combination *c;
1029 struct nlattr *nl_combi, *nl_limits;
1030
1031 c = &wiphy->iface_combinations[i];
1032
1033 nl_combi = nla_nest_start(msg, i + 1);
1034 if (!nl_combi)
1035 goto nla_put_failure;
1036
1037 nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
1038 if (!nl_limits)
1039 goto nla_put_failure;
1040
1041 for (j = 0; j < c->n_limits; j++) {
1042 struct nlattr *nl_limit;
1043
1044 nl_limit = nla_nest_start(msg, j + 1);
1045 if (!nl_limit)
1046 goto nla_put_failure;
1047 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
1048 c->limits[j].max))
1049 goto nla_put_failure;
1050 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
1051 c->limits[j].types))
1052 goto nla_put_failure;
1053 nla_nest_end(msg, nl_limit);
1054 }
1055
1056 nla_nest_end(msg, nl_limits);
1057
1058 if (c->beacon_int_infra_match &&
1059 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
1060 goto nla_put_failure;
1061 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
1062 c->num_different_channels) ||
1063 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
1064 c->max_interfaces))
1065 goto nla_put_failure;
1066 if (large &&
1067 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
1068 c->radar_detect_widths) ||
1069 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
1070 c->radar_detect_regions)))
1071 goto nla_put_failure;
1072 if (c->beacon_int_min_gcd &&
1073 nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
1074 c->beacon_int_min_gcd))
1075 goto nla_put_failure;
1076
1077 nla_nest_end(msg, nl_combi);
1078 }
1079
1080 nla_nest_end(msg, nl_combis);
1081
1082 return 0;
1083 nla_put_failure:
1084 return -ENOBUFS;
1085 }
1086
1087 #ifdef CONFIG_PM
1088 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
1089 struct sk_buff *msg)
1090 {
1091 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
1092 struct nlattr *nl_tcp;
1093
1094 if (!tcp)
1095 return 0;
1096
1097 nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
1098 if (!nl_tcp)
1099 return -ENOBUFS;
1100
1101 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1102 tcp->data_payload_max))
1103 return -ENOBUFS;
1104
1105 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1106 tcp->data_payload_max))
1107 return -ENOBUFS;
1108
1109 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
1110 return -ENOBUFS;
1111
1112 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
1113 sizeof(*tcp->tok), tcp->tok))
1114 return -ENOBUFS;
1115
1116 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
1117 tcp->data_interval_max))
1118 return -ENOBUFS;
1119
1120 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
1121 tcp->wake_payload_max))
1122 return -ENOBUFS;
1123
1124 nla_nest_end(msg, nl_tcp);
1125 return 0;
1126 }
1127
1128 static int nl80211_send_wowlan(struct sk_buff *msg,
1129 struct cfg80211_registered_device *rdev,
1130 bool large)
1131 {
1132 struct nlattr *nl_wowlan;
1133
1134 if (!rdev->wiphy.wowlan)
1135 return 0;
1136
1137 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1138 if (!nl_wowlan)
1139 return -ENOBUFS;
1140
1141 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
1142 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1143 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
1144 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1145 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
1146 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1147 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
1148 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1149 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
1150 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1151 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
1152 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1153 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
1154 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1155 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
1156 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1157 return -ENOBUFS;
1158
1159 if (rdev->wiphy.wowlan->n_patterns) {
1160 struct nl80211_pattern_support pat = {
1161 .max_patterns = rdev->wiphy.wowlan->n_patterns,
1162 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
1163 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
1164 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
1165 };
1166
1167 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1168 sizeof(pat), &pat))
1169 return -ENOBUFS;
1170 }
1171
1172 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
1173 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
1174 rdev->wiphy.wowlan->max_nd_match_sets))
1175 return -ENOBUFS;
1176
1177 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
1178 return -ENOBUFS;
1179
1180 nla_nest_end(msg, nl_wowlan);
1181
1182 return 0;
1183 }
1184 #endif
1185
1186 static int nl80211_send_coalesce(struct sk_buff *msg,
1187 struct cfg80211_registered_device *rdev)
1188 {
1189 struct nl80211_coalesce_rule_support rule;
1190
1191 if (!rdev->wiphy.coalesce)
1192 return 0;
1193
1194 rule.max_rules = rdev->wiphy.coalesce->n_rules;
1195 rule.max_delay = rdev->wiphy.coalesce->max_delay;
1196 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
1197 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
1198 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
1199 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
1200
1201 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
1202 return -ENOBUFS;
1203
1204 return 0;
1205 }
1206
1207 static int nl80211_send_band_rateinfo(struct sk_buff *msg,
1208 struct ieee80211_supported_band *sband)
1209 {
1210 struct nlattr *nl_rates, *nl_rate;
1211 struct ieee80211_rate *rate;
1212 int i;
1213
1214 /* add HT info */
1215 if (sband->ht_cap.ht_supported &&
1216 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
1217 sizeof(sband->ht_cap.mcs),
1218 &sband->ht_cap.mcs) ||
1219 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
1220 sband->ht_cap.cap) ||
1221 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1222 sband->ht_cap.ampdu_factor) ||
1223 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1224 sband->ht_cap.ampdu_density)))
1225 return -ENOBUFS;
1226
1227 /* add VHT info */
1228 if (sband->vht_cap.vht_supported &&
1229 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1230 sizeof(sband->vht_cap.vht_mcs),
1231 &sband->vht_cap.vht_mcs) ||
1232 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1233 sband->vht_cap.cap)))
1234 return -ENOBUFS;
1235
1236 /* add bitrates */
1237 nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
1238 if (!nl_rates)
1239 return -ENOBUFS;
1240
1241 for (i = 0; i < sband->n_bitrates; i++) {
1242 nl_rate = nla_nest_start(msg, i);
1243 if (!nl_rate)
1244 return -ENOBUFS;
1245
1246 rate = &sband->bitrates[i];
1247 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1248 rate->bitrate))
1249 return -ENOBUFS;
1250 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1251 nla_put_flag(msg,
1252 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1253 return -ENOBUFS;
1254
1255 nla_nest_end(msg, nl_rate);
1256 }
1257
1258 nla_nest_end(msg, nl_rates);
1259
1260 return 0;
1261 }
1262
1263 static int
1264 nl80211_send_mgmt_stypes(struct sk_buff *msg,
1265 const struct ieee80211_txrx_stypes *mgmt_stypes)
1266 {
1267 u16 stypes;
1268 struct nlattr *nl_ftypes, *nl_ifs;
1269 enum nl80211_iftype ift;
1270 int i;
1271
1272 if (!mgmt_stypes)
1273 return 0;
1274
1275 nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
1276 if (!nl_ifs)
1277 return -ENOBUFS;
1278
1279 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1280 nl_ftypes = nla_nest_start(msg, ift);
1281 if (!nl_ftypes)
1282 return -ENOBUFS;
1283 i = 0;
1284 stypes = mgmt_stypes[ift].tx;
1285 while (stypes) {
1286 if ((stypes & 1) &&
1287 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1288 (i << 4) | IEEE80211_FTYPE_MGMT))
1289 return -ENOBUFS;
1290 stypes >>= 1;
1291 i++;
1292 }
1293 nla_nest_end(msg, nl_ftypes);
1294 }
1295
1296 nla_nest_end(msg, nl_ifs);
1297
1298 nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
1299 if (!nl_ifs)
1300 return -ENOBUFS;
1301
1302 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1303 nl_ftypes = nla_nest_start(msg, ift);
1304 if (!nl_ftypes)
1305 return -ENOBUFS;
1306 i = 0;
1307 stypes = mgmt_stypes[ift].rx;
1308 while (stypes) {
1309 if ((stypes & 1) &&
1310 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1311 (i << 4) | IEEE80211_FTYPE_MGMT))
1312 return -ENOBUFS;
1313 stypes >>= 1;
1314 i++;
1315 }
1316 nla_nest_end(msg, nl_ftypes);
1317 }
1318 nla_nest_end(msg, nl_ifs);
1319
1320 return 0;
1321 }
1322
1323 #define CMD(op, n) \
1324 do { \
1325 if (rdev->ops->op) { \
1326 i++; \
1327 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
1328 goto nla_put_failure; \
1329 } \
1330 } while (0)
1331
1332 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
1333 struct sk_buff *msg)
1334 {
1335 int i = 0;
1336
1337 /*
1338 * do *NOT* add anything into this function, new things need to be
1339 * advertised only to new versions of userspace that can deal with
1340 * the split (and they can't possibly care about new features...
1341 */
1342 CMD(add_virtual_intf, NEW_INTERFACE);
1343 CMD(change_virtual_intf, SET_INTERFACE);
1344 CMD(add_key, NEW_KEY);
1345 CMD(start_ap, START_AP);
1346 CMD(add_station, NEW_STATION);
1347 CMD(add_mpath, NEW_MPATH);
1348 CMD(update_mesh_config, SET_MESH_CONFIG);
1349 CMD(change_bss, SET_BSS);
1350 CMD(auth, AUTHENTICATE);
1351 CMD(assoc, ASSOCIATE);
1352 CMD(deauth, DEAUTHENTICATE);
1353 CMD(disassoc, DISASSOCIATE);
1354 CMD(join_ibss, JOIN_IBSS);
1355 CMD(join_mesh, JOIN_MESH);
1356 CMD(set_pmksa, SET_PMKSA);
1357 CMD(del_pmksa, DEL_PMKSA);
1358 CMD(flush_pmksa, FLUSH_PMKSA);
1359 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
1360 CMD(remain_on_channel, REMAIN_ON_CHANNEL);
1361 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
1362 CMD(mgmt_tx, FRAME);
1363 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
1364 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
1365 i++;
1366 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
1367 goto nla_put_failure;
1368 }
1369 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
1370 rdev->ops->join_mesh) {
1371 i++;
1372 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1373 goto nla_put_failure;
1374 }
1375 CMD(set_wds_peer, SET_WDS_PEER);
1376 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
1377 CMD(tdls_mgmt, TDLS_MGMT);
1378 CMD(tdls_oper, TDLS_OPER);
1379 }
1380 if (rdev->wiphy.max_sched_scan_reqs)
1381 CMD(sched_scan_start, START_SCHED_SCAN);
1382 CMD(probe_client, PROBE_CLIENT);
1383 CMD(set_noack_map, SET_NOACK_MAP);
1384 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
1385 i++;
1386 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1387 goto nla_put_failure;
1388 }
1389 CMD(start_p2p_device, START_P2P_DEVICE);
1390 CMD(set_mcast_rate, SET_MCAST_RATE);
1391 #ifdef CONFIG_NL80211_TESTMODE
1392 CMD(testmode_cmd, TESTMODE);
1393 #endif
1394
1395 if (rdev->ops->connect || rdev->ops->auth) {
1396 i++;
1397 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
1398 goto nla_put_failure;
1399 }
1400
1401 if (rdev->ops->disconnect || rdev->ops->deauth) {
1402 i++;
1403 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1404 goto nla_put_failure;
1405 }
1406
1407 return i;
1408 nla_put_failure:
1409 return -ENOBUFS;
1410 }
1411
1412 struct nl80211_dump_wiphy_state {
1413 s64 filter_wiphy;
1414 long start;
1415 long split_start, band_start, chan_start, capa_start;
1416 bool split;
1417 };
1418
1419 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
1420 enum nl80211_commands cmd,
1421 struct sk_buff *msg, u32 portid, u32 seq,
1422 int flags, struct nl80211_dump_wiphy_state *state)
1423 {
1424 void *hdr;
1425 struct nlattr *nl_bands, *nl_band;
1426 struct nlattr *nl_freqs, *nl_freq;
1427 struct nlattr *nl_cmds;
1428 enum nl80211_band band;
1429 struct ieee80211_channel *chan;
1430 int i;
1431 const struct ieee80211_txrx_stypes *mgmt_stypes =
1432 rdev->wiphy.mgmt_stypes;
1433 u32 features;
1434
1435 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
1436 if (!hdr)
1437 return -ENOBUFS;
1438
1439 if (WARN_ON(!state))
1440 return -EINVAL;
1441
1442 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
1443 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
1444 wiphy_name(&rdev->wiphy)) ||
1445 nla_put_u32(msg, NL80211_ATTR_GENERATION,
1446 cfg80211_rdev_list_generation))
1447 goto nla_put_failure;
1448
1449 if (cmd != NL80211_CMD_NEW_WIPHY)
1450 goto finish;
1451
1452 switch (state->split_start) {
1453 case 0:
1454 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
1455 rdev->wiphy.retry_short) ||
1456 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
1457 rdev->wiphy.retry_long) ||
1458 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
1459 rdev->wiphy.frag_threshold) ||
1460 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
1461 rdev->wiphy.rts_threshold) ||
1462 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
1463 rdev->wiphy.coverage_class) ||
1464 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
1465 rdev->wiphy.max_scan_ssids) ||
1466 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
1467 rdev->wiphy.max_sched_scan_ssids) ||
1468 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
1469 rdev->wiphy.max_scan_ie_len) ||
1470 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
1471 rdev->wiphy.max_sched_scan_ie_len) ||
1472 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
1473 rdev->wiphy.max_match_sets) ||
1474 nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
1475 rdev->wiphy.max_sched_scan_plans) ||
1476 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
1477 rdev->wiphy.max_sched_scan_plan_interval) ||
1478 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
1479 rdev->wiphy.max_sched_scan_plan_iterations))
1480 goto nla_put_failure;
1481
1482 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
1483 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
1484 goto nla_put_failure;
1485 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
1486 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
1487 goto nla_put_failure;
1488 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
1489 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
1490 goto nla_put_failure;
1491 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
1492 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
1493 goto nla_put_failure;
1494 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
1495 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
1496 goto nla_put_failure;
1497 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
1498 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
1499 goto nla_put_failure;
1500 state->split_start++;
1501 if (state->split)
1502 break;
1503 case 1:
1504 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
1505 sizeof(u32) * rdev->wiphy.n_cipher_suites,
1506 rdev->wiphy.cipher_suites))
1507 goto nla_put_failure;
1508
1509 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
1510 rdev->wiphy.max_num_pmkids))
1511 goto nla_put_failure;
1512
1513 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
1514 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
1515 goto nla_put_failure;
1516
1517 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
1518 rdev->wiphy.available_antennas_tx) ||
1519 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
1520 rdev->wiphy.available_antennas_rx))
1521 goto nla_put_failure;
1522
1523 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
1524 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
1525 rdev->wiphy.probe_resp_offload))
1526 goto nla_put_failure;
1527
1528 if ((rdev->wiphy.available_antennas_tx ||
1529 rdev->wiphy.available_antennas_rx) &&
1530 rdev->ops->get_antenna) {
1531 u32 tx_ant = 0, rx_ant = 0;
1532 int res;
1533
1534 res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
1535 if (!res) {
1536 if (nla_put_u32(msg,
1537 NL80211_ATTR_WIPHY_ANTENNA_TX,
1538 tx_ant) ||
1539 nla_put_u32(msg,
1540 NL80211_ATTR_WIPHY_ANTENNA_RX,
1541 rx_ant))
1542 goto nla_put_failure;
1543 }
1544 }
1545
1546 state->split_start++;
1547 if (state->split)
1548 break;
1549 case 2:
1550 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
1551 rdev->wiphy.interface_modes))
1552 goto nla_put_failure;
1553 state->split_start++;
1554 if (state->split)
1555 break;
1556 case 3:
1557 nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
1558 if (!nl_bands)
1559 goto nla_put_failure;
1560
1561 for (band = state->band_start;
1562 band < NUM_NL80211_BANDS; band++) {
1563 struct ieee80211_supported_band *sband;
1564
1565 sband = rdev->wiphy.bands[band];
1566
1567 if (!sband)
1568 continue;
1569
1570 nl_band = nla_nest_start(msg, band);
1571 if (!nl_band)
1572 goto nla_put_failure;
1573
1574 switch (state->chan_start) {
1575 case 0:
1576 if (nl80211_send_band_rateinfo(msg, sband))
1577 goto nla_put_failure;
1578 state->chan_start++;
1579 if (state->split)
1580 break;
1581 default:
1582 /* add frequencies */
1583 nl_freqs = nla_nest_start(
1584 msg, NL80211_BAND_ATTR_FREQS);
1585 if (!nl_freqs)
1586 goto nla_put_failure;
1587
1588 for (i = state->chan_start - 1;
1589 i < sband->n_channels;
1590 i++) {
1591 nl_freq = nla_nest_start(msg, i);
1592 if (!nl_freq)
1593 goto nla_put_failure;
1594
1595 chan = &sband->channels[i];
1596
1597 if (nl80211_msg_put_channel(
1598 msg, chan,
1599 state->split))
1600 goto nla_put_failure;
1601
1602 nla_nest_end(msg, nl_freq);
1603 if (state->split)
1604 break;
1605 }
1606 if (i < sband->n_channels)
1607 state->chan_start = i + 2;
1608 else
1609 state->chan_start = 0;
1610 nla_nest_end(msg, nl_freqs);
1611 }
1612
1613 nla_nest_end(msg, nl_band);
1614
1615 if (state->split) {
1616 /* start again here */
1617 if (state->chan_start)
1618 band--;
1619 break;
1620 }
1621 }
1622 nla_nest_end(msg, nl_bands);
1623
1624 if (band < NUM_NL80211_BANDS)
1625 state->band_start = band + 1;
1626 else
1627 state->band_start = 0;
1628
1629 /* if bands & channels are done, continue outside */
1630 if (state->band_start == 0 && state->chan_start == 0)
1631 state->split_start++;
1632 if (state->split)
1633 break;
1634 case 4:
1635 nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
1636 if (!nl_cmds)
1637 goto nla_put_failure;
1638
1639 i = nl80211_add_commands_unsplit(rdev, msg);
1640 if (i < 0)
1641 goto nla_put_failure;
1642 if (state->split) {
1643 CMD(crit_proto_start, CRIT_PROTOCOL_START);
1644 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
1645 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
1646 CMD(channel_switch, CHANNEL_SWITCH);
1647 CMD(set_qos_map, SET_QOS_MAP);
1648 if (rdev->wiphy.features &
1649 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
1650 CMD(add_tx_ts, ADD_TX_TS);
1651 CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
1652 CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
1653 }
1654 #undef CMD
1655
1656 nla_nest_end(msg, nl_cmds);
1657 state->split_start++;
1658 if (state->split)
1659 break;
1660 case 5:
1661 if (rdev->ops->remain_on_channel &&
1662 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
1663 nla_put_u32(msg,
1664 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
1665 rdev->wiphy.max_remain_on_channel_duration))
1666 goto nla_put_failure;
1667
1668 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
1669 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
1670 goto nla_put_failure;
1671
1672 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
1673 goto nla_put_failure;
1674 state->split_start++;
1675 if (state->split)
1676 break;
1677 case 6:
1678 #ifdef CONFIG_PM
1679 if (nl80211_send_wowlan(msg, rdev, state->split))
1680 goto nla_put_failure;
1681 state->split_start++;
1682 if (state->split)
1683 break;
1684 #else
1685 state->split_start++;
1686 #endif
1687 case 7:
1688 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
1689 rdev->wiphy.software_iftypes))
1690 goto nla_put_failure;
1691
1692 if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
1693 state->split))
1694 goto nla_put_failure;
1695
1696 state->split_start++;
1697 if (state->split)
1698 break;
1699 case 8:
1700 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
1701 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
1702 rdev->wiphy.ap_sme_capa))
1703 goto nla_put_failure;
1704
1705 features = rdev->wiphy.features;
1706 /*
1707 * We can only add the per-channel limit information if the
1708 * dump is split, otherwise it makes it too big. Therefore
1709 * only advertise it in that case.
1710 */
1711 if (state->split)
1712 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
1713 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
1714 goto nla_put_failure;
1715
1716 if (rdev->wiphy.ht_capa_mod_mask &&
1717 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
1718 sizeof(*rdev->wiphy.ht_capa_mod_mask),
1719 rdev->wiphy.ht_capa_mod_mask))
1720 goto nla_put_failure;
1721
1722 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
1723 rdev->wiphy.max_acl_mac_addrs &&
1724 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
1725 rdev->wiphy.max_acl_mac_addrs))
1726 goto nla_put_failure;
1727
1728 /*
1729 * Any information below this point is only available to
1730 * applications that can deal with it being split. This
1731 * helps ensure that newly added capabilities don't break
1732 * older tools by overrunning their buffers.
1733 *
1734 * We still increment split_start so that in the split
1735 * case we'll continue with more data in the next round,
1736 * but break unconditionally so unsplit data stops here.
1737 */
1738 state->split_start++;
1739 break;
1740 case 9:
1741 if (rdev->wiphy.extended_capabilities &&
1742 (nla_put(msg, NL80211_ATTR_EXT_CAPA,
1743 rdev->wiphy.extended_capabilities_len,
1744 rdev->wiphy.extended_capabilities) ||
1745 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1746 rdev->wiphy.extended_capabilities_len,
1747 rdev->wiphy.extended_capabilities_mask)))
1748 goto nla_put_failure;
1749
1750 if (rdev->wiphy.vht_capa_mod_mask &&
1751 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
1752 sizeof(*rdev->wiphy.vht_capa_mod_mask),
1753 rdev->wiphy.vht_capa_mod_mask))
1754 goto nla_put_failure;
1755
1756 state->split_start++;
1757 break;
1758 case 10:
1759 if (nl80211_send_coalesce(msg, rdev))
1760 goto nla_put_failure;
1761
1762 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
1763 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
1764 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
1765 goto nla_put_failure;
1766
1767 if (rdev->wiphy.max_ap_assoc_sta &&
1768 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
1769 rdev->wiphy.max_ap_assoc_sta))
1770 goto nla_put_failure;
1771
1772 state->split_start++;
1773 break;
1774 case 11:
1775 if (rdev->wiphy.n_vendor_commands) {
1776 const struct nl80211_vendor_cmd_info *info;
1777 struct nlattr *nested;
1778
1779 nested = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA);
1780 if (!nested)
1781 goto nla_put_failure;
1782
1783 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
1784 info = &rdev->wiphy.vendor_commands[i].info;
1785 if (nla_put(msg, i + 1, sizeof(*info), info))
1786 goto nla_put_failure;
1787 }
1788 nla_nest_end(msg, nested);
1789 }
1790
1791 if (rdev->wiphy.n_vendor_events) {
1792 const struct nl80211_vendor_cmd_info *info;
1793 struct nlattr *nested;
1794
1795 nested = nla_nest_start(msg,
1796 NL80211_ATTR_VENDOR_EVENTS);
1797 if (!nested)
1798 goto nla_put_failure;
1799
1800 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
1801 info = &rdev->wiphy.vendor_events[i];
1802 if (nla_put(msg, i + 1, sizeof(*info), info))
1803 goto nla_put_failure;
1804 }
1805 nla_nest_end(msg, nested);
1806 }
1807 state->split_start++;
1808 break;
1809 case 12:
1810 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
1811 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
1812 rdev->wiphy.max_num_csa_counters))
1813 goto nla_put_failure;
1814
1815 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
1816 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
1817 goto nla_put_failure;
1818
1819 if (rdev->wiphy.max_sched_scan_reqs &&
1820 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
1821 rdev->wiphy.max_sched_scan_reqs))
1822 goto nla_put_failure;
1823
1824 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
1825 sizeof(rdev->wiphy.ext_features),
1826 rdev->wiphy.ext_features))
1827 goto nla_put_failure;
1828
1829 if (rdev->wiphy.bss_select_support) {
1830 struct nlattr *nested;
1831 u32 bss_select_support = rdev->wiphy.bss_select_support;
1832
1833 nested = nla_nest_start(msg, NL80211_ATTR_BSS_SELECT);
1834 if (!nested)
1835 goto nla_put_failure;
1836
1837 i = 0;
1838 while (bss_select_support) {
1839 if ((bss_select_support & 1) &&
1840 nla_put_flag(msg, i))
1841 goto nla_put_failure;
1842 i++;
1843 bss_select_support >>= 1;
1844 }
1845 nla_nest_end(msg, nested);
1846 }
1847
1848 state->split_start++;
1849 break;
1850 case 13:
1851 if (rdev->wiphy.num_iftype_ext_capab &&
1852 rdev->wiphy.iftype_ext_capab) {
1853 struct nlattr *nested_ext_capab, *nested;
1854
1855 nested = nla_nest_start(msg,
1856 NL80211_ATTR_IFTYPE_EXT_CAPA);
1857 if (!nested)
1858 goto nla_put_failure;
1859
1860 for (i = state->capa_start;
1861 i < rdev->wiphy.num_iftype_ext_capab; i++) {
1862 const struct wiphy_iftype_ext_capab *capab;
1863
1864 capab = &rdev->wiphy.iftype_ext_capab[i];
1865
1866 nested_ext_capab = nla_nest_start(msg, i);
1867 if (!nested_ext_capab ||
1868 nla_put_u32(msg, NL80211_ATTR_IFTYPE,
1869 capab->iftype) ||
1870 nla_put(msg, NL80211_ATTR_EXT_CAPA,
1871 capab->extended_capabilities_len,
1872 capab->extended_capabilities) ||
1873 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1874 capab->extended_capabilities_len,
1875 capab->extended_capabilities_mask))
1876 goto nla_put_failure;
1877
1878 nla_nest_end(msg, nested_ext_capab);
1879 if (state->split)
1880 break;
1881 }
1882 nla_nest_end(msg, nested);
1883 if (i < rdev->wiphy.num_iftype_ext_capab) {
1884 state->capa_start = i + 1;
1885 break;
1886 }
1887 }
1888
1889 if (nla_put_u32(msg, NL80211_ATTR_BANDS,
1890 rdev->wiphy.nan_supported_bands))
1891 goto nla_put_failure;
1892
1893 /* done */
1894 state->split_start = 0;
1895 break;
1896 }
1897 finish:
1898 genlmsg_end(msg, hdr);
1899 return 0;
1900
1901 nla_put_failure:
1902 genlmsg_cancel(msg, hdr);
1903 return -EMSGSIZE;
1904 }
1905
1906 static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
1907 struct netlink_callback *cb,
1908 struct nl80211_dump_wiphy_state *state)
1909 {
1910 struct nlattr **tb = genl_family_attrbuf(&nl80211_fam);
1911 int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize, tb,
1912 nl80211_fam.maxattr, nl80211_policy, NULL);
1913 /* ignore parse errors for backward compatibility */
1914 if (ret)
1915 return 0;
1916
1917 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
1918 if (tb[NL80211_ATTR_WIPHY])
1919 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
1920 if (tb[NL80211_ATTR_WDEV])
1921 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
1922 if (tb[NL80211_ATTR_IFINDEX]) {
1923 struct net_device *netdev;
1924 struct cfg80211_registered_device *rdev;
1925 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
1926
1927 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
1928 if (!netdev)
1929 return -ENODEV;
1930 if (netdev->ieee80211_ptr) {
1931 rdev = wiphy_to_rdev(
1932 netdev->ieee80211_ptr->wiphy);
1933 state->filter_wiphy = rdev->wiphy_idx;
1934 }
1935 }
1936
1937 return 0;
1938 }
1939
1940 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
1941 {
1942 int idx = 0, ret;
1943 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
1944 struct cfg80211_registered_device *rdev;
1945
1946 rtnl_lock();
1947 if (!state) {
1948 state = kzalloc(sizeof(*state), GFP_KERNEL);
1949 if (!state) {
1950 rtnl_unlock();
1951 return -ENOMEM;
1952 }
1953 state->filter_wiphy = -1;
1954 ret = nl80211_dump_wiphy_parse(skb, cb, state);
1955 if (ret) {
1956 kfree(state);
1957 rtnl_unlock();
1958 return ret;
1959 }
1960 cb->args[0] = (long)state;
1961 }
1962
1963 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1964 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
1965 continue;
1966 if (++idx <= state->start)
1967 continue;
1968 if (state->filter_wiphy != -1 &&
1969 state->filter_wiphy != rdev->wiphy_idx)
1970 continue;
1971 /* attempt to fit multiple wiphy data chunks into the skb */
1972 do {
1973 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
1974 skb,
1975 NETLINK_CB(cb->skb).portid,
1976 cb->nlh->nlmsg_seq,
1977 NLM_F_MULTI, state);
1978 if (ret < 0) {
1979 /*
1980 * If sending the wiphy data didn't fit (ENOBUFS
1981 * or EMSGSIZE returned), this SKB is still
1982 * empty (so it's not too big because another
1983 * wiphy dataset is already in the skb) and
1984 * we've not tried to adjust the dump allocation
1985 * yet ... then adjust the alloc size to be
1986 * bigger, and return 1 but with the empty skb.
1987 * This results in an empty message being RX'ed
1988 * in userspace, but that is ignored.
1989 *
1990 * We can then retry with the larger buffer.
1991 */
1992 if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
1993 !skb->len && !state->split &&
1994 cb->min_dump_alloc < 4096) {
1995 cb->min_dump_alloc = 4096;
1996 state->split_start = 0;
1997 rtnl_unlock();
1998 return 1;
1999 }
2000 idx--;
2001 break;
2002 }
2003 } while (state->split_start > 0);
2004 break;
2005 }
2006 rtnl_unlock();
2007
2008 state->start = idx;
2009
2010 return skb->len;
2011 }
2012
2013 static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
2014 {
2015 kfree((void *)cb->args[0]);
2016 return 0;
2017 }
2018
2019 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
2020 {
2021 struct sk_buff *msg;
2022 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2023 struct nl80211_dump_wiphy_state state = {};
2024
2025 msg = nlmsg_new(4096, GFP_KERNEL);
2026 if (!msg)
2027 return -ENOMEM;
2028
2029 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
2030 info->snd_portid, info->snd_seq, 0,
2031 &state) < 0) {
2032 nlmsg_free(msg);
2033 return -ENOBUFS;
2034 }
2035
2036 return genlmsg_reply(msg, info);
2037 }
2038
2039 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
2040 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
2041 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
2042 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
2043 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
2044 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
2045 };
2046
2047 static int parse_txq_params(struct nlattr *tb[],
2048 struct ieee80211_txq_params *txq_params)
2049 {
2050 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
2051 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
2052 !tb[NL80211_TXQ_ATTR_AIFS])
2053 return -EINVAL;
2054
2055 txq_params->ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
2056 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
2057 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
2058 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
2059 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
2060
2061 if (txq_params->ac >= NL80211_NUM_ACS)
2062 return -EINVAL;
2063
2064 return 0;
2065 }
2066
2067 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
2068 {
2069 /*
2070 * You can only set the channel explicitly for WDS interfaces,
2071 * all others have their channel managed via their respective
2072 * "establish a connection" command (connect, join, ...)
2073 *
2074 * For AP/GO and mesh mode, the channel can be set with the
2075 * channel userspace API, but is only stored and passed to the
2076 * low-level driver when the AP starts or the mesh is joined.
2077 * This is for backward compatibility, userspace can also give
2078 * the channel in the start-ap or join-mesh commands instead.
2079 *
2080 * Monitors are special as they are normally slaved to
2081 * whatever else is going on, so they have their own special
2082 * operation to set the monitor channel if possible.
2083 */
2084 return !wdev ||
2085 wdev->iftype == NL80211_IFTYPE_AP ||
2086 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
2087 wdev->iftype == NL80211_IFTYPE_MONITOR ||
2088 wdev->iftype == NL80211_IFTYPE_P2P_GO;
2089 }
2090
2091 static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
2092 struct genl_info *info,
2093 struct cfg80211_chan_def *chandef)
2094 {
2095 u32 control_freq;
2096
2097 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
2098 return -EINVAL;
2099
2100 control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
2101
2102 chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
2103 chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
2104 chandef->center_freq1 = control_freq;
2105 chandef->center_freq2 = 0;
2106
2107 /* Primary channel not allowed */
2108 if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
2109 return -EINVAL;
2110
2111 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
2112 enum nl80211_channel_type chantype;
2113
2114 chantype = nla_get_u32(
2115 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
2116
2117 switch (chantype) {
2118 case NL80211_CHAN_NO_HT:
2119 case NL80211_CHAN_HT20:
2120 case NL80211_CHAN_HT40PLUS:
2121 case NL80211_CHAN_HT40MINUS:
2122 cfg80211_chandef_create(chandef, chandef->chan,
2123 chantype);
2124 break;
2125 default:
2126 return -EINVAL;
2127 }
2128 } else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
2129 chandef->width =
2130 nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
2131 if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
2132 chandef->center_freq1 =
2133 nla_get_u32(
2134 info->attrs[NL80211_ATTR_CENTER_FREQ1]);
2135 if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
2136 chandef->center_freq2 =
2137 nla_get_u32(
2138 info->attrs[NL80211_ATTR_CENTER_FREQ2]);
2139 }
2140
2141 if (!cfg80211_chandef_valid(chandef))
2142 return -EINVAL;
2143
2144 if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
2145 IEEE80211_CHAN_DISABLED))
2146 return -EINVAL;
2147
2148 if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
2149 chandef->width == NL80211_CHAN_WIDTH_10) &&
2150 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ))
2151 return -EINVAL;
2152
2153 return 0;
2154 }
2155
2156 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
2157 struct net_device *dev,
2158 struct genl_info *info)
2159 {
2160 struct cfg80211_chan_def chandef;
2161 int result;
2162 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
2163 struct wireless_dev *wdev = NULL;
2164
2165 if (dev)
2166 wdev = dev->ieee80211_ptr;
2167 if (!nl80211_can_set_dev_channel(wdev))
2168 return -EOPNOTSUPP;
2169 if (wdev)
2170 iftype = wdev->iftype;
2171
2172 result = nl80211_parse_chandef(rdev, info, &chandef);
2173 if (result)
2174 return result;
2175
2176 switch (iftype) {
2177 case NL80211_IFTYPE_AP:
2178 case NL80211_IFTYPE_P2P_GO:
2179 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
2180 iftype)) {
2181 result = -EINVAL;
2182 break;
2183 }
2184 if (wdev->beacon_interval) {
2185 if (!dev || !rdev->ops->set_ap_chanwidth ||
2186 !(rdev->wiphy.features &
2187 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
2188 result = -EBUSY;
2189 break;
2190 }
2191
2192 /* Only allow dynamic channel width changes */
2193 if (chandef.chan != wdev->preset_chandef.chan) {
2194 result = -EBUSY;
2195 break;
2196 }
2197 result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
2198 if (result)
2199 break;
2200 }
2201 wdev->preset_chandef = chandef;
2202 result = 0;
2203 break;
2204 case NL80211_IFTYPE_MESH_POINT:
2205 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
2206 break;
2207 case NL80211_IFTYPE_MONITOR:
2208 result = cfg80211_set_monitor_channel(rdev, &chandef);
2209 break;
2210 default:
2211 result = -EINVAL;
2212 }
2213
2214 return result;
2215 }
2216
2217 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
2218 {
2219 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2220 struct net_device *netdev = info->user_ptr[1];
2221
2222 return __nl80211_set_channel(rdev, netdev, info);
2223 }
2224
2225 static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
2226 {
2227 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2228 struct net_device *dev = info->user_ptr[1];
2229 struct wireless_dev *wdev = dev->ieee80211_ptr;
2230 const u8 *bssid;
2231
2232 if (!info->attrs[NL80211_ATTR_MAC])
2233 return -EINVAL;
2234
2235 if (netif_running(dev))
2236 return -EBUSY;
2237
2238 if (!rdev->ops->set_wds_peer)
2239 return -EOPNOTSUPP;
2240
2241 if (wdev->iftype != NL80211_IFTYPE_WDS)
2242 return -EOPNOTSUPP;
2243
2244 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
2245 return rdev_set_wds_peer(rdev, dev, bssid);
2246 }
2247
2248 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
2249 {
2250 struct cfg80211_registered_device *rdev;
2251 struct net_device *netdev = NULL;
2252 struct wireless_dev *wdev;
2253 int result = 0, rem_txq_params = 0;
2254 struct nlattr *nl_txq_params;
2255 u32 changed;
2256 u8 retry_short = 0, retry_long = 0;
2257 u32 frag_threshold = 0, rts_threshold = 0;
2258 u8 coverage_class = 0;
2259
2260 ASSERT_RTNL();
2261
2262 /*
2263 * Try to find the wiphy and netdev. Normally this
2264 * function shouldn't need the netdev, but this is
2265 * done for backward compatibility -- previously
2266 * setting the channel was done per wiphy, but now
2267 * it is per netdev. Previous userland like hostapd
2268 * also passed a netdev to set_wiphy, so that it is
2269 * possible to let that go to the right netdev!
2270 */
2271
2272 if (info->attrs[NL80211_ATTR_IFINDEX]) {
2273 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
2274
2275 netdev = __dev_get_by_index(genl_info_net(info), ifindex);
2276 if (netdev && netdev->ieee80211_ptr)
2277 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
2278 else
2279 netdev = NULL;
2280 }
2281
2282 if (!netdev) {
2283 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
2284 info->attrs);
2285 if (IS_ERR(rdev))
2286 return PTR_ERR(rdev);
2287 wdev = NULL;
2288 netdev = NULL;
2289 result = 0;
2290 } else
2291 wdev = netdev->ieee80211_ptr;
2292
2293 /*
2294 * end workaround code, by now the rdev is available
2295 * and locked, and wdev may or may not be NULL.
2296 */
2297
2298 if (info->attrs[NL80211_ATTR_WIPHY_NAME])
2299 result = cfg80211_dev_rename(
2300 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
2301
2302 if (result)
2303 return result;
2304
2305 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
2306 struct ieee80211_txq_params txq_params;
2307 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
2308
2309 if (!rdev->ops->set_txq_params)
2310 return -EOPNOTSUPP;
2311
2312 if (!netdev)
2313 return -EINVAL;
2314
2315 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2316 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2317 return -EINVAL;
2318
2319 if (!netif_running(netdev))
2320 return -ENETDOWN;
2321
2322 nla_for_each_nested(nl_txq_params,
2323 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
2324 rem_txq_params) {
2325 result = nla_parse_nested(tb, NL80211_TXQ_ATTR_MAX,
2326 nl_txq_params,
2327 txq_params_policy,
2328 info->extack);
2329 if (result)
2330 return result;
2331 result = parse_txq_params(tb, &txq_params);
2332 if (result)
2333 return result;
2334
2335 result = rdev_set_txq_params(rdev, netdev,
2336 &txq_params);
2337 if (result)
2338 return result;
2339 }
2340 }
2341
2342 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
2343 result = __nl80211_set_channel(
2344 rdev,
2345 nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
2346 info);
2347 if (result)
2348 return result;
2349 }
2350
2351 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
2352 struct wireless_dev *txp_wdev = wdev;
2353 enum nl80211_tx_power_setting type;
2354 int idx, mbm = 0;
2355
2356 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
2357 txp_wdev = NULL;
2358
2359 if (!rdev->ops->set_tx_power)
2360 return -EOPNOTSUPP;
2361
2362 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
2363 type = nla_get_u32(info->attrs[idx]);
2364
2365 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
2366 (type != NL80211_TX_POWER_AUTOMATIC))
2367 return -EINVAL;
2368
2369 if (type != NL80211_TX_POWER_AUTOMATIC) {
2370 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
2371 mbm = nla_get_u32(info->attrs[idx]);
2372 }
2373
2374 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
2375 if (result)
2376 return result;
2377 }
2378
2379 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
2380 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
2381 u32 tx_ant, rx_ant;
2382
2383 if ((!rdev->wiphy.available_antennas_tx &&
2384 !rdev->wiphy.available_antennas_rx) ||
2385 !rdev->ops->set_antenna)
2386 return -EOPNOTSUPP;
2387
2388 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
2389 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
2390
2391 /* reject antenna configurations which don't match the
2392 * available antenna masks, except for the "all" mask */
2393 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
2394 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
2395 return -EINVAL;
2396
2397 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
2398 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
2399
2400 result = rdev_set_antenna(rdev, tx_ant, rx_ant);
2401 if (result)
2402 return result;
2403 }
2404
2405 changed = 0;
2406
2407 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
2408 retry_short = nla_get_u8(
2409 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
2410 if (retry_short == 0)
2411 return -EINVAL;
2412
2413 changed |= WIPHY_PARAM_RETRY_SHORT;
2414 }
2415
2416 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
2417 retry_long = nla_get_u8(
2418 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
2419 if (retry_long == 0)
2420 return -EINVAL;
2421
2422 changed |= WIPHY_PARAM_RETRY_LONG;
2423 }
2424
2425 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
2426 frag_threshold = nla_get_u32(
2427 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
2428 if (frag_threshold < 256)
2429 return -EINVAL;
2430
2431 if (frag_threshold != (u32) -1) {
2432 /*
2433 * Fragments (apart from the last one) are required to
2434 * have even length. Make the fragmentation code
2435 * simpler by stripping LSB should someone try to use
2436 * odd threshold value.
2437 */
2438 frag_threshold &= ~0x1;
2439 }
2440 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
2441 }
2442
2443 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
2444 rts_threshold = nla_get_u32(
2445 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
2446 changed |= WIPHY_PARAM_RTS_THRESHOLD;
2447 }
2448
2449 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
2450 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
2451 return -EINVAL;
2452
2453 coverage_class = nla_get_u8(
2454 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
2455 changed |= WIPHY_PARAM_COVERAGE_CLASS;
2456 }
2457
2458 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
2459 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
2460 return -EOPNOTSUPP;
2461
2462 changed |= WIPHY_PARAM_DYN_ACK;
2463 }
2464
2465 if (changed) {
2466 u8 old_retry_short, old_retry_long;
2467 u32 old_frag_threshold, old_rts_threshold;
2468 u8 old_coverage_class;
2469
2470 if (!rdev->ops->set_wiphy_params)
2471 return -EOPNOTSUPP;
2472
2473 old_retry_short = rdev->wiphy.retry_short;
2474 old_retry_long = rdev->wiphy.retry_long;
2475 old_frag_threshold = rdev->wiphy.frag_threshold;
2476 old_rts_threshold = rdev->wiphy.rts_threshold;
2477 old_coverage_class = rdev->wiphy.coverage_class;
2478
2479 if (changed & WIPHY_PARAM_RETRY_SHORT)
2480 rdev->wiphy.retry_short = retry_short;
2481 if (changed & WIPHY_PARAM_RETRY_LONG)
2482 rdev->wiphy.retry_long = retry_long;
2483 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
2484 rdev->wiphy.frag_threshold = frag_threshold;
2485 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
2486 rdev->wiphy.rts_threshold = rts_threshold;
2487 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
2488 rdev->wiphy.coverage_class = coverage_class;
2489
2490 result = rdev_set_wiphy_params(rdev, changed);
2491 if (result) {
2492 rdev->wiphy.retry_short = old_retry_short;
2493 rdev->wiphy.retry_long = old_retry_long;
2494 rdev->wiphy.frag_threshold = old_frag_threshold;
2495 rdev->wiphy.rts_threshold = old_rts_threshold;
2496 rdev->wiphy.coverage_class = old_coverage_class;
2497 return result;
2498 }
2499 }
2500 return 0;
2501 }
2502
2503 static inline u64 wdev_id(struct wireless_dev *wdev)
2504 {
2505 return (u64)wdev->identifier |
2506 ((u64)wiphy_to_rdev(wdev->wiphy)->wiphy_idx << 32);
2507 }
2508
2509 static int nl80211_send_chandef(struct sk_buff *msg,
2510 const struct cfg80211_chan_def *chandef)
2511 {
2512 if (WARN_ON(!cfg80211_chandef_valid(chandef)))
2513 return -EINVAL;
2514
2515 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
2516 chandef->chan->center_freq))
2517 return -ENOBUFS;
2518 switch (chandef->width) {
2519 case NL80211_CHAN_WIDTH_20_NOHT:
2520 case NL80211_CHAN_WIDTH_20:
2521 case NL80211_CHAN_WIDTH_40:
2522 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
2523 cfg80211_get_chandef_type(chandef)))
2524 return -ENOBUFS;
2525 break;
2526 default:
2527 break;
2528 }
2529 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
2530 return -ENOBUFS;
2531 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
2532 return -ENOBUFS;
2533 if (chandef->center_freq2 &&
2534 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
2535 return -ENOBUFS;
2536 return 0;
2537 }
2538
2539 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
2540 struct cfg80211_registered_device *rdev,
2541 struct wireless_dev *wdev, bool removal)
2542 {
2543 struct net_device *dev = wdev->netdev;
2544 u8 cmd = NL80211_CMD_NEW_INTERFACE;
2545 void *hdr;
2546
2547 if (removal)
2548 cmd = NL80211_CMD_DEL_INTERFACE;
2549
2550 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
2551 if (!hdr)
2552 return -1;
2553
2554 if (dev &&
2555 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
2556 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
2557 goto nla_put_failure;
2558
2559 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
2560 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
2561 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
2562 NL80211_ATTR_PAD) ||
2563 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
2564 nla_put_u32(msg, NL80211_ATTR_GENERATION,
2565 rdev->devlist_generation ^
2566 (cfg80211_rdev_list_generation << 2)))
2567 goto nla_put_failure;
2568
2569 if (rdev->ops->get_channel) {
2570 int ret;
2571 struct cfg80211_chan_def chandef;
2572
2573 ret = rdev_get_channel(rdev, wdev, &chandef);
2574 if (ret == 0) {
2575 if (nl80211_send_chandef(msg, &chandef))
2576 goto nla_put_failure;
2577 }
2578 }
2579
2580 if (rdev->ops->get_tx_power) {
2581 int dbm, ret;
2582
2583 ret = rdev_get_tx_power(rdev, wdev, &dbm);
2584 if (ret == 0 &&
2585 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
2586 DBM_TO_MBM(dbm)))
2587 goto nla_put_failure;
2588 }
2589
2590 if (wdev->ssid_len) {
2591 if (nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
2592 goto nla_put_failure;
2593 }
2594
2595 genlmsg_end(msg, hdr);
2596 return 0;
2597
2598 nla_put_failure:
2599 genlmsg_cancel(msg, hdr);
2600 return -EMSGSIZE;
2601 }
2602
2603 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
2604 {
2605 int wp_idx = 0;
2606 int if_idx = 0;
2607 int wp_start = cb->args[0];
2608 int if_start = cb->args[1];
2609 int filter_wiphy = -1;
2610 struct cfg80211_registered_device *rdev;
2611 struct wireless_dev *wdev;
2612 int ret;
2613
2614 rtnl_lock();
2615 if (!cb->args[2]) {
2616 struct nl80211_dump_wiphy_state state = {
2617 .filter_wiphy = -1,
2618 };
2619
2620 ret = nl80211_dump_wiphy_parse(skb, cb, &state);
2621 if (ret)
2622 goto out_unlock;
2623
2624 filter_wiphy = state.filter_wiphy;
2625
2626 /*
2627 * if filtering, set cb->args[2] to +1 since 0 is the default
2628 * value needed to determine that parsing is necessary.
2629 */
2630 if (filter_wiphy >= 0)
2631 cb->args[2] = filter_wiphy + 1;
2632 else
2633 cb->args[2] = -1;
2634 } else if (cb->args[2] > 0) {
2635 filter_wiphy = cb->args[2] - 1;
2636 }
2637
2638 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2639 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
2640 continue;
2641 if (wp_idx < wp_start) {
2642 wp_idx++;
2643 continue;
2644 }
2645
2646 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
2647 continue;
2648
2649 if_idx = 0;
2650
2651 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
2652 if (if_idx < if_start) {
2653 if_idx++;
2654 continue;
2655 }
2656 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
2657 cb->nlh->nlmsg_seq, NLM_F_MULTI,
2658 rdev, wdev, false) < 0) {
2659 goto out;
2660 }
2661 if_idx++;
2662 }
2663
2664 wp_idx++;
2665 }
2666 out:
2667 cb->args[0] = wp_idx;
2668 cb->args[1] = if_idx;
2669
2670 ret = skb->len;
2671 out_unlock:
2672 rtnl_unlock();
2673
2674 return ret;
2675 }
2676
2677 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
2678 {
2679 struct sk_buff *msg;
2680 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2681 struct wireless_dev *wdev = info->user_ptr[1];
2682
2683 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2684 if (!msg)
2685 return -ENOMEM;
2686
2687 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
2688 rdev, wdev, false) < 0) {
2689 nlmsg_free(msg);
2690 return -ENOBUFS;
2691 }
2692
2693 return genlmsg_reply(msg, info);
2694 }
2695
2696 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
2697 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
2698 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
2699 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
2700 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
2701 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
2702 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
2703 };
2704
2705 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
2706 {
2707 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
2708 int flag;
2709
2710 *mntrflags = 0;
2711
2712 if (!nla)
2713 return -EINVAL;
2714
2715 if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX, nla,
2716 mntr_flags_policy, NULL))
2717 return -EINVAL;
2718
2719 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
2720 if (flags[flag])
2721 *mntrflags |= (1<<flag);
2722
2723 *mntrflags |= MONITOR_FLAG_CHANGED;
2724
2725 return 0;
2726 }
2727
2728 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
2729 enum nl80211_iftype type,
2730 struct genl_info *info,
2731 struct vif_params *params)
2732 {
2733 bool change = false;
2734 int err;
2735
2736 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
2737 if (type != NL80211_IFTYPE_MONITOR)
2738 return -EINVAL;
2739
2740 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
2741 &params->flags);
2742 if (err)
2743 return err;
2744
2745 change = true;
2746 }
2747
2748 if (params->flags & MONITOR_FLAG_ACTIVE &&
2749 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
2750 return -EOPNOTSUPP;
2751
2752 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
2753 const u8 *mumimo_groups;
2754 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2755
2756 if (type != NL80211_IFTYPE_MONITOR)
2757 return -EINVAL;
2758
2759 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2760 return -EOPNOTSUPP;
2761
2762 mumimo_groups =
2763 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
2764
2765 /* bits 0 and 63 are reserved and must be zero */
2766 if ((mumimo_groups[0] & BIT(7)) ||
2767 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(0)))
2768 return -EINVAL;
2769
2770 params->vht_mumimo_groups = mumimo_groups;
2771 change = true;
2772 }
2773
2774 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
2775 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2776
2777 if (type != NL80211_IFTYPE_MONITOR)
2778 return -EINVAL;
2779
2780 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2781 return -EOPNOTSUPP;
2782
2783 params->vht_mumimo_follow_addr =
2784 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
2785 change = true;
2786 }
2787
2788 return change ? 1 : 0;
2789 }
2790
2791 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
2792 struct net_device *netdev, u8 use_4addr,
2793 enum nl80211_iftype iftype)
2794 {
2795 if (!use_4addr) {
2796 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
2797 return -EBUSY;
2798 return 0;
2799 }
2800
2801 switch (iftype) {
2802 case NL80211_IFTYPE_AP_VLAN:
2803 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
2804 return 0;
2805 break;
2806 case NL80211_IFTYPE_STATION:
2807 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
2808 return 0;
2809 break;
2810 default:
2811 break;
2812 }
2813
2814 return -EOPNOTSUPP;
2815 }
2816
2817 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
2818 {
2819 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2820 struct vif_params params;
2821 int err;
2822 enum nl80211_iftype otype, ntype;
2823 struct net_device *dev = info->user_ptr[1];
2824 bool change = false;
2825
2826 memset(&params, 0, sizeof(params));
2827
2828 otype = ntype = dev->ieee80211_ptr->iftype;
2829
2830 if (info->attrs[NL80211_ATTR_IFTYPE]) {
2831 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2832 if (otype != ntype)
2833 change = true;
2834 if (ntype > NL80211_IFTYPE_MAX)
2835 return -EINVAL;
2836 }
2837
2838 if (info->attrs[NL80211_ATTR_MESH_ID]) {
2839 struct wireless_dev *wdev = dev->ieee80211_ptr;
2840
2841 if (ntype != NL80211_IFTYPE_MESH_POINT)
2842 return -EINVAL;
2843 if (netif_running(dev))
2844 return -EBUSY;
2845
2846 wdev_lock(wdev);
2847 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2848 IEEE80211_MAX_MESH_ID_LEN);
2849 wdev->mesh_id_up_len =
2850 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2851 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2852 wdev->mesh_id_up_len);
2853 wdev_unlock(wdev);
2854 }
2855
2856 if (info->attrs[NL80211_ATTR_4ADDR]) {
2857 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2858 change = true;
2859 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
2860 if (err)
2861 return err;
2862 } else {
2863 params.use_4addr = -1;
2864 }
2865
2866 err = nl80211_parse_mon_options(rdev, ntype, info, &params);
2867 if (err < 0)
2868 return err;
2869 if (err > 0)
2870 change = true;
2871
2872 if (change)
2873 err = cfg80211_change_iface(rdev, dev, ntype, &params);
2874 else
2875 err = 0;
2876
2877 if (!err && params.use_4addr != -1)
2878 dev->ieee80211_ptr->use_4addr = params.use_4addr;
2879
2880 return err;
2881 }
2882
2883 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
2884 {
2885 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2886 struct vif_params params;
2887 struct wireless_dev *wdev;
2888 struct sk_buff *msg;
2889 int err;
2890 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
2891
2892 /* to avoid failing a new interface creation due to pending removal */
2893 cfg80211_destroy_ifaces(rdev);
2894
2895 memset(&params, 0, sizeof(params));
2896
2897 if (!info->attrs[NL80211_ATTR_IFNAME])
2898 return -EINVAL;
2899
2900 if (info->attrs[NL80211_ATTR_IFTYPE]) {
2901 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2902 if (type > NL80211_IFTYPE_MAX)
2903 return -EINVAL;
2904 }
2905
2906 if (!rdev->ops->add_virtual_intf ||
2907 !(rdev->wiphy.interface_modes & (1 << type)))
2908 return -EOPNOTSUPP;
2909
2910 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
2911 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
2912 info->attrs[NL80211_ATTR_MAC]) {
2913 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
2914 ETH_ALEN);
2915 if (!is_valid_ether_addr(params.macaddr))
2916 return -EADDRNOTAVAIL;
2917 }
2918
2919 if (info->attrs[NL80211_ATTR_4ADDR]) {
2920 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2921 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
2922 if (err)
2923 return err;
2924 }
2925
2926 err = nl80211_parse_mon_options(rdev, type, info, &params);
2927 if (err < 0)
2928 return err;
2929
2930 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2931 if (!msg)
2932 return -ENOMEM;
2933
2934 wdev = rdev_add_virtual_intf(rdev,
2935 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
2936 NET_NAME_USER, type, &params);
2937 if (WARN_ON(!wdev)) {
2938 nlmsg_free(msg);
2939 return -EPROTO;
2940 } else if (IS_ERR(wdev)) {
2941 nlmsg_free(msg);
2942 return PTR_ERR(wdev);
2943 }
2944
2945 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
2946 wdev->owner_nlportid = info->snd_portid;
2947
2948 switch (type) {
2949 case NL80211_IFTYPE_MESH_POINT:
2950 if (!info->attrs[NL80211_ATTR_MESH_ID])
2951 break;
2952 wdev_lock(wdev);
2953 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2954 IEEE80211_MAX_MESH_ID_LEN);
2955 wdev->mesh_id_up_len =
2956 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2957 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2958 wdev->mesh_id_up_len);
2959 wdev_unlock(wdev);
2960 break;
2961 case NL80211_IFTYPE_NAN:
2962 case NL80211_IFTYPE_P2P_DEVICE:
2963 /*
2964 * P2P Device and NAN do not have a netdev, so don't go
2965 * through the netdev notifier and must be added here
2966 */
2967 mutex_init(&wdev->mtx);
2968 INIT_LIST_HEAD(&wdev->event_list);
2969 spin_lock_init(&wdev->event_lock);
2970 INIT_LIST_HEAD(&wdev->mgmt_registrations);
2971 spin_lock_init(&wdev->mgmt_registrations_lock);
2972
2973 wdev->identifier = ++rdev->wdev_id;
2974 list_add_rcu(&wdev->list, &rdev->wiphy.wdev_list);
2975 rdev->devlist_generation++;
2976 break;
2977 default:
2978 break;
2979 }
2980
2981 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
2982 rdev, wdev, false) < 0) {
2983 nlmsg_free(msg);
2984 return -ENOBUFS;
2985 }
2986
2987 /*
2988 * For wdevs which have no associated netdev object (e.g. of type
2989 * NL80211_IFTYPE_P2P_DEVICE), emit the NEW_INTERFACE event here.
2990 * For all other types, the event will be generated from the
2991 * netdev notifier
2992 */
2993 if (!wdev->netdev)
2994 nl80211_notify_iface(rdev, wdev, NL80211_CMD_NEW_INTERFACE);
2995
2996 return genlmsg_reply(msg, info);
2997 }
2998
2999 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
3000 {
3001 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3002 struct wireless_dev *wdev = info->user_ptr[1];
3003
3004 if (!rdev->ops->del_virtual_intf)
3005 return -EOPNOTSUPP;
3006
3007 /*
3008 * If we remove a wireless device without a netdev then clear
3009 * user_ptr[1] so that nl80211_post_doit won't dereference it
3010 * to check if it needs to do dev_put(). Otherwise it crashes
3011 * since the wdev has been freed, unlike with a netdev where
3012 * we need the dev_put() for the netdev to really be freed.
3013 */
3014 if (!wdev->netdev)
3015 info->user_ptr[1] = NULL;
3016
3017 return rdev_del_virtual_intf(rdev, wdev);
3018 }
3019
3020 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
3021 {
3022 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3023 struct net_device *dev = info->user_ptr[1];
3024 u16 noack_map;
3025
3026 if (!info->attrs[NL80211_ATTR_NOACK_MAP])
3027 return -EINVAL;
3028
3029 if (!rdev->ops->set_noack_map)
3030 return -EOPNOTSUPP;
3031
3032 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
3033
3034 return rdev_set_noack_map(rdev, dev, noack_map);
3035 }
3036
3037 struct get_key_cookie {
3038 struct sk_buff *msg;
3039 int error;
3040 int idx;
3041 };
3042
3043 static void get_key_callback(void *c, struct key_params *params)
3044 {
3045 struct nlattr *key;
3046 struct get_key_cookie *cookie = c;
3047
3048 if ((params->key &&
3049 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
3050 params->key_len, params->key)) ||
3051 (params->seq &&
3052 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
3053 params->seq_len, params->seq)) ||
3054 (params->cipher &&
3055 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
3056 params->cipher)))
3057 goto nla_put_failure;
3058
3059 key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
3060 if (!key)
3061 goto nla_put_failure;
3062
3063 if ((params->key &&
3064 nla_put(cookie->msg, NL80211_KEY_DATA,
3065 params->key_len, params->key)) ||
3066 (params->seq &&
3067 nla_put(cookie->msg, NL80211_KEY_SEQ,
3068 params->seq_len, params->seq)) ||
3069 (params->cipher &&
3070 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
3071 params->cipher)))
3072 goto nla_put_failure;
3073
3074 if (nla_put_u8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx))
3075 goto nla_put_failure;
3076
3077 nla_nest_end(cookie->msg, key);
3078
3079 return;
3080 nla_put_failure:
3081 cookie->error = 1;
3082 }
3083
3084 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
3085 {
3086 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3087 int err;
3088 struct net_device *dev = info->user_ptr[1];
3089 u8 key_idx = 0;
3090 const u8 *mac_addr = NULL;
3091 bool pairwise;
3092 struct get_key_cookie cookie = {
3093 .error = 0,
3094 };
3095 void *hdr;
3096 struct sk_buff *msg;
3097
3098 if (info->attrs[NL80211_ATTR_KEY_IDX])
3099 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
3100
3101 if (key_idx > 5)
3102 return -EINVAL;
3103
3104 if (info->attrs[NL80211_ATTR_MAC])
3105 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3106
3107 pairwise = !!mac_addr;
3108 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
3109 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
3110
3111 if (kt >= NUM_NL80211_KEYTYPES)
3112 return -EINVAL;
3113 if (kt != NL80211_KEYTYPE_GROUP &&
3114 kt != NL80211_KEYTYPE_PAIRWISE)
3115 return -EINVAL;
3116 pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
3117 }
3118
3119 if (!rdev->ops->get_key)
3120 return -EOPNOTSUPP;
3121
3122 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3123 return -ENOENT;
3124
3125 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3126 if (!msg)
3127 return -ENOMEM;
3128
3129 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
3130 NL80211_CMD_NEW_KEY);
3131 if (!hdr)
3132 goto nla_put_failure;
3133
3134 cookie.msg = msg;
3135 cookie.idx = key_idx;
3136
3137 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3138 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
3139 goto nla_put_failure;
3140 if (mac_addr &&
3141 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
3142 goto nla_put_failure;
3143
3144 err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
3145 get_key_callback);
3146
3147 if (err)
3148 goto free_msg;
3149
3150 if (cookie.error)
3151 goto nla_put_failure;
3152
3153 genlmsg_end(msg, hdr);
3154 return genlmsg_reply(msg, info);
3155
3156 nla_put_failure:
3157 err = -ENOBUFS;
3158 free_msg:
3159 nlmsg_free(msg);
3160 return err;
3161 }
3162
3163 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
3164 {
3165 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3166 struct key_parse key;
3167 int err;
3168 struct net_device *dev = info->user_ptr[1];
3169
3170 err = nl80211_parse_key(info, &key);
3171 if (err)
3172 return err;
3173
3174 if (key.idx < 0)
3175 return -EINVAL;
3176
3177 /* only support setting default key */
3178 if (!key.def && !key.defmgmt)
3179 return -EINVAL;
3180
3181 wdev_lock(dev->ieee80211_ptr);
3182
3183 if (key.def) {
3184 if (!rdev->ops->set_default_key) {
3185 err = -EOPNOTSUPP;
3186 goto out;
3187 }
3188
3189 err = nl80211_key_allowed(dev->ieee80211_ptr);
3190 if (err)
3191 goto out;
3192
3193 err = rdev_set_default_key(rdev, dev, key.idx,
3194 key.def_uni, key.def_multi);
3195
3196 if (err)
3197 goto out;
3198
3199 #ifdef CONFIG_CFG80211_WEXT
3200 dev->ieee80211_ptr->wext.default_key = key.idx;
3201 #endif
3202 } else {
3203 if (key.def_uni || !key.def_multi) {
3204 err = -EINVAL;
3205 goto out;
3206 }
3207
3208 if (!rdev->ops->set_default_mgmt_key) {
3209 err = -EOPNOTSUPP;
3210 goto out;
3211 }
3212
3213 err = nl80211_key_allowed(dev->ieee80211_ptr);
3214 if (err)
3215 goto out;
3216
3217 err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
3218 if (err)
3219 goto out;
3220
3221 #ifdef CONFIG_CFG80211_WEXT
3222 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
3223 #endif
3224 }
3225
3226 out:
3227 wdev_unlock(dev->ieee80211_ptr);
3228
3229 return err;
3230 }
3231
3232 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
3233 {
3234 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3235 int err;
3236 struct net_device *dev = info->user_ptr[1];
3237 struct key_parse key;
3238 const u8 *mac_addr = NULL;
3239
3240 err = nl80211_parse_key(info, &key);
3241 if (err)
3242 return err;
3243
3244 if (!key.p.key)
3245 return -EINVAL;
3246
3247 if (info->attrs[NL80211_ATTR_MAC])
3248 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3249
3250 if (key.type == -1) {
3251 if (mac_addr)
3252 key.type = NL80211_KEYTYPE_PAIRWISE;
3253 else
3254 key.type = NL80211_KEYTYPE_GROUP;
3255 }
3256
3257 /* for now */
3258 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3259 key.type != NL80211_KEYTYPE_GROUP)
3260 return -EINVAL;
3261
3262 if (!rdev->ops->add_key)
3263 return -EOPNOTSUPP;
3264
3265 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
3266 key.type == NL80211_KEYTYPE_PAIRWISE,
3267 mac_addr))
3268 return -EINVAL;
3269
3270 wdev_lock(dev->ieee80211_ptr);
3271 err = nl80211_key_allowed(dev->ieee80211_ptr);
3272 if (!err)
3273 err = rdev_add_key(rdev, dev, key.idx,
3274 key.type == NL80211_KEYTYPE_PAIRWISE,
3275 mac_addr, &key.p);
3276 wdev_unlock(dev->ieee80211_ptr);
3277
3278 return err;
3279 }
3280
3281 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
3282 {
3283 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3284 int err;
3285 struct net_device *dev = info->user_ptr[1];
3286 u8 *mac_addr = NULL;
3287 struct key_parse key;
3288
3289 err = nl80211_parse_key(info, &key);
3290 if (err)
3291 return err;
3292
3293 if (info->attrs[NL80211_ATTR_MAC])
3294 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3295
3296 if (key.type == -1) {
3297 if (mac_addr)
3298 key.type = NL80211_KEYTYPE_PAIRWISE;
3299 else
3300 key.type = NL80211_KEYTYPE_GROUP;
3301 }
3302
3303 /* for now */
3304 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3305 key.type != NL80211_KEYTYPE_GROUP)
3306 return -EINVAL;
3307
3308 if (!rdev->ops->del_key)
3309 return -EOPNOTSUPP;
3310
3311 wdev_lock(dev->ieee80211_ptr);
3312 err = nl80211_key_allowed(dev->ieee80211_ptr);
3313
3314 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
3315 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3316 err = -ENOENT;
3317
3318 if (!err)
3319 err = rdev_del_key(rdev, dev, key.idx,
3320 key.type == NL80211_KEYTYPE_PAIRWISE,
3321 mac_addr);
3322
3323 #ifdef CONFIG_CFG80211_WEXT
3324 if (!err) {
3325 if (key.idx == dev->ieee80211_ptr->wext.default_key)
3326 dev->ieee80211_ptr->wext.default_key = -1;
3327 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
3328 dev->ieee80211_ptr->wext.default_mgmt_key = -1;
3329 }
3330 #endif
3331 wdev_unlock(dev->ieee80211_ptr);
3332
3333 return err;
3334 }
3335
3336 /* This function returns an error or the number of nested attributes */
3337 static int validate_acl_mac_addrs(struct nlattr *nl_attr)
3338 {
3339 struct nlattr *attr;
3340 int n_entries = 0, tmp;
3341
3342 nla_for_each_nested(attr, nl_attr, tmp) {
3343 if (nla_len(attr) != ETH_ALEN)
3344 return -EINVAL;
3345
3346 n_entries++;
3347 }
3348
3349 return n_entries;
3350 }
3351
3352 /*
3353 * This function parses ACL information and allocates memory for ACL data.
3354 * On successful return, the calling function is responsible to free the
3355 * ACL buffer returned by this function.
3356 */
3357 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
3358 struct genl_info *info)
3359 {
3360 enum nl80211_acl_policy acl_policy;
3361 struct nlattr *attr;
3362 struct cfg80211_acl_data *acl;
3363 int i = 0, n_entries, tmp;
3364
3365 if (!wiphy->max_acl_mac_addrs)
3366 return ERR_PTR(-EOPNOTSUPP);
3367
3368 if (!info->attrs[NL80211_ATTR_ACL_POLICY])
3369 return ERR_PTR(-EINVAL);
3370
3371 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
3372 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
3373 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
3374 return ERR_PTR(-EINVAL);
3375
3376 if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
3377 return ERR_PTR(-EINVAL);
3378
3379 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
3380 if (n_entries < 0)
3381 return ERR_PTR(n_entries);
3382
3383 if (n_entries > wiphy->max_acl_mac_addrs)
3384 return ERR_PTR(-ENOTSUPP);
3385
3386 acl = kzalloc(sizeof(*acl) + (sizeof(struct mac_address) * n_entries),
3387 GFP_KERNEL);
3388 if (!acl)
3389 return ERR_PTR(-ENOMEM);
3390
3391 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
3392 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
3393 i++;
3394 }
3395
3396 acl->n_acl_entries = n_entries;
3397 acl->acl_policy = acl_policy;
3398
3399 return acl;
3400 }
3401
3402 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
3403 {
3404 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3405 struct net_device *dev = info->user_ptr[1];
3406 struct cfg80211_acl_data *acl;
3407 int err;
3408
3409 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3410 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3411 return -EOPNOTSUPP;
3412
3413 if (!dev->ieee80211_ptr->beacon_interval)
3414 return -EINVAL;
3415
3416 acl = parse_acl_data(&rdev->wiphy, info);
3417 if (IS_ERR(acl))
3418 return PTR_ERR(acl);
3419
3420 err = rdev_set_mac_acl(rdev, dev, acl);
3421
3422 kfree(acl);
3423
3424 return err;
3425 }
3426
3427 static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
3428 u8 *rates, u8 rates_len)
3429 {
3430 u8 i;
3431 u32 mask = 0;
3432
3433 for (i = 0; i < rates_len; i++) {
3434 int rate = (rates[i] & 0x7f) * 5;
3435 int ridx;
3436
3437 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
3438 struct ieee80211_rate *srate =
3439 &sband->bitrates[ridx];
3440 if (rate == srate->bitrate) {
3441 mask |= 1 << ridx;
3442 break;
3443 }
3444 }
3445 if (ridx == sband->n_bitrates)
3446 return 0; /* rate not found */
3447 }
3448
3449 return mask;
3450 }
3451
3452 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
3453 u8 *rates, u8 rates_len,
3454 u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
3455 {
3456 u8 i;
3457
3458 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
3459
3460 for (i = 0; i < rates_len; i++) {
3461 int ridx, rbit;
3462
3463 ridx = rates[i] / 8;
3464 rbit = BIT(rates[i] % 8);
3465
3466 /* check validity */
3467 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
3468 return false;
3469
3470 /* check availability */
3471 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
3472 mcs[ridx] |= rbit;
3473 else
3474 return false;
3475 }
3476
3477 return true;
3478 }
3479
3480 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
3481 {
3482 u16 mcs_mask = 0;
3483
3484 switch (vht_mcs_map) {
3485 case IEEE80211_VHT_MCS_NOT_SUPPORTED:
3486 break;
3487 case IEEE80211_VHT_MCS_SUPPORT_0_7:
3488 mcs_mask = 0x00FF;
3489 break;
3490 case IEEE80211_VHT_MCS_SUPPORT_0_8:
3491 mcs_mask = 0x01FF;
3492 break;
3493 case IEEE80211_VHT_MCS_SUPPORT_0_9:
3494 mcs_mask = 0x03FF;
3495 break;
3496 default:
3497 break;
3498 }
3499
3500 return mcs_mask;
3501 }
3502
3503 static void vht_build_mcs_mask(u16 vht_mcs_map,
3504 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
3505 {
3506 u8 nss;
3507
3508 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
3509 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
3510 vht_mcs_map >>= 2;
3511 }
3512 }
3513
3514 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
3515 struct nl80211_txrate_vht *txrate,
3516 u16 mcs[NL80211_VHT_NSS_MAX])
3517 {
3518 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3519 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
3520 u8 i;
3521
3522 if (!sband->vht_cap.vht_supported)
3523 return false;
3524
3525 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
3526
3527 /* Build vht_mcs_mask from VHT capabilities */
3528 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
3529
3530 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
3531 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
3532 mcs[i] = txrate->mcs[i];
3533 else
3534 return false;
3535 }
3536
3537 return true;
3538 }
3539
3540 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
3541 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
3542 .len = NL80211_MAX_SUPP_RATES },
3543 [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
3544 .len = NL80211_MAX_SUPP_HT_RATES },
3545 [NL80211_TXRATE_VHT] = { .len = sizeof(struct nl80211_txrate_vht)},
3546 [NL80211_TXRATE_GI] = { .type = NLA_U8 },
3547 };
3548
3549 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
3550 struct cfg80211_bitrate_mask *mask)
3551 {
3552 struct nlattr *tb[NL80211_TXRATE_MAX + 1];
3553 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3554 int rem, i;
3555 struct nlattr *tx_rates;
3556 struct ieee80211_supported_band *sband;
3557 u16 vht_tx_mcs_map;
3558
3559 memset(mask, 0, sizeof(*mask));
3560 /* Default to all rates enabled */
3561 for (i = 0; i < NUM_NL80211_BANDS; i++) {
3562 sband = rdev->wiphy.bands[i];
3563
3564 if (!sband)
3565 continue;
3566
3567 mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
3568 memcpy(mask->control[i].ht_mcs,
3569 sband->ht_cap.mcs.rx_mask,
3570 sizeof(mask->control[i].ht_mcs));
3571
3572 if (!sband->vht_cap.vht_supported)
3573 continue;
3574
3575 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3576 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
3577 }
3578
3579 /* if no rates are given set it back to the defaults */
3580 if (!info->attrs[NL80211_ATTR_TX_RATES])
3581 goto out;
3582
3583 /* The nested attribute uses enum nl80211_band as the index. This maps
3584 * directly to the enum nl80211_band values used in cfg80211.
3585 */
3586 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
3587 nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
3588 enum nl80211_band band = nla_type(tx_rates);
3589 int err;
3590
3591 if (band < 0 || band >= NUM_NL80211_BANDS)
3592 return -EINVAL;
3593 sband = rdev->wiphy.bands[band];
3594 if (sband == NULL)
3595 return -EINVAL;
3596 err = nla_parse_nested(tb, NL80211_TXRATE_MAX, tx_rates,
3597 nl80211_txattr_policy, info->extack);
3598 if (err)
3599 return err;
3600 if (tb[NL80211_TXRATE_LEGACY]) {
3601 mask->control[band].legacy = rateset_to_mask(
3602 sband,
3603 nla_data(tb[NL80211_TXRATE_LEGACY]),
3604 nla_len(tb[NL80211_TXRATE_LEGACY]));
3605 if ((mask->control[band].legacy == 0) &&
3606 nla_len(tb[NL80211_TXRATE_LEGACY]))
3607 return -EINVAL;
3608 }
3609 if (tb[NL80211_TXRATE_HT]) {
3610 if (!ht_rateset_to_mask(
3611 sband,
3612 nla_data(tb[NL80211_TXRATE_HT]),
3613 nla_len(tb[NL80211_TXRATE_HT]),
3614 mask->control[band].ht_mcs))
3615 return -EINVAL;
3616 }
3617 if (tb[NL80211_TXRATE_VHT]) {
3618 if (!vht_set_mcs_mask(
3619 sband,
3620 nla_data(tb[NL80211_TXRATE_VHT]),
3621 mask->control[band].vht_mcs))
3622 return -EINVAL;
3623 }
3624 if (tb[NL80211_TXRATE_GI]) {
3625 mask->control[band].gi =
3626 nla_get_u8(tb[NL80211_TXRATE_GI]);
3627 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
3628 return -EINVAL;
3629 }
3630
3631 if (mask->control[band].legacy == 0) {
3632 /* don't allow empty legacy rates if HT or VHT
3633 * are not even supported.
3634 */
3635 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
3636 rdev->wiphy.bands[band]->vht_cap.vht_supported))
3637 return -EINVAL;
3638
3639 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
3640 if (mask->control[band].ht_mcs[i])
3641 goto out;
3642
3643 for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
3644 if (mask->control[band].vht_mcs[i])
3645 goto out;
3646
3647 /* legacy and mcs rates may not be both empty */
3648 return -EINVAL;
3649 }
3650 }
3651
3652 out:
3653 return 0;
3654 }
3655
3656 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
3657 enum nl80211_band band,
3658 struct cfg80211_bitrate_mask *beacon_rate)
3659 {
3660 u32 count_ht, count_vht, i;
3661 u32 rate = beacon_rate->control[band].legacy;
3662
3663 /* Allow only one rate */
3664 if (hweight32(rate) > 1)
3665 return -EINVAL;
3666
3667 count_ht = 0;
3668 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
3669 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
3670 return -EINVAL;
3671 } else if (beacon_rate->control[band].ht_mcs[i]) {
3672 count_ht++;
3673 if (count_ht > 1)
3674 return -EINVAL;
3675 }
3676 if (count_ht && rate)
3677 return -EINVAL;
3678 }
3679
3680 count_vht = 0;
3681 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
3682 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
3683 return -EINVAL;
3684 } else if (beacon_rate->control[band].vht_mcs[i]) {
3685 count_vht++;
3686 if (count_vht > 1)
3687 return -EINVAL;
3688 }
3689 if (count_vht && rate)
3690 return -EINVAL;
3691 }
3692
3693 if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
3694 return -EINVAL;
3695
3696 if (rate &&
3697 !wiphy_ext_feature_isset(&rdev->wiphy,
3698 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
3699 return -EINVAL;
3700 if (count_ht &&
3701 !wiphy_ext_feature_isset(&rdev->wiphy,
3702 NL80211_EXT_FEATURE_BEACON_RATE_HT))
3703 return -EINVAL;
3704 if (count_vht &&
3705 !wiphy_ext_feature_isset(&rdev->wiphy,
3706 NL80211_EXT_FEATURE_BEACON_RATE_VHT))
3707 return -EINVAL;
3708
3709 return 0;
3710 }
3711
3712 static int nl80211_parse_beacon(struct nlattr *attrs[],
3713 struct cfg80211_beacon_data *bcn)
3714 {
3715 bool haveinfo = false;
3716
3717 if (!is_valid_ie_attr(attrs[NL80211_ATTR_BEACON_TAIL]) ||
3718 !is_valid_ie_attr(attrs[NL80211_ATTR_IE]) ||
3719 !is_valid_ie_attr(attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
3720 !is_valid_ie_attr(attrs[NL80211_ATTR_IE_ASSOC_RESP]))
3721 return -EINVAL;
3722
3723 memset(bcn, 0, sizeof(*bcn));
3724
3725 if (attrs[NL80211_ATTR_BEACON_HEAD]) {
3726 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
3727 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
3728 if (!bcn->head_len)
3729 return -EINVAL;
3730 haveinfo = true;
3731 }
3732
3733 if (attrs[NL80211_ATTR_BEACON_TAIL]) {
3734 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
3735 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
3736 haveinfo = true;
3737 }
3738
3739 if (!haveinfo)
3740 return -EINVAL;
3741
3742 if (attrs[NL80211_ATTR_IE]) {
3743 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
3744 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
3745 }
3746
3747 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
3748 bcn->proberesp_ies =
3749 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
3750 bcn->proberesp_ies_len =
3751 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
3752 }
3753
3754 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
3755 bcn->assocresp_ies =
3756 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
3757 bcn->assocresp_ies_len =
3758 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
3759 }
3760
3761 if (attrs[NL80211_ATTR_PROBE_RESP]) {
3762 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
3763 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
3764 }
3765
3766 return 0;
3767 }
3768
3769 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
3770 const u8 *rates)
3771 {
3772 int i;
3773
3774 if (!rates)
3775 return;
3776
3777 for (i = 0; i < rates[1]; i++) {
3778 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
3779 params->ht_required = true;
3780 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
3781 params->vht_required = true;
3782 }
3783 }
3784
3785 /*
3786 * Since the nl80211 API didn't include, from the beginning, attributes about
3787 * HT/VHT requirements/capabilities, we parse them out of the IEs for the
3788 * benefit of drivers that rebuild IEs in the firmware.
3789 */
3790 static void nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
3791 {
3792 const struct cfg80211_beacon_data *bcn = &params->beacon;
3793 size_t ies_len = bcn->beacon_ies_len;
3794 const u8 *ies = bcn->beacon_ies;
3795 const u8 *rates;
3796 const u8 *cap;
3797
3798 rates = cfg80211_find_ie(WLAN_EID_SUPP_RATES, ies, ies_len);
3799 nl80211_check_ap_rate_selectors(params, rates);
3800
3801 rates = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
3802 nl80211_check_ap_rate_selectors(params, rates);
3803
3804 cap = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies, ies_len);
3805 if (cap && cap[1] >= sizeof(*params->ht_cap))
3806 params->ht_cap = (void *)(cap + 2);
3807 cap = cfg80211_find_ie(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
3808 if (cap && cap[1] >= sizeof(*params->vht_cap))
3809 params->vht_cap = (void *)(cap + 2);
3810 }
3811
3812 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
3813 struct cfg80211_ap_settings *params)
3814 {
3815 struct wireless_dev *wdev;
3816 bool ret = false;
3817
3818 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
3819 if (wdev->iftype != NL80211_IFTYPE_AP &&
3820 wdev->iftype != NL80211_IFTYPE_P2P_GO)
3821 continue;
3822
3823 if (!wdev->preset_chandef.chan)
3824 continue;
3825
3826 params->chandef = wdev->preset_chandef;
3827 ret = true;
3828 break;
3829 }
3830
3831 return ret;
3832 }
3833
3834 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
3835 enum nl80211_auth_type auth_type,
3836 enum nl80211_commands cmd)
3837 {
3838 if (auth_type > NL80211_AUTHTYPE_MAX)
3839 return false;
3840
3841 switch (cmd) {
3842 case NL80211_CMD_AUTHENTICATE:
3843 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
3844 auth_type == NL80211_AUTHTYPE_SAE)
3845 return false;
3846 if (!wiphy_ext_feature_isset(&rdev->wiphy,
3847 NL80211_EXT_FEATURE_FILS_STA) &&
3848 (auth_type == NL80211_AUTHTYPE_FILS_SK ||
3849 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3850 auth_type == NL80211_AUTHTYPE_FILS_PK))
3851 return false;
3852 return true;
3853 case NL80211_CMD_CONNECT:
3854 /* SAE not supported yet */
3855 if (auth_type == NL80211_AUTHTYPE_SAE)
3856 return false;
3857 /* FILS with SK PFS or PK not supported yet */
3858 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3859 auth_type == NL80211_AUTHTYPE_FILS_PK)
3860 return false;
3861 if (!wiphy_ext_feature_isset(
3862 &rdev->wiphy,
3863 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
3864 auth_type == NL80211_AUTHTYPE_FILS_SK)
3865 return false;
3866 return true;
3867 case NL80211_CMD_START_AP:
3868 /* SAE not supported yet */
3869 if (auth_type == NL80211_AUTHTYPE_SAE)
3870 return false;
3871 /* FILS not supported yet */
3872 if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
3873 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3874 auth_type == NL80211_AUTHTYPE_FILS_PK)
3875 return false;
3876 return true;
3877 default:
3878 return false;
3879 }
3880 }
3881
3882 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
3883 {
3884 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3885 struct net_device *dev = info->user_ptr[1];
3886 struct wireless_dev *wdev = dev->ieee80211_ptr;
3887 struct cfg80211_ap_settings params;
3888 int err;
3889
3890 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3891 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3892 return -EOPNOTSUPP;
3893
3894 if (!rdev->ops->start_ap)
3895 return -EOPNOTSUPP;
3896
3897 if (wdev->beacon_interval)
3898 return -EALREADY;
3899
3900 memset(&params, 0, sizeof(params));
3901
3902 /* these are required for START_AP */
3903 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
3904 !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
3905 !info->attrs[NL80211_ATTR_BEACON_HEAD])
3906 return -EINVAL;
3907
3908 err = nl80211_parse_beacon(info->attrs, &params.beacon);
3909 if (err)
3910 return err;
3911
3912 params.beacon_interval =
3913 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
3914 params.dtim_period =
3915 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
3916
3917 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
3918 params.beacon_interval);
3919 if (err)
3920 return err;
3921
3922 /*
3923 * In theory, some of these attributes should be required here
3924 * but since they were not used when the command was originally
3925 * added, keep them optional for old user space programs to let
3926 * them continue to work with drivers that do not need the
3927 * additional information -- drivers must check!
3928 */
3929 if (info->attrs[NL80211_ATTR_SSID]) {
3930 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
3931 params.ssid_len =
3932 nla_len(info->attrs[NL80211_ATTR_SSID]);
3933 if (params.ssid_len == 0 ||
3934 params.ssid_len > IEEE80211_MAX_SSID_LEN)
3935 return -EINVAL;
3936 }
3937
3938 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
3939 params.hidden_ssid = nla_get_u32(
3940 info->attrs[NL80211_ATTR_HIDDEN_SSID]);
3941 if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
3942 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
3943 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
3944 return -EINVAL;
3945 }
3946
3947 params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
3948
3949 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
3950 params.auth_type = nla_get_u32(
3951 info->attrs[NL80211_ATTR_AUTH_TYPE]);
3952 if (!nl80211_valid_auth_type(rdev, params.auth_type,
3953 NL80211_CMD_START_AP))
3954 return -EINVAL;
3955 } else
3956 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
3957
3958 err = nl80211_crypto_settings(rdev, info, &params.crypto,
3959 NL80211_MAX_NR_CIPHER_SUITES);
3960 if (err)
3961 return err;
3962
3963 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
3964 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
3965 return -EOPNOTSUPP;
3966 params.inactivity_timeout = nla_get_u16(
3967 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
3968 }
3969
3970 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
3971 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3972 return -EINVAL;
3973 params.p2p_ctwindow =
3974 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
3975 if (params.p2p_ctwindow > 127)
3976 return -EINVAL;
3977 if (params.p2p_ctwindow != 0 &&
3978 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
3979 return -EINVAL;
3980 }
3981
3982 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
3983 u8 tmp;
3984
3985 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3986 return -EINVAL;
3987 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
3988 if (tmp > 1)
3989 return -EINVAL;
3990 params.p2p_opp_ps = tmp;
3991 if (params.p2p_opp_ps != 0 &&
3992 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
3993 return -EINVAL;
3994 }
3995
3996 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
3997 err = nl80211_parse_chandef(rdev, info, &params.chandef);
3998 if (err)
3999 return err;
4000 } else if (wdev->preset_chandef.chan) {
4001 params.chandef = wdev->preset_chandef;
4002 } else if (!nl80211_get_ap_channel(rdev, &params))
4003 return -EINVAL;
4004
4005 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
4006 wdev->iftype))
4007 return -EINVAL;
4008
4009 if (info->attrs[NL80211_ATTR_TX_RATES]) {
4010 err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
4011 if (err)
4012 return err;
4013
4014 err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
4015 &params.beacon_rate);
4016 if (err)
4017 return err;
4018 }
4019
4020 if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
4021 params.smps_mode =
4022 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
4023 switch (params.smps_mode) {
4024 case NL80211_SMPS_OFF:
4025 break;
4026 case NL80211_SMPS_STATIC:
4027 if (!(rdev->wiphy.features &
4028 NL80211_FEATURE_STATIC_SMPS))
4029 return -EINVAL;
4030 break;
4031 case NL80211_SMPS_DYNAMIC:
4032 if (!(rdev->wiphy.features &
4033 NL80211_FEATURE_DYNAMIC_SMPS))
4034 return -EINVAL;
4035 break;
4036 default:
4037 return -EINVAL;
4038 }
4039 } else {
4040 params.smps_mode = NL80211_SMPS_OFF;
4041 }
4042
4043 params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
4044 if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
4045 return -EOPNOTSUPP;
4046
4047 if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
4048 params.acl = parse_acl_data(&rdev->wiphy, info);
4049 if (IS_ERR(params.acl))
4050 return PTR_ERR(params.acl);
4051 }
4052
4053 nl80211_calculate_ap_params(&params);
4054
4055 wdev_lock(wdev);
4056 err = rdev_start_ap(rdev, dev, &params);
4057 if (!err) {
4058 wdev->preset_chandef = params.chandef;
4059 wdev->beacon_interval = params.beacon_interval;
4060 wdev->chandef = params.chandef;
4061 wdev->ssid_len = params.ssid_len;
4062 memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
4063 }
4064 wdev_unlock(wdev);
4065
4066 kfree(params.acl);
4067
4068 return err;
4069 }
4070
4071 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
4072 {
4073 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4074 struct net_device *dev = info->user_ptr[1];
4075 struct wireless_dev *wdev = dev->ieee80211_ptr;
4076 struct cfg80211_beacon_data params;
4077 int err;
4078
4079 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4080 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4081 return -EOPNOTSUPP;
4082
4083 if (!rdev->ops->change_beacon)
4084 return -EOPNOTSUPP;
4085
4086 if (!wdev->beacon_interval)
4087 return -EINVAL;
4088
4089 err = nl80211_parse_beacon(info->attrs, &params);
4090 if (err)
4091 return err;
4092
4093 wdev_lock(wdev);
4094 err = rdev_change_beacon(rdev, dev, &params);
4095 wdev_unlock(wdev);
4096
4097 return err;
4098 }
4099
4100 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
4101 {
4102 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4103 struct net_device *dev = info->user_ptr[1];
4104
4105 return cfg80211_stop_ap(rdev, dev, false);
4106 }
4107
4108 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
4109 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
4110 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
4111 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
4112 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
4113 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
4114 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
4115 };
4116
4117 static int parse_station_flags(struct genl_info *info,
4118 enum nl80211_iftype iftype,
4119 struct station_parameters *params)
4120 {
4121 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
4122 struct nlattr *nla;
4123 int flag;
4124
4125 /*
4126 * Try parsing the new attribute first so userspace
4127 * can specify both for older kernels.
4128 */
4129 nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
4130 if (nla) {
4131 struct nl80211_sta_flag_update *sta_flags;
4132
4133 sta_flags = nla_data(nla);
4134 params->sta_flags_mask = sta_flags->mask;
4135 params->sta_flags_set = sta_flags->set;
4136 params->sta_flags_set &= params->sta_flags_mask;
4137 if ((params->sta_flags_mask |
4138 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
4139 return -EINVAL;
4140 return 0;
4141 }
4142
4143 /* if present, parse the old attribute */
4144
4145 nla = info->attrs[NL80211_ATTR_STA_FLAGS];
4146 if (!nla)
4147 return 0;
4148
4149 if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX, nla,
4150 sta_flags_policy, info->extack))
4151 return -EINVAL;
4152
4153 /*
4154 * Only allow certain flags for interface types so that
4155 * other attributes are silently ignored. Remember that
4156 * this is backward compatibility code with old userspace
4157 * and shouldn't be hit in other cases anyway.
4158 */
4159 switch (iftype) {
4160 case NL80211_IFTYPE_AP:
4161 case NL80211_IFTYPE_AP_VLAN:
4162 case NL80211_IFTYPE_P2P_GO:
4163 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4164 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4165 BIT(NL80211_STA_FLAG_WME) |
4166 BIT(NL80211_STA_FLAG_MFP);
4167 break;
4168 case NL80211_IFTYPE_P2P_CLIENT:
4169 case NL80211_IFTYPE_STATION:
4170 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4171 BIT(NL80211_STA_FLAG_TDLS_PEER);
4172 break;
4173 case NL80211_IFTYPE_MESH_POINT:
4174 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4175 BIT(NL80211_STA_FLAG_MFP) |
4176 BIT(NL80211_STA_FLAG_AUTHORIZED);
4177 default:
4178 return -EINVAL;
4179 }
4180
4181 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
4182 if (flags[flag]) {
4183 params->sta_flags_set |= (1<<flag);
4184
4185 /* no longer support new API additions in old API */
4186 if (flag > NL80211_STA_FLAG_MAX_OLD_API)
4187 return -EINVAL;
4188 }
4189 }
4190
4191 return 0;
4192 }
4193
4194 static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
4195 int attr)
4196 {
4197 struct nlattr *rate;
4198 u32 bitrate;
4199 u16 bitrate_compat;
4200 enum nl80211_rate_info rate_flg;
4201
4202 rate = nla_nest_start(msg, attr);
4203 if (!rate)
4204 return false;
4205
4206 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
4207 bitrate = cfg80211_calculate_bitrate(info);
4208 /* report 16-bit bitrate only if we can */
4209 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
4210 if (bitrate > 0 &&
4211 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
4212 return false;
4213 if (bitrate_compat > 0 &&
4214 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
4215 return false;
4216
4217 switch (info->bw) {
4218 case RATE_INFO_BW_5:
4219 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
4220 break;
4221 case RATE_INFO_BW_10:
4222 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
4223 break;
4224 default:
4225 WARN_ON(1);
4226 /* fall through */
4227 case RATE_INFO_BW_20:
4228 rate_flg = 0;
4229 break;
4230 case RATE_INFO_BW_40:
4231 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
4232 break;
4233 case RATE_INFO_BW_80:
4234 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
4235 break;
4236 case RATE_INFO_BW_160:
4237 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
4238 break;
4239 }
4240
4241 if (rate_flg && nla_put_flag(msg, rate_flg))
4242 return false;
4243
4244 if (info->flags & RATE_INFO_FLAGS_MCS) {
4245 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
4246 return false;
4247 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4248 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4249 return false;
4250 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
4251 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
4252 return false;
4253 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
4254 return false;
4255 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4256 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4257 return false;
4258 }
4259
4260 nla_nest_end(msg, rate);
4261 return true;
4262 }
4263
4264 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
4265 int id)
4266 {
4267 void *attr;
4268 int i = 0;
4269
4270 if (!mask)
4271 return true;
4272
4273 attr = nla_nest_start(msg, id);
4274 if (!attr)
4275 return false;
4276
4277 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
4278 if (!(mask & BIT(i)))
4279 continue;
4280
4281 if (nla_put_u8(msg, i, signal[i]))
4282 return false;
4283 }
4284
4285 nla_nest_end(msg, attr);
4286
4287 return true;
4288 }
4289
4290 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
4291 u32 seq, int flags,
4292 struct cfg80211_registered_device *rdev,
4293 struct net_device *dev,
4294 const u8 *mac_addr, struct station_info *sinfo)
4295 {
4296 void *hdr;
4297 struct nlattr *sinfoattr, *bss_param;
4298
4299 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
4300 if (!hdr)
4301 return -1;
4302
4303 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
4304 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
4305 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
4306 goto nla_put_failure;
4307
4308 sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
4309 if (!sinfoattr)
4310 goto nla_put_failure;
4311
4312 #define PUT_SINFO(attr, memb, type) do { \
4313 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \
4314 if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
4315 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \
4316 sinfo->memb)) \
4317 goto nla_put_failure; \
4318 } while (0)
4319 #define PUT_SINFO_U64(attr, memb) do { \
4320 if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
4321 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \
4322 sinfo->memb, NL80211_STA_INFO_PAD)) \
4323 goto nla_put_failure; \
4324 } while (0)
4325
4326 PUT_SINFO(CONNECTED_TIME, connected_time, u32);
4327 PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
4328
4329 if (sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES) |
4330 BIT(NL80211_STA_INFO_RX_BYTES64)) &&
4331 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
4332 (u32)sinfo->rx_bytes))
4333 goto nla_put_failure;
4334
4335 if (sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES) |
4336 BIT(NL80211_STA_INFO_TX_BYTES64)) &&
4337 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
4338 (u32)sinfo->tx_bytes))
4339 goto nla_put_failure;
4340
4341 PUT_SINFO_U64(RX_BYTES64, rx_bytes);
4342 PUT_SINFO_U64(TX_BYTES64, tx_bytes);
4343 PUT_SINFO(LLID, llid, u16);
4344 PUT_SINFO(PLID, plid, u16);
4345 PUT_SINFO(PLINK_STATE, plink_state, u8);
4346 PUT_SINFO_U64(RX_DURATION, rx_duration);
4347
4348 switch (rdev->wiphy.signal_type) {
4349 case CFG80211_SIGNAL_TYPE_MBM:
4350 PUT_SINFO(SIGNAL, signal, u8);
4351 PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
4352 break;
4353 default:
4354 break;
4355 }
4356 if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL)) {
4357 if (!nl80211_put_signal(msg, sinfo->chains,
4358 sinfo->chain_signal,
4359 NL80211_STA_INFO_CHAIN_SIGNAL))
4360 goto nla_put_failure;
4361 }
4362 if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
4363 if (!nl80211_put_signal(msg, sinfo->chains,
4364 sinfo->chain_signal_avg,
4365 NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
4366 goto nla_put_failure;
4367 }
4368 if (sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE)) {
4369 if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
4370 NL80211_STA_INFO_TX_BITRATE))
4371 goto nla_put_failure;
4372 }
4373 if (sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE)) {
4374 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
4375 NL80211_STA_INFO_RX_BITRATE))
4376 goto nla_put_failure;
4377 }
4378
4379 PUT_SINFO(RX_PACKETS, rx_packets, u32);
4380 PUT_SINFO(TX_PACKETS, tx_packets, u32);
4381 PUT_SINFO(TX_RETRIES, tx_retries, u32);
4382 PUT_SINFO(TX_FAILED, tx_failed, u32);
4383 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
4384 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
4385 PUT_SINFO(LOCAL_PM, local_pm, u32);
4386 PUT_SINFO(PEER_PM, peer_pm, u32);
4387 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
4388
4389 if (sinfo->filled & BIT(NL80211_STA_INFO_BSS_PARAM)) {
4390 bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
4391 if (!bss_param)
4392 goto nla_put_failure;
4393
4394 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
4395 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
4396 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
4397 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
4398 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
4399 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
4400 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
4401 sinfo->bss_param.dtim_period) ||
4402 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
4403 sinfo->bss_param.beacon_interval))
4404 goto nla_put_failure;
4405
4406 nla_nest_end(msg, bss_param);
4407 }
4408 if ((sinfo->filled & BIT(NL80211_STA_INFO_STA_FLAGS)) &&
4409 nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
4410 sizeof(struct nl80211_sta_flag_update),
4411 &sinfo->sta_flags))
4412 goto nla_put_failure;
4413
4414 PUT_SINFO_U64(T_OFFSET, t_offset);
4415 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
4416 PUT_SINFO_U64(BEACON_RX, rx_beacon);
4417 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
4418
4419 #undef PUT_SINFO
4420 #undef PUT_SINFO_U64
4421
4422 if (sinfo->filled & BIT(NL80211_STA_INFO_TID_STATS)) {
4423 struct nlattr *tidsattr;
4424 int tid;
4425
4426 tidsattr = nla_nest_start(msg, NL80211_STA_INFO_TID_STATS);
4427 if (!tidsattr)
4428 goto nla_put_failure;
4429
4430 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
4431 struct cfg80211_tid_stats *tidstats;
4432 struct nlattr *tidattr;
4433
4434 tidstats = &sinfo->pertid[tid];
4435
4436 if (!tidstats->filled)
4437 continue;
4438
4439 tidattr = nla_nest_start(msg, tid + 1);
4440 if (!tidattr)
4441 goto nla_put_failure;
4442
4443 #define PUT_TIDVAL_U64(attr, memb) do { \
4444 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \
4445 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \
4446 tidstats->memb, NL80211_TID_STATS_PAD)) \
4447 goto nla_put_failure; \
4448 } while (0)
4449
4450 PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
4451 PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
4452 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
4453 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
4454
4455 #undef PUT_TIDVAL_U64
4456 nla_nest_end(msg, tidattr);
4457 }
4458
4459 nla_nest_end(msg, tidsattr);
4460 }
4461
4462 nla_nest_end(msg, sinfoattr);
4463
4464 if (sinfo->assoc_req_ies_len &&
4465 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
4466 sinfo->assoc_req_ies))
4467 goto nla_put_failure;
4468
4469 genlmsg_end(msg, hdr);
4470 return 0;
4471
4472 nla_put_failure:
4473 genlmsg_cancel(msg, hdr);
4474 return -EMSGSIZE;
4475 }
4476
4477 static int nl80211_dump_station(struct sk_buff *skb,
4478 struct netlink_callback *cb)
4479 {
4480 struct station_info sinfo;
4481 struct cfg80211_registered_device *rdev;
4482 struct wireless_dev *wdev;
4483 u8 mac_addr[ETH_ALEN];
4484 int sta_idx = cb->args[2];
4485 int err;
4486
4487 rtnl_lock();
4488 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
4489 if (err)
4490 goto out_err;
4491
4492 if (!wdev->netdev) {
4493 err = -EINVAL;
4494 goto out_err;
4495 }
4496
4497 if (!rdev->ops->dump_station) {
4498 err = -EOPNOTSUPP;
4499 goto out_err;
4500 }
4501
4502 while (1) {
4503 memset(&sinfo, 0, sizeof(sinfo));
4504 err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
4505 mac_addr, &sinfo);
4506 if (err == -ENOENT)
4507 break;
4508 if (err)
4509 goto out_err;
4510
4511 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
4512 NETLINK_CB(cb->skb).portid,
4513 cb->nlh->nlmsg_seq, NLM_F_MULTI,
4514 rdev, wdev->netdev, mac_addr,
4515 &sinfo) < 0)
4516 goto out;
4517
4518 sta_idx++;
4519 }
4520
4521 out:
4522 cb->args[2] = sta_idx;
4523 err = skb->len;
4524 out_err:
4525 rtnl_unlock();
4526
4527 return err;
4528 }
4529
4530 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
4531 {
4532 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4533 struct net_device *dev = info->user_ptr[1];
4534 struct station_info sinfo;
4535 struct sk_buff *msg;
4536 u8 *mac_addr = NULL;
4537 int err;
4538
4539 memset(&sinfo, 0, sizeof(sinfo));
4540
4541 if (!info->attrs[NL80211_ATTR_MAC])
4542 return -EINVAL;
4543
4544 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4545
4546 if (!rdev->ops->get_station)
4547 return -EOPNOTSUPP;
4548
4549 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
4550 if (err)
4551 return err;
4552
4553 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4554 if (!msg)
4555 return -ENOMEM;
4556
4557 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
4558 info->snd_portid, info->snd_seq, 0,
4559 rdev, dev, mac_addr, &sinfo) < 0) {
4560 nlmsg_free(msg);
4561 return -ENOBUFS;
4562 }
4563
4564 return genlmsg_reply(msg, info);
4565 }
4566
4567 int cfg80211_check_station_change(struct wiphy *wiphy,
4568 struct station_parameters *params,
4569 enum cfg80211_station_type statype)
4570 {
4571 if (params->listen_interval != -1 &&
4572 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4573 return -EINVAL;
4574
4575 if (params->support_p2p_ps != -1 &&
4576 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4577 return -EINVAL;
4578
4579 if (params->aid &&
4580 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
4581 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4582 return -EINVAL;
4583
4584 /* When you run into this, adjust the code below for the new flag */
4585 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
4586
4587 switch (statype) {
4588 case CFG80211_STA_MESH_PEER_KERNEL:
4589 case CFG80211_STA_MESH_PEER_USER:
4590 /*
4591 * No ignoring the TDLS flag here -- the userspace mesh
4592 * code doesn't have the bug of including TDLS in the
4593 * mask everywhere.
4594 */
4595 if (params->sta_flags_mask &
4596 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4597 BIT(NL80211_STA_FLAG_MFP) |
4598 BIT(NL80211_STA_FLAG_AUTHORIZED)))
4599 return -EINVAL;
4600 break;
4601 case CFG80211_STA_TDLS_PEER_SETUP:
4602 case CFG80211_STA_TDLS_PEER_ACTIVE:
4603 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
4604 return -EINVAL;
4605 /* ignore since it can't change */
4606 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4607 break;
4608 default:
4609 /* disallow mesh-specific things */
4610 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
4611 return -EINVAL;
4612 if (params->local_pm)
4613 return -EINVAL;
4614 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4615 return -EINVAL;
4616 }
4617
4618 if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4619 statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
4620 /* TDLS can't be set, ... */
4621 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
4622 return -EINVAL;
4623 /*
4624 * ... but don't bother the driver with it. This works around
4625 * a hostapd/wpa_supplicant issue -- it always includes the
4626 * TLDS_PEER flag in the mask even for AP mode.
4627 */
4628 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4629 }
4630
4631 if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4632 statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
4633 /* reject other things that can't change */
4634 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
4635 return -EINVAL;
4636 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
4637 return -EINVAL;
4638 if (params->supported_rates)
4639 return -EINVAL;
4640 if (params->ext_capab || params->ht_capa || params->vht_capa)
4641 return -EINVAL;
4642 }
4643
4644 if (statype != CFG80211_STA_AP_CLIENT &&
4645 statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
4646 if (params->vlan)
4647 return -EINVAL;
4648 }
4649
4650 switch (statype) {
4651 case CFG80211_STA_AP_MLME_CLIENT:
4652 /* Use this only for authorizing/unauthorizing a station */
4653 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
4654 return -EOPNOTSUPP;
4655 break;
4656 case CFG80211_STA_AP_CLIENT:
4657 case CFG80211_STA_AP_CLIENT_UNASSOC:
4658 /* accept only the listed bits */
4659 if (params->sta_flags_mask &
4660 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4661 BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4662 BIT(NL80211_STA_FLAG_ASSOCIATED) |
4663 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4664 BIT(NL80211_STA_FLAG_WME) |
4665 BIT(NL80211_STA_FLAG_MFP)))
4666 return -EINVAL;
4667
4668 /* but authenticated/associated only if driver handles it */
4669 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
4670 params->sta_flags_mask &
4671 (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4672 BIT(NL80211_STA_FLAG_ASSOCIATED)))
4673 return -EINVAL;
4674 break;
4675 case CFG80211_STA_IBSS:
4676 case CFG80211_STA_AP_STA:
4677 /* reject any changes other than AUTHORIZED */
4678 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
4679 return -EINVAL;
4680 break;
4681 case CFG80211_STA_TDLS_PEER_SETUP:
4682 /* reject any changes other than AUTHORIZED or WME */
4683 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4684 BIT(NL80211_STA_FLAG_WME)))
4685 return -EINVAL;
4686 /* force (at least) rates when authorizing */
4687 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
4688 !params->supported_rates)
4689 return -EINVAL;
4690 break;
4691 case CFG80211_STA_TDLS_PEER_ACTIVE:
4692 /* reject any changes */
4693 return -EINVAL;
4694 case CFG80211_STA_MESH_PEER_KERNEL:
4695 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4696 return -EINVAL;
4697 break;
4698 case CFG80211_STA_MESH_PEER_USER:
4699 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
4700 params->plink_action != NL80211_PLINK_ACTION_BLOCK)
4701 return -EINVAL;
4702 break;
4703 }
4704
4705 /*
4706 * Older kernel versions ignored this attribute entirely, so don't
4707 * reject attempts to update it but mark it as unused instead so the
4708 * driver won't look at the data.
4709 */
4710 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
4711 statype != CFG80211_STA_TDLS_PEER_SETUP)
4712 params->opmode_notif_used = false;
4713
4714 return 0;
4715 }
4716 EXPORT_SYMBOL(cfg80211_check_station_change);
4717
4718 /*
4719 * Get vlan interface making sure it is running and on the right wiphy.
4720 */
4721 static struct net_device *get_vlan(struct genl_info *info,
4722 struct cfg80211_registered_device *rdev)
4723 {
4724 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
4725 struct net_device *v;
4726 int ret;
4727
4728 if (!vlanattr)
4729 return NULL;
4730
4731 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
4732 if (!v)
4733 return ERR_PTR(-ENODEV);
4734
4735 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
4736 ret = -EINVAL;
4737 goto error;
4738 }
4739
4740 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
4741 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4742 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
4743 ret = -EINVAL;
4744 goto error;
4745 }
4746
4747 if (!netif_running(v)) {
4748 ret = -ENETDOWN;
4749 goto error;
4750 }
4751
4752 return v;
4753 error:
4754 dev_put(v);
4755 return ERR_PTR(ret);
4756 }
4757
4758 static const struct nla_policy
4759 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
4760 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
4761 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
4762 };
4763
4764 static int nl80211_parse_sta_wme(struct genl_info *info,
4765 struct station_parameters *params)
4766 {
4767 struct nlattr *tb[NL80211_STA_WME_MAX + 1];
4768 struct nlattr *nla;
4769 int err;
4770
4771 /* parse WME attributes if present */
4772 if (!info->attrs[NL80211_ATTR_STA_WME])
4773 return 0;
4774
4775 nla = info->attrs[NL80211_ATTR_STA_WME];
4776 err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
4777 nl80211_sta_wme_policy, info->extack);
4778 if (err)
4779 return err;
4780
4781 if (tb[NL80211_STA_WME_UAPSD_QUEUES])
4782 params->uapsd_queues = nla_get_u8(
4783 tb[NL80211_STA_WME_UAPSD_QUEUES]);
4784 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
4785 return -EINVAL;
4786
4787 if (tb[NL80211_STA_WME_MAX_SP])
4788 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
4789
4790 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
4791 return -EINVAL;
4792
4793 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
4794
4795 return 0;
4796 }
4797
4798 static int nl80211_parse_sta_channel_info(struct genl_info *info,
4799 struct station_parameters *params)
4800 {
4801 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
4802 params->supported_channels =
4803 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4804 params->supported_channels_len =
4805 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4806 /*
4807 * Need to include at least one (first channel, number of
4808 * channels) tuple for each subband, and must have proper
4809 * tuples for the rest of the data as well.
4810 */
4811 if (params->supported_channels_len < 2)
4812 return -EINVAL;
4813 if (params->supported_channels_len % 2)
4814 return -EINVAL;
4815 }
4816
4817 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
4818 params->supported_oper_classes =
4819 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4820 params->supported_oper_classes_len =
4821 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4822 /*
4823 * The value of the Length field of the Supported Operating
4824 * Classes element is between 2 and 253.
4825 */
4826 if (params->supported_oper_classes_len < 2 ||
4827 params->supported_oper_classes_len > 253)
4828 return -EINVAL;
4829 }
4830 return 0;
4831 }
4832
4833 static int nl80211_set_station_tdls(struct genl_info *info,
4834 struct station_parameters *params)
4835 {
4836 int err;
4837 /* Dummy STA entry gets updated once the peer capabilities are known */
4838 if (info->attrs[NL80211_ATTR_PEER_AID])
4839 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
4840 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
4841 params->ht_capa =
4842 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
4843 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
4844 params->vht_capa =
4845 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
4846
4847 err = nl80211_parse_sta_channel_info(info, params);
4848 if (err)
4849 return err;
4850
4851 return nl80211_parse_sta_wme(info, params);
4852 }
4853
4854 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
4855 {
4856 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4857 struct net_device *dev = info->user_ptr[1];
4858 struct station_parameters params;
4859 u8 *mac_addr;
4860 int err;
4861
4862 memset(&params, 0, sizeof(params));
4863
4864 if (!rdev->ops->change_station)
4865 return -EOPNOTSUPP;
4866
4867 /*
4868 * AID and listen_interval properties can be set only for unassociated
4869 * station. Include these parameters here and will check them in
4870 * cfg80211_check_station_change().
4871 */
4872 if (info->attrs[NL80211_ATTR_STA_AID])
4873 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
4874
4875 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
4876 params.listen_interval =
4877 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
4878 else
4879 params.listen_interval = -1;
4880
4881 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
4882 u8 tmp;
4883
4884 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
4885 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
4886 return -EINVAL;
4887
4888 params.support_p2p_ps = tmp;
4889 } else {
4890 params.support_p2p_ps = -1;
4891 }
4892
4893 if (!info->attrs[NL80211_ATTR_MAC])
4894 return -EINVAL;
4895
4896 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4897
4898 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
4899 params.supported_rates =
4900 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4901 params.supported_rates_len =
4902 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4903 }
4904
4905 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
4906 params.capability =
4907 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
4908 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
4909 }
4910
4911 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
4912 params.ext_capab =
4913 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4914 params.ext_capab_len =
4915 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4916 }
4917
4918 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
4919 return -EINVAL;
4920
4921 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
4922 params.plink_action =
4923 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
4924 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
4925 return -EINVAL;
4926 }
4927
4928 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
4929 params.plink_state =
4930 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
4931 if (params.plink_state >= NUM_NL80211_PLINK_STATES)
4932 return -EINVAL;
4933 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) {
4934 params.peer_aid = nla_get_u16(
4935 info->attrs[NL80211_ATTR_MESH_PEER_AID]);
4936 if (params.peer_aid > IEEE80211_MAX_AID)
4937 return -EINVAL;
4938 }
4939 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
4940 }
4941
4942 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) {
4943 enum nl80211_mesh_power_mode pm = nla_get_u32(
4944 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
4945
4946 if (pm <= NL80211_MESH_POWER_UNKNOWN ||
4947 pm > NL80211_MESH_POWER_MAX)
4948 return -EINVAL;
4949
4950 params.local_pm = pm;
4951 }
4952
4953 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
4954 params.opmode_notif_used = true;
4955 params.opmode_notif =
4956 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
4957 }
4958
4959 /* Include parameters for TDLS peer (will check later) */
4960 err = nl80211_set_station_tdls(info, &params);
4961 if (err)
4962 return err;
4963
4964 params.vlan = get_vlan(info, rdev);
4965 if (IS_ERR(params.vlan))
4966 return PTR_ERR(params.vlan);
4967
4968 switch (dev->ieee80211_ptr->iftype) {
4969 case NL80211_IFTYPE_AP:
4970 case NL80211_IFTYPE_AP_VLAN:
4971 case NL80211_IFTYPE_P2P_GO:
4972 case NL80211_IFTYPE_P2P_CLIENT:
4973 case NL80211_IFTYPE_STATION:
4974 case NL80211_IFTYPE_ADHOC:
4975 case NL80211_IFTYPE_MESH_POINT:
4976 break;
4977 default:
4978 err = -EOPNOTSUPP;
4979 goto out_put_vlan;
4980 }
4981
4982 /* driver will call cfg80211_check_station_change() */
4983 err = rdev_change_station(rdev, dev, mac_addr, &params);
4984
4985 out_put_vlan:
4986 if (params.vlan)
4987 dev_put(params.vlan);
4988
4989 return err;
4990 }
4991
4992 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
4993 {
4994 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4995 int err;
4996 struct net_device *dev = info->user_ptr[1];
4997 struct station_parameters params;
4998 u8 *mac_addr = NULL;
4999 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5000 BIT(NL80211_STA_FLAG_ASSOCIATED);
5001
5002 memset(&params, 0, sizeof(params));
5003
5004 if (!rdev->ops->add_station)
5005 return -EOPNOTSUPP;
5006
5007 if (!info->attrs[NL80211_ATTR_MAC])
5008 return -EINVAL;
5009
5010 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
5011 return -EINVAL;
5012
5013 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
5014 return -EINVAL;
5015
5016 if (!info->attrs[NL80211_ATTR_STA_AID] &&
5017 !info->attrs[NL80211_ATTR_PEER_AID])
5018 return -EINVAL;
5019
5020 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5021 params.supported_rates =
5022 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5023 params.supported_rates_len =
5024 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5025 params.listen_interval =
5026 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
5027
5028 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
5029 u8 tmp;
5030
5031 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
5032 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
5033 return -EINVAL;
5034
5035 params.support_p2p_ps = tmp;
5036 } else {
5037 /*
5038 * if not specified, assume it's supported for P2P GO interface,
5039 * and is NOT supported for AP interface
5040 */
5041 params.support_p2p_ps =
5042 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
5043 }
5044
5045 if (info->attrs[NL80211_ATTR_PEER_AID])
5046 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
5047 else
5048 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
5049 if (!params.aid || params.aid > IEEE80211_MAX_AID)
5050 return -EINVAL;
5051
5052 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
5053 params.capability =
5054 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5055 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5056 }
5057
5058 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5059 params.ext_capab =
5060 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5061 params.ext_capab_len =
5062 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5063 }
5064
5065 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
5066 params.ht_capa =
5067 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5068
5069 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
5070 params.vht_capa =
5071 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
5072
5073 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5074 params.opmode_notif_used = true;
5075 params.opmode_notif =
5076 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5077 }
5078
5079 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
5080 params.plink_action =
5081 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
5082 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
5083 return -EINVAL;
5084 }
5085
5086 err = nl80211_parse_sta_channel_info(info, &params);
5087 if (err)
5088 return err;
5089
5090 err = nl80211_parse_sta_wme(info, &params);
5091 if (err)
5092 return err;
5093
5094 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5095 return -EINVAL;
5096
5097 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
5098 * as userspace might just pass through the capabilities from the IEs
5099 * directly, rather than enforcing this restriction and returning an
5100 * error in this case.
5101 */
5102 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
5103 params.ht_capa = NULL;
5104 params.vht_capa = NULL;
5105 }
5106
5107 /* When you run into this, adjust the code below for the new flag */
5108 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
5109
5110 switch (dev->ieee80211_ptr->iftype) {
5111 case NL80211_IFTYPE_AP:
5112 case NL80211_IFTYPE_AP_VLAN:
5113 case NL80211_IFTYPE_P2P_GO:
5114 /* ignore WME attributes if iface/sta is not capable */
5115 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
5116 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
5117 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5118
5119 /* TDLS peers cannot be added */
5120 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5121 info->attrs[NL80211_ATTR_PEER_AID])
5122 return -EINVAL;
5123 /* but don't bother the driver with it */
5124 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5125
5126 /* allow authenticated/associated only if driver handles it */
5127 if (!(rdev->wiphy.features &
5128 NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
5129 params.sta_flags_mask & auth_assoc)
5130 return -EINVAL;
5131
5132 /* Older userspace, or userspace wanting to be compatible with
5133 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
5134 * and assoc flags in the mask, but assumes the station will be
5135 * added as associated anyway since this was the required driver
5136 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
5137 * introduced.
5138 * In order to not bother drivers with this quirk in the API
5139 * set the flags in both the mask and set for new stations in
5140 * this case.
5141 */
5142 if (!(params.sta_flags_mask & auth_assoc)) {
5143 params.sta_flags_mask |= auth_assoc;
5144 params.sta_flags_set |= auth_assoc;
5145 }
5146
5147 /* must be last in here for error handling */
5148 params.vlan = get_vlan(info, rdev);
5149 if (IS_ERR(params.vlan))
5150 return PTR_ERR(params.vlan);
5151 break;
5152 case NL80211_IFTYPE_MESH_POINT:
5153 /* ignore uAPSD data */
5154 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5155
5156 /* associated is disallowed */
5157 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
5158 return -EINVAL;
5159 /* TDLS peers cannot be added */
5160 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5161 info->attrs[NL80211_ATTR_PEER_AID])
5162 return -EINVAL;
5163 break;
5164 case NL80211_IFTYPE_STATION:
5165 case NL80211_IFTYPE_P2P_CLIENT:
5166 /* ignore uAPSD data */
5167 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5168
5169 /* these are disallowed */
5170 if (params.sta_flags_mask &
5171 (BIT(NL80211_STA_FLAG_ASSOCIATED) |
5172 BIT(NL80211_STA_FLAG_AUTHENTICATED)))
5173 return -EINVAL;
5174 /* Only TDLS peers can be added */
5175 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
5176 return -EINVAL;
5177 /* Can only add if TDLS ... */
5178 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
5179 return -EOPNOTSUPP;
5180 /* ... with external setup is supported */
5181 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
5182 return -EOPNOTSUPP;
5183 /*
5184 * Older wpa_supplicant versions always mark the TDLS peer
5185 * as authorized, but it shouldn't yet be.
5186 */
5187 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
5188 break;
5189 default:
5190 return -EOPNOTSUPP;
5191 }
5192
5193 /* be aware of params.vlan when changing code here */
5194
5195 err = rdev_add_station(rdev, dev, mac_addr, &params);
5196
5197 if (params.vlan)
5198 dev_put(params.vlan);
5199 return err;
5200 }
5201
5202 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
5203 {
5204 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5205 struct net_device *dev = info->user_ptr[1];
5206 struct station_del_parameters params;
5207
5208 memset(&params, 0, sizeof(params));
5209
5210 if (info->attrs[NL80211_ATTR_MAC])
5211 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
5212
5213 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5214 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
5215 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
5216 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5217 return -EINVAL;
5218
5219 if (!rdev->ops->del_station)
5220 return -EOPNOTSUPP;
5221
5222 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
5223 params.subtype =
5224 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
5225 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
5226 params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
5227 return -EINVAL;
5228 } else {
5229 /* Default to Deauthentication frame */
5230 params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
5231 }
5232
5233 if (info->attrs[NL80211_ATTR_REASON_CODE]) {
5234 params.reason_code =
5235 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5236 if (params.reason_code == 0)
5237 return -EINVAL; /* 0 is reserved */
5238 } else {
5239 /* Default to reason code 2 */
5240 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
5241 }
5242
5243 return rdev_del_station(rdev, dev, &params);
5244 }
5245
5246 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
5247 int flags, struct net_device *dev,
5248 u8 *dst, u8 *next_hop,
5249 struct mpath_info *pinfo)
5250 {
5251 void *hdr;
5252 struct nlattr *pinfoattr;
5253
5254 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
5255 if (!hdr)
5256 return -1;
5257
5258 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5259 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
5260 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
5261 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
5262 goto nla_put_failure;
5263
5264 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
5265 if (!pinfoattr)
5266 goto nla_put_failure;
5267 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
5268 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
5269 pinfo->frame_qlen))
5270 goto nla_put_failure;
5271 if (((pinfo->filled & MPATH_INFO_SN) &&
5272 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
5273 ((pinfo->filled & MPATH_INFO_METRIC) &&
5274 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
5275 pinfo->metric)) ||
5276 ((pinfo->filled & MPATH_INFO_EXPTIME) &&
5277 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
5278 pinfo->exptime)) ||
5279 ((pinfo->filled & MPATH_INFO_FLAGS) &&
5280 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
5281 pinfo->flags)) ||
5282 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
5283 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
5284 pinfo->discovery_timeout)) ||
5285 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
5286 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
5287 pinfo->discovery_retries)))
5288 goto nla_put_failure;
5289
5290 nla_nest_end(msg, pinfoattr);
5291
5292 genlmsg_end(msg, hdr);
5293 return 0;
5294
5295 nla_put_failure:
5296 genlmsg_cancel(msg, hdr);
5297 return -EMSGSIZE;
5298 }
5299
5300 static int nl80211_dump_mpath(struct sk_buff *skb,
5301 struct netlink_callback *cb)
5302 {
5303 struct mpath_info pinfo;
5304 struct cfg80211_registered_device *rdev;
5305 struct wireless_dev *wdev;
5306 u8 dst[ETH_ALEN];
5307 u8 next_hop[ETH_ALEN];
5308 int path_idx = cb->args[2];
5309 int err;
5310
5311 rtnl_lock();
5312 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
5313 if (err)
5314 goto out_err;
5315
5316 if (!rdev->ops->dump_mpath) {
5317 err = -EOPNOTSUPP;
5318 goto out_err;
5319 }
5320
5321 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5322 err = -EOPNOTSUPP;
5323 goto out_err;
5324 }
5325
5326 while (1) {
5327 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
5328 next_hop, &pinfo);
5329 if (err == -ENOENT)
5330 break;
5331 if (err)
5332 goto out_err;
5333
5334 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
5335 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5336 wdev->netdev, dst, next_hop,
5337 &pinfo) < 0)
5338 goto out;
5339
5340 path_idx++;
5341 }
5342
5343 out:
5344 cb->args[2] = path_idx;
5345 err = skb->len;
5346 out_err:
5347 rtnl_unlock();
5348 return err;
5349 }
5350
5351 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
5352 {
5353 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5354 int err;
5355 struct net_device *dev = info->user_ptr[1];
5356 struct mpath_info pinfo;
5357 struct sk_buff *msg;
5358 u8 *dst = NULL;
5359 u8 next_hop[ETH_ALEN];
5360
5361 memset(&pinfo, 0, sizeof(pinfo));
5362
5363 if (!info->attrs[NL80211_ATTR_MAC])
5364 return -EINVAL;
5365
5366 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5367
5368 if (!rdev->ops->get_mpath)
5369 return -EOPNOTSUPP;
5370
5371 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5372 return -EOPNOTSUPP;
5373
5374 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
5375 if (err)
5376 return err;
5377
5378 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5379 if (!msg)
5380 return -ENOMEM;
5381
5382 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
5383 dev, dst, next_hop, &pinfo) < 0) {
5384 nlmsg_free(msg);
5385 return -ENOBUFS;
5386 }
5387
5388 return genlmsg_reply(msg, info);
5389 }
5390
5391 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
5392 {
5393 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5394 struct net_device *dev = info->user_ptr[1];
5395 u8 *dst = NULL;
5396 u8 *next_hop = NULL;
5397
5398 if (!info->attrs[NL80211_ATTR_MAC])
5399 return -EINVAL;
5400
5401 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5402 return -EINVAL;
5403
5404 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5405 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5406
5407 if (!rdev->ops->change_mpath)
5408 return -EOPNOTSUPP;
5409
5410 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5411 return -EOPNOTSUPP;
5412
5413 return rdev_change_mpath(rdev, dev, dst, next_hop);
5414 }
5415
5416 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
5417 {
5418 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5419 struct net_device *dev = info->user_ptr[1];
5420 u8 *dst = NULL;
5421 u8 *next_hop = NULL;
5422
5423 if (!info->attrs[NL80211_ATTR_MAC])
5424 return -EINVAL;
5425
5426 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5427 return -EINVAL;
5428
5429 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5430 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5431
5432 if (!rdev->ops->add_mpath)
5433 return -EOPNOTSUPP;
5434
5435 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5436 return -EOPNOTSUPP;
5437
5438 return rdev_add_mpath(rdev, dev, dst, next_hop);
5439 }
5440
5441 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
5442 {
5443 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5444 struct net_device *dev = info->user_ptr[1];
5445 u8 *dst = NULL;
5446
5447 if (info->attrs[NL80211_ATTR_MAC])
5448 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5449
5450 if (!rdev->ops->del_mpath)
5451 return -EOPNOTSUPP;
5452
5453 return rdev_del_mpath(rdev, dev, dst);
5454 }
5455
5456 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
5457 {
5458 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5459 int err;
5460 struct net_device *dev = info->user_ptr[1];
5461 struct mpath_info pinfo;
5462 struct sk_buff *msg;
5463 u8 *dst = NULL;
5464 u8 mpp[ETH_ALEN];
5465
5466 memset(&pinfo, 0, sizeof(pinfo));
5467
5468 if (!info->attrs[NL80211_ATTR_MAC])
5469 return -EINVAL;
5470
5471 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5472
5473 if (!rdev->ops->get_mpp)
5474 return -EOPNOTSUPP;
5475
5476 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5477 return -EOPNOTSUPP;
5478
5479 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
5480 if (err)
5481 return err;
5482
5483 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5484 if (!msg)
5485 return -ENOMEM;
5486
5487 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
5488 dev, dst, mpp, &pinfo) < 0) {
5489 nlmsg_free(msg);
5490 return -ENOBUFS;
5491 }
5492
5493 return genlmsg_reply(msg, info);
5494 }
5495
5496 static int nl80211_dump_mpp(struct sk_buff *skb,
5497 struct netlink_callback *cb)
5498 {
5499 struct mpath_info pinfo;
5500 struct cfg80211_registered_device *rdev;
5501 struct wireless_dev *wdev;
5502 u8 dst[ETH_ALEN];
5503 u8 mpp[ETH_ALEN];
5504 int path_idx = cb->args[2];
5505 int err;
5506
5507 rtnl_lock();
5508 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
5509 if (err)
5510 goto out_err;
5511
5512 if (!rdev->ops->dump_mpp) {
5513 err = -EOPNOTSUPP;
5514 goto out_err;
5515 }
5516
5517 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5518 err = -EOPNOTSUPP;
5519 goto out_err;
5520 }
5521
5522 while (1) {
5523 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
5524 mpp, &pinfo);
5525 if (err == -ENOENT)
5526 break;
5527 if (err)
5528 goto out_err;
5529
5530 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
5531 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5532 wdev->netdev, dst, mpp,
5533 &pinfo) < 0)
5534 goto out;
5535
5536 path_idx++;
5537 }
5538
5539 out:
5540 cb->args[2] = path_idx;
5541 err = skb->len;
5542 out_err:
5543 rtnl_unlock();
5544 return err;
5545 }
5546
5547 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
5548 {
5549 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5550 struct net_device *dev = info->user_ptr[1];
5551 struct wireless_dev *wdev = dev->ieee80211_ptr;
5552 struct bss_parameters params;
5553 int err;
5554
5555 memset(&params, 0, sizeof(params));
5556 /* default to not changing parameters */
5557 params.use_cts_prot = -1;
5558 params.use_short_preamble = -1;
5559 params.use_short_slot_time = -1;
5560 params.ap_isolate = -1;
5561 params.ht_opmode = -1;
5562 params.p2p_ctwindow = -1;
5563 params.p2p_opp_ps = -1;
5564
5565 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
5566 params.use_cts_prot =
5567 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
5568 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
5569 params.use_short_preamble =
5570 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
5571 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
5572 params.use_short_slot_time =
5573 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
5574 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
5575 params.basic_rates =
5576 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5577 params.basic_rates_len =
5578 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5579 }
5580 if (info->attrs[NL80211_ATTR_AP_ISOLATE])
5581 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
5582 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
5583 params.ht_opmode =
5584 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
5585
5586 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
5587 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5588 return -EINVAL;
5589 params.p2p_ctwindow =
5590 nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
5591 if (params.p2p_ctwindow < 0)
5592 return -EINVAL;
5593 if (params.p2p_ctwindow != 0 &&
5594 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
5595 return -EINVAL;
5596 }
5597
5598 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
5599 u8 tmp;
5600
5601 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5602 return -EINVAL;
5603 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
5604 if (tmp > 1)
5605 return -EINVAL;
5606 params.p2p_opp_ps = tmp;
5607 if (params.p2p_opp_ps &&
5608 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
5609 return -EINVAL;
5610 }
5611
5612 if (!rdev->ops->change_bss)
5613 return -EOPNOTSUPP;
5614
5615 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5616 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5617 return -EOPNOTSUPP;
5618
5619 wdev_lock(wdev);
5620 err = rdev_change_bss(rdev, dev, &params);
5621 wdev_unlock(wdev);
5622
5623 return err;
5624 }
5625
5626 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
5627 {
5628 char *data = NULL;
5629 bool is_indoor;
5630 enum nl80211_user_reg_hint_type user_reg_hint_type;
5631 u32 owner_nlportid;
5632
5633 /*
5634 * You should only get this when cfg80211 hasn't yet initialized
5635 * completely when built-in to the kernel right between the time
5636 * window between nl80211_init() and regulatory_init(), if that is
5637 * even possible.
5638 */
5639 if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
5640 return -EINPROGRESS;
5641
5642 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
5643 user_reg_hint_type =
5644 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
5645 else
5646 user_reg_hint_type = NL80211_USER_REG_HINT_USER;
5647
5648 switch (user_reg_hint_type) {
5649 case NL80211_USER_REG_HINT_USER:
5650 case NL80211_USER_REG_HINT_CELL_BASE:
5651 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
5652 return -EINVAL;
5653
5654 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
5655 return regulatory_hint_user(data, user_reg_hint_type);
5656 case NL80211_USER_REG_HINT_INDOOR:
5657 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
5658 owner_nlportid = info->snd_portid;
5659 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
5660 } else {
5661 owner_nlportid = 0;
5662 is_indoor = true;
5663 }
5664
5665 return regulatory_hint_indoor(is_indoor, owner_nlportid);
5666 default:
5667 return -EINVAL;
5668 }
5669 }
5670
5671 static int nl80211_get_mesh_config(struct sk_buff *skb,
5672 struct genl_info *info)
5673 {
5674 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5675 struct net_device *dev = info->user_ptr[1];
5676 struct wireless_dev *wdev = dev->ieee80211_ptr;
5677 struct mesh_config cur_params;
5678 int err = 0;
5679 void *hdr;
5680 struct nlattr *pinfoattr;
5681 struct sk_buff *msg;
5682
5683 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
5684 return -EOPNOTSUPP;
5685
5686 if (!rdev->ops->get_mesh_config)
5687 return -EOPNOTSUPP;
5688
5689 wdev_lock(wdev);
5690 /* If not connected, get default parameters */
5691 if (!wdev->mesh_id_len)
5692 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
5693 else
5694 err = rdev_get_mesh_config(rdev, dev, &cur_params);
5695 wdev_unlock(wdev);
5696
5697 if (err)
5698 return err;
5699
5700 /* Draw up a netlink message to send back */
5701 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5702 if (!msg)
5703 return -ENOMEM;
5704 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
5705 NL80211_CMD_GET_MESH_CONFIG);
5706 if (!hdr)
5707 goto out;
5708 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
5709 if (!pinfoattr)
5710 goto nla_put_failure;
5711 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5712 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
5713 cur_params.dot11MeshRetryTimeout) ||
5714 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
5715 cur_params.dot11MeshConfirmTimeout) ||
5716 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
5717 cur_params.dot11MeshHoldingTimeout) ||
5718 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
5719 cur_params.dot11MeshMaxPeerLinks) ||
5720 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
5721 cur_params.dot11MeshMaxRetries) ||
5722 nla_put_u8(msg, NL80211_MESHCONF_TTL,
5723 cur_params.dot11MeshTTL) ||
5724 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
5725 cur_params.element_ttl) ||
5726 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
5727 cur_params.auto_open_plinks) ||
5728 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
5729 cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
5730 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
5731 cur_params.dot11MeshHWMPmaxPREQretries) ||
5732 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
5733 cur_params.path_refresh_time) ||
5734 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
5735 cur_params.min_discovery_timeout) ||
5736 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
5737 cur_params.dot11MeshHWMPactivePathTimeout) ||
5738 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
5739 cur_params.dot11MeshHWMPpreqMinInterval) ||
5740 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
5741 cur_params.dot11MeshHWMPperrMinInterval) ||
5742 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
5743 cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
5744 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
5745 cur_params.dot11MeshHWMPRootMode) ||
5746 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
5747 cur_params.dot11MeshHWMPRannInterval) ||
5748 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
5749 cur_params.dot11MeshGateAnnouncementProtocol) ||
5750 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
5751 cur_params.dot11MeshForwarding) ||
5752 nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
5753 cur_params.rssi_threshold) ||
5754 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
5755 cur_params.ht_opmode) ||
5756 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
5757 cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
5758 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
5759 cur_params.dot11MeshHWMProotInterval) ||
5760 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
5761 cur_params.dot11MeshHWMPconfirmationInterval) ||
5762 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
5763 cur_params.power_mode) ||
5764 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
5765 cur_params.dot11MeshAwakeWindowDuration) ||
5766 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
5767 cur_params.plink_timeout))
5768 goto nla_put_failure;
5769 nla_nest_end(msg, pinfoattr);
5770 genlmsg_end(msg, hdr);
5771 return genlmsg_reply(msg, info);
5772
5773 nla_put_failure:
5774 genlmsg_cancel(msg, hdr);
5775 out:
5776 nlmsg_free(msg);
5777 return -ENOBUFS;
5778 }
5779
5780 static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
5781 [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
5782 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
5783 [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
5784 [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
5785 [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
5786 [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
5787 [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
5788 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
5789 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
5790 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
5791 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
5792 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
5793 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
5794 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
5795 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
5796 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
5797 [NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
5798 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
5799 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
5800 [NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
5801 [NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
5802 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
5803 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
5804 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
5805 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
5806 [NL80211_MESHCONF_POWER_MODE] = { .type = NLA_U32 },
5807 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
5808 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
5809 };
5810
5811 static const struct nla_policy
5812 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
5813 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
5814 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
5815 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
5816 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
5817 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
5818 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
5819 [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
5820 .len = IEEE80211_MAX_DATA_LEN },
5821 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
5822 };
5823
5824 static int nl80211_check_bool(const struct nlattr *nla, u8 min, u8 max, bool *out)
5825 {
5826 u8 val = nla_get_u8(nla);
5827 if (val < min || val > max)
5828 return -EINVAL;
5829 *out = val;
5830 return 0;
5831 }
5832
5833 static int nl80211_check_u8(const struct nlattr *nla, u8 min, u8 max, u8 *out)
5834 {
5835 u8 val = nla_get_u8(nla);
5836 if (val < min || val > max)
5837 return -EINVAL;
5838 *out = val;
5839 return 0;
5840 }
5841
5842 static int nl80211_check_u16(const struct nlattr *nla, u16 min, u16 max, u16 *out)
5843 {
5844 u16 val = nla_get_u16(nla);
5845 if (val < min || val > max)
5846 return -EINVAL;
5847 *out = val;
5848 return 0;
5849 }
5850
5851 static int nl80211_check_u32(const struct nlattr *nla, u32 min, u32 max, u32 *out)
5852 {
5853 u32 val = nla_get_u32(nla);
5854 if (val < min || val > max)
5855 return -EINVAL;
5856 *out = val;
5857 return 0;
5858 }
5859
5860 static int nl80211_check_s32(const struct nlattr *nla, s32 min, s32 max, s32 *out)
5861 {
5862 s32 val = nla_get_s32(nla);
5863 if (val < min || val > max)
5864 return -EINVAL;
5865 *out = val;
5866 return 0;
5867 }
5868
5869 static int nl80211_check_power_mode(const struct nlattr *nla,
5870 enum nl80211_mesh_power_mode min,
5871 enum nl80211_mesh_power_mode max,
5872 enum nl80211_mesh_power_mode *out)
5873 {
5874 u32 val = nla_get_u32(nla);
5875 if (val < min || val > max)
5876 return -EINVAL;
5877 *out = val;
5878 return 0;
5879 }
5880
5881 static int nl80211_parse_mesh_config(struct genl_info *info,
5882 struct mesh_config *cfg,
5883 u32 *mask_out)
5884 {
5885 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
5886 u32 mask = 0;
5887 u16 ht_opmode;
5888
5889 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, min, max, mask, attr, fn) \
5890 do { \
5891 if (tb[attr]) { \
5892 if (fn(tb[attr], min, max, &cfg->param)) \
5893 return -EINVAL; \
5894 mask |= (1 << (attr - 1)); \
5895 } \
5896 } while (0)
5897
5898 if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
5899 return -EINVAL;
5900 if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
5901 info->attrs[NL80211_ATTR_MESH_CONFIG],
5902 nl80211_meshconf_params_policy, info->extack))
5903 return -EINVAL;
5904
5905 /* This makes sure that there aren't more than 32 mesh config
5906 * parameters (otherwise our bitfield scheme would not work.) */
5907 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
5908
5909 /* Fill in the params struct */
5910 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, 1, 255,
5911 mask, NL80211_MESHCONF_RETRY_TIMEOUT,
5912 nl80211_check_u16);
5913 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, 1, 255,
5914 mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
5915 nl80211_check_u16);
5916 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, 1, 255,
5917 mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
5918 nl80211_check_u16);
5919 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, 0, 255,
5920 mask, NL80211_MESHCONF_MAX_PEER_LINKS,
5921 nl80211_check_u16);
5922 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, 0, 16,
5923 mask, NL80211_MESHCONF_MAX_RETRIES,
5924 nl80211_check_u8);
5925 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, 1, 255,
5926 mask, NL80211_MESHCONF_TTL, nl80211_check_u8);
5927 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, 1, 255,
5928 mask, NL80211_MESHCONF_ELEMENT_TTL,
5929 nl80211_check_u8);
5930 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, 0, 1,
5931 mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
5932 nl80211_check_bool);
5933 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
5934 1, 255, mask,
5935 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
5936 nl80211_check_u32);
5937 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, 0, 255,
5938 mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
5939 nl80211_check_u8);
5940 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, 1, 65535,
5941 mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
5942 nl80211_check_u32);
5943 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, 1, 65535,
5944 mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
5945 nl80211_check_u16);
5946 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
5947 1, 65535, mask,
5948 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
5949 nl80211_check_u32);
5950 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
5951 1, 65535, mask,
5952 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
5953 nl80211_check_u16);
5954 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
5955 1, 65535, mask,
5956 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
5957 nl80211_check_u16);
5958 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
5959 dot11MeshHWMPnetDiameterTraversalTime,
5960 1, 65535, mask,
5961 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
5962 nl80211_check_u16);
5963 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, 0, 4,
5964 mask, NL80211_MESHCONF_HWMP_ROOTMODE,
5965 nl80211_check_u8);
5966 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, 1, 65535,
5967 mask, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
5968 nl80211_check_u16);
5969 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
5970 dot11MeshGateAnnouncementProtocol, 0, 1,
5971 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
5972 nl80211_check_bool);
5973 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, 0, 1,
5974 mask, NL80211_MESHCONF_FORWARDING,
5975 nl80211_check_bool);
5976 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, -255, 0,
5977 mask, NL80211_MESHCONF_RSSI_THRESHOLD,
5978 nl80211_check_s32);
5979 /*
5980 * Check HT operation mode based on
5981 * IEEE 802.11 2012 8.4.2.59 HT Operation element.
5982 */
5983 if (tb[NL80211_MESHCONF_HT_OPMODE]) {
5984 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
5985
5986 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
5987 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
5988 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
5989 return -EINVAL;
5990
5991 if ((ht_opmode & IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT) &&
5992 (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
5993 return -EINVAL;
5994
5995 switch (ht_opmode & IEEE80211_HT_OP_MODE_PROTECTION) {
5996 case IEEE80211_HT_OP_MODE_PROTECTION_NONE:
5997 case IEEE80211_HT_OP_MODE_PROTECTION_20MHZ:
5998 if (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)
5999 return -EINVAL;
6000 break;
6001 case IEEE80211_HT_OP_MODE_PROTECTION_NONMEMBER:
6002 case IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED:
6003 if (!(ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
6004 return -EINVAL;
6005 break;
6006 }
6007 cfg->ht_opmode = ht_opmode;
6008 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
6009 }
6010 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
6011 1, 65535, mask,
6012 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
6013 nl80211_check_u32);
6014 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, 1, 65535,
6015 mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
6016 nl80211_check_u16);
6017 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6018 dot11MeshHWMPconfirmationInterval,
6019 1, 65535, mask,
6020 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
6021 nl80211_check_u16);
6022 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode,
6023 NL80211_MESH_POWER_ACTIVE,
6024 NL80211_MESH_POWER_MAX,
6025 mask, NL80211_MESHCONF_POWER_MODE,
6026 nl80211_check_power_mode);
6027 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration,
6028 0, 65535, mask,
6029 NL80211_MESHCONF_AWAKE_WINDOW, nl80211_check_u16);
6030 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, 0, 0xffffffff,
6031 mask, NL80211_MESHCONF_PLINK_TIMEOUT,
6032 nl80211_check_u32);
6033 if (mask_out)
6034 *mask_out = mask;
6035
6036 return 0;
6037
6038 #undef FILL_IN_MESH_PARAM_IF_SET
6039 }
6040
6041 static int nl80211_parse_mesh_setup(struct genl_info *info,
6042 struct mesh_setup *setup)
6043 {
6044 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6045 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
6046
6047 if (!info->attrs[NL80211_ATTR_MESH_SETUP])
6048 return -EINVAL;
6049 if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
6050 info->attrs[NL80211_ATTR_MESH_SETUP],
6051 nl80211_mesh_setup_params_policy, info->extack))
6052 return -EINVAL;
6053
6054 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
6055 setup->sync_method =
6056 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
6057 IEEE80211_SYNC_METHOD_VENDOR :
6058 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
6059
6060 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
6061 setup->path_sel_proto =
6062 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
6063 IEEE80211_PATH_PROTOCOL_VENDOR :
6064 IEEE80211_PATH_PROTOCOL_HWMP;
6065
6066 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
6067 setup->path_metric =
6068 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
6069 IEEE80211_PATH_METRIC_VENDOR :
6070 IEEE80211_PATH_METRIC_AIRTIME;
6071
6072 if (tb[NL80211_MESH_SETUP_IE]) {
6073 struct nlattr *ieattr =
6074 tb[NL80211_MESH_SETUP_IE];
6075 if (!is_valid_ie_attr(ieattr))
6076 return -EINVAL;
6077 setup->ie = nla_data(ieattr);
6078 setup->ie_len = nla_len(ieattr);
6079 }
6080 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
6081 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
6082 return -EINVAL;
6083 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
6084 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
6085 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
6086 if (setup->is_secure)
6087 setup->user_mpm = true;
6088
6089 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
6090 if (!setup->user_mpm)
6091 return -EINVAL;
6092 setup->auth_id =
6093 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
6094 }
6095
6096 return 0;
6097 }
6098
6099 static int nl80211_update_mesh_config(struct sk_buff *skb,
6100 struct genl_info *info)
6101 {
6102 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6103 struct net_device *dev = info->user_ptr[1];
6104 struct wireless_dev *wdev = dev->ieee80211_ptr;
6105 struct mesh_config cfg;
6106 u32 mask;
6107 int err;
6108
6109 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
6110 return -EOPNOTSUPP;
6111
6112 if (!rdev->ops->update_mesh_config)
6113 return -EOPNOTSUPP;
6114
6115 err = nl80211_parse_mesh_config(info, &cfg, &mask);
6116 if (err)
6117 return err;
6118
6119 wdev_lock(wdev);
6120 if (!wdev->mesh_id_len)
6121 err = -ENOLINK;
6122
6123 if (!err)
6124 err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
6125
6126 wdev_unlock(wdev);
6127
6128 return err;
6129 }
6130
6131 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
6132 struct sk_buff *msg)
6133 {
6134 struct nlattr *nl_reg_rules;
6135 unsigned int i;
6136
6137 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
6138 (regdom->dfs_region &&
6139 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
6140 goto nla_put_failure;
6141
6142 nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
6143 if (!nl_reg_rules)
6144 goto nla_put_failure;
6145
6146 for (i = 0; i < regdom->n_reg_rules; i++) {
6147 struct nlattr *nl_reg_rule;
6148 const struct ieee80211_reg_rule *reg_rule;
6149 const struct ieee80211_freq_range *freq_range;
6150 const struct ieee80211_power_rule *power_rule;
6151 unsigned int max_bandwidth_khz;
6152
6153 reg_rule = &regdom->reg_rules[i];
6154 freq_range = &reg_rule->freq_range;
6155 power_rule = &reg_rule->power_rule;
6156
6157 nl_reg_rule = nla_nest_start(msg, i);
6158 if (!nl_reg_rule)
6159 goto nla_put_failure;
6160
6161 max_bandwidth_khz = freq_range->max_bandwidth_khz;
6162 if (!max_bandwidth_khz)
6163 max_bandwidth_khz = reg_get_max_bandwidth(regdom,
6164 reg_rule);
6165
6166 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
6167 reg_rule->flags) ||
6168 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
6169 freq_range->start_freq_khz) ||
6170 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
6171 freq_range->end_freq_khz) ||
6172 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
6173 max_bandwidth_khz) ||
6174 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
6175 power_rule->max_antenna_gain) ||
6176 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
6177 power_rule->max_eirp) ||
6178 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
6179 reg_rule->dfs_cac_ms))
6180 goto nla_put_failure;
6181
6182 nla_nest_end(msg, nl_reg_rule);
6183 }
6184
6185 nla_nest_end(msg, nl_reg_rules);
6186 return 0;
6187
6188 nla_put_failure:
6189 return -EMSGSIZE;
6190 }
6191
6192 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
6193 {
6194 const struct ieee80211_regdomain *regdom = NULL;
6195 struct cfg80211_registered_device *rdev;
6196 struct wiphy *wiphy = NULL;
6197 struct sk_buff *msg;
6198 void *hdr;
6199
6200 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6201 if (!msg)
6202 return -ENOBUFS;
6203
6204 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6205 NL80211_CMD_GET_REG);
6206 if (!hdr)
6207 goto put_failure;
6208
6209 if (info->attrs[NL80211_ATTR_WIPHY]) {
6210 bool self_managed;
6211
6212 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
6213 if (IS_ERR(rdev)) {
6214 nlmsg_free(msg);
6215 return PTR_ERR(rdev);
6216 }
6217
6218 wiphy = &rdev->wiphy;
6219 self_managed = wiphy->regulatory_flags &
6220 REGULATORY_WIPHY_SELF_MANAGED;
6221 regdom = get_wiphy_regdom(wiphy);
6222
6223 /* a self-managed-reg device must have a private regdom */
6224 if (WARN_ON(!regdom && self_managed)) {
6225 nlmsg_free(msg);
6226 return -EINVAL;
6227 }
6228
6229 if (regdom &&
6230 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6231 goto nla_put_failure;
6232 }
6233
6234 if (!wiphy && reg_last_request_cell_base() &&
6235 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6236 NL80211_USER_REG_HINT_CELL_BASE))
6237 goto nla_put_failure;
6238
6239 rcu_read_lock();
6240
6241 if (!regdom)
6242 regdom = rcu_dereference(cfg80211_regdomain);
6243
6244 if (nl80211_put_regdom(regdom, msg))
6245 goto nla_put_failure_rcu;
6246
6247 rcu_read_unlock();
6248
6249 genlmsg_end(msg, hdr);
6250 return genlmsg_reply(msg, info);
6251
6252 nla_put_failure_rcu:
6253 rcu_read_unlock();
6254 nla_put_failure:
6255 genlmsg_cancel(msg, hdr);
6256 put_failure:
6257 nlmsg_free(msg);
6258 return -EMSGSIZE;
6259 }
6260
6261 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
6262 u32 seq, int flags, struct wiphy *wiphy,
6263 const struct ieee80211_regdomain *regdom)
6264 {
6265 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
6266 NL80211_CMD_GET_REG);
6267
6268 if (!hdr)
6269 return -1;
6270
6271 genl_dump_check_consistent(cb, hdr, &nl80211_fam);
6272
6273 if (nl80211_put_regdom(regdom, msg))
6274 goto nla_put_failure;
6275
6276 if (!wiphy && reg_last_request_cell_base() &&
6277 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6278 NL80211_USER_REG_HINT_CELL_BASE))
6279 goto nla_put_failure;
6280
6281 if (wiphy &&
6282 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6283 goto nla_put_failure;
6284
6285 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
6286 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
6287 goto nla_put_failure;
6288
6289 genlmsg_end(msg, hdr);
6290 return 0;
6291
6292 nla_put_failure:
6293 genlmsg_cancel(msg, hdr);
6294 return -EMSGSIZE;
6295 }
6296
6297 static int nl80211_get_reg_dump(struct sk_buff *skb,
6298 struct netlink_callback *cb)
6299 {
6300 const struct ieee80211_regdomain *regdom = NULL;
6301 struct cfg80211_registered_device *rdev;
6302 int err, reg_idx, start = cb->args[2];
6303
6304 rtnl_lock();
6305
6306 if (cfg80211_regdomain && start == 0) {
6307 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6308 NLM_F_MULTI, NULL,
6309 rtnl_dereference(cfg80211_regdomain));
6310 if (err < 0)
6311 goto out_err;
6312 }
6313
6314 /* the global regdom is idx 0 */
6315 reg_idx = 1;
6316 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
6317 regdom = get_wiphy_regdom(&rdev->wiphy);
6318 if (!regdom)
6319 continue;
6320
6321 if (++reg_idx <= start)
6322 continue;
6323
6324 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6325 NLM_F_MULTI, &rdev->wiphy, regdom);
6326 if (err < 0) {
6327 reg_idx--;
6328 break;
6329 }
6330 }
6331
6332 cb->args[2] = reg_idx;
6333 err = skb->len;
6334 out_err:
6335 rtnl_unlock();
6336 return err;
6337 }
6338
6339 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
6340 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
6341 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
6342 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
6343 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
6344 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
6345 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
6346 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
6347 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 },
6348 };
6349
6350 static int parse_reg_rule(struct nlattr *tb[],
6351 struct ieee80211_reg_rule *reg_rule)
6352 {
6353 struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
6354 struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
6355
6356 if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
6357 return -EINVAL;
6358 if (!tb[NL80211_ATTR_FREQ_RANGE_START])
6359 return -EINVAL;
6360 if (!tb[NL80211_ATTR_FREQ_RANGE_END])
6361 return -EINVAL;
6362 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
6363 return -EINVAL;
6364 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
6365 return -EINVAL;
6366
6367 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
6368
6369 freq_range->start_freq_khz =
6370 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
6371 freq_range->end_freq_khz =
6372 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
6373 freq_range->max_bandwidth_khz =
6374 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
6375
6376 power_rule->max_eirp =
6377 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
6378
6379 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
6380 power_rule->max_antenna_gain =
6381 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
6382
6383 if (tb[NL80211_ATTR_DFS_CAC_TIME])
6384 reg_rule->dfs_cac_ms =
6385 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
6386
6387 return 0;
6388 }
6389
6390 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
6391 {
6392 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
6393 struct nlattr *nl_reg_rule;
6394 char *alpha2;
6395 int rem_reg_rules, r;
6396 u32 num_rules = 0, rule_idx = 0, size_of_regd;
6397 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
6398 struct ieee80211_regdomain *rd;
6399
6400 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
6401 return -EINVAL;
6402
6403 if (!info->attrs[NL80211_ATTR_REG_RULES])
6404 return -EINVAL;
6405
6406 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
6407
6408 if (info->attrs[NL80211_ATTR_DFS_REGION])
6409 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
6410
6411 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
6412 rem_reg_rules) {
6413 num_rules++;
6414 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
6415 return -EINVAL;
6416 }
6417
6418 if (!reg_is_valid_request(alpha2))
6419 return -EINVAL;
6420
6421 size_of_regd = sizeof(struct ieee80211_regdomain) +
6422 num_rules * sizeof(struct ieee80211_reg_rule);
6423
6424 rd = kzalloc(size_of_regd, GFP_KERNEL);
6425 if (!rd)
6426 return -ENOMEM;
6427
6428 rd->n_reg_rules = num_rules;
6429 rd->alpha2[0] = alpha2[0];
6430 rd->alpha2[1] = alpha2[1];
6431
6432 /*
6433 * Disable DFS master mode if the DFS region was
6434 * not supported or known on this kernel.
6435 */
6436 if (reg_supported_dfs_region(dfs_region))
6437 rd->dfs_region = dfs_region;
6438
6439 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
6440 rem_reg_rules) {
6441 r = nla_parse_nested(tb, NL80211_REG_RULE_ATTR_MAX,
6442 nl_reg_rule, reg_rule_policy,
6443 info->extack);
6444 if (r)
6445 goto bad_reg;
6446 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
6447 if (r)
6448 goto bad_reg;
6449
6450 rule_idx++;
6451
6452 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
6453 r = -EINVAL;
6454 goto bad_reg;
6455 }
6456 }
6457
6458 /* set_regdom takes ownership of rd */
6459 return set_regdom(rd, REGD_SOURCE_CRDA);
6460 bad_reg:
6461 kfree(rd);
6462 return r;
6463 }
6464 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */
6465
6466 static int validate_scan_freqs(struct nlattr *freqs)
6467 {
6468 struct nlattr *attr1, *attr2;
6469 int n_channels = 0, tmp1, tmp2;
6470
6471 nla_for_each_nested(attr1, freqs, tmp1) {
6472 n_channels++;
6473 /*
6474 * Some hardware has a limited channel list for
6475 * scanning, and it is pretty much nonsensical
6476 * to scan for a channel twice, so disallow that
6477 * and don't require drivers to check that the
6478 * channel list they get isn't longer than what
6479 * they can scan, as long as they can scan all
6480 * the channels they registered at once.
6481 */
6482 nla_for_each_nested(attr2, freqs, tmp2)
6483 if (attr1 != attr2 &&
6484 nla_get_u32(attr1) == nla_get_u32(attr2))
6485 return 0;
6486 }
6487
6488 return n_channels;
6489 }
6490
6491 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
6492 {
6493 return b < NUM_NL80211_BANDS && wiphy->bands[b];
6494 }
6495
6496 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
6497 struct cfg80211_bss_selection *bss_select)
6498 {
6499 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
6500 struct nlattr *nest;
6501 int err;
6502 bool found = false;
6503 int i;
6504
6505 /* only process one nested attribute */
6506 nest = nla_data(nla);
6507 if (!nla_ok(nest, nla_len(nest)))
6508 return -EINVAL;
6509
6510 err = nla_parse_nested(attr, NL80211_BSS_SELECT_ATTR_MAX, nest,
6511 nl80211_bss_select_policy, NULL);
6512 if (err)
6513 return err;
6514
6515 /* only one attribute may be given */
6516 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
6517 if (attr[i]) {
6518 if (found)
6519 return -EINVAL;
6520 found = true;
6521 }
6522 }
6523
6524 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
6525
6526 if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
6527 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
6528
6529 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
6530 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
6531 bss_select->param.band_pref =
6532 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
6533 if (!is_band_valid(wiphy, bss_select->param.band_pref))
6534 return -EINVAL;
6535 }
6536
6537 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
6538 struct nl80211_bss_select_rssi_adjust *adj_param;
6539
6540 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
6541 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
6542 bss_select->param.adjust.band = adj_param->band;
6543 bss_select->param.adjust.delta = adj_param->delta;
6544 if (!is_band_valid(wiphy, bss_select->param.adjust.band))
6545 return -EINVAL;
6546 }
6547
6548 /* user-space did not provide behaviour attribute */
6549 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
6550 return -EINVAL;
6551
6552 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
6553 return -EINVAL;
6554
6555 return 0;
6556 }
6557
6558 static int nl80211_parse_random_mac(struct nlattr **attrs,
6559 u8 *mac_addr, u8 *mac_addr_mask)
6560 {
6561 int i;
6562
6563 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
6564 eth_zero_addr(mac_addr);
6565 eth_zero_addr(mac_addr_mask);
6566 mac_addr[0] = 0x2;
6567 mac_addr_mask[0] = 0x3;
6568
6569 return 0;
6570 }
6571
6572 /* need both or none */
6573 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
6574 return -EINVAL;
6575
6576 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
6577 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
6578
6579 /* don't allow or configure an mcast address */
6580 if (!is_multicast_ether_addr(mac_addr_mask) ||
6581 is_multicast_ether_addr(mac_addr))
6582 return -EINVAL;
6583
6584 /*
6585 * allow users to pass a MAC address that has bits set outside
6586 * of the mask, but don't bother drivers with having to deal
6587 * with such bits
6588 */
6589 for (i = 0; i < ETH_ALEN; i++)
6590 mac_addr[i] &= mac_addr_mask[i];
6591
6592 return 0;
6593 }
6594
6595 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev)
6596 {
6597 ASSERT_WDEV_LOCK(wdev);
6598
6599 if (!cfg80211_beaconing_iface_active(wdev))
6600 return true;
6601
6602 if (!(wdev->chandef.chan->flags & IEEE80211_CHAN_RADAR))
6603 return true;
6604
6605 return regulatory_pre_cac_allowed(wdev->wiphy);
6606 }
6607
6608 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
6609 {
6610 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6611 struct wireless_dev *wdev = info->user_ptr[1];
6612 struct cfg80211_scan_request *request;
6613 struct nlattr *attr;
6614 struct wiphy *wiphy;
6615 int err, tmp, n_ssids = 0, n_channels, i;
6616 size_t ie_len;
6617
6618 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
6619 return -EINVAL;
6620
6621 wiphy = &rdev->wiphy;
6622
6623 if (wdev->iftype == NL80211_IFTYPE_NAN)
6624 return -EOPNOTSUPP;
6625
6626 if (!rdev->ops->scan)
6627 return -EOPNOTSUPP;
6628
6629 if (rdev->scan_req || rdev->scan_msg) {
6630 err = -EBUSY;
6631 goto unlock;
6632 }
6633
6634 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6635 n_channels = validate_scan_freqs(
6636 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
6637 if (!n_channels) {
6638 err = -EINVAL;
6639 goto unlock;
6640 }
6641 } else {
6642 n_channels = ieee80211_get_num_supported_channels(wiphy);
6643 }
6644
6645 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
6646 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
6647 n_ssids++;
6648
6649 if (n_ssids > wiphy->max_scan_ssids) {
6650 err = -EINVAL;
6651 goto unlock;
6652 }
6653
6654 if (info->attrs[NL80211_ATTR_IE])
6655 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
6656 else
6657 ie_len = 0;
6658
6659 if (ie_len > wiphy->max_scan_ie_len) {
6660 err = -EINVAL;
6661 goto unlock;
6662 }
6663
6664 request = kzalloc(sizeof(*request)
6665 + sizeof(*request->ssids) * n_ssids
6666 + sizeof(*request->channels) * n_channels
6667 + ie_len, GFP_KERNEL);
6668 if (!request) {
6669 err = -ENOMEM;
6670 goto unlock;
6671 }
6672
6673 if (n_ssids)
6674 request->ssids = (void *)&request->channels[n_channels];
6675 request->n_ssids = n_ssids;
6676 if (ie_len) {
6677 if (n_ssids)
6678 request->ie = (void *)(request->ssids + n_ssids);
6679 else
6680 request->ie = (void *)(request->channels + n_channels);
6681 }
6682
6683 i = 0;
6684 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6685 /* user specified, bail out if channel not found */
6686 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
6687 struct ieee80211_channel *chan;
6688
6689 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
6690
6691 if (!chan) {
6692 err = -EINVAL;
6693 goto out_free;
6694 }
6695
6696 /* ignore disabled channels */
6697 if (chan->flags & IEEE80211_CHAN_DISABLED)
6698 continue;
6699
6700 request->channels[i] = chan;
6701 i++;
6702 }
6703 } else {
6704 enum nl80211_band band;
6705
6706 /* all channels */
6707 for (band = 0; band < NUM_NL80211_BANDS; band++) {
6708 int j;
6709
6710 if (!wiphy->bands[band])
6711 continue;
6712 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
6713 struct ieee80211_channel *chan;
6714
6715 chan = &wiphy->bands[band]->channels[j];
6716
6717 if (chan->flags & IEEE80211_CHAN_DISABLED)
6718 continue;
6719
6720 request->channels[i] = chan;
6721 i++;
6722 }
6723 }
6724 }
6725
6726 if (!i) {
6727 err = -EINVAL;
6728 goto out_free;
6729 }
6730
6731 request->n_channels = i;
6732
6733 wdev_lock(wdev);
6734 if (!cfg80211_off_channel_oper_allowed(wdev)) {
6735 struct ieee80211_channel *chan;
6736
6737 if (request->n_channels != 1) {
6738 wdev_unlock(wdev);
6739 err = -EBUSY;
6740 goto out_free;
6741 }
6742
6743 chan = request->channels[0];
6744 if (chan->center_freq != wdev->chandef.chan->center_freq) {
6745 wdev_unlock(wdev);
6746 err = -EBUSY;
6747 goto out_free;
6748 }
6749 }
6750 wdev_unlock(wdev);
6751
6752 i = 0;
6753 if (n_ssids) {
6754 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
6755 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
6756 err = -EINVAL;
6757 goto out_free;
6758 }
6759 request->ssids[i].ssid_len = nla_len(attr);
6760 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
6761 i++;
6762 }
6763 }
6764
6765 if (info->attrs[NL80211_ATTR_IE]) {
6766 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
6767 memcpy((void *)request->ie,
6768 nla_data(info->attrs[NL80211_ATTR_IE]),
6769 request->ie_len);
6770 }
6771
6772 for (i = 0; i < NUM_NL80211_BANDS; i++)
6773 if (wiphy->bands[i])
6774 request->rates[i] =
6775 (1 << wiphy->bands[i]->n_bitrates) - 1;
6776
6777 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
6778 nla_for_each_nested(attr,
6779 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
6780 tmp) {
6781 enum nl80211_band band = nla_type(attr);
6782
6783 if (band < 0 || band >= NUM_NL80211_BANDS) {
6784 err = -EINVAL;
6785 goto out_free;
6786 }
6787
6788 if (!wiphy->bands[band])
6789 continue;
6790
6791 err = ieee80211_get_ratemask(wiphy->bands[band],
6792 nla_data(attr),
6793 nla_len(attr),
6794 &request->rates[band]);
6795 if (err)
6796 goto out_free;
6797 }
6798 }
6799
6800 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
6801 if (!wiphy_ext_feature_isset(wiphy,
6802 NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
6803 err = -EOPNOTSUPP;
6804 goto out_free;
6805 }
6806
6807 request->duration =
6808 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
6809 request->duration_mandatory =
6810 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
6811 }
6812
6813 if (info->attrs[NL80211_ATTR_SCAN_FLAGS]) {
6814 request->flags = nla_get_u32(
6815 info->attrs[NL80211_ATTR_SCAN_FLAGS]);
6816 if ((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
6817 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) {
6818 err = -EOPNOTSUPP;
6819 goto out_free;
6820 }
6821
6822 if (request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
6823 if (!(wiphy->features &
6824 NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR)) {
6825 err = -EOPNOTSUPP;
6826 goto out_free;
6827 }
6828
6829 if (wdev->current_bss) {
6830 err = -EOPNOTSUPP;
6831 goto out_free;
6832 }
6833
6834 err = nl80211_parse_random_mac(info->attrs,
6835 request->mac_addr,
6836 request->mac_addr_mask);
6837 if (err)
6838 goto out_free;
6839 }
6840 }
6841
6842 request->no_cck =
6843 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
6844
6845 /* Initial implementation used NL80211_ATTR_MAC to set the specific
6846 * BSSID to scan for. This was problematic because that same attribute
6847 * was already used for another purpose (local random MAC address). The
6848 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
6849 * compatibility with older userspace components, also use the
6850 * NL80211_ATTR_MAC value here if it can be determined to be used for
6851 * the specific BSSID use case instead of the random MAC address
6852 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
6853 */
6854 if (info->attrs[NL80211_ATTR_BSSID])
6855 memcpy(request->bssid,
6856 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
6857 else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
6858 info->attrs[NL80211_ATTR_MAC])
6859 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
6860 ETH_ALEN);
6861 else
6862 eth_broadcast_addr(request->bssid);
6863
6864 request->wdev = wdev;
6865 request->wiphy = &rdev->wiphy;
6866 request->scan_start = jiffies;
6867
6868 rdev->scan_req = request;
6869 err = rdev_scan(rdev, request);
6870
6871 if (!err) {
6872 nl80211_send_scan_start(rdev, wdev);
6873 if (wdev->netdev)
6874 dev_hold(wdev->netdev);
6875 } else {
6876 out_free:
6877 rdev->scan_req = NULL;
6878 kfree(request);
6879 }
6880
6881 unlock:
6882 return err;
6883 }
6884
6885 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
6886 {
6887 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6888 struct wireless_dev *wdev = info->user_ptr[1];
6889
6890 if (!rdev->ops->abort_scan)
6891 return -EOPNOTSUPP;
6892
6893 if (rdev->scan_msg)
6894 return 0;
6895
6896 if (!rdev->scan_req)
6897 return -ENOENT;
6898
6899 rdev_abort_scan(rdev, wdev);
6900 return 0;
6901 }
6902
6903 static int
6904 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
6905 struct cfg80211_sched_scan_request *request,
6906 struct nlattr **attrs)
6907 {
6908 int tmp, err, i = 0;
6909 struct nlattr *attr;
6910
6911 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
6912 u32 interval;
6913
6914 /*
6915 * If scan plans are not specified,
6916 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
6917 * case one scan plan will be set with the specified scan
6918 * interval and infinite number of iterations.
6919 */
6920 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
6921 if (!interval)
6922 return -EINVAL;
6923
6924 request->scan_plans[0].interval =
6925 DIV_ROUND_UP(interval, MSEC_PER_SEC);
6926 if (!request->scan_plans[0].interval)
6927 return -EINVAL;
6928
6929 if (request->scan_plans[0].interval >
6930 wiphy->max_sched_scan_plan_interval)
6931 request->scan_plans[0].interval =
6932 wiphy->max_sched_scan_plan_interval;
6933
6934 return 0;
6935 }
6936
6937 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
6938 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
6939
6940 if (WARN_ON(i >= n_plans))
6941 return -EINVAL;
6942
6943 err = nla_parse_nested(plan, NL80211_SCHED_SCAN_PLAN_MAX,
6944 attr, nl80211_plan_policy, NULL);
6945 if (err)
6946 return err;
6947
6948 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
6949 return -EINVAL;
6950
6951 request->scan_plans[i].interval =
6952 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
6953 if (!request->scan_plans[i].interval ||
6954 request->scan_plans[i].interval >
6955 wiphy->max_sched_scan_plan_interval)
6956 return -EINVAL;
6957
6958 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
6959 request->scan_plans[i].iterations =
6960 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
6961 if (!request->scan_plans[i].iterations ||
6962 (request->scan_plans[i].iterations >
6963 wiphy->max_sched_scan_plan_iterations))
6964 return -EINVAL;
6965 } else if (i < n_plans - 1) {
6966 /*
6967 * All scan plans but the last one must specify
6968 * a finite number of iterations
6969 */
6970 return -EINVAL;
6971 }
6972
6973 i++;
6974 }
6975
6976 /*
6977 * The last scan plan must not specify the number of
6978 * iterations, it is supposed to run infinitely
6979 */
6980 if (request->scan_plans[n_plans - 1].iterations)
6981 return -EINVAL;
6982
6983 return 0;
6984 }
6985
6986 static struct cfg80211_sched_scan_request *
6987 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
6988 struct nlattr **attrs, int max_match_sets)
6989 {
6990 struct cfg80211_sched_scan_request *request;
6991 struct nlattr *attr;
6992 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
6993 enum nl80211_band band;
6994 size_t ie_len;
6995 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
6996 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
6997
6998 if (!is_valid_ie_attr(attrs[NL80211_ATTR_IE]))
6999 return ERR_PTR(-EINVAL);
7000
7001 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7002 n_channels = validate_scan_freqs(
7003 attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
7004 if (!n_channels)
7005 return ERR_PTR(-EINVAL);
7006 } else {
7007 n_channels = ieee80211_get_num_supported_channels(wiphy);
7008 }
7009
7010 if (attrs[NL80211_ATTR_SCAN_SSIDS])
7011 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
7012 tmp)
7013 n_ssids++;
7014
7015 if (n_ssids > wiphy->max_sched_scan_ssids)
7016 return ERR_PTR(-EINVAL);
7017
7018 /*
7019 * First, count the number of 'real' matchsets. Due to an issue with
7020 * the old implementation, matchsets containing only the RSSI attribute
7021 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
7022 * RSSI for all matchsets, rather than their own matchset for reporting
7023 * all APs with a strong RSSI. This is needed to be compatible with
7024 * older userspace that treated a matchset with only the RSSI as the
7025 * global RSSI for all other matchsets - if there are other matchsets.
7026 */
7027 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
7028 nla_for_each_nested(attr,
7029 attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
7030 tmp) {
7031 struct nlattr *rssi;
7032
7033 err = nla_parse_nested(tb,
7034 NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7035 attr, nl80211_match_policy,
7036 NULL);
7037 if (err)
7038 return ERR_PTR(err);
7039 /* add other standalone attributes here */
7040 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]) {
7041 n_match_sets++;
7042 continue;
7043 }
7044 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7045 if (rssi)
7046 default_match_rssi = nla_get_s32(rssi);
7047 }
7048 }
7049
7050 /* However, if there's no other matchset, add the RSSI one */
7051 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
7052 n_match_sets = 1;
7053
7054 if (n_match_sets > max_match_sets)
7055 return ERR_PTR(-EINVAL);
7056
7057 if (attrs[NL80211_ATTR_IE])
7058 ie_len = nla_len(attrs[NL80211_ATTR_IE]);
7059 else
7060 ie_len = 0;
7061
7062 if (ie_len > wiphy->max_sched_scan_ie_len)
7063 return ERR_PTR(-EINVAL);
7064
7065 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7066 /*
7067 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
7068 * each scan plan already specifies its own interval
7069 */
7070 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7071 return ERR_PTR(-EINVAL);
7072
7073 nla_for_each_nested(attr,
7074 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
7075 n_plans++;
7076 } else {
7077 /*
7078 * The scan interval attribute is kept for backward
7079 * compatibility. If no scan plans are specified and sched scan
7080 * interval is specified, one scan plan will be set with this
7081 * scan interval and infinite number of iterations.
7082 */
7083 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7084 return ERR_PTR(-EINVAL);
7085
7086 n_plans = 1;
7087 }
7088
7089 if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
7090 return ERR_PTR(-EINVAL);
7091
7092 if (!wiphy_ext_feature_isset(
7093 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
7094 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
7095 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
7096 return ERR_PTR(-EINVAL);
7097
7098 request = kzalloc(sizeof(*request)
7099 + sizeof(*request->ssids) * n_ssids
7100 + sizeof(*request->match_sets) * n_match_sets
7101 + sizeof(*request->scan_plans) * n_plans
7102 + sizeof(*request->channels) * n_channels
7103 + ie_len, GFP_KERNEL);
7104 if (!request)
7105 return ERR_PTR(-ENOMEM);
7106
7107 if (n_ssids)
7108 request->ssids = (void *)&request->channels[n_channels];
7109 request->n_ssids = n_ssids;
7110 if (ie_len) {
7111 if (n_ssids)
7112 request->ie = (void *)(request->ssids + n_ssids);
7113 else
7114 request->ie = (void *)(request->channels + n_channels);
7115 }
7116
7117 if (n_match_sets) {
7118 if (request->ie)
7119 request->match_sets = (void *)(request->ie + ie_len);
7120 else if (n_ssids)
7121 request->match_sets =
7122 (void *)(request->ssids + n_ssids);
7123 else
7124 request->match_sets =
7125 (void *)(request->channels + n_channels);
7126 }
7127 request->n_match_sets = n_match_sets;
7128
7129 if (n_match_sets)
7130 request->scan_plans = (void *)(request->match_sets +
7131 n_match_sets);
7132 else if (request->ie)
7133 request->scan_plans = (void *)(request->ie + ie_len);
7134 else if (n_ssids)
7135 request->scan_plans = (void *)(request->ssids + n_ssids);
7136 else
7137 request->scan_plans = (void *)(request->channels + n_channels);
7138
7139 request->n_scan_plans = n_plans;
7140
7141 i = 0;
7142 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7143 /* user specified, bail out if channel not found */
7144 nla_for_each_nested(attr,
7145 attrs[NL80211_ATTR_SCAN_FREQUENCIES],
7146 tmp) {
7147 struct ieee80211_channel *chan;
7148
7149 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
7150
7151 if (!chan) {
7152 err = -EINVAL;
7153 goto out_free;
7154 }
7155
7156 /* ignore disabled channels */
7157 if (chan->flags & IEEE80211_CHAN_DISABLED)
7158 continue;
7159
7160 request->channels[i] = chan;
7161 i++;
7162 }
7163 } else {
7164 /* all channels */
7165 for (band = 0; band < NUM_NL80211_BANDS; band++) {
7166 int j;
7167
7168 if (!wiphy->bands[band])
7169 continue;
7170 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
7171 struct ieee80211_channel *chan;
7172
7173 chan = &wiphy->bands[band]->channels[j];
7174
7175 if (chan->flags & IEEE80211_CHAN_DISABLED)
7176 continue;
7177
7178 request->channels[i] = chan;
7179 i++;
7180 }
7181 }
7182 }
7183
7184 if (!i) {
7185 err = -EINVAL;
7186 goto out_free;
7187 }
7188
7189 request->n_channels = i;
7190
7191 i = 0;
7192 if (n_ssids) {
7193 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
7194 tmp) {
7195 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
7196 err = -EINVAL;
7197 goto out_free;
7198 }
7199 request->ssids[i].ssid_len = nla_len(attr);
7200 memcpy(request->ssids[i].ssid, nla_data(attr),
7201 nla_len(attr));
7202 i++;
7203 }
7204 }
7205
7206 i = 0;
7207 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
7208 nla_for_each_nested(attr,
7209 attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
7210 tmp) {
7211 struct nlattr *ssid, *rssi;
7212
7213 err = nla_parse_nested(tb,
7214 NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7215 attr, nl80211_match_policy,
7216 NULL);
7217 if (err)
7218 goto out_free;
7219 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
7220 if (ssid) {
7221 if (WARN_ON(i >= n_match_sets)) {
7222 /* this indicates a programming error,
7223 * the loop above should have verified
7224 * things properly
7225 */
7226 err = -EINVAL;
7227 goto out_free;
7228 }
7229
7230 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
7231 err = -EINVAL;
7232 goto out_free;
7233 }
7234 memcpy(request->match_sets[i].ssid.ssid,
7235 nla_data(ssid), nla_len(ssid));
7236 request->match_sets[i].ssid.ssid_len =
7237 nla_len(ssid);
7238 /* special attribute - old implementation w/a */
7239 request->match_sets[i].rssi_thold =
7240 default_match_rssi;
7241 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7242 if (rssi)
7243 request->match_sets[i].rssi_thold =
7244 nla_get_s32(rssi);
7245 }
7246 i++;
7247 }
7248
7249 /* there was no other matchset, so the RSSI one is alone */
7250 if (i == 0 && n_match_sets)
7251 request->match_sets[0].rssi_thold = default_match_rssi;
7252
7253 request->min_rssi_thold = INT_MAX;
7254 for (i = 0; i < n_match_sets; i++)
7255 request->min_rssi_thold =
7256 min(request->match_sets[i].rssi_thold,
7257 request->min_rssi_thold);
7258 } else {
7259 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
7260 }
7261
7262 if (ie_len) {
7263 request->ie_len = ie_len;
7264 memcpy((void *)request->ie,
7265 nla_data(attrs[NL80211_ATTR_IE]),
7266 request->ie_len);
7267 }
7268
7269 if (attrs[NL80211_ATTR_SCAN_FLAGS]) {
7270 request->flags = nla_get_u32(
7271 attrs[NL80211_ATTR_SCAN_FLAGS]);
7272 if ((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
7273 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) {
7274 err = -EOPNOTSUPP;
7275 goto out_free;
7276 }
7277
7278 if (request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
7279 u32 flg = NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR;
7280
7281 if (!wdev) /* must be net-detect */
7282 flg = NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
7283
7284 if (!(wiphy->features & flg)) {
7285 err = -EOPNOTSUPP;
7286 goto out_free;
7287 }
7288
7289 if (wdev && wdev->current_bss) {
7290 err = -EOPNOTSUPP;
7291 goto out_free;
7292 }
7293
7294 err = nl80211_parse_random_mac(attrs, request->mac_addr,
7295 request->mac_addr_mask);
7296 if (err)
7297 goto out_free;
7298 }
7299 }
7300
7301 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
7302 request->delay =
7303 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
7304
7305 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
7306 request->relative_rssi = nla_get_s8(
7307 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
7308 request->relative_rssi_set = true;
7309 }
7310
7311 if (request->relative_rssi_set &&
7312 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
7313 struct nl80211_bss_select_rssi_adjust *rssi_adjust;
7314
7315 rssi_adjust = nla_data(
7316 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
7317 request->rssi_adjust.band = rssi_adjust->band;
7318 request->rssi_adjust.delta = rssi_adjust->delta;
7319 if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
7320 err = -EINVAL;
7321 goto out_free;
7322 }
7323 }
7324
7325 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
7326 if (err)
7327 goto out_free;
7328
7329 request->scan_start = jiffies;
7330
7331 return request;
7332
7333 out_free:
7334 kfree(request);
7335 return ERR_PTR(err);
7336 }
7337
7338 static int nl80211_start_sched_scan(struct sk_buff *skb,
7339 struct genl_info *info)
7340 {
7341 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7342 struct net_device *dev = info->user_ptr[1];
7343 struct wireless_dev *wdev = dev->ieee80211_ptr;
7344 struct cfg80211_sched_scan_request *sched_scan_req;
7345 bool want_multi;
7346 int err;
7347
7348 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
7349 return -EOPNOTSUPP;
7350
7351 want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
7352 err = cfg80211_sched_scan_req_possible(rdev, want_multi);
7353 if (err)
7354 return err;
7355
7356 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
7357 info->attrs,
7358 rdev->wiphy.max_match_sets);
7359
7360 err = PTR_ERR_OR_ZERO(sched_scan_req);
7361 if (err)
7362 goto out_err;
7363
7364 /* leave request id zero for legacy request
7365 * or if driver does not support multi-scheduled scan
7366 */
7367 if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) {
7368 while (!sched_scan_req->reqid)
7369 sched_scan_req->reqid = rdev->wiphy.cookie_counter++;
7370 }
7371
7372 err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
7373 if (err)
7374 goto out_free;
7375
7376 sched_scan_req->dev = dev;
7377 sched_scan_req->wiphy = &rdev->wiphy;
7378
7379 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
7380 sched_scan_req->owner_nlportid = info->snd_portid;
7381
7382 cfg80211_add_sched_scan_req(rdev, sched_scan_req);
7383
7384 nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
7385 return 0;
7386
7387 out_free:
7388 kfree(sched_scan_req);
7389 out_err:
7390 return err;
7391 }
7392
7393 static int nl80211_stop_sched_scan(struct sk_buff *skb,
7394 struct genl_info *info)
7395 {
7396 struct cfg80211_sched_scan_request *req;
7397 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7398 u64 cookie;
7399
7400 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
7401 return -EOPNOTSUPP;
7402
7403 if (info->attrs[NL80211_ATTR_COOKIE]) {
7404 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
7405 return __cfg80211_stop_sched_scan(rdev, cookie, false);
7406 }
7407
7408 req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
7409 struct cfg80211_sched_scan_request,
7410 list);
7411 if (!req || req->reqid ||
7412 (req->owner_nlportid &&
7413 req->owner_nlportid != info->snd_portid))
7414 return -ENOENT;
7415
7416 return cfg80211_stop_sched_scan_req(rdev, req, false);
7417 }
7418
7419 static int nl80211_start_radar_detection(struct sk_buff *skb,
7420 struct genl_info *info)
7421 {
7422 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7423 struct net_device *dev = info->user_ptr[1];
7424 struct wireless_dev *wdev = dev->ieee80211_ptr;
7425 struct cfg80211_chan_def chandef;
7426 enum nl80211_dfs_regions dfs_region;
7427 unsigned int cac_time_ms;
7428 int err;
7429
7430 dfs_region = reg_get_dfs_region(wdev->wiphy);
7431 if (dfs_region == NL80211_DFS_UNSET)
7432 return -EINVAL;
7433
7434 err = nl80211_parse_chandef(rdev, info, &chandef);
7435 if (err)
7436 return err;
7437
7438 if (netif_carrier_ok(dev))
7439 return -EBUSY;
7440
7441 if (wdev->cac_started)
7442 return -EBUSY;
7443
7444 err = cfg80211_chandef_dfs_required(wdev->wiphy, &chandef,
7445 wdev->iftype);
7446 if (err < 0)
7447 return err;
7448
7449 if (err == 0)
7450 return -EINVAL;
7451
7452 if (!cfg80211_chandef_dfs_usable(wdev->wiphy, &chandef))
7453 return -EINVAL;
7454
7455 if (!rdev->ops->start_radar_detection)
7456 return -EOPNOTSUPP;
7457
7458 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
7459 if (WARN_ON(!cac_time_ms))
7460 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
7461
7462 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
7463 if (!err) {
7464 wdev->chandef = chandef;
7465 wdev->cac_started = true;
7466 wdev->cac_start_time = jiffies;
7467 wdev->cac_time_ms = cac_time_ms;
7468 }
7469 return err;
7470 }
7471
7472 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
7473 {
7474 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7475 struct net_device *dev = info->user_ptr[1];
7476 struct wireless_dev *wdev = dev->ieee80211_ptr;
7477 struct cfg80211_csa_settings params;
7478 /* csa_attrs is defined static to avoid waste of stack size - this
7479 * function is called under RTNL lock, so this should not be a problem.
7480 */
7481 static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
7482 int err;
7483 bool need_new_beacon = false;
7484 int len, i;
7485 u32 cs_count;
7486
7487 if (!rdev->ops->channel_switch ||
7488 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
7489 return -EOPNOTSUPP;
7490
7491 switch (dev->ieee80211_ptr->iftype) {
7492 case NL80211_IFTYPE_AP:
7493 case NL80211_IFTYPE_P2P_GO:
7494 need_new_beacon = true;
7495
7496 /* useless if AP is not running */
7497 if (!wdev->beacon_interval)
7498 return -ENOTCONN;
7499 break;
7500 case NL80211_IFTYPE_ADHOC:
7501 if (!wdev->ssid_len)
7502 return -ENOTCONN;
7503 break;
7504 case NL80211_IFTYPE_MESH_POINT:
7505 if (!wdev->mesh_id_len)
7506 return -ENOTCONN;
7507 break;
7508 default:
7509 return -EOPNOTSUPP;
7510 }
7511
7512 memset(&params, 0, sizeof(params));
7513
7514 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
7515 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
7516 return -EINVAL;
7517
7518 /* only important for AP, IBSS and mesh create IEs internally */
7519 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
7520 return -EINVAL;
7521
7522 /* Even though the attribute is u32, the specification says
7523 * u8, so let's make sure we don't overflow.
7524 */
7525 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
7526 if (cs_count > 255)
7527 return -EINVAL;
7528
7529 params.count = cs_count;
7530
7531 if (!need_new_beacon)
7532 goto skip_beacons;
7533
7534 err = nl80211_parse_beacon(info->attrs, &params.beacon_after);
7535 if (err)
7536 return err;
7537
7538 err = nla_parse_nested(csa_attrs, NL80211_ATTR_MAX,
7539 info->attrs[NL80211_ATTR_CSA_IES],
7540 nl80211_policy, info->extack);
7541 if (err)
7542 return err;
7543
7544 err = nl80211_parse_beacon(csa_attrs, &params.beacon_csa);
7545 if (err)
7546 return err;
7547
7548 if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
7549 return -EINVAL;
7550
7551 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7552 if (!len || (len % sizeof(u16)))
7553 return -EINVAL;
7554
7555 params.n_counter_offsets_beacon = len / sizeof(u16);
7556 if (rdev->wiphy.max_num_csa_counters &&
7557 (params.n_counter_offsets_beacon >
7558 rdev->wiphy.max_num_csa_counters))
7559 return -EINVAL;
7560
7561 params.counter_offsets_beacon =
7562 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7563
7564 /* sanity checks - counters should fit and be the same */
7565 for (i = 0; i < params.n_counter_offsets_beacon; i++) {
7566 u16 offset = params.counter_offsets_beacon[i];
7567
7568 if (offset >= params.beacon_csa.tail_len)
7569 return -EINVAL;
7570
7571 if (params.beacon_csa.tail[offset] != params.count)
7572 return -EINVAL;
7573 }
7574
7575 if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
7576 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7577 if (!len || (len % sizeof(u16)))
7578 return -EINVAL;
7579
7580 params.n_counter_offsets_presp = len / sizeof(u16);
7581 if (rdev->wiphy.max_num_csa_counters &&
7582 (params.n_counter_offsets_presp >
7583 rdev->wiphy.max_num_csa_counters))
7584 return -EINVAL;
7585
7586 params.counter_offsets_presp =
7587 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7588
7589 /* sanity checks - counters should fit and be the same */
7590 for (i = 0; i < params.n_counter_offsets_presp; i++) {
7591 u16 offset = params.counter_offsets_presp[i];
7592
7593 if (offset >= params.beacon_csa.probe_resp_len)
7594 return -EINVAL;
7595
7596 if (params.beacon_csa.probe_resp[offset] !=
7597 params.count)
7598 return -EINVAL;
7599 }
7600 }
7601
7602 skip_beacons:
7603 err = nl80211_parse_chandef(rdev, info, &params.chandef);
7604 if (err)
7605 return err;
7606
7607 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
7608 wdev->iftype))
7609 return -EINVAL;
7610
7611 err = cfg80211_chandef_dfs_required(wdev->wiphy,
7612 &params.chandef,
7613 wdev->iftype);
7614 if (err < 0)
7615 return err;
7616
7617 if (err > 0)
7618 params.radar_required = true;
7619
7620 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
7621 params.block_tx = true;
7622
7623 wdev_lock(wdev);
7624 err = rdev_channel_switch(rdev, dev, &params);
7625 wdev_unlock(wdev);
7626
7627 return err;
7628 }
7629
7630 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
7631 u32 seq, int flags,
7632 struct cfg80211_registered_device *rdev,
7633 struct wireless_dev *wdev,
7634 struct cfg80211_internal_bss *intbss)
7635 {
7636 struct cfg80211_bss *res = &intbss->pub;
7637 const struct cfg80211_bss_ies *ies;
7638 void *hdr;
7639 struct nlattr *bss;
7640
7641 ASSERT_WDEV_LOCK(wdev);
7642
7643 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
7644 NL80211_CMD_NEW_SCAN_RESULTS);
7645 if (!hdr)
7646 return -1;
7647
7648 genl_dump_check_consistent(cb, hdr, &nl80211_fam);
7649
7650 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
7651 goto nla_put_failure;
7652 if (wdev->netdev &&
7653 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
7654 goto nla_put_failure;
7655 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
7656 NL80211_ATTR_PAD))
7657 goto nla_put_failure;
7658
7659 bss = nla_nest_start(msg, NL80211_ATTR_BSS);
7660 if (!bss)
7661 goto nla_put_failure;
7662 if ((!is_zero_ether_addr(res->bssid) &&
7663 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
7664 goto nla_put_failure;
7665
7666 rcu_read_lock();
7667 /* indicate whether we have probe response data or not */
7668 if (rcu_access_pointer(res->proberesp_ies) &&
7669 nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
7670 goto fail_unlock_rcu;
7671
7672 /* this pointer prefers to be pointed to probe response data
7673 * but is always valid
7674 */
7675 ies = rcu_dereference(res->ies);
7676 if (ies) {
7677 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
7678 NL80211_BSS_PAD))
7679 goto fail_unlock_rcu;
7680 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
7681 ies->len, ies->data))
7682 goto fail_unlock_rcu;
7683 }
7684
7685 /* and this pointer is always (unless driver didn't know) beacon data */
7686 ies = rcu_dereference(res->beacon_ies);
7687 if (ies && ies->from_beacon) {
7688 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
7689 NL80211_BSS_PAD))
7690 goto fail_unlock_rcu;
7691 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
7692 ies->len, ies->data))
7693 goto fail_unlock_rcu;
7694 }
7695 rcu_read_unlock();
7696
7697 if (res->beacon_interval &&
7698 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
7699 goto nla_put_failure;
7700 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
7701 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
7702 nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
7703 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
7704 jiffies_to_msecs(jiffies - intbss->ts)))
7705 goto nla_put_failure;
7706
7707 if (intbss->parent_tsf &&
7708 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
7709 intbss->parent_tsf, NL80211_BSS_PAD) ||
7710 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
7711 intbss->parent_bssid)))
7712 goto nla_put_failure;
7713
7714 if (intbss->ts_boottime &&
7715 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
7716 intbss->ts_boottime, NL80211_BSS_PAD))
7717 goto nla_put_failure;
7718
7719 switch (rdev->wiphy.signal_type) {
7720 case CFG80211_SIGNAL_TYPE_MBM:
7721 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
7722 goto nla_put_failure;
7723 break;
7724 case CFG80211_SIGNAL_TYPE_UNSPEC:
7725 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
7726 goto nla_put_failure;
7727 break;
7728 default:
7729 break;
7730 }
7731
7732 switch (wdev->iftype) {
7733 case NL80211_IFTYPE_P2P_CLIENT:
7734 case NL80211_IFTYPE_STATION:
7735 if (intbss == wdev->current_bss &&
7736 nla_put_u32(msg, NL80211_BSS_STATUS,
7737 NL80211_BSS_STATUS_ASSOCIATED))
7738 goto nla_put_failure;
7739 break;
7740 case NL80211_IFTYPE_ADHOC:
7741 if (intbss == wdev->current_bss &&
7742 nla_put_u32(msg, NL80211_BSS_STATUS,
7743 NL80211_BSS_STATUS_IBSS_JOINED))
7744 goto nla_put_failure;
7745 break;
7746 default:
7747 break;
7748 }
7749
7750 nla_nest_end(msg, bss);
7751
7752 genlmsg_end(msg, hdr);
7753 return 0;
7754
7755 fail_unlock_rcu:
7756 rcu_read_unlock();
7757 nla_put_failure:
7758 genlmsg_cancel(msg, hdr);
7759 return -EMSGSIZE;
7760 }
7761
7762 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
7763 {
7764 struct cfg80211_registered_device *rdev;
7765 struct cfg80211_internal_bss *scan;
7766 struct wireless_dev *wdev;
7767 int start = cb->args[2], idx = 0;
7768 int err;
7769
7770 rtnl_lock();
7771 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
7772 if (err) {
7773 rtnl_unlock();
7774 return err;
7775 }
7776
7777 wdev_lock(wdev);
7778 spin_lock_bh(&rdev->bss_lock);
7779 cfg80211_bss_expire(rdev);
7780
7781 cb->seq = rdev->bss_generation;
7782
7783 list_for_each_entry(scan, &rdev->bss_list, list) {
7784 if (++idx <= start)
7785 continue;
7786 if (nl80211_send_bss(skb, cb,
7787 cb->nlh->nlmsg_seq, NLM_F_MULTI,
7788 rdev, wdev, scan) < 0) {
7789 idx--;
7790 break;
7791 }
7792 }
7793
7794 spin_unlock_bh(&rdev->bss_lock);
7795 wdev_unlock(wdev);
7796
7797 cb->args[2] = idx;
7798 rtnl_unlock();
7799
7800 return skb->len;
7801 }
7802
7803 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
7804 int flags, struct net_device *dev,
7805 bool allow_radio_stats,
7806 struct survey_info *survey)
7807 {
7808 void *hdr;
7809 struct nlattr *infoattr;
7810
7811 /* skip radio stats if userspace didn't request them */
7812 if (!survey->channel && !allow_radio_stats)
7813 return 0;
7814
7815 hdr = nl80211hdr_put(msg, portid, seq, flags,
7816 NL80211_CMD_NEW_SURVEY_RESULTS);
7817 if (!hdr)
7818 return -ENOMEM;
7819
7820 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
7821 goto nla_put_failure;
7822
7823 infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
7824 if (!infoattr)
7825 goto nla_put_failure;
7826
7827 if (survey->channel &&
7828 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
7829 survey->channel->center_freq))
7830 goto nla_put_failure;
7831
7832 if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
7833 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
7834 goto nla_put_failure;
7835 if ((survey->filled & SURVEY_INFO_IN_USE) &&
7836 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
7837 goto nla_put_failure;
7838 if ((survey->filled & SURVEY_INFO_TIME) &&
7839 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
7840 survey->time, NL80211_SURVEY_INFO_PAD))
7841 goto nla_put_failure;
7842 if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
7843 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
7844 survey->time_busy, NL80211_SURVEY_INFO_PAD))
7845 goto nla_put_failure;
7846 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
7847 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
7848 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
7849 goto nla_put_failure;
7850 if ((survey->filled & SURVEY_INFO_TIME_RX) &&
7851 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
7852 survey->time_rx, NL80211_SURVEY_INFO_PAD))
7853 goto nla_put_failure;
7854 if ((survey->filled & SURVEY_INFO_TIME_TX) &&
7855 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
7856 survey->time_tx, NL80211_SURVEY_INFO_PAD))
7857 goto nla_put_failure;
7858 if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
7859 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
7860 survey->time_scan, NL80211_SURVEY_INFO_PAD))
7861 goto nla_put_failure;
7862
7863 nla_nest_end(msg, infoattr);
7864
7865 genlmsg_end(msg, hdr);
7866 return 0;
7867
7868 nla_put_failure:
7869 genlmsg_cancel(msg, hdr);
7870 return -EMSGSIZE;
7871 }
7872
7873 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
7874 {
7875 struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
7876 struct survey_info survey;
7877 struct cfg80211_registered_device *rdev;
7878 struct wireless_dev *wdev;
7879 int survey_idx = cb->args[2];
7880 int res;
7881 bool radio_stats;
7882
7883 rtnl_lock();
7884 res = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
7885 if (res)
7886 goto out_err;
7887
7888 /* prepare_wdev_dump parsed the attributes */
7889 radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
7890
7891 if (!wdev->netdev) {
7892 res = -EINVAL;
7893 goto out_err;
7894 }
7895
7896 if (!rdev->ops->dump_survey) {
7897 res = -EOPNOTSUPP;
7898 goto out_err;
7899 }
7900
7901 while (1) {
7902 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
7903 if (res == -ENOENT)
7904 break;
7905 if (res)
7906 goto out_err;
7907
7908 /* don't send disabled channels, but do send non-channel data */
7909 if (survey.channel &&
7910 survey.channel->flags & IEEE80211_CHAN_DISABLED) {
7911 survey_idx++;
7912 continue;
7913 }
7914
7915 if (nl80211_send_survey(skb,
7916 NETLINK_CB(cb->skb).portid,
7917 cb->nlh->nlmsg_seq, NLM_F_MULTI,
7918 wdev->netdev, radio_stats, &survey) < 0)
7919 goto out;
7920 survey_idx++;
7921 }
7922
7923 out:
7924 cb->args[2] = survey_idx;
7925 res = skb->len;
7926 out_err:
7927 rtnl_unlock();
7928 return res;
7929 }
7930
7931 static bool nl80211_valid_wpa_versions(u32 wpa_versions)
7932 {
7933 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
7934 NL80211_WPA_VERSION_2));
7935 }
7936
7937 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
7938 {
7939 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7940 struct net_device *dev = info->user_ptr[1];
7941 struct ieee80211_channel *chan;
7942 const u8 *bssid, *ssid, *ie = NULL, *auth_data = NULL;
7943 int err, ssid_len, ie_len = 0, auth_data_len = 0;
7944 enum nl80211_auth_type auth_type;
7945 struct key_parse key;
7946 bool local_state_change;
7947
7948 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
7949 return -EINVAL;
7950
7951 if (!info->attrs[NL80211_ATTR_MAC])
7952 return -EINVAL;
7953
7954 if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
7955 return -EINVAL;
7956
7957 if (!info->attrs[NL80211_ATTR_SSID])
7958 return -EINVAL;
7959
7960 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
7961 return -EINVAL;
7962
7963 err = nl80211_parse_key(info, &key);
7964 if (err)
7965 return err;
7966
7967 if (key.idx >= 0) {
7968 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
7969 return -EINVAL;
7970 if (!key.p.key || !key.p.key_len)
7971 return -EINVAL;
7972 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
7973 key.p.key_len != WLAN_KEY_LEN_WEP40) &&
7974 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
7975 key.p.key_len != WLAN_KEY_LEN_WEP104))
7976 return -EINVAL;
7977 if (key.idx > 3)
7978 return -EINVAL;
7979 } else {
7980 key.p.key_len = 0;
7981 key.p.key = NULL;
7982 }
7983
7984 if (key.idx >= 0) {
7985 int i;
7986 bool ok = false;
7987
7988 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
7989 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
7990 ok = true;
7991 break;
7992 }
7993 }
7994 if (!ok)
7995 return -EINVAL;
7996 }
7997
7998 if (!rdev->ops->auth)
7999 return -EOPNOTSUPP;
8000
8001 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8002 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8003 return -EOPNOTSUPP;
8004
8005 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8006 chan = nl80211_get_valid_chan(&rdev->wiphy,
8007 info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8008 if (!chan)
8009 return -EINVAL;
8010
8011 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8012 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8013
8014 if (info->attrs[NL80211_ATTR_IE]) {
8015 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8016 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8017 }
8018
8019 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
8020 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
8021 return -EINVAL;
8022
8023 if ((auth_type == NL80211_AUTHTYPE_SAE ||
8024 auth_type == NL80211_AUTHTYPE_FILS_SK ||
8025 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
8026 auth_type == NL80211_AUTHTYPE_FILS_PK) &&
8027 !info->attrs[NL80211_ATTR_AUTH_DATA])
8028 return -EINVAL;
8029
8030 if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
8031 if (auth_type != NL80211_AUTHTYPE_SAE &&
8032 auth_type != NL80211_AUTHTYPE_FILS_SK &&
8033 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
8034 auth_type != NL80211_AUTHTYPE_FILS_PK)
8035 return -EINVAL;
8036 auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
8037 auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
8038 /* need to include at least Auth Transaction and Status Code */
8039 if (auth_data_len < 4)
8040 return -EINVAL;
8041 }
8042
8043 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8044
8045 /*
8046 * Since we no longer track auth state, ignore
8047 * requests to only change local state.
8048 */
8049 if (local_state_change)
8050 return 0;
8051
8052 wdev_lock(dev->ieee80211_ptr);
8053 err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
8054 ssid, ssid_len, ie, ie_len,
8055 key.p.key, key.p.key_len, key.idx,
8056 auth_data, auth_data_len);
8057 wdev_unlock(dev->ieee80211_ptr);
8058 return err;
8059 }
8060
8061 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
8062 struct genl_info *info,
8063 struct cfg80211_crypto_settings *settings,
8064 int cipher_limit)
8065 {
8066 memset(settings, 0, sizeof(*settings));
8067
8068 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
8069
8070 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
8071 u16 proto;
8072
8073 proto = nla_get_u16(
8074 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
8075 settings->control_port_ethertype = cpu_to_be16(proto);
8076 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
8077 proto != ETH_P_PAE)
8078 return -EINVAL;
8079 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
8080 settings->control_port_no_encrypt = true;
8081 } else
8082 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
8083
8084 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
8085 void *data;
8086 int len, i;
8087
8088 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
8089 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
8090 settings->n_ciphers_pairwise = len / sizeof(u32);
8091
8092 if (len % sizeof(u32))
8093 return -EINVAL;
8094
8095 if (settings->n_ciphers_pairwise > cipher_limit)
8096 return -EINVAL;
8097
8098 memcpy(settings->ciphers_pairwise, data, len);
8099
8100 for (i = 0; i < settings->n_ciphers_pairwise; i++)
8101 if (!cfg80211_supported_cipher_suite(
8102 &rdev->wiphy,
8103 settings->ciphers_pairwise[i]))
8104 return -EINVAL;
8105 }
8106
8107 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
8108 settings->cipher_group =
8109 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
8110 if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
8111 settings->cipher_group))
8112 return -EINVAL;
8113 }
8114
8115 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
8116 settings->wpa_versions =
8117 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
8118 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
8119 return -EINVAL;
8120 }
8121
8122 if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
8123 void *data;
8124 int len;
8125
8126 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
8127 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
8128 settings->n_akm_suites = len / sizeof(u32);
8129
8130 if (len % sizeof(u32))
8131 return -EINVAL;
8132
8133 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
8134 return -EINVAL;
8135
8136 memcpy(settings->akm_suites, data, len);
8137 }
8138
8139 return 0;
8140 }
8141
8142 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
8143 {
8144 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8145 struct net_device *dev = info->user_ptr[1];
8146 struct ieee80211_channel *chan;
8147 struct cfg80211_assoc_request req = {};
8148 const u8 *bssid, *ssid;
8149 int err, ssid_len = 0;
8150
8151 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8152 return -EINVAL;
8153
8154 if (!info->attrs[NL80211_ATTR_MAC] ||
8155 !info->attrs[NL80211_ATTR_SSID] ||
8156 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
8157 return -EINVAL;
8158
8159 if (!rdev->ops->assoc)
8160 return -EOPNOTSUPP;
8161
8162 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8163 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8164 return -EOPNOTSUPP;
8165
8166 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8167
8168 chan = nl80211_get_valid_chan(&rdev->wiphy,
8169 info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8170 if (!chan)
8171 return -EINVAL;
8172
8173 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8174 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8175
8176 if (info->attrs[NL80211_ATTR_IE]) {
8177 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8178 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8179 }
8180
8181 if (info->attrs[NL80211_ATTR_USE_MFP]) {
8182 enum nl80211_mfp mfp =
8183 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
8184 if (mfp == NL80211_MFP_REQUIRED)
8185 req.use_mfp = true;
8186 else if (mfp != NL80211_MFP_NO)
8187 return -EINVAL;
8188 }
8189
8190 if (info->attrs[NL80211_ATTR_PREV_BSSID])
8191 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
8192
8193 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
8194 req.flags |= ASSOC_REQ_DISABLE_HT;
8195
8196 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8197 memcpy(&req.ht_capa_mask,
8198 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8199 sizeof(req.ht_capa_mask));
8200
8201 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8202 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8203 return -EINVAL;
8204 memcpy(&req.ht_capa,
8205 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8206 sizeof(req.ht_capa));
8207 }
8208
8209 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
8210 req.flags |= ASSOC_REQ_DISABLE_VHT;
8211
8212 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
8213 memcpy(&req.vht_capa_mask,
8214 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
8215 sizeof(req.vht_capa_mask));
8216
8217 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
8218 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
8219 return -EINVAL;
8220 memcpy(&req.vht_capa,
8221 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
8222 sizeof(req.vht_capa));
8223 }
8224
8225 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
8226 if (!((rdev->wiphy.features &
8227 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
8228 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
8229 !wiphy_ext_feature_isset(&rdev->wiphy,
8230 NL80211_EXT_FEATURE_RRM))
8231 return -EINVAL;
8232 req.flags |= ASSOC_REQ_USE_RRM;
8233 }
8234
8235 if (info->attrs[NL80211_ATTR_FILS_KEK]) {
8236 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
8237 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
8238 if (!info->attrs[NL80211_ATTR_FILS_NONCES])
8239 return -EINVAL;
8240 req.fils_nonces =
8241 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
8242 }
8243
8244 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
8245 if (!err) {
8246 wdev_lock(dev->ieee80211_ptr);
8247
8248 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
8249 ssid, ssid_len, &req);
8250
8251 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
8252 dev->ieee80211_ptr->conn_owner_nlportid =
8253 info->snd_portid;
8254 memcpy(dev->ieee80211_ptr->disconnect_bssid,
8255 bssid, ETH_ALEN);
8256 }
8257
8258 wdev_unlock(dev->ieee80211_ptr);
8259 }
8260
8261 return err;
8262 }
8263
8264 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
8265 {
8266 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8267 struct net_device *dev = info->user_ptr[1];
8268 const u8 *ie = NULL, *bssid;
8269 int ie_len = 0, err;
8270 u16 reason_code;
8271 bool local_state_change;
8272
8273 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8274 return -EINVAL;
8275
8276 if (!info->attrs[NL80211_ATTR_MAC])
8277 return -EINVAL;
8278
8279 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8280 return -EINVAL;
8281
8282 if (!rdev->ops->deauth)
8283 return -EOPNOTSUPP;
8284
8285 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8286 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8287 return -EOPNOTSUPP;
8288
8289 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8290
8291 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8292 if (reason_code == 0) {
8293 /* Reason Code 0 is reserved */
8294 return -EINVAL;
8295 }
8296
8297 if (info->attrs[NL80211_ATTR_IE]) {
8298 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8299 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8300 }
8301
8302 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8303
8304 wdev_lock(dev->ieee80211_ptr);
8305 err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
8306 local_state_change);
8307 wdev_unlock(dev->ieee80211_ptr);
8308 return err;
8309 }
8310
8311 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
8312 {
8313 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8314 struct net_device *dev = info->user_ptr[1];
8315 const u8 *ie = NULL, *bssid;
8316 int ie_len = 0, err;
8317 u16 reason_code;
8318 bool local_state_change;
8319
8320 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8321 return -EINVAL;
8322
8323 if (!info->attrs[NL80211_ATTR_MAC])
8324 return -EINVAL;
8325
8326 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8327 return -EINVAL;
8328
8329 if (!rdev->ops->disassoc)
8330 return -EOPNOTSUPP;
8331
8332 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8333 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8334 return -EOPNOTSUPP;
8335
8336 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8337
8338 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8339 if (reason_code == 0) {
8340 /* Reason Code 0 is reserved */
8341 return -EINVAL;
8342 }
8343
8344 if (info->attrs[NL80211_ATTR_IE]) {
8345 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8346 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8347 }
8348
8349 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8350
8351 wdev_lock(dev->ieee80211_ptr);
8352 err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
8353 local_state_change);
8354 wdev_unlock(dev->ieee80211_ptr);
8355 return err;
8356 }
8357
8358 static bool
8359 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
8360 int mcast_rate[NUM_NL80211_BANDS],
8361 int rateval)
8362 {
8363 struct wiphy *wiphy = &rdev->wiphy;
8364 bool found = false;
8365 int band, i;
8366
8367 for (band = 0; band < NUM_NL80211_BANDS; band++) {
8368 struct ieee80211_supported_band *sband;
8369
8370 sband = wiphy->bands[band];
8371 if (!sband)
8372 continue;
8373
8374 for (i = 0; i < sband->n_bitrates; i++) {
8375 if (sband->bitrates[i].bitrate == rateval) {
8376 mcast_rate[band] = i + 1;
8377 found = true;
8378 break;
8379 }
8380 }
8381 }
8382
8383 return found;
8384 }
8385
8386 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
8387 {
8388 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8389 struct net_device *dev = info->user_ptr[1];
8390 struct cfg80211_ibss_params ibss;
8391 struct wiphy *wiphy;
8392 struct cfg80211_cached_keys *connkeys = NULL;
8393 int err;
8394
8395 memset(&ibss, 0, sizeof(ibss));
8396
8397 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8398 return -EINVAL;
8399
8400 if (!info->attrs[NL80211_ATTR_SSID] ||
8401 !nla_len(info->attrs[NL80211_ATTR_SSID]))
8402 return -EINVAL;
8403
8404 ibss.beacon_interval = 100;
8405
8406 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
8407 ibss.beacon_interval =
8408 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
8409
8410 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
8411 ibss.beacon_interval);
8412 if (err)
8413 return err;
8414
8415 if (!rdev->ops->join_ibss)
8416 return -EOPNOTSUPP;
8417
8418 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8419 return -EOPNOTSUPP;
8420
8421 wiphy = &rdev->wiphy;
8422
8423 if (info->attrs[NL80211_ATTR_MAC]) {
8424 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8425
8426 if (!is_valid_ether_addr(ibss.bssid))
8427 return -EINVAL;
8428 }
8429 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8430 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8431
8432 if (info->attrs[NL80211_ATTR_IE]) {
8433 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8434 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8435 }
8436
8437 err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
8438 if (err)
8439 return err;
8440
8441 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
8442 NL80211_IFTYPE_ADHOC))
8443 return -EINVAL;
8444
8445 switch (ibss.chandef.width) {
8446 case NL80211_CHAN_WIDTH_5:
8447 case NL80211_CHAN_WIDTH_10:
8448 case NL80211_CHAN_WIDTH_20_NOHT:
8449 break;
8450 case NL80211_CHAN_WIDTH_20:
8451 case NL80211_CHAN_WIDTH_40:
8452 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8453 return -EINVAL;
8454 break;
8455 case NL80211_CHAN_WIDTH_80:
8456 case NL80211_CHAN_WIDTH_80P80:
8457 case NL80211_CHAN_WIDTH_160:
8458 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8459 return -EINVAL;
8460 if (!wiphy_ext_feature_isset(&rdev->wiphy,
8461 NL80211_EXT_FEATURE_VHT_IBSS))
8462 return -EINVAL;
8463 break;
8464 default:
8465 return -EINVAL;
8466 }
8467
8468 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
8469 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
8470
8471 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
8472 u8 *rates =
8473 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8474 int n_rates =
8475 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8476 struct ieee80211_supported_band *sband =
8477 wiphy->bands[ibss.chandef.chan->band];
8478
8479 err = ieee80211_get_ratemask(sband, rates, n_rates,
8480 &ibss.basic_rates);
8481 if (err)
8482 return err;
8483 }
8484
8485 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8486 memcpy(&ibss.ht_capa_mask,
8487 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8488 sizeof(ibss.ht_capa_mask));
8489
8490 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8491 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8492 return -EINVAL;
8493 memcpy(&ibss.ht_capa,
8494 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8495 sizeof(ibss.ht_capa));
8496 }
8497
8498 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
8499 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
8500 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
8501 return -EINVAL;
8502
8503 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
8504 bool no_ht = false;
8505
8506 connkeys = nl80211_parse_connkeys(rdev,
8507 info->attrs[NL80211_ATTR_KEYS],
8508 &no_ht);
8509 if (IS_ERR(connkeys))
8510 return PTR_ERR(connkeys);
8511
8512 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
8513 no_ht) {
8514 kzfree(connkeys);
8515 return -EINVAL;
8516 }
8517 }
8518
8519 ibss.control_port =
8520 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
8521
8522 ibss.userspace_handles_dfs =
8523 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
8524
8525 err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
8526 if (err)
8527 kzfree(connkeys);
8528 return err;
8529 }
8530
8531 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
8532 {
8533 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8534 struct net_device *dev = info->user_ptr[1];
8535
8536 if (!rdev->ops->leave_ibss)
8537 return -EOPNOTSUPP;
8538
8539 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8540 return -EOPNOTSUPP;
8541
8542 return cfg80211_leave_ibss(rdev, dev, false);
8543 }
8544
8545 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
8546 {
8547 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8548 struct net_device *dev = info->user_ptr[1];
8549 int mcast_rate[NUM_NL80211_BANDS];
8550 u32 nla_rate;
8551 int err;
8552
8553 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
8554 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
8555 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
8556 return -EOPNOTSUPP;
8557
8558 if (!rdev->ops->set_mcast_rate)
8559 return -EOPNOTSUPP;
8560
8561 memset(mcast_rate, 0, sizeof(mcast_rate));
8562
8563 if (!info->attrs[NL80211_ATTR_MCAST_RATE])
8564 return -EINVAL;
8565
8566 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
8567 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
8568 return -EINVAL;
8569
8570 err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
8571
8572 return err;
8573 }
8574
8575 static struct sk_buff *
8576 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
8577 struct wireless_dev *wdev, int approxlen,
8578 u32 portid, u32 seq, enum nl80211_commands cmd,
8579 enum nl80211_attrs attr,
8580 const struct nl80211_vendor_cmd_info *info,
8581 gfp_t gfp)
8582 {
8583 struct sk_buff *skb;
8584 void *hdr;
8585 struct nlattr *data;
8586
8587 skb = nlmsg_new(approxlen + 100, gfp);
8588 if (!skb)
8589 return NULL;
8590
8591 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
8592 if (!hdr) {
8593 kfree_skb(skb);
8594 return NULL;
8595 }
8596
8597 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
8598 goto nla_put_failure;
8599
8600 if (info) {
8601 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
8602 info->vendor_id))
8603 goto nla_put_failure;
8604 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
8605 info->subcmd))
8606 goto nla_put_failure;
8607 }
8608
8609 if (wdev) {
8610 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
8611 wdev_id(wdev), NL80211_ATTR_PAD))
8612 goto nla_put_failure;
8613 if (wdev->netdev &&
8614 nla_put_u32(skb, NL80211_ATTR_IFINDEX,
8615 wdev->netdev->ifindex))
8616 goto nla_put_failure;
8617 }
8618
8619 data = nla_nest_start(skb, attr);
8620 if (!data)
8621 goto nla_put_failure;
8622
8623 ((void **)skb->cb)[0] = rdev;
8624 ((void **)skb->cb)[1] = hdr;
8625 ((void **)skb->cb)[2] = data;
8626
8627 return skb;
8628
8629 nla_put_failure:
8630 kfree_skb(skb);
8631 return NULL;
8632 }
8633
8634 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
8635 struct wireless_dev *wdev,
8636 enum nl80211_commands cmd,
8637 enum nl80211_attrs attr,
8638 int vendor_event_idx,
8639 int approxlen, gfp_t gfp)
8640 {
8641 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
8642 const struct nl80211_vendor_cmd_info *info;
8643
8644 switch (cmd) {
8645 case NL80211_CMD_TESTMODE:
8646 if (WARN_ON(vendor_event_idx != -1))
8647 return NULL;
8648 info = NULL;
8649 break;
8650 case NL80211_CMD_VENDOR:
8651 if (WARN_ON(vendor_event_idx < 0 ||
8652 vendor_event_idx >= wiphy->n_vendor_events))
8653 return NULL;
8654 info = &wiphy->vendor_events[vendor_event_idx];
8655 break;
8656 default:
8657 WARN_ON(1);
8658 return NULL;
8659 }
8660
8661 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, 0, 0,
8662 cmd, attr, info, gfp);
8663 }
8664 EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
8665
8666 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
8667 {
8668 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
8669 void *hdr = ((void **)skb->cb)[1];
8670 struct nlattr *data = ((void **)skb->cb)[2];
8671 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
8672
8673 /* clear CB data for netlink core to own from now on */
8674 memset(skb->cb, 0, sizeof(skb->cb));
8675
8676 nla_nest_end(skb, data);
8677 genlmsg_end(skb, hdr);
8678
8679 if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
8680 mcgrp = NL80211_MCGRP_VENDOR;
8681
8682 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), skb, 0,
8683 mcgrp, gfp);
8684 }
8685 EXPORT_SYMBOL(__cfg80211_send_event_skb);
8686
8687 #ifdef CONFIG_NL80211_TESTMODE
8688 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
8689 {
8690 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8691 struct wireless_dev *wdev =
8692 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
8693 int err;
8694
8695 if (!rdev->ops->testmode_cmd)
8696 return -EOPNOTSUPP;
8697
8698 if (IS_ERR(wdev)) {
8699 err = PTR_ERR(wdev);
8700 if (err != -EINVAL)
8701 return err;
8702 wdev = NULL;
8703 } else if (wdev->wiphy != &rdev->wiphy) {
8704 return -EINVAL;
8705 }
8706
8707 if (!info->attrs[NL80211_ATTR_TESTDATA])
8708 return -EINVAL;
8709
8710 rdev->cur_cmd_info = info;
8711 err = rdev_testmode_cmd(rdev, wdev,
8712 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
8713 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
8714 rdev->cur_cmd_info = NULL;
8715
8716 return err;
8717 }
8718
8719 static int nl80211_testmode_dump(struct sk_buff *skb,
8720 struct netlink_callback *cb)
8721 {
8722 struct cfg80211_registered_device *rdev;
8723 int err;
8724 long phy_idx;
8725 void *data = NULL;
8726 int data_len = 0;
8727
8728 rtnl_lock();
8729
8730 if (cb->args[0]) {
8731 /*
8732 * 0 is a valid index, but not valid for args[0],
8733 * so we need to offset by 1.
8734 */
8735 phy_idx = cb->args[0] - 1;
8736
8737 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
8738 if (!rdev) {
8739 err = -ENOENT;
8740 goto out_err;
8741 }
8742 } else {
8743 struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
8744
8745 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
8746 attrbuf, nl80211_fam.maxattr,
8747 nl80211_policy, NULL);
8748 if (err)
8749 goto out_err;
8750
8751 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
8752 if (IS_ERR(rdev)) {
8753 err = PTR_ERR(rdev);
8754 goto out_err;
8755 }
8756 phy_idx = rdev->wiphy_idx;
8757
8758 if (attrbuf[NL80211_ATTR_TESTDATA])
8759 cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
8760 }
8761
8762 if (cb->args[1]) {
8763 data = nla_data((void *)cb->args[1]);
8764 data_len = nla_len((void *)cb->args[1]);
8765 }
8766
8767 if (!rdev->ops->testmode_dump) {
8768 err = -EOPNOTSUPP;
8769 goto out_err;
8770 }
8771
8772 while (1) {
8773 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
8774 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8775 NL80211_CMD_TESTMODE);
8776 struct nlattr *tmdata;
8777
8778 if (!hdr)
8779 break;
8780
8781 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
8782 genlmsg_cancel(skb, hdr);
8783 break;
8784 }
8785
8786 tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
8787 if (!tmdata) {
8788 genlmsg_cancel(skb, hdr);
8789 break;
8790 }
8791 err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
8792 nla_nest_end(skb, tmdata);
8793
8794 if (err == -ENOBUFS || err == -ENOENT) {
8795 genlmsg_cancel(skb, hdr);
8796 break;
8797 } else if (err) {
8798 genlmsg_cancel(skb, hdr);
8799 goto out_err;
8800 }
8801
8802 genlmsg_end(skb, hdr);
8803 }
8804
8805 err = skb->len;
8806 /* see above */
8807 cb->args[0] = phy_idx + 1;
8808 out_err:
8809 rtnl_unlock();
8810 return err;
8811 }
8812 #endif
8813
8814 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
8815 {
8816 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8817 struct net_device *dev = info->user_ptr[1];
8818 struct cfg80211_connect_params connect;
8819 struct wiphy *wiphy;
8820 struct cfg80211_cached_keys *connkeys = NULL;
8821 int err;
8822
8823 memset(&connect, 0, sizeof(connect));
8824
8825 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8826 return -EINVAL;
8827
8828 if (!info->attrs[NL80211_ATTR_SSID] ||
8829 !nla_len(info->attrs[NL80211_ATTR_SSID]))
8830 return -EINVAL;
8831
8832 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
8833 connect.auth_type =
8834 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
8835 if (!nl80211_valid_auth_type(rdev, connect.auth_type,
8836 NL80211_CMD_CONNECT))
8837 return -EINVAL;
8838 } else
8839 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
8840
8841 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
8842
8843 err = nl80211_crypto_settings(rdev, info, &connect.crypto,
8844 NL80211_MAX_NR_CIPHER_SUITES);
8845 if (err)
8846 return err;
8847
8848 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8849 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8850 return -EOPNOTSUPP;
8851
8852 wiphy = &rdev->wiphy;
8853
8854 connect.bg_scan_period = -1;
8855 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
8856 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
8857 connect.bg_scan_period =
8858 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
8859 }
8860
8861 if (info->attrs[NL80211_ATTR_MAC])
8862 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8863 else if (info->attrs[NL80211_ATTR_MAC_HINT])
8864 connect.bssid_hint =
8865 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
8866 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8867 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8868
8869 if (info->attrs[NL80211_ATTR_IE]) {
8870 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8871 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8872 }
8873
8874 if (info->attrs[NL80211_ATTR_USE_MFP]) {
8875 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
8876 if (connect.mfp != NL80211_MFP_REQUIRED &&
8877 connect.mfp != NL80211_MFP_NO)
8878 return -EINVAL;
8879 } else {
8880 connect.mfp = NL80211_MFP_NO;
8881 }
8882
8883 if (info->attrs[NL80211_ATTR_PREV_BSSID])
8884 connect.prev_bssid =
8885 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
8886
8887 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
8888 connect.channel = nl80211_get_valid_chan(
8889 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8890 if (!connect.channel)
8891 return -EINVAL;
8892 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
8893 connect.channel_hint = nl80211_get_valid_chan(
8894 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
8895 if (!connect.channel_hint)
8896 return -EINVAL;
8897 }
8898
8899 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
8900 connkeys = nl80211_parse_connkeys(rdev,
8901 info->attrs[NL80211_ATTR_KEYS], NULL);
8902 if (IS_ERR(connkeys))
8903 return PTR_ERR(connkeys);
8904 }
8905
8906 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
8907 connect.flags |= ASSOC_REQ_DISABLE_HT;
8908
8909 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8910 memcpy(&connect.ht_capa_mask,
8911 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8912 sizeof(connect.ht_capa_mask));
8913
8914 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8915 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
8916 kzfree(connkeys);
8917 return -EINVAL;
8918 }
8919 memcpy(&connect.ht_capa,
8920 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8921 sizeof(connect.ht_capa));
8922 }
8923
8924 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
8925 connect.flags |= ASSOC_REQ_DISABLE_VHT;
8926
8927 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
8928 memcpy(&connect.vht_capa_mask,
8929 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
8930 sizeof(connect.vht_capa_mask));
8931
8932 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
8933 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
8934 kzfree(connkeys);
8935 return -EINVAL;
8936 }
8937 memcpy(&connect.vht_capa,
8938 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
8939 sizeof(connect.vht_capa));
8940 }
8941
8942 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
8943 if (!((rdev->wiphy.features &
8944 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
8945 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
8946 !wiphy_ext_feature_isset(&rdev->wiphy,
8947 NL80211_EXT_FEATURE_RRM)) {
8948 kzfree(connkeys);
8949 return -EINVAL;
8950 }
8951 connect.flags |= ASSOC_REQ_USE_RRM;
8952 }
8953
8954 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
8955 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
8956 kzfree(connkeys);
8957 return -EOPNOTSUPP;
8958 }
8959
8960 if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
8961 /* bss selection makes no sense if bssid is set */
8962 if (connect.bssid) {
8963 kzfree(connkeys);
8964 return -EINVAL;
8965 }
8966
8967 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
8968 wiphy, &connect.bss_select);
8969 if (err) {
8970 kzfree(connkeys);
8971 return err;
8972 }
8973 }
8974
8975 if (wiphy_ext_feature_isset(&rdev->wiphy,
8976 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
8977 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
8978 info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
8979 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
8980 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
8981 connect.fils_erp_username =
8982 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
8983 connect.fils_erp_username_len =
8984 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
8985 connect.fils_erp_realm =
8986 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
8987 connect.fils_erp_realm_len =
8988 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
8989 connect.fils_erp_next_seq_num =
8990 nla_get_u16(
8991 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
8992 connect.fils_erp_rrk =
8993 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
8994 connect.fils_erp_rrk_len =
8995 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
8996 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
8997 info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
8998 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
8999 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9000 kzfree(connkeys);
9001 return -EINVAL;
9002 }
9003
9004 wdev_lock(dev->ieee80211_ptr);
9005
9006 err = cfg80211_connect(rdev, dev, &connect, connkeys,
9007 connect.prev_bssid);
9008 if (err)
9009 kzfree(connkeys);
9010
9011 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9012 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
9013 if (connect.bssid)
9014 memcpy(dev->ieee80211_ptr->disconnect_bssid,
9015 connect.bssid, ETH_ALEN);
9016 else
9017 memset(dev->ieee80211_ptr->disconnect_bssid,
9018 0, ETH_ALEN);
9019 }
9020
9021 wdev_unlock(dev->ieee80211_ptr);
9022
9023 return err;
9024 }
9025
9026 static int nl80211_update_connect_params(struct sk_buff *skb,
9027 struct genl_info *info)
9028 {
9029 struct cfg80211_connect_params connect = {};
9030 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9031 struct net_device *dev = info->user_ptr[1];
9032 struct wireless_dev *wdev = dev->ieee80211_ptr;
9033 u32 changed = 0;
9034 int ret;
9035
9036 if (!rdev->ops->update_connect_params)
9037 return -EOPNOTSUPP;
9038
9039 if (info->attrs[NL80211_ATTR_IE]) {
9040 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
9041 return -EINVAL;
9042 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9043 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9044 changed |= UPDATE_ASSOC_IES;
9045 }
9046
9047 wdev_lock(dev->ieee80211_ptr);
9048 if (!wdev->current_bss)
9049 ret = -ENOLINK;
9050 else
9051 ret = rdev_update_connect_params(rdev, dev, &connect, changed);
9052 wdev_unlock(dev->ieee80211_ptr);
9053
9054 return ret;
9055 }
9056
9057 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
9058 {
9059 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9060 struct net_device *dev = info->user_ptr[1];
9061 u16 reason;
9062 int ret;
9063
9064 if (!info->attrs[NL80211_ATTR_REASON_CODE])
9065 reason = WLAN_REASON_DEAUTH_LEAVING;
9066 else
9067 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9068
9069 if (reason == 0)
9070 return -EINVAL;
9071
9072 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9073 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9074 return -EOPNOTSUPP;
9075
9076 wdev_lock(dev->ieee80211_ptr);
9077 ret = cfg80211_disconnect(rdev, dev, reason, true);
9078 wdev_unlock(dev->ieee80211_ptr);
9079 return ret;
9080 }
9081
9082 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
9083 {
9084 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9085 struct net *net;
9086 int err;
9087
9088 if (info->attrs[NL80211_ATTR_PID]) {
9089 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
9090
9091 net = get_net_ns_by_pid(pid);
9092 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
9093 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
9094
9095 net = get_net_ns_by_fd(fd);
9096 } else {
9097 return -EINVAL;
9098 }
9099
9100 if (IS_ERR(net))
9101 return PTR_ERR(net);
9102
9103 err = 0;
9104
9105 /* check if anything to do */
9106 if (!net_eq(wiphy_net(&rdev->wiphy), net))
9107 err = cfg80211_switch_netns(rdev, net);
9108
9109 put_net(net);
9110 return err;
9111 }
9112
9113 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
9114 {
9115 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9116 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
9117 struct cfg80211_pmksa *pmksa) = NULL;
9118 struct net_device *dev = info->user_ptr[1];
9119 struct cfg80211_pmksa pmksa;
9120
9121 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
9122
9123 if (!info->attrs[NL80211_ATTR_PMKID])
9124 return -EINVAL;
9125
9126 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
9127
9128 if (info->attrs[NL80211_ATTR_MAC]) {
9129 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9130 } else if (info->attrs[NL80211_ATTR_SSID] &&
9131 info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
9132 (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA ||
9133 info->attrs[NL80211_ATTR_PMK])) {
9134 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9135 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9136 pmksa.cache_id =
9137 nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
9138 } else {
9139 return -EINVAL;
9140 }
9141 if (info->attrs[NL80211_ATTR_PMK]) {
9142 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
9143 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
9144 }
9145
9146 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9147 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9148 return -EOPNOTSUPP;
9149
9150 switch (info->genlhdr->cmd) {
9151 case NL80211_CMD_SET_PMKSA:
9152 rdev_ops = rdev->ops->set_pmksa;
9153 break;
9154 case NL80211_CMD_DEL_PMKSA:
9155 rdev_ops = rdev->ops->del_pmksa;
9156 break;
9157 default:
9158 WARN_ON(1);
9159 break;
9160 }
9161
9162 if (!rdev_ops)
9163 return -EOPNOTSUPP;
9164
9165 return rdev_ops(&rdev->wiphy, dev, &pmksa);
9166 }
9167
9168 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
9169 {
9170 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9171 struct net_device *dev = info->user_ptr[1];
9172
9173 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9174 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9175 return -EOPNOTSUPP;
9176
9177 if (!rdev->ops->flush_pmksa)
9178 return -EOPNOTSUPP;
9179
9180 return rdev_flush_pmksa(rdev, dev);
9181 }
9182
9183 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
9184 {
9185 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9186 struct net_device *dev = info->user_ptr[1];
9187 u8 action_code, dialog_token;
9188 u32 peer_capability = 0;
9189 u16 status_code;
9190 u8 *peer;
9191 bool initiator;
9192
9193 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
9194 !rdev->ops->tdls_mgmt)
9195 return -EOPNOTSUPP;
9196
9197 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
9198 !info->attrs[NL80211_ATTR_STATUS_CODE] ||
9199 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
9200 !info->attrs[NL80211_ATTR_IE] ||
9201 !info->attrs[NL80211_ATTR_MAC])
9202 return -EINVAL;
9203
9204 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
9205 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
9206 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
9207 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
9208 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
9209 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
9210 peer_capability =
9211 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
9212
9213 return rdev_tdls_mgmt(rdev, dev, peer, action_code,
9214 dialog_token, status_code, peer_capability,
9215 initiator,
9216 nla_data(info->attrs[NL80211_ATTR_IE]),
9217 nla_len(info->attrs[NL80211_ATTR_IE]));
9218 }
9219
9220 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
9221 {
9222 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9223 struct net_device *dev = info->user_ptr[1];
9224 enum nl80211_tdls_operation operation;
9225 u8 *peer;
9226
9227 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
9228 !rdev->ops->tdls_oper)
9229 return -EOPNOTSUPP;
9230
9231 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
9232 !info->attrs[NL80211_ATTR_MAC])
9233 return -EINVAL;
9234
9235 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
9236 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
9237
9238 return rdev_tdls_oper(rdev, dev, peer, operation);
9239 }
9240
9241 static int nl80211_remain_on_channel(struct sk_buff *skb,
9242 struct genl_info *info)
9243 {
9244 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9245 struct wireless_dev *wdev = info->user_ptr[1];
9246 struct cfg80211_chan_def chandef;
9247 const struct cfg80211_chan_def *compat_chandef;
9248 struct sk_buff *msg;
9249 void *hdr;
9250 u64 cookie;
9251 u32 duration;
9252 int err;
9253
9254 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
9255 !info->attrs[NL80211_ATTR_DURATION])
9256 return -EINVAL;
9257
9258 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
9259
9260 if (!rdev->ops->remain_on_channel ||
9261 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
9262 return -EOPNOTSUPP;
9263
9264 /*
9265 * We should be on that channel for at least a minimum amount of
9266 * time (10ms) but no longer than the driver supports.
9267 */
9268 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9269 duration > rdev->wiphy.max_remain_on_channel_duration)
9270 return -EINVAL;
9271
9272 err = nl80211_parse_chandef(rdev, info, &chandef);
9273 if (err)
9274 return err;
9275
9276 wdev_lock(wdev);
9277 if (!cfg80211_off_channel_oper_allowed(wdev) &&
9278 !cfg80211_chandef_identical(&wdev->chandef, &chandef)) {
9279 compat_chandef = cfg80211_chandef_compatible(&wdev->chandef,
9280 &chandef);
9281 if (compat_chandef != &chandef) {
9282 wdev_unlock(wdev);
9283 return -EBUSY;
9284 }
9285 }
9286 wdev_unlock(wdev);
9287
9288 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9289 if (!msg)
9290 return -ENOMEM;
9291
9292 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9293 NL80211_CMD_REMAIN_ON_CHANNEL);
9294 if (!hdr) {
9295 err = -ENOBUFS;
9296 goto free_msg;
9297 }
9298
9299 err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
9300 duration, &cookie);
9301
9302 if (err)
9303 goto free_msg;
9304
9305 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
9306 NL80211_ATTR_PAD))
9307 goto nla_put_failure;
9308
9309 genlmsg_end(msg, hdr);
9310
9311 return genlmsg_reply(msg, info);
9312
9313 nla_put_failure:
9314 err = -ENOBUFS;
9315 free_msg:
9316 nlmsg_free(msg);
9317 return err;
9318 }
9319
9320 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
9321 struct genl_info *info)
9322 {
9323 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9324 struct wireless_dev *wdev = info->user_ptr[1];
9325 u64 cookie;
9326
9327 if (!info->attrs[NL80211_ATTR_COOKIE])
9328 return -EINVAL;
9329
9330 if (!rdev->ops->cancel_remain_on_channel)
9331 return -EOPNOTSUPP;
9332
9333 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
9334
9335 return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
9336 }
9337
9338 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
9339 struct genl_info *info)
9340 {
9341 struct cfg80211_bitrate_mask mask;
9342 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9343 struct net_device *dev = info->user_ptr[1];
9344 int err;
9345
9346 if (!rdev->ops->set_bitrate_mask)
9347 return -EOPNOTSUPP;
9348
9349 err = nl80211_parse_tx_bitrate_mask(info, &mask);
9350 if (err)
9351 return err;
9352
9353 return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
9354 }
9355
9356 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
9357 {
9358 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9359 struct wireless_dev *wdev = info->user_ptr[1];
9360 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
9361
9362 if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
9363 return -EINVAL;
9364
9365 if (info->attrs[NL80211_ATTR_FRAME_TYPE])
9366 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
9367
9368 switch (wdev->iftype) {
9369 case NL80211_IFTYPE_STATION:
9370 case NL80211_IFTYPE_ADHOC:
9371 case NL80211_IFTYPE_P2P_CLIENT:
9372 case NL80211_IFTYPE_AP:
9373 case NL80211_IFTYPE_AP_VLAN:
9374 case NL80211_IFTYPE_MESH_POINT:
9375 case NL80211_IFTYPE_P2P_GO:
9376 case NL80211_IFTYPE_P2P_DEVICE:
9377 break;
9378 case NL80211_IFTYPE_NAN:
9379 default:
9380 return -EOPNOTSUPP;
9381 }
9382
9383 /* not much point in registering if we can't reply */
9384 if (!rdev->ops->mgmt_tx)
9385 return -EOPNOTSUPP;
9386
9387 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
9388 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
9389 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
9390 }
9391
9392 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
9393 {
9394 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9395 struct wireless_dev *wdev = info->user_ptr[1];
9396 struct cfg80211_chan_def chandef;
9397 int err;
9398 void *hdr = NULL;
9399 u64 cookie;
9400 struct sk_buff *msg = NULL;
9401 struct cfg80211_mgmt_tx_params params = {
9402 .dont_wait_for_ack =
9403 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
9404 };
9405
9406 if (!info->attrs[NL80211_ATTR_FRAME])
9407 return -EINVAL;
9408
9409 if (!rdev->ops->mgmt_tx)
9410 return -EOPNOTSUPP;
9411
9412 switch (wdev->iftype) {
9413 case NL80211_IFTYPE_P2P_DEVICE:
9414 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
9415 return -EINVAL;
9416 case NL80211_IFTYPE_STATION:
9417 case NL80211_IFTYPE_ADHOC:
9418 case NL80211_IFTYPE_P2P_CLIENT:
9419 case NL80211_IFTYPE_AP:
9420 case NL80211_IFTYPE_AP_VLAN:
9421 case NL80211_IFTYPE_MESH_POINT:
9422 case NL80211_IFTYPE_P2P_GO:
9423 break;
9424 case NL80211_IFTYPE_NAN:
9425 default:
9426 return -EOPNOTSUPP;
9427 }
9428
9429 if (info->attrs[NL80211_ATTR_DURATION]) {
9430 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
9431 return -EINVAL;
9432 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
9433
9434 /*
9435 * We should wait on the channel for at least a minimum amount
9436 * of time (10ms) but no longer than the driver supports.
9437 */
9438 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9439 params.wait > rdev->wiphy.max_remain_on_channel_duration)
9440 return -EINVAL;
9441 }
9442
9443 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
9444
9445 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
9446 return -EINVAL;
9447
9448 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
9449
9450 /* get the channel if any has been specified, otherwise pass NULL to
9451 * the driver. The latter will use the current one
9452 */
9453 chandef.chan = NULL;
9454 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9455 err = nl80211_parse_chandef(rdev, info, &chandef);
9456 if (err)
9457 return err;
9458 }
9459
9460 if (!chandef.chan && params.offchan)
9461 return -EINVAL;
9462
9463 wdev_lock(wdev);
9464 if (params.offchan && !cfg80211_off_channel_oper_allowed(wdev)) {
9465 wdev_unlock(wdev);
9466 return -EBUSY;
9467 }
9468 wdev_unlock(wdev);
9469
9470 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
9471 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
9472
9473 if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
9474 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9475 int i;
9476
9477 if (len % sizeof(u16))
9478 return -EINVAL;
9479
9480 params.n_csa_offsets = len / sizeof(u16);
9481 params.csa_offsets =
9482 nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9483
9484 /* check that all the offsets fit the frame */
9485 for (i = 0; i < params.n_csa_offsets; i++) {
9486 if (params.csa_offsets[i] >= params.len)
9487 return -EINVAL;
9488 }
9489 }
9490
9491 if (!params.dont_wait_for_ack) {
9492 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9493 if (!msg)
9494 return -ENOMEM;
9495
9496 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9497 NL80211_CMD_FRAME);
9498 if (!hdr) {
9499 err = -ENOBUFS;
9500 goto free_msg;
9501 }
9502 }
9503
9504 params.chan = chandef.chan;
9505 err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
9506 if (err)
9507 goto free_msg;
9508
9509 if (msg) {
9510 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
9511 NL80211_ATTR_PAD))
9512 goto nla_put_failure;
9513
9514 genlmsg_end(msg, hdr);
9515 return genlmsg_reply(msg, info);
9516 }
9517
9518 return 0;
9519
9520 nla_put_failure:
9521 err = -ENOBUFS;
9522 free_msg:
9523 nlmsg_free(msg);
9524 return err;
9525 }
9526
9527 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
9528 {
9529 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9530 struct wireless_dev *wdev = info->user_ptr[1];
9531 u64 cookie;
9532
9533 if (!info->attrs[NL80211_ATTR_COOKIE])
9534 return -EINVAL;
9535
9536 if (!rdev->ops->mgmt_tx_cancel_wait)
9537 return -EOPNOTSUPP;
9538
9539 switch (wdev->iftype) {
9540 case NL80211_IFTYPE_STATION:
9541 case NL80211_IFTYPE_ADHOC:
9542 case NL80211_IFTYPE_P2P_CLIENT:
9543 case NL80211_IFTYPE_AP:
9544 case NL80211_IFTYPE_AP_VLAN:
9545 case NL80211_IFTYPE_P2P_GO:
9546 case NL80211_IFTYPE_P2P_DEVICE:
9547 break;
9548 case NL80211_IFTYPE_NAN:
9549 default:
9550 return -EOPNOTSUPP;
9551 }
9552
9553 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
9554
9555 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
9556 }
9557
9558 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
9559 {
9560 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9561 struct wireless_dev *wdev;
9562 struct net_device *dev = info->user_ptr[1];
9563 u8 ps_state;
9564 bool state;
9565 int err;
9566
9567 if (!info->attrs[NL80211_ATTR_PS_STATE])
9568 return -EINVAL;
9569
9570 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
9571
9572 if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
9573 return -EINVAL;
9574
9575 wdev = dev->ieee80211_ptr;
9576
9577 if (!rdev->ops->set_power_mgmt)
9578 return -EOPNOTSUPP;
9579
9580 state = (ps_state == NL80211_PS_ENABLED) ? true : false;
9581
9582 if (state == wdev->ps)
9583 return 0;
9584
9585 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
9586 if (!err)
9587 wdev->ps = state;
9588 return err;
9589 }
9590
9591 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
9592 {
9593 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9594 enum nl80211_ps_state ps_state;
9595 struct wireless_dev *wdev;
9596 struct net_device *dev = info->user_ptr[1];
9597 struct sk_buff *msg;
9598 void *hdr;
9599 int err;
9600
9601 wdev = dev->ieee80211_ptr;
9602
9603 if (!rdev->ops->set_power_mgmt)
9604 return -EOPNOTSUPP;
9605
9606 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9607 if (!msg)
9608 return -ENOMEM;
9609
9610 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9611 NL80211_CMD_GET_POWER_SAVE);
9612 if (!hdr) {
9613 err = -ENOBUFS;
9614 goto free_msg;
9615 }
9616
9617 if (wdev->ps)
9618 ps_state = NL80211_PS_ENABLED;
9619 else
9620 ps_state = NL80211_PS_DISABLED;
9621
9622 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
9623 goto nla_put_failure;
9624
9625 genlmsg_end(msg, hdr);
9626 return genlmsg_reply(msg, info);
9627
9628 nla_put_failure:
9629 err = -ENOBUFS;
9630 free_msg:
9631 nlmsg_free(msg);
9632 return err;
9633 }
9634
9635 static const struct nla_policy
9636 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
9637 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
9638 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
9639 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
9640 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
9641 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
9642 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
9643 [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
9644 };
9645
9646 static int nl80211_set_cqm_txe(struct genl_info *info,
9647 u32 rate, u32 pkts, u32 intvl)
9648 {
9649 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9650 struct net_device *dev = info->user_ptr[1];
9651 struct wireless_dev *wdev = dev->ieee80211_ptr;
9652
9653 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
9654 return -EINVAL;
9655
9656 if (!rdev->ops->set_cqm_txe_config)
9657 return -EOPNOTSUPP;
9658
9659 if (wdev->iftype != NL80211_IFTYPE_STATION &&
9660 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9661 return -EOPNOTSUPP;
9662
9663 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
9664 }
9665
9666 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
9667 struct net_device *dev)
9668 {
9669 struct wireless_dev *wdev = dev->ieee80211_ptr;
9670 s32 last, low, high;
9671 u32 hyst;
9672 int i, n;
9673 int err;
9674
9675 /* RSSI reporting disabled? */
9676 if (!wdev->cqm_config)
9677 return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);
9678
9679 /*
9680 * Obtain current RSSI value if possible, if not and no RSSI threshold
9681 * event has been received yet, we should receive an event after a
9682 * connection is established and enough beacons received to calculate
9683 * the average.
9684 */
9685 if (!wdev->cqm_config->last_rssi_event_value && wdev->current_bss &&
9686 rdev->ops->get_station) {
9687 struct station_info sinfo;
9688 u8 *mac_addr;
9689
9690 mac_addr = wdev->current_bss->pub.bssid;
9691
9692 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
9693 if (err)
9694 return err;
9695
9696 if (sinfo.filled & BIT(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
9697 wdev->cqm_config->last_rssi_event_value =
9698 (s8) sinfo.rx_beacon_signal_avg;
9699 }
9700
9701 last = wdev->cqm_config->last_rssi_event_value;
9702 hyst = wdev->cqm_config->rssi_hyst;
9703 n = wdev->cqm_config->n_rssi_thresholds;
9704
9705 for (i = 0; i < n; i++)
9706 if (last < wdev->cqm_config->rssi_thresholds[i])
9707 break;
9708
9709 low = i > 0 ?
9710 (wdev->cqm_config->rssi_thresholds[i - 1] - hyst) : S32_MIN;
9711 high = i < n ?
9712 (wdev->cqm_config->rssi_thresholds[i] + hyst - 1) : S32_MAX;
9713
9714 return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
9715 }
9716
9717 static int nl80211_set_cqm_rssi(struct genl_info *info,
9718 const s32 *thresholds, int n_thresholds,
9719 u32 hysteresis)
9720 {
9721 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9722 struct net_device *dev = info->user_ptr[1];
9723 struct wireless_dev *wdev = dev->ieee80211_ptr;
9724 int i, err;
9725 s32 prev = S32_MIN;
9726
9727 /* Check all values negative and sorted */
9728 for (i = 0; i < n_thresholds; i++) {
9729 if (thresholds[i] > 0 || thresholds[i] <= prev)
9730 return -EINVAL;
9731
9732 prev = thresholds[i];
9733 }
9734
9735 if (wdev->iftype != NL80211_IFTYPE_STATION &&
9736 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9737 return -EOPNOTSUPP;
9738
9739 wdev_lock(wdev);
9740 cfg80211_cqm_config_free(wdev);
9741 wdev_unlock(wdev);
9742
9743 if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) {
9744 if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */
9745 return rdev_set_cqm_rssi_config(rdev, dev, 0, 0);
9746
9747 return rdev_set_cqm_rssi_config(rdev, dev,
9748 thresholds[0], hysteresis);
9749 }
9750
9751 if (!wiphy_ext_feature_isset(&rdev->wiphy,
9752 NL80211_EXT_FEATURE_CQM_RSSI_LIST))
9753 return -EOPNOTSUPP;
9754
9755 if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
9756 n_thresholds = 0;
9757
9758 wdev_lock(wdev);
9759 if (n_thresholds) {
9760 struct cfg80211_cqm_config *cqm_config;
9761
9762 cqm_config = kzalloc(sizeof(struct cfg80211_cqm_config) +
9763 n_thresholds * sizeof(s32), GFP_KERNEL);
9764 if (!cqm_config) {
9765 err = -ENOMEM;
9766 goto unlock;
9767 }
9768
9769 cqm_config->rssi_hyst = hysteresis;
9770 cqm_config->n_rssi_thresholds = n_thresholds;
9771 memcpy(cqm_config->rssi_thresholds, thresholds,
9772 n_thresholds * sizeof(s32));
9773
9774 wdev->cqm_config = cqm_config;
9775 }
9776
9777 err = cfg80211_cqm_rssi_update(rdev, dev);
9778
9779 unlock:
9780 wdev_unlock(wdev);
9781
9782 return err;
9783 }
9784
9785 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
9786 {
9787 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
9788 struct nlattr *cqm;
9789 int err;
9790
9791 cqm = info->attrs[NL80211_ATTR_CQM];
9792 if (!cqm)
9793 return -EINVAL;
9794
9795 err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
9796 nl80211_attr_cqm_policy, info->extack);
9797 if (err)
9798 return err;
9799
9800 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
9801 attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
9802 const s32 *thresholds =
9803 nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
9804 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
9805 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
9806
9807 if (len % 4)
9808 return -EINVAL;
9809
9810 return nl80211_set_cqm_rssi(info, thresholds, len / 4,
9811 hysteresis);
9812 }
9813
9814 if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
9815 attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
9816 attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
9817 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
9818 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
9819 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
9820
9821 return nl80211_set_cqm_txe(info, rate, pkts, intvl);
9822 }
9823
9824 return -EINVAL;
9825 }
9826
9827 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
9828 {
9829 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9830 struct net_device *dev = info->user_ptr[1];
9831 struct ocb_setup setup = {};
9832 int err;
9833
9834 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
9835 if (err)
9836 return err;
9837
9838 return cfg80211_join_ocb(rdev, dev, &setup);
9839 }
9840
9841 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
9842 {
9843 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9844 struct net_device *dev = info->user_ptr[1];
9845
9846 return cfg80211_leave_ocb(rdev, dev);
9847 }
9848
9849 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
9850 {
9851 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9852 struct net_device *dev = info->user_ptr[1];
9853 struct mesh_config cfg;
9854 struct mesh_setup setup;
9855 int err;
9856
9857 /* start with default */
9858 memcpy(&cfg, &default_mesh_config, sizeof(cfg));
9859 memcpy(&setup, &default_mesh_setup, sizeof(setup));
9860
9861 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
9862 /* and parse parameters if given */
9863 err = nl80211_parse_mesh_config(info, &cfg, NULL);
9864 if (err)
9865 return err;
9866 }
9867
9868 if (!info->attrs[NL80211_ATTR_MESH_ID] ||
9869 !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
9870 return -EINVAL;
9871
9872 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
9873 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
9874
9875 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
9876 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
9877 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
9878 return -EINVAL;
9879
9880 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
9881 setup.beacon_interval =
9882 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
9883
9884 err = cfg80211_validate_beacon_int(rdev,
9885 NL80211_IFTYPE_MESH_POINT,
9886 setup.beacon_interval);
9887 if (err)
9888 return err;
9889 }
9890
9891 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
9892 setup.dtim_period =
9893 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
9894 if (setup.dtim_period < 1 || setup.dtim_period > 100)
9895 return -EINVAL;
9896 }
9897
9898 if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
9899 /* parse additional setup parameters if given */
9900 err = nl80211_parse_mesh_setup(info, &setup);
9901 if (err)
9902 return err;
9903 }
9904
9905 if (setup.user_mpm)
9906 cfg.auto_open_plinks = false;
9907
9908 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9909 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
9910 if (err)
9911 return err;
9912 } else {
9913 /* cfg80211_join_mesh() will sort it out */
9914 setup.chandef.chan = NULL;
9915 }
9916
9917 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
9918 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9919 int n_rates =
9920 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9921 struct ieee80211_supported_band *sband;
9922
9923 if (!setup.chandef.chan)
9924 return -EINVAL;
9925
9926 sband = rdev->wiphy.bands[setup.chandef.chan->band];
9927
9928 err = ieee80211_get_ratemask(sband, rates, n_rates,
9929 &setup.basic_rates);
9930 if (err)
9931 return err;
9932 }
9933
9934 if (info->attrs[NL80211_ATTR_TX_RATES]) {
9935 err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
9936 if (err)
9937 return err;
9938
9939 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
9940 &setup.beacon_rate);
9941 if (err)
9942 return err;
9943 }
9944
9945 return cfg80211_join_mesh(rdev, dev, &setup, &cfg);
9946 }
9947
9948 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
9949 {
9950 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9951 struct net_device *dev = info->user_ptr[1];
9952
9953 return cfg80211_leave_mesh(rdev, dev);
9954 }
9955
9956 #ifdef CONFIG_PM
9957 static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
9958 struct cfg80211_registered_device *rdev)
9959 {
9960 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
9961 struct nlattr *nl_pats, *nl_pat;
9962 int i, pat_len;
9963
9964 if (!wowlan->n_patterns)
9965 return 0;
9966
9967 nl_pats = nla_nest_start(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
9968 if (!nl_pats)
9969 return -ENOBUFS;
9970
9971 for (i = 0; i < wowlan->n_patterns; i++) {
9972 nl_pat = nla_nest_start(msg, i + 1);
9973 if (!nl_pat)
9974 return -ENOBUFS;
9975 pat_len = wowlan->patterns[i].pattern_len;
9976 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
9977 wowlan->patterns[i].mask) ||
9978 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
9979 wowlan->patterns[i].pattern) ||
9980 nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
9981 wowlan->patterns[i].pkt_offset))
9982 return -ENOBUFS;
9983 nla_nest_end(msg, nl_pat);
9984 }
9985 nla_nest_end(msg, nl_pats);
9986
9987 return 0;
9988 }
9989
9990 static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
9991 struct cfg80211_wowlan_tcp *tcp)
9992 {
9993 struct nlattr *nl_tcp;
9994
9995 if (!tcp)
9996 return 0;
9997
9998 nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
9999 if (!nl_tcp)
10000 return -ENOBUFS;
10001
10002 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
10003 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
10004 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
10005 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
10006 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
10007 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
10008 tcp->payload_len, tcp->payload) ||
10009 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
10010 tcp->data_interval) ||
10011 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
10012 tcp->wake_len, tcp->wake_data) ||
10013 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
10014 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
10015 return -ENOBUFS;
10016
10017 if (tcp->payload_seq.len &&
10018 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
10019 sizeof(tcp->payload_seq), &tcp->payload_seq))
10020 return -ENOBUFS;
10021
10022 if (tcp->payload_tok.len &&
10023 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
10024 sizeof(tcp->payload_tok) + tcp->tokens_size,
10025 &tcp->payload_tok))
10026 return -ENOBUFS;
10027
10028 nla_nest_end(msg, nl_tcp);
10029
10030 return 0;
10031 }
10032
10033 static int nl80211_send_wowlan_nd(struct sk_buff *msg,
10034 struct cfg80211_sched_scan_request *req)
10035 {
10036 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
10037 int i;
10038
10039 if (!req)
10040 return 0;
10041
10042 nd = nla_nest_start(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
10043 if (!nd)
10044 return -ENOBUFS;
10045
10046 if (req->n_scan_plans == 1 &&
10047 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
10048 req->scan_plans[0].interval * 1000))
10049 return -ENOBUFS;
10050
10051 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
10052 return -ENOBUFS;
10053
10054 if (req->relative_rssi_set) {
10055 struct nl80211_bss_select_rssi_adjust rssi_adjust;
10056
10057 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
10058 req->relative_rssi))
10059 return -ENOBUFS;
10060
10061 rssi_adjust.band = req->rssi_adjust.band;
10062 rssi_adjust.delta = req->rssi_adjust.delta;
10063 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
10064 sizeof(rssi_adjust), &rssi_adjust))
10065 return -ENOBUFS;
10066 }
10067
10068 freqs = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
10069 if (!freqs)
10070 return -ENOBUFS;
10071
10072 for (i = 0; i < req->n_channels; i++) {
10073 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
10074 return -ENOBUFS;
10075 }
10076
10077 nla_nest_end(msg, freqs);
10078
10079 if (req->n_match_sets) {
10080 matches = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_MATCH);
10081 if (!matches)
10082 return -ENOBUFS;
10083
10084 for (i = 0; i < req->n_match_sets; i++) {
10085 match = nla_nest_start(msg, i);
10086 if (!match)
10087 return -ENOBUFS;
10088
10089 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
10090 req->match_sets[i].ssid.ssid_len,
10091 req->match_sets[i].ssid.ssid))
10092 return -ENOBUFS;
10093 nla_nest_end(msg, match);
10094 }
10095 nla_nest_end(msg, matches);
10096 }
10097
10098 scan_plans = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
10099 if (!scan_plans)
10100 return -ENOBUFS;
10101
10102 for (i = 0; i < req->n_scan_plans; i++) {
10103 scan_plan = nla_nest_start(msg, i + 1);
10104 if (!scan_plan)
10105 return -ENOBUFS;
10106
10107 if (!scan_plan ||
10108 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
10109 req->scan_plans[i].interval) ||
10110 (req->scan_plans[i].iterations &&
10111 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
10112 req->scan_plans[i].iterations)))
10113 return -ENOBUFS;
10114 nla_nest_end(msg, scan_plan);
10115 }
10116 nla_nest_end(msg, scan_plans);
10117
10118 nla_nest_end(msg, nd);
10119
10120 return 0;
10121 }
10122
10123 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
10124 {
10125 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10126 struct sk_buff *msg;
10127 void *hdr;
10128 u32 size = NLMSG_DEFAULT_SIZE;
10129
10130 if (!rdev->wiphy.wowlan)
10131 return -EOPNOTSUPP;
10132
10133 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
10134 /* adjust size to have room for all the data */
10135 size += rdev->wiphy.wowlan_config->tcp->tokens_size +
10136 rdev->wiphy.wowlan_config->tcp->payload_len +
10137 rdev->wiphy.wowlan_config->tcp->wake_len +
10138 rdev->wiphy.wowlan_config->tcp->wake_len / 8;
10139 }
10140
10141 msg = nlmsg_new(size, GFP_KERNEL);
10142 if (!msg)
10143 return -ENOMEM;
10144
10145 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10146 NL80211_CMD_GET_WOWLAN);
10147 if (!hdr)
10148 goto nla_put_failure;
10149
10150 if (rdev->wiphy.wowlan_config) {
10151 struct nlattr *nl_wowlan;
10152
10153 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
10154 if (!nl_wowlan)
10155 goto nla_put_failure;
10156
10157 if ((rdev->wiphy.wowlan_config->any &&
10158 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
10159 (rdev->wiphy.wowlan_config->disconnect &&
10160 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
10161 (rdev->wiphy.wowlan_config->magic_pkt &&
10162 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
10163 (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
10164 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
10165 (rdev->wiphy.wowlan_config->eap_identity_req &&
10166 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
10167 (rdev->wiphy.wowlan_config->four_way_handshake &&
10168 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
10169 (rdev->wiphy.wowlan_config->rfkill_release &&
10170 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
10171 goto nla_put_failure;
10172
10173 if (nl80211_send_wowlan_patterns(msg, rdev))
10174 goto nla_put_failure;
10175
10176 if (nl80211_send_wowlan_tcp(msg,
10177 rdev->wiphy.wowlan_config->tcp))
10178 goto nla_put_failure;
10179
10180 if (nl80211_send_wowlan_nd(
10181 msg,
10182 rdev->wiphy.wowlan_config->nd_config))
10183 goto nla_put_failure;
10184
10185 nla_nest_end(msg, nl_wowlan);
10186 }
10187
10188 genlmsg_end(msg, hdr);
10189 return genlmsg_reply(msg, info);
10190
10191 nla_put_failure:
10192 nlmsg_free(msg);
10193 return -ENOBUFS;
10194 }
10195
10196 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
10197 struct nlattr *attr,
10198 struct cfg80211_wowlan *trig)
10199 {
10200 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
10201 struct cfg80211_wowlan_tcp *cfg;
10202 struct nl80211_wowlan_tcp_data_token *tok = NULL;
10203 struct nl80211_wowlan_tcp_data_seq *seq = NULL;
10204 u32 size;
10205 u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
10206 int err, port;
10207
10208 if (!rdev->wiphy.wowlan->tcp)
10209 return -EINVAL;
10210
10211 err = nla_parse_nested(tb, MAX_NL80211_WOWLAN_TCP, attr,
10212 nl80211_wowlan_tcp_policy, NULL);
10213 if (err)
10214 return err;
10215
10216 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
10217 !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
10218 !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
10219 !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
10220 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
10221 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
10222 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
10223 !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
10224 return -EINVAL;
10225
10226 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
10227 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
10228 return -EINVAL;
10229
10230 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
10231 rdev->wiphy.wowlan->tcp->data_interval_max ||
10232 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
10233 return -EINVAL;
10234
10235 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
10236 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
10237 return -EINVAL;
10238
10239 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
10240 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
10241 return -EINVAL;
10242
10243 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
10244 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
10245
10246 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
10247 tokens_size = tokln - sizeof(*tok);
10248
10249 if (!tok->len || tokens_size % tok->len)
10250 return -EINVAL;
10251 if (!rdev->wiphy.wowlan->tcp->tok)
10252 return -EINVAL;
10253 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
10254 return -EINVAL;
10255 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
10256 return -EINVAL;
10257 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
10258 return -EINVAL;
10259 if (tok->offset + tok->len > data_size)
10260 return -EINVAL;
10261 }
10262
10263 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
10264 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
10265 if (!rdev->wiphy.wowlan->tcp->seq)
10266 return -EINVAL;
10267 if (seq->len == 0 || seq->len > 4)
10268 return -EINVAL;
10269 if (seq->len + seq->offset > data_size)
10270 return -EINVAL;
10271 }
10272
10273 size = sizeof(*cfg);
10274 size += data_size;
10275 size += wake_size + wake_mask_size;
10276 size += tokens_size;
10277
10278 cfg = kzalloc(size, GFP_KERNEL);
10279 if (!cfg)
10280 return -ENOMEM;
10281 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
10282 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
10283 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
10284 ETH_ALEN);
10285 if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
10286 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
10287 else
10288 port = 0;
10289 #ifdef CONFIG_INET
10290 /* allocate a socket and port for it and use it */
10291 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
10292 IPPROTO_TCP, &cfg->sock, 1);
10293 if (err) {
10294 kfree(cfg);
10295 return err;
10296 }
10297 if (inet_csk_get_port(cfg->sock->sk, port)) {
10298 sock_release(cfg->sock);
10299 kfree(cfg);
10300 return -EADDRINUSE;
10301 }
10302 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
10303 #else
10304 if (!port) {
10305 kfree(cfg);
10306 return -EINVAL;
10307 }
10308 cfg->src_port = port;
10309 #endif
10310
10311 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
10312 cfg->payload_len = data_size;
10313 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
10314 memcpy((void *)cfg->payload,
10315 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
10316 data_size);
10317 if (seq)
10318 cfg->payload_seq = *seq;
10319 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
10320 cfg->wake_len = wake_size;
10321 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
10322 memcpy((void *)cfg->wake_data,
10323 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
10324 wake_size);
10325 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
10326 data_size + wake_size;
10327 memcpy((void *)cfg->wake_mask,
10328 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
10329 wake_mask_size);
10330 if (tok) {
10331 cfg->tokens_size = tokens_size;
10332 memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
10333 }
10334
10335 trig->tcp = cfg;
10336
10337 return 0;
10338 }
10339
10340 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
10341 const struct wiphy_wowlan_support *wowlan,
10342 struct nlattr *attr,
10343 struct cfg80211_wowlan *trig)
10344 {
10345 struct nlattr **tb;
10346 int err;
10347
10348 tb = kzalloc(NUM_NL80211_ATTR * sizeof(*tb), GFP_KERNEL);
10349 if (!tb)
10350 return -ENOMEM;
10351
10352 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
10353 err = -EOPNOTSUPP;
10354 goto out;
10355 }
10356
10357 err = nla_parse_nested(tb, NL80211_ATTR_MAX, attr, nl80211_policy,
10358 NULL);
10359 if (err)
10360 goto out;
10361
10362 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
10363 wowlan->max_nd_match_sets);
10364 err = PTR_ERR_OR_ZERO(trig->nd_config);
10365 if (err)
10366 trig->nd_config = NULL;
10367
10368 out:
10369 kfree(tb);
10370 return err;
10371 }
10372
10373 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
10374 {
10375 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10376 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
10377 struct cfg80211_wowlan new_triggers = {};
10378 struct cfg80211_wowlan *ntrig;
10379 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
10380 int err, i;
10381 bool prev_enabled = rdev->wiphy.wowlan_config;
10382 bool regular = false;
10383
10384 if (!wowlan)
10385 return -EOPNOTSUPP;
10386
10387 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
10388 cfg80211_rdev_free_wowlan(rdev);
10389 rdev->wiphy.wowlan_config = NULL;
10390 goto set_wakeup;
10391 }
10392
10393 err = nla_parse_nested(tb, MAX_NL80211_WOWLAN_TRIG,
10394 info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
10395 nl80211_wowlan_policy, info->extack);
10396 if (err)
10397 return err;
10398
10399 if (tb[NL80211_WOWLAN_TRIG_ANY]) {
10400 if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
10401 return -EINVAL;
10402 new_triggers.any = true;
10403 }
10404
10405 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
10406 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
10407 return -EINVAL;
10408 new_triggers.disconnect = true;
10409 regular = true;
10410 }
10411
10412 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
10413 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
10414 return -EINVAL;
10415 new_triggers.magic_pkt = true;
10416 regular = true;
10417 }
10418
10419 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
10420 return -EINVAL;
10421
10422 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
10423 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
10424 return -EINVAL;
10425 new_triggers.gtk_rekey_failure = true;
10426 regular = true;
10427 }
10428
10429 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
10430 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
10431 return -EINVAL;
10432 new_triggers.eap_identity_req = true;
10433 regular = true;
10434 }
10435
10436 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
10437 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
10438 return -EINVAL;
10439 new_triggers.four_way_handshake = true;
10440 regular = true;
10441 }
10442
10443 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
10444 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
10445 return -EINVAL;
10446 new_triggers.rfkill_release = true;
10447 regular = true;
10448 }
10449
10450 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
10451 struct nlattr *pat;
10452 int n_patterns = 0;
10453 int rem, pat_len, mask_len, pkt_offset;
10454 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
10455
10456 regular = true;
10457
10458 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
10459 rem)
10460 n_patterns++;
10461 if (n_patterns > wowlan->n_patterns)
10462 return -EINVAL;
10463
10464 new_triggers.patterns = kcalloc(n_patterns,
10465 sizeof(new_triggers.patterns[0]),
10466 GFP_KERNEL);
10467 if (!new_triggers.patterns)
10468 return -ENOMEM;
10469
10470 new_triggers.n_patterns = n_patterns;
10471 i = 0;
10472
10473 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
10474 rem) {
10475 u8 *mask_pat;
10476
10477 nla_parse_nested(pat_tb, MAX_NL80211_PKTPAT, pat,
10478 NULL, info->extack);
10479 err = -EINVAL;
10480 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10481 !pat_tb[NL80211_PKTPAT_PATTERN])
10482 goto error;
10483 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
10484 mask_len = DIV_ROUND_UP(pat_len, 8);
10485 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
10486 goto error;
10487 if (pat_len > wowlan->pattern_max_len ||
10488 pat_len < wowlan->pattern_min_len)
10489 goto error;
10490
10491 if (!pat_tb[NL80211_PKTPAT_OFFSET])
10492 pkt_offset = 0;
10493 else
10494 pkt_offset = nla_get_u32(
10495 pat_tb[NL80211_PKTPAT_OFFSET]);
10496 if (pkt_offset > wowlan->max_pkt_offset)
10497 goto error;
10498 new_triggers.patterns[i].pkt_offset = pkt_offset;
10499
10500 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10501 if (!mask_pat) {
10502 err = -ENOMEM;
10503 goto error;
10504 }
10505 new_triggers.patterns[i].mask = mask_pat;
10506 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
10507 mask_len);
10508 mask_pat += mask_len;
10509 new_triggers.patterns[i].pattern = mask_pat;
10510 new_triggers.patterns[i].pattern_len = pat_len;
10511 memcpy(mask_pat,
10512 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
10513 pat_len);
10514 i++;
10515 }
10516 }
10517
10518 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
10519 regular = true;
10520 err = nl80211_parse_wowlan_tcp(
10521 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
10522 &new_triggers);
10523 if (err)
10524 goto error;
10525 }
10526
10527 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
10528 regular = true;
10529 err = nl80211_parse_wowlan_nd(
10530 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
10531 &new_triggers);
10532 if (err)
10533 goto error;
10534 }
10535
10536 /* The 'any' trigger means the device continues operating more or less
10537 * as in its normal operation mode and wakes up the host on most of the
10538 * normal interrupts (like packet RX, ...)
10539 * It therefore makes little sense to combine with the more constrained
10540 * wakeup trigger modes.
10541 */
10542 if (new_triggers.any && regular) {
10543 err = -EINVAL;
10544 goto error;
10545 }
10546
10547 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
10548 if (!ntrig) {
10549 err = -ENOMEM;
10550 goto error;
10551 }
10552 cfg80211_rdev_free_wowlan(rdev);
10553 rdev->wiphy.wowlan_config = ntrig;
10554
10555 set_wakeup:
10556 if (rdev->ops->set_wakeup &&
10557 prev_enabled != !!rdev->wiphy.wowlan_config)
10558 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
10559
10560 return 0;
10561 error:
10562 for (i = 0; i < new_triggers.n_patterns; i++)
10563 kfree(new_triggers.patterns[i].mask);
10564 kfree(new_triggers.patterns);
10565 if (new_triggers.tcp && new_triggers.tcp->sock)
10566 sock_release(new_triggers.tcp->sock);
10567 kfree(new_triggers.tcp);
10568 kfree(new_triggers.nd_config);
10569 return err;
10570 }
10571 #endif
10572
10573 static int nl80211_send_coalesce_rules(struct sk_buff *msg,
10574 struct cfg80211_registered_device *rdev)
10575 {
10576 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
10577 int i, j, pat_len;
10578 struct cfg80211_coalesce_rules *rule;
10579
10580 if (!rdev->coalesce->n_rules)
10581 return 0;
10582
10583 nl_rules = nla_nest_start(msg, NL80211_ATTR_COALESCE_RULE);
10584 if (!nl_rules)
10585 return -ENOBUFS;
10586
10587 for (i = 0; i < rdev->coalesce->n_rules; i++) {
10588 nl_rule = nla_nest_start(msg, i + 1);
10589 if (!nl_rule)
10590 return -ENOBUFS;
10591
10592 rule = &rdev->coalesce->rules[i];
10593 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
10594 rule->delay))
10595 return -ENOBUFS;
10596
10597 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
10598 rule->condition))
10599 return -ENOBUFS;
10600
10601 nl_pats = nla_nest_start(msg,
10602 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
10603 if (!nl_pats)
10604 return -ENOBUFS;
10605
10606 for (j = 0; j < rule->n_patterns; j++) {
10607 nl_pat = nla_nest_start(msg, j + 1);
10608 if (!nl_pat)
10609 return -ENOBUFS;
10610 pat_len = rule->patterns[j].pattern_len;
10611 if (nla_put(msg, NL80211_PKTPAT_MASK,
10612 DIV_ROUND_UP(pat_len, 8),
10613 rule->patterns[j].mask) ||
10614 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
10615 rule->patterns[j].pattern) ||
10616 nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
10617 rule->patterns[j].pkt_offset))
10618 return -ENOBUFS;
10619 nla_nest_end(msg, nl_pat);
10620 }
10621 nla_nest_end(msg, nl_pats);
10622 nla_nest_end(msg, nl_rule);
10623 }
10624 nla_nest_end(msg, nl_rules);
10625
10626 return 0;
10627 }
10628
10629 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
10630 {
10631 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10632 struct sk_buff *msg;
10633 void *hdr;
10634
10635 if (!rdev->wiphy.coalesce)
10636 return -EOPNOTSUPP;
10637
10638 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10639 if (!msg)
10640 return -ENOMEM;
10641
10642 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10643 NL80211_CMD_GET_COALESCE);
10644 if (!hdr)
10645 goto nla_put_failure;
10646
10647 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
10648 goto nla_put_failure;
10649
10650 genlmsg_end(msg, hdr);
10651 return genlmsg_reply(msg, info);
10652
10653 nla_put_failure:
10654 nlmsg_free(msg);
10655 return -ENOBUFS;
10656 }
10657
10658 void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
10659 {
10660 struct cfg80211_coalesce *coalesce = rdev->coalesce;
10661 int i, j;
10662 struct cfg80211_coalesce_rules *rule;
10663
10664 if (!coalesce)
10665 return;
10666
10667 for (i = 0; i < coalesce->n_rules; i++) {
10668 rule = &coalesce->rules[i];
10669 for (j = 0; j < rule->n_patterns; j++)
10670 kfree(rule->patterns[j].mask);
10671 kfree(rule->patterns);
10672 }
10673 kfree(coalesce->rules);
10674 kfree(coalesce);
10675 rdev->coalesce = NULL;
10676 }
10677
10678 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
10679 struct nlattr *rule,
10680 struct cfg80211_coalesce_rules *new_rule)
10681 {
10682 int err, i;
10683 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10684 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
10685 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
10686 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
10687
10688 err = nla_parse_nested(tb, NL80211_ATTR_COALESCE_RULE_MAX, rule,
10689 nl80211_coalesce_policy, NULL);
10690 if (err)
10691 return err;
10692
10693 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
10694 new_rule->delay =
10695 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
10696 if (new_rule->delay > coalesce->max_delay)
10697 return -EINVAL;
10698
10699 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
10700 new_rule->condition =
10701 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
10702 if (new_rule->condition != NL80211_COALESCE_CONDITION_MATCH &&
10703 new_rule->condition != NL80211_COALESCE_CONDITION_NO_MATCH)
10704 return -EINVAL;
10705
10706 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
10707 return -EINVAL;
10708
10709 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10710 rem)
10711 n_patterns++;
10712 if (n_patterns > coalesce->n_patterns)
10713 return -EINVAL;
10714
10715 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
10716 GFP_KERNEL);
10717 if (!new_rule->patterns)
10718 return -ENOMEM;
10719
10720 new_rule->n_patterns = n_patterns;
10721 i = 0;
10722
10723 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10724 rem) {
10725 u8 *mask_pat;
10726
10727 nla_parse_nested(pat_tb, MAX_NL80211_PKTPAT, pat, NULL, NULL);
10728 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10729 !pat_tb[NL80211_PKTPAT_PATTERN])
10730 return -EINVAL;
10731 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
10732 mask_len = DIV_ROUND_UP(pat_len, 8);
10733 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
10734 return -EINVAL;
10735 if (pat_len > coalesce->pattern_max_len ||
10736 pat_len < coalesce->pattern_min_len)
10737 return -EINVAL;
10738
10739 if (!pat_tb[NL80211_PKTPAT_OFFSET])
10740 pkt_offset = 0;
10741 else
10742 pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
10743 if (pkt_offset > coalesce->max_pkt_offset)
10744 return -EINVAL;
10745 new_rule->patterns[i].pkt_offset = pkt_offset;
10746
10747 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10748 if (!mask_pat)
10749 return -ENOMEM;
10750
10751 new_rule->patterns[i].mask = mask_pat;
10752 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
10753 mask_len);
10754
10755 mask_pat += mask_len;
10756 new_rule->patterns[i].pattern = mask_pat;
10757 new_rule->patterns[i].pattern_len = pat_len;
10758 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
10759 pat_len);
10760 i++;
10761 }
10762
10763 return 0;
10764 }
10765
10766 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
10767 {
10768 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10769 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10770 struct cfg80211_coalesce new_coalesce = {};
10771 struct cfg80211_coalesce *n_coalesce;
10772 int err, rem_rule, n_rules = 0, i, j;
10773 struct nlattr *rule;
10774 struct cfg80211_coalesce_rules *tmp_rule;
10775
10776 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
10777 return -EOPNOTSUPP;
10778
10779 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
10780 cfg80211_rdev_free_coalesce(rdev);
10781 rdev_set_coalesce(rdev, NULL);
10782 return 0;
10783 }
10784
10785 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10786 rem_rule)
10787 n_rules++;
10788 if (n_rules > coalesce->n_rules)
10789 return -EINVAL;
10790
10791 new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
10792 GFP_KERNEL);
10793 if (!new_coalesce.rules)
10794 return -ENOMEM;
10795
10796 new_coalesce.n_rules = n_rules;
10797 i = 0;
10798
10799 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10800 rem_rule) {
10801 err = nl80211_parse_coalesce_rule(rdev, rule,
10802 &new_coalesce.rules[i]);
10803 if (err)
10804 goto error;
10805
10806 i++;
10807 }
10808
10809 err = rdev_set_coalesce(rdev, &new_coalesce);
10810 if (err)
10811 goto error;
10812
10813 n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
10814 if (!n_coalesce) {
10815 err = -ENOMEM;
10816 goto error;
10817 }
10818 cfg80211_rdev_free_coalesce(rdev);
10819 rdev->coalesce = n_coalesce;
10820
10821 return 0;
10822 error:
10823 for (i = 0; i < new_coalesce.n_rules; i++) {
10824 tmp_rule = &new_coalesce.rules[i];
10825 for (j = 0; j < tmp_rule->n_patterns; j++)
10826 kfree(tmp_rule->patterns[j].mask);
10827 kfree(tmp_rule->patterns);
10828 }
10829 kfree(new_coalesce.rules);
10830
10831 return err;
10832 }
10833
10834 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
10835 {
10836 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10837 struct net_device *dev = info->user_ptr[1];
10838 struct wireless_dev *wdev = dev->ieee80211_ptr;
10839 struct nlattr *tb[NUM_NL80211_REKEY_DATA];
10840 struct cfg80211_gtk_rekey_data rekey_data;
10841 int err;
10842
10843 if (!info->attrs[NL80211_ATTR_REKEY_DATA])
10844 return -EINVAL;
10845
10846 err = nla_parse_nested(tb, MAX_NL80211_REKEY_DATA,
10847 info->attrs[NL80211_ATTR_REKEY_DATA],
10848 nl80211_rekey_policy, info->extack);
10849 if (err)
10850 return err;
10851
10852 if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
10853 return -ERANGE;
10854 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
10855 return -ERANGE;
10856 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
10857 return -ERANGE;
10858
10859 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
10860 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
10861 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
10862
10863 wdev_lock(wdev);
10864 if (!wdev->current_bss) {
10865 err = -ENOTCONN;
10866 goto out;
10867 }
10868
10869 if (!rdev->ops->set_rekey_data) {
10870 err = -EOPNOTSUPP;
10871 goto out;
10872 }
10873
10874 err = rdev_set_rekey_data(rdev, dev, &rekey_data);
10875 out:
10876 wdev_unlock(wdev);
10877 return err;
10878 }
10879
10880 static int nl80211_register_unexpected_frame(struct sk_buff *skb,
10881 struct genl_info *info)
10882 {
10883 struct net_device *dev = info->user_ptr[1];
10884 struct wireless_dev *wdev = dev->ieee80211_ptr;
10885
10886 if (wdev->iftype != NL80211_IFTYPE_AP &&
10887 wdev->iftype != NL80211_IFTYPE_P2P_GO)
10888 return -EINVAL;
10889
10890 if (wdev->ap_unexpected_nlportid)
10891 return -EBUSY;
10892
10893 wdev->ap_unexpected_nlportid = info->snd_portid;
10894 return 0;
10895 }
10896
10897 static int nl80211_probe_client(struct sk_buff *skb,
10898 struct genl_info *info)
10899 {
10900 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10901 struct net_device *dev = info->user_ptr[1];
10902 struct wireless_dev *wdev = dev->ieee80211_ptr;
10903 struct sk_buff *msg;
10904 void *hdr;
10905 const u8 *addr;
10906 u64 cookie;
10907 int err;
10908
10909 if (wdev->iftype != NL80211_IFTYPE_AP &&
10910 wdev->iftype != NL80211_IFTYPE_P2P_GO)
10911 return -EOPNOTSUPP;
10912
10913 if (!info->attrs[NL80211_ATTR_MAC])
10914 return -EINVAL;
10915
10916 if (!rdev->ops->probe_client)
10917 return -EOPNOTSUPP;
10918
10919 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10920 if (!msg)
10921 return -ENOMEM;
10922
10923 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10924 NL80211_CMD_PROBE_CLIENT);
10925 if (!hdr) {
10926 err = -ENOBUFS;
10927 goto free_msg;
10928 }
10929
10930 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
10931
10932 err = rdev_probe_client(rdev, dev, addr, &cookie);
10933 if (err)
10934 goto free_msg;
10935
10936 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
10937 NL80211_ATTR_PAD))
10938 goto nla_put_failure;
10939
10940 genlmsg_end(msg, hdr);
10941
10942 return genlmsg_reply(msg, info);
10943
10944 nla_put_failure:
10945 err = -ENOBUFS;
10946 free_msg:
10947 nlmsg_free(msg);
10948 return err;
10949 }
10950
10951 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
10952 {
10953 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10954 struct cfg80211_beacon_registration *reg, *nreg;
10955 int rv;
10956
10957 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
10958 return -EOPNOTSUPP;
10959
10960 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
10961 if (!nreg)
10962 return -ENOMEM;
10963
10964 /* First, check if already registered. */
10965 spin_lock_bh(&rdev->beacon_registrations_lock);
10966 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
10967 if (reg->nlportid == info->snd_portid) {
10968 rv = -EALREADY;
10969 goto out_err;
10970 }
10971 }
10972 /* Add it to the list */
10973 nreg->nlportid = info->snd_portid;
10974 list_add(&nreg->list, &rdev->beacon_registrations);
10975
10976 spin_unlock_bh(&rdev->beacon_registrations_lock);
10977
10978 return 0;
10979 out_err:
10980 spin_unlock_bh(&rdev->beacon_registrations_lock);
10981 kfree(nreg);
10982 return rv;
10983 }
10984
10985 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
10986 {
10987 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10988 struct wireless_dev *wdev = info->user_ptr[1];
10989 int err;
10990
10991 if (!rdev->ops->start_p2p_device)
10992 return -EOPNOTSUPP;
10993
10994 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
10995 return -EOPNOTSUPP;
10996
10997 if (wdev_running(wdev))
10998 return 0;
10999
11000 if (rfkill_blocked(rdev->rfkill))
11001 return -ERFKILL;
11002
11003 err = rdev_start_p2p_device(rdev, wdev);
11004 if (err)
11005 return err;
11006
11007 wdev->is_running = true;
11008 rdev->opencount++;
11009
11010 return 0;
11011 }
11012
11013 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
11014 {
11015 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11016 struct wireless_dev *wdev = info->user_ptr[1];
11017
11018 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
11019 return -EOPNOTSUPP;
11020
11021 if (!rdev->ops->stop_p2p_device)
11022 return -EOPNOTSUPP;
11023
11024 cfg80211_stop_p2p_device(rdev, wdev);
11025
11026 return 0;
11027 }
11028
11029 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
11030 {
11031 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11032 struct wireless_dev *wdev = info->user_ptr[1];
11033 struct cfg80211_nan_conf conf = {};
11034 int err;
11035
11036 if (wdev->iftype != NL80211_IFTYPE_NAN)
11037 return -EOPNOTSUPP;
11038
11039 if (wdev_running(wdev))
11040 return -EEXIST;
11041
11042 if (rfkill_blocked(rdev->rfkill))
11043 return -ERFKILL;
11044
11045 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
11046 return -EINVAL;
11047
11048 conf.master_pref =
11049 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
11050 if (!conf.master_pref)
11051 return -EINVAL;
11052
11053 if (info->attrs[NL80211_ATTR_BANDS]) {
11054 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
11055
11056 if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
11057 return -EOPNOTSUPP;
11058
11059 if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
11060 return -EINVAL;
11061
11062 conf.bands = bands;
11063 }
11064
11065 err = rdev_start_nan(rdev, wdev, &conf);
11066 if (err)
11067 return err;
11068
11069 wdev->is_running = true;
11070 rdev->opencount++;
11071
11072 return 0;
11073 }
11074
11075 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
11076 {
11077 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11078 struct wireless_dev *wdev = info->user_ptr[1];
11079
11080 if (wdev->iftype != NL80211_IFTYPE_NAN)
11081 return -EOPNOTSUPP;
11082
11083 cfg80211_stop_nan(rdev, wdev);
11084
11085 return 0;
11086 }
11087
11088 static int validate_nan_filter(struct nlattr *filter_attr)
11089 {
11090 struct nlattr *attr;
11091 int len = 0, n_entries = 0, rem;
11092
11093 nla_for_each_nested(attr, filter_attr, rem) {
11094 len += nla_len(attr);
11095 n_entries++;
11096 }
11097
11098 if (len >= U8_MAX)
11099 return -EINVAL;
11100
11101 return n_entries;
11102 }
11103
11104 static int handle_nan_filter(struct nlattr *attr_filter,
11105 struct cfg80211_nan_func *func,
11106 bool tx)
11107 {
11108 struct nlattr *attr;
11109 int n_entries, rem, i;
11110 struct cfg80211_nan_func_filter *filter;
11111
11112 n_entries = validate_nan_filter(attr_filter);
11113 if (n_entries < 0)
11114 return n_entries;
11115
11116 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
11117
11118 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
11119 if (!filter)
11120 return -ENOMEM;
11121
11122 i = 0;
11123 nla_for_each_nested(attr, attr_filter, rem) {
11124 filter[i].filter = nla_memdup(attr, GFP_KERNEL);
11125 filter[i].len = nla_len(attr);
11126 i++;
11127 }
11128 if (tx) {
11129 func->num_tx_filters = n_entries;
11130 func->tx_filters = filter;
11131 } else {
11132 func->num_rx_filters = n_entries;
11133 func->rx_filters = filter;
11134 }
11135
11136 return 0;
11137 }
11138
11139 static int nl80211_nan_add_func(struct sk_buff *skb,
11140 struct genl_info *info)
11141 {
11142 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11143 struct wireless_dev *wdev = info->user_ptr[1];
11144 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
11145 struct cfg80211_nan_func *func;
11146 struct sk_buff *msg = NULL;
11147 void *hdr = NULL;
11148 int err = 0;
11149
11150 if (wdev->iftype != NL80211_IFTYPE_NAN)
11151 return -EOPNOTSUPP;
11152
11153 if (!wdev_running(wdev))
11154 return -ENOTCONN;
11155
11156 if (!info->attrs[NL80211_ATTR_NAN_FUNC])
11157 return -EINVAL;
11158
11159 if (wdev->owner_nlportid &&
11160 wdev->owner_nlportid != info->snd_portid)
11161 return -ENOTCONN;
11162
11163 err = nla_parse_nested(tb, NL80211_NAN_FUNC_ATTR_MAX,
11164 info->attrs[NL80211_ATTR_NAN_FUNC],
11165 nl80211_nan_func_policy, info->extack);
11166 if (err)
11167 return err;
11168
11169 func = kzalloc(sizeof(*func), GFP_KERNEL);
11170 if (!func)
11171 return -ENOMEM;
11172
11173 func->cookie = wdev->wiphy->cookie_counter++;
11174
11175 if (!tb[NL80211_NAN_FUNC_TYPE] ||
11176 nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
11177 err = -EINVAL;
11178 goto out;
11179 }
11180
11181
11182 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
11183
11184 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
11185 err = -EINVAL;
11186 goto out;
11187 }
11188
11189 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
11190 sizeof(func->service_id));
11191
11192 func->close_range =
11193 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
11194
11195 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
11196 func->serv_spec_info_len =
11197 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
11198 func->serv_spec_info =
11199 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
11200 func->serv_spec_info_len,
11201 GFP_KERNEL);
11202 if (!func->serv_spec_info) {
11203 err = -ENOMEM;
11204 goto out;
11205 }
11206 }
11207
11208 if (tb[NL80211_NAN_FUNC_TTL])
11209 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
11210
11211 switch (func->type) {
11212 case NL80211_NAN_FUNC_PUBLISH:
11213 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
11214 err = -EINVAL;
11215 goto out;
11216 }
11217
11218 func->publish_type =
11219 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
11220 func->publish_bcast =
11221 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
11222
11223 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
11224 func->publish_bcast) {
11225 err = -EINVAL;
11226 goto out;
11227 }
11228 break;
11229 case NL80211_NAN_FUNC_SUBSCRIBE:
11230 func->subscribe_active =
11231 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
11232 break;
11233 case NL80211_NAN_FUNC_FOLLOW_UP:
11234 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
11235 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]) {
11236 err = -EINVAL;
11237 goto out;
11238 }
11239
11240 func->followup_id =
11241 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
11242 func->followup_reqid =
11243 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
11244 memcpy(func->followup_dest.addr,
11245 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
11246 sizeof(func->followup_dest.addr));
11247 if (func->ttl) {
11248 err = -EINVAL;
11249 goto out;
11250 }
11251 break;
11252 default:
11253 err = -EINVAL;
11254 goto out;
11255 }
11256
11257 if (tb[NL80211_NAN_FUNC_SRF]) {
11258 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
11259
11260 err = nla_parse_nested(srf_tb, NL80211_NAN_SRF_ATTR_MAX,
11261 tb[NL80211_NAN_FUNC_SRF],
11262 nl80211_nan_srf_policy, info->extack);
11263 if (err)
11264 goto out;
11265
11266 func->srf_include =
11267 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
11268
11269 if (srf_tb[NL80211_NAN_SRF_BF]) {
11270 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
11271 !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
11272 err = -EINVAL;
11273 goto out;
11274 }
11275
11276 func->srf_bf_len =
11277 nla_len(srf_tb[NL80211_NAN_SRF_BF]);
11278 func->srf_bf =
11279 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
11280 func->srf_bf_len, GFP_KERNEL);
11281 if (!func->srf_bf) {
11282 err = -ENOMEM;
11283 goto out;
11284 }
11285
11286 func->srf_bf_idx =
11287 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
11288 } else {
11289 struct nlattr *attr, *mac_attr =
11290 srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
11291 int n_entries, rem, i = 0;
11292
11293 if (!mac_attr) {
11294 err = -EINVAL;
11295 goto out;
11296 }
11297
11298 n_entries = validate_acl_mac_addrs(mac_attr);
11299 if (n_entries <= 0) {
11300 err = -EINVAL;
11301 goto out;
11302 }
11303
11304 func->srf_num_macs = n_entries;
11305 func->srf_macs =
11306 kzalloc(sizeof(*func->srf_macs) * n_entries,
11307 GFP_KERNEL);
11308 if (!func->srf_macs) {
11309 err = -ENOMEM;
11310 goto out;
11311 }
11312
11313 nla_for_each_nested(attr, mac_attr, rem)
11314 memcpy(func->srf_macs[i++].addr, nla_data(attr),
11315 sizeof(*func->srf_macs));
11316 }
11317 }
11318
11319 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
11320 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
11321 func, true);
11322 if (err)
11323 goto out;
11324 }
11325
11326 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
11327 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
11328 func, false);
11329 if (err)
11330 goto out;
11331 }
11332
11333 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11334 if (!msg) {
11335 err = -ENOMEM;
11336 goto out;
11337 }
11338
11339 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11340 NL80211_CMD_ADD_NAN_FUNCTION);
11341 /* This can't really happen - we just allocated 4KB */
11342 if (WARN_ON(!hdr)) {
11343 err = -ENOMEM;
11344 goto out;
11345 }
11346
11347 err = rdev_add_nan_func(rdev, wdev, func);
11348 out:
11349 if (err < 0) {
11350 cfg80211_free_nan_func(func);
11351 nlmsg_free(msg);
11352 return err;
11353 }
11354
11355 /* propagate the instance id and cookie to userspace */
11356 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
11357 NL80211_ATTR_PAD))
11358 goto nla_put_failure;
11359
11360 func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
11361 if (!func_attr)
11362 goto nla_put_failure;
11363
11364 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
11365 func->instance_id))
11366 goto nla_put_failure;
11367
11368 nla_nest_end(msg, func_attr);
11369
11370 genlmsg_end(msg, hdr);
11371 return genlmsg_reply(msg, info);
11372
11373 nla_put_failure:
11374 nlmsg_free(msg);
11375 return -ENOBUFS;
11376 }
11377
11378 static int nl80211_nan_del_func(struct sk_buff *skb,
11379 struct genl_info *info)
11380 {
11381 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11382 struct wireless_dev *wdev = info->user_ptr[1];
11383 u64 cookie;
11384
11385 if (wdev->iftype != NL80211_IFTYPE_NAN)
11386 return -EOPNOTSUPP;
11387
11388 if (!wdev_running(wdev))
11389 return -ENOTCONN;
11390
11391 if (!info->attrs[NL80211_ATTR_COOKIE])
11392 return -EINVAL;
11393
11394 if (wdev->owner_nlportid &&
11395 wdev->owner_nlportid != info->snd_portid)
11396 return -ENOTCONN;
11397
11398 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
11399
11400 rdev_del_nan_func(rdev, wdev, cookie);
11401
11402 return 0;
11403 }
11404
11405 static int nl80211_nan_change_config(struct sk_buff *skb,
11406 struct genl_info *info)
11407 {
11408 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11409 struct wireless_dev *wdev = info->user_ptr[1];
11410 struct cfg80211_nan_conf conf = {};
11411 u32 changed = 0;
11412
11413 if (wdev->iftype != NL80211_IFTYPE_NAN)
11414 return -EOPNOTSUPP;
11415
11416 if (!wdev_running(wdev))
11417 return -ENOTCONN;
11418
11419 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
11420 conf.master_pref =
11421 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
11422 if (conf.master_pref <= 1 || conf.master_pref == 255)
11423 return -EINVAL;
11424
11425 changed |= CFG80211_NAN_CONF_CHANGED_PREF;
11426 }
11427
11428 if (info->attrs[NL80211_ATTR_BANDS]) {
11429 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
11430
11431 if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
11432 return -EOPNOTSUPP;
11433
11434 if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
11435 return -EINVAL;
11436
11437 conf.bands = bands;
11438 changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
11439 }
11440
11441 if (!changed)
11442 return -EINVAL;
11443
11444 return rdev_nan_change_conf(rdev, wdev, &conf, changed);
11445 }
11446
11447 void cfg80211_nan_match(struct wireless_dev *wdev,
11448 struct cfg80211_nan_match_params *match, gfp_t gfp)
11449 {
11450 struct wiphy *wiphy = wdev->wiphy;
11451 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11452 struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
11453 struct sk_buff *msg;
11454 void *hdr;
11455
11456 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
11457 return;
11458
11459 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
11460 if (!msg)
11461 return;
11462
11463 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
11464 if (!hdr) {
11465 nlmsg_free(msg);
11466 return;
11467 }
11468
11469 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11470 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
11471 wdev->netdev->ifindex)) ||
11472 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
11473 NL80211_ATTR_PAD))
11474 goto nla_put_failure;
11475
11476 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
11477 NL80211_ATTR_PAD) ||
11478 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
11479 goto nla_put_failure;
11480
11481 match_attr = nla_nest_start(msg, NL80211_ATTR_NAN_MATCH);
11482 if (!match_attr)
11483 goto nla_put_failure;
11484
11485 local_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_LOCAL);
11486 if (!local_func_attr)
11487 goto nla_put_failure;
11488
11489 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
11490 goto nla_put_failure;
11491
11492 nla_nest_end(msg, local_func_attr);
11493
11494 peer_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_PEER);
11495 if (!peer_func_attr)
11496 goto nla_put_failure;
11497
11498 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
11499 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
11500 goto nla_put_failure;
11501
11502 if (match->info && match->info_len &&
11503 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
11504 match->info))
11505 goto nla_put_failure;
11506
11507 nla_nest_end(msg, peer_func_attr);
11508 nla_nest_end(msg, match_attr);
11509 genlmsg_end(msg, hdr);
11510
11511 if (!wdev->owner_nlportid)
11512 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11513 msg, 0, NL80211_MCGRP_NAN, gfp);
11514 else
11515 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11516 wdev->owner_nlportid);
11517
11518 return;
11519
11520 nla_put_failure:
11521 nlmsg_free(msg);
11522 }
11523 EXPORT_SYMBOL(cfg80211_nan_match);
11524
11525 void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
11526 u8 inst_id,
11527 enum nl80211_nan_func_term_reason reason,
11528 u64 cookie, gfp_t gfp)
11529 {
11530 struct wiphy *wiphy = wdev->wiphy;
11531 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11532 struct sk_buff *msg;
11533 struct nlattr *func_attr;
11534 void *hdr;
11535
11536 if (WARN_ON(!inst_id))
11537 return;
11538
11539 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
11540 if (!msg)
11541 return;
11542
11543 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
11544 if (!hdr) {
11545 nlmsg_free(msg);
11546 return;
11547 }
11548
11549 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11550 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
11551 wdev->netdev->ifindex)) ||
11552 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
11553 NL80211_ATTR_PAD))
11554 goto nla_put_failure;
11555
11556 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
11557 NL80211_ATTR_PAD))
11558 goto nla_put_failure;
11559
11560 func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
11561 if (!func_attr)
11562 goto nla_put_failure;
11563
11564 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
11565 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
11566 goto nla_put_failure;
11567
11568 nla_nest_end(msg, func_attr);
11569 genlmsg_end(msg, hdr);
11570
11571 if (!wdev->owner_nlportid)
11572 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11573 msg, 0, NL80211_MCGRP_NAN, gfp);
11574 else
11575 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11576 wdev->owner_nlportid);
11577
11578 return;
11579
11580 nla_put_failure:
11581 nlmsg_free(msg);
11582 }
11583 EXPORT_SYMBOL(cfg80211_nan_func_terminated);
11584
11585 static int nl80211_get_protocol_features(struct sk_buff *skb,
11586 struct genl_info *info)
11587 {
11588 void *hdr;
11589 struct sk_buff *msg;
11590
11591 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11592 if (!msg)
11593 return -ENOMEM;
11594
11595 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11596 NL80211_CMD_GET_PROTOCOL_FEATURES);
11597 if (!hdr)
11598 goto nla_put_failure;
11599
11600 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
11601 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
11602 goto nla_put_failure;
11603
11604 genlmsg_end(msg, hdr);
11605 return genlmsg_reply(msg, info);
11606
11607 nla_put_failure:
11608 kfree_skb(msg);
11609 return -ENOBUFS;
11610 }
11611
11612 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
11613 {
11614 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11615 struct cfg80211_update_ft_ies_params ft_params;
11616 struct net_device *dev = info->user_ptr[1];
11617
11618 if (!rdev->ops->update_ft_ies)
11619 return -EOPNOTSUPP;
11620
11621 if (!info->attrs[NL80211_ATTR_MDID] ||
11622 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
11623 return -EINVAL;
11624
11625 memset(&ft_params, 0, sizeof(ft_params));
11626 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
11627 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
11628 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
11629
11630 return rdev_update_ft_ies(rdev, dev, &ft_params);
11631 }
11632
11633 static int nl80211_crit_protocol_start(struct sk_buff *skb,
11634 struct genl_info *info)
11635 {
11636 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11637 struct wireless_dev *wdev = info->user_ptr[1];
11638 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
11639 u16 duration;
11640 int ret;
11641
11642 if (!rdev->ops->crit_proto_start)
11643 return -EOPNOTSUPP;
11644
11645 if (WARN_ON(!rdev->ops->crit_proto_stop))
11646 return -EINVAL;
11647
11648 if (rdev->crit_proto_nlportid)
11649 return -EBUSY;
11650
11651 /* determine protocol if provided */
11652 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
11653 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
11654
11655 if (proto >= NUM_NL80211_CRIT_PROTO)
11656 return -EINVAL;
11657
11658 /* timeout must be provided */
11659 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
11660 return -EINVAL;
11661
11662 duration =
11663 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
11664
11665 if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
11666 return -ERANGE;
11667
11668 ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
11669 if (!ret)
11670 rdev->crit_proto_nlportid = info->snd_portid;
11671
11672 return ret;
11673 }
11674
11675 static int nl80211_crit_protocol_stop(struct sk_buff *skb,
11676 struct genl_info *info)
11677 {
11678 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11679 struct wireless_dev *wdev = info->user_ptr[1];
11680
11681 if (!rdev->ops->crit_proto_stop)
11682 return -EOPNOTSUPP;
11683
11684 if (rdev->crit_proto_nlportid) {
11685 rdev->crit_proto_nlportid = 0;
11686 rdev_crit_proto_stop(rdev, wdev);
11687 }
11688 return 0;
11689 }
11690
11691 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
11692 {
11693 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11694 struct wireless_dev *wdev =
11695 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
11696 int i, err;
11697 u32 vid, subcmd;
11698
11699 if (!rdev->wiphy.vendor_commands)
11700 return -EOPNOTSUPP;
11701
11702 if (IS_ERR(wdev)) {
11703 err = PTR_ERR(wdev);
11704 if (err != -EINVAL)
11705 return err;
11706 wdev = NULL;
11707 } else if (wdev->wiphy != &rdev->wiphy) {
11708 return -EINVAL;
11709 }
11710
11711 if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
11712 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
11713 return -EINVAL;
11714
11715 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
11716 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
11717 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
11718 const struct wiphy_vendor_command *vcmd;
11719 void *data = NULL;
11720 int len = 0;
11721
11722 vcmd = &rdev->wiphy.vendor_commands[i];
11723
11724 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11725 continue;
11726
11727 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
11728 WIPHY_VENDOR_CMD_NEED_NETDEV)) {
11729 if (!wdev)
11730 return -EINVAL;
11731 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
11732 !wdev->netdev)
11733 return -EINVAL;
11734
11735 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
11736 if (!wdev_running(wdev))
11737 return -ENETDOWN;
11738 }
11739
11740 if (!vcmd->doit)
11741 return -EOPNOTSUPP;
11742 } else {
11743 wdev = NULL;
11744 }
11745
11746 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
11747 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11748 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11749 }
11750
11751 rdev->cur_cmd_info = info;
11752 err = rdev->wiphy.vendor_commands[i].doit(&rdev->wiphy, wdev,
11753 data, len);
11754 rdev->cur_cmd_info = NULL;
11755 return err;
11756 }
11757
11758 return -EOPNOTSUPP;
11759 }
11760
11761 static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
11762 struct netlink_callback *cb,
11763 struct cfg80211_registered_device **rdev,
11764 struct wireless_dev **wdev)
11765 {
11766 struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
11767 u32 vid, subcmd;
11768 unsigned int i;
11769 int vcmd_idx = -1;
11770 int err;
11771 void *data = NULL;
11772 unsigned int data_len = 0;
11773
11774 if (cb->args[0]) {
11775 /* subtract the 1 again here */
11776 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
11777 struct wireless_dev *tmp;
11778
11779 if (!wiphy)
11780 return -ENODEV;
11781 *rdev = wiphy_to_rdev(wiphy);
11782 *wdev = NULL;
11783
11784 if (cb->args[1]) {
11785 list_for_each_entry(tmp, &wiphy->wdev_list, list) {
11786 if (tmp->identifier == cb->args[1] - 1) {
11787 *wdev = tmp;
11788 break;
11789 }
11790 }
11791 }
11792
11793 /* keep rtnl locked in successful case */
11794 return 0;
11795 }
11796
11797 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize, attrbuf,
11798 nl80211_fam.maxattr, nl80211_policy, NULL);
11799 if (err)
11800 return err;
11801
11802 if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
11803 !attrbuf[NL80211_ATTR_VENDOR_SUBCMD])
11804 return -EINVAL;
11805
11806 *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk), attrbuf);
11807 if (IS_ERR(*wdev))
11808 *wdev = NULL;
11809
11810 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
11811 if (IS_ERR(*rdev))
11812 return PTR_ERR(*rdev);
11813
11814 vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
11815 subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
11816
11817 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
11818 const struct wiphy_vendor_command *vcmd;
11819
11820 vcmd = &(*rdev)->wiphy.vendor_commands[i];
11821
11822 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11823 continue;
11824
11825 if (!vcmd->dumpit)
11826 return -EOPNOTSUPP;
11827
11828 vcmd_idx = i;
11829 break;
11830 }
11831
11832 if (vcmd_idx < 0)
11833 return -EOPNOTSUPP;
11834
11835 if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
11836 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
11837 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
11838 }
11839
11840 /* 0 is the first index - add 1 to parse only once */
11841 cb->args[0] = (*rdev)->wiphy_idx + 1;
11842 /* add 1 to know if it was NULL */
11843 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
11844 cb->args[2] = vcmd_idx;
11845 cb->args[3] = (unsigned long)data;
11846 cb->args[4] = data_len;
11847
11848 /* keep rtnl locked in successful case */
11849 return 0;
11850 }
11851
11852 static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
11853 struct netlink_callback *cb)
11854 {
11855 struct cfg80211_registered_device *rdev;
11856 struct wireless_dev *wdev;
11857 unsigned int vcmd_idx;
11858 const struct wiphy_vendor_command *vcmd;
11859 void *data;
11860 int data_len;
11861 int err;
11862 struct nlattr *vendor_data;
11863
11864 rtnl_lock();
11865 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
11866 if (err)
11867 goto out;
11868
11869 vcmd_idx = cb->args[2];
11870 data = (void *)cb->args[3];
11871 data_len = cb->args[4];
11872 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
11873
11874 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
11875 WIPHY_VENDOR_CMD_NEED_NETDEV)) {
11876 if (!wdev) {
11877 err = -EINVAL;
11878 goto out;
11879 }
11880 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
11881 !wdev->netdev) {
11882 err = -EINVAL;
11883 goto out;
11884 }
11885
11886 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
11887 if (!wdev_running(wdev)) {
11888 err = -ENETDOWN;
11889 goto out;
11890 }
11891 }
11892 }
11893
11894 while (1) {
11895 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
11896 cb->nlh->nlmsg_seq, NLM_F_MULTI,
11897 NL80211_CMD_VENDOR);
11898 if (!hdr)
11899 break;
11900
11901 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11902 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
11903 wdev_id(wdev),
11904 NL80211_ATTR_PAD))) {
11905 genlmsg_cancel(skb, hdr);
11906 break;
11907 }
11908
11909 vendor_data = nla_nest_start(skb, NL80211_ATTR_VENDOR_DATA);
11910 if (!vendor_data) {
11911 genlmsg_cancel(skb, hdr);
11912 break;
11913 }
11914
11915 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
11916 (unsigned long *)&cb->args[5]);
11917 nla_nest_end(skb, vendor_data);
11918
11919 if (err == -ENOBUFS || err == -ENOENT) {
11920 genlmsg_cancel(skb, hdr);
11921 break;
11922 } else if (err) {
11923 genlmsg_cancel(skb, hdr);
11924 goto out;
11925 }
11926
11927 genlmsg_end(skb, hdr);
11928 }
11929
11930 err = skb->len;
11931 out:
11932 rtnl_unlock();
11933 return err;
11934 }
11935
11936 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
11937 enum nl80211_commands cmd,
11938 enum nl80211_attrs attr,
11939 int approxlen)
11940 {
11941 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11942
11943 if (WARN_ON(!rdev->cur_cmd_info))
11944 return NULL;
11945
11946 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
11947 rdev->cur_cmd_info->snd_portid,
11948 rdev->cur_cmd_info->snd_seq,
11949 cmd, attr, NULL, GFP_KERNEL);
11950 }
11951 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
11952
11953 int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
11954 {
11955 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
11956 void *hdr = ((void **)skb->cb)[1];
11957 struct nlattr *data = ((void **)skb->cb)[2];
11958
11959 /* clear CB data for netlink core to own from now on */
11960 memset(skb->cb, 0, sizeof(skb->cb));
11961
11962 if (WARN_ON(!rdev->cur_cmd_info)) {
11963 kfree_skb(skb);
11964 return -EINVAL;
11965 }
11966
11967 nla_nest_end(skb, data);
11968 genlmsg_end(skb, hdr);
11969 return genlmsg_reply(skb, rdev->cur_cmd_info);
11970 }
11971 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
11972
11973 static int nl80211_set_qos_map(struct sk_buff *skb,
11974 struct genl_info *info)
11975 {
11976 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11977 struct cfg80211_qos_map *qos_map = NULL;
11978 struct net_device *dev = info->user_ptr[1];
11979 u8 *pos, len, num_des, des_len, des;
11980 int ret;
11981
11982 if (!rdev->ops->set_qos_map)
11983 return -EOPNOTSUPP;
11984
11985 if (info->attrs[NL80211_ATTR_QOS_MAP]) {
11986 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
11987 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
11988
11989 if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
11990 len > IEEE80211_QOS_MAP_LEN_MAX)
11991 return -EINVAL;
11992
11993 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
11994 if (!qos_map)
11995 return -ENOMEM;
11996
11997 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
11998 if (num_des) {
11999 des_len = num_des *
12000 sizeof(struct cfg80211_dscp_exception);
12001 memcpy(qos_map->dscp_exception, pos, des_len);
12002 qos_map->num_des = num_des;
12003 for (des = 0; des < num_des; des++) {
12004 if (qos_map->dscp_exception[des].up > 7) {
12005 kfree(qos_map);
12006 return -EINVAL;
12007 }
12008 }
12009 pos += des_len;
12010 }
12011 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
12012 }
12013
12014 wdev_lock(dev->ieee80211_ptr);
12015 ret = nl80211_key_allowed(dev->ieee80211_ptr);
12016 if (!ret)
12017 ret = rdev_set_qos_map(rdev, dev, qos_map);
12018 wdev_unlock(dev->ieee80211_ptr);
12019
12020 kfree(qos_map);
12021 return ret;
12022 }
12023
12024 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
12025 {
12026 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12027 struct net_device *dev = info->user_ptr[1];
12028 struct wireless_dev *wdev = dev->ieee80211_ptr;
12029 const u8 *peer;
12030 u8 tsid, up;
12031 u16 admitted_time = 0;
12032 int err;
12033
12034 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
12035 return -EOPNOTSUPP;
12036
12037 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
12038 !info->attrs[NL80211_ATTR_USER_PRIO])
12039 return -EINVAL;
12040
12041 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
12042 if (tsid >= IEEE80211_NUM_TIDS)
12043 return -EINVAL;
12044
12045 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
12046 if (up >= IEEE80211_NUM_UPS)
12047 return -EINVAL;
12048
12049 /* WMM uses TIDs 0-7 even for TSPEC */
12050 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
12051 /* TODO: handle 802.11 TSPEC/admission control
12052 * need more attributes for that (e.g. BA session requirement);
12053 * change the WMM adminssion test above to allow both then
12054 */
12055 return -EINVAL;
12056 }
12057
12058 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12059
12060 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
12061 admitted_time =
12062 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
12063 if (!admitted_time)
12064 return -EINVAL;
12065 }
12066
12067 wdev_lock(wdev);
12068 switch (wdev->iftype) {
12069 case NL80211_IFTYPE_STATION:
12070 case NL80211_IFTYPE_P2P_CLIENT:
12071 if (wdev->current_bss)
12072 break;
12073 err = -ENOTCONN;
12074 goto out;
12075 default:
12076 err = -EOPNOTSUPP;
12077 goto out;
12078 }
12079
12080 err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
12081
12082 out:
12083 wdev_unlock(wdev);
12084 return err;
12085 }
12086
12087 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
12088 {
12089 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12090 struct net_device *dev = info->user_ptr[1];
12091 struct wireless_dev *wdev = dev->ieee80211_ptr;
12092 const u8 *peer;
12093 u8 tsid;
12094 int err;
12095
12096 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
12097 return -EINVAL;
12098
12099 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
12100 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12101
12102 wdev_lock(wdev);
12103 err = rdev_del_tx_ts(rdev, dev, tsid, peer);
12104 wdev_unlock(wdev);
12105
12106 return err;
12107 }
12108
12109 static int nl80211_tdls_channel_switch(struct sk_buff *skb,
12110 struct genl_info *info)
12111 {
12112 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12113 struct net_device *dev = info->user_ptr[1];
12114 struct wireless_dev *wdev = dev->ieee80211_ptr;
12115 struct cfg80211_chan_def chandef = {};
12116 const u8 *addr;
12117 u8 oper_class;
12118 int err;
12119
12120 if (!rdev->ops->tdls_channel_switch ||
12121 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
12122 return -EOPNOTSUPP;
12123
12124 switch (dev->ieee80211_ptr->iftype) {
12125 case NL80211_IFTYPE_STATION:
12126 case NL80211_IFTYPE_P2P_CLIENT:
12127 break;
12128 default:
12129 return -EOPNOTSUPP;
12130 }
12131
12132 if (!info->attrs[NL80211_ATTR_MAC] ||
12133 !info->attrs[NL80211_ATTR_OPER_CLASS])
12134 return -EINVAL;
12135
12136 err = nl80211_parse_chandef(rdev, info, &chandef);
12137 if (err)
12138 return err;
12139
12140 /*
12141 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
12142 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
12143 * specification is not defined for them.
12144 */
12145 if (chandef.chan->band == NL80211_BAND_2GHZ &&
12146 chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
12147 chandef.width != NL80211_CHAN_WIDTH_20)
12148 return -EINVAL;
12149
12150 /* we will be active on the TDLS link */
12151 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
12152 wdev->iftype))
12153 return -EINVAL;
12154
12155 /* don't allow switching to DFS channels */
12156 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
12157 return -EINVAL;
12158
12159 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
12160 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
12161
12162 wdev_lock(wdev);
12163 err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
12164 wdev_unlock(wdev);
12165
12166 return err;
12167 }
12168
12169 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
12170 struct genl_info *info)
12171 {
12172 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12173 struct net_device *dev = info->user_ptr[1];
12174 struct wireless_dev *wdev = dev->ieee80211_ptr;
12175 const u8 *addr;
12176
12177 if (!rdev->ops->tdls_channel_switch ||
12178 !rdev->ops->tdls_cancel_channel_switch ||
12179 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
12180 return -EOPNOTSUPP;
12181
12182 switch (dev->ieee80211_ptr->iftype) {
12183 case NL80211_IFTYPE_STATION:
12184 case NL80211_IFTYPE_P2P_CLIENT:
12185 break;
12186 default:
12187 return -EOPNOTSUPP;
12188 }
12189
12190 if (!info->attrs[NL80211_ATTR_MAC])
12191 return -EINVAL;
12192
12193 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
12194
12195 wdev_lock(wdev);
12196 rdev_tdls_cancel_channel_switch(rdev, dev, addr);
12197 wdev_unlock(wdev);
12198
12199 return 0;
12200 }
12201
12202 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
12203 struct genl_info *info)
12204 {
12205 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12206 struct net_device *dev = info->user_ptr[1];
12207 struct wireless_dev *wdev = dev->ieee80211_ptr;
12208 const struct nlattr *nla;
12209 bool enabled;
12210
12211 if (!rdev->ops->set_multicast_to_unicast)
12212 return -EOPNOTSUPP;
12213
12214 if (wdev->iftype != NL80211_IFTYPE_AP &&
12215 wdev->iftype != NL80211_IFTYPE_P2P_GO)
12216 return -EOPNOTSUPP;
12217
12218 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
12219 enabled = nla_get_flag(nla);
12220
12221 return rdev_set_multicast_to_unicast(rdev, dev, enabled);
12222 }
12223
12224 #define NL80211_FLAG_NEED_WIPHY 0x01
12225 #define NL80211_FLAG_NEED_NETDEV 0x02
12226 #define NL80211_FLAG_NEED_RTNL 0x04
12227 #define NL80211_FLAG_CHECK_NETDEV_UP 0x08
12228 #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
12229 NL80211_FLAG_CHECK_NETDEV_UP)
12230 #define NL80211_FLAG_NEED_WDEV 0x10
12231 /* If a netdev is associated, it must be UP, P2P must be started */
12232 #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
12233 NL80211_FLAG_CHECK_NETDEV_UP)
12234 #define NL80211_FLAG_CLEAR_SKB 0x20
12235
12236 static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
12237 struct genl_info *info)
12238 {
12239 struct cfg80211_registered_device *rdev;
12240 struct wireless_dev *wdev;
12241 struct net_device *dev;
12242 bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
12243
12244 if (rtnl)
12245 rtnl_lock();
12246
12247 if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
12248 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
12249 if (IS_ERR(rdev)) {
12250 if (rtnl)
12251 rtnl_unlock();
12252 return PTR_ERR(rdev);
12253 }
12254 info->user_ptr[0] = rdev;
12255 } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
12256 ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
12257 ASSERT_RTNL();
12258
12259 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
12260 info->attrs);
12261 if (IS_ERR(wdev)) {
12262 if (rtnl)
12263 rtnl_unlock();
12264 return PTR_ERR(wdev);
12265 }
12266
12267 dev = wdev->netdev;
12268 rdev = wiphy_to_rdev(wdev->wiphy);
12269
12270 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
12271 if (!dev) {
12272 if (rtnl)
12273 rtnl_unlock();
12274 return -EINVAL;
12275 }
12276
12277 info->user_ptr[1] = dev;
12278 } else {
12279 info->user_ptr[1] = wdev;
12280 }
12281
12282 if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
12283 !wdev_running(wdev)) {
12284 if (rtnl)
12285 rtnl_unlock();
12286 return -ENETDOWN;
12287 }
12288
12289 if (dev)
12290 dev_hold(dev);
12291
12292 info->user_ptr[0] = rdev;
12293 }
12294
12295 return 0;
12296 }
12297
12298 static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
12299 struct genl_info *info)
12300 {
12301 if (info->user_ptr[1]) {
12302 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
12303 struct wireless_dev *wdev = info->user_ptr[1];
12304
12305 if (wdev->netdev)
12306 dev_put(wdev->netdev);
12307 } else {
12308 dev_put(info->user_ptr[1]);
12309 }
12310 }
12311
12312 if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
12313 rtnl_unlock();
12314
12315 /* If needed, clear the netlink message payload from the SKB
12316 * as it might contain key data that shouldn't stick around on
12317 * the heap after the SKB is freed. The netlink message header
12318 * is still needed for further processing, so leave it intact.
12319 */
12320 if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
12321 struct nlmsghdr *nlh = nlmsg_hdr(skb);
12322
12323 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
12324 }
12325 }
12326
12327 static const struct genl_ops nl80211_ops[] = {
12328 {
12329 .cmd = NL80211_CMD_GET_WIPHY,
12330 .doit = nl80211_get_wiphy,
12331 .dumpit = nl80211_dump_wiphy,
12332 .done = nl80211_dump_wiphy_done,
12333 .policy = nl80211_policy,
12334 /* can be retrieved by unprivileged users */
12335 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12336 NL80211_FLAG_NEED_RTNL,
12337 },
12338 {
12339 .cmd = NL80211_CMD_SET_WIPHY,
12340 .doit = nl80211_set_wiphy,
12341 .policy = nl80211_policy,
12342 .flags = GENL_UNS_ADMIN_PERM,
12343 .internal_flags = NL80211_FLAG_NEED_RTNL,
12344 },
12345 {
12346 .cmd = NL80211_CMD_GET_INTERFACE,
12347 .doit = nl80211_get_interface,
12348 .dumpit = nl80211_dump_interface,
12349 .policy = nl80211_policy,
12350 /* can be retrieved by unprivileged users */
12351 .internal_flags = NL80211_FLAG_NEED_WDEV |
12352 NL80211_FLAG_NEED_RTNL,
12353 },
12354 {
12355 .cmd = NL80211_CMD_SET_INTERFACE,
12356 .doit = nl80211_set_interface,
12357 .policy = nl80211_policy,
12358 .flags = GENL_UNS_ADMIN_PERM,
12359 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12360 NL80211_FLAG_NEED_RTNL,
12361 },
12362 {
12363 .cmd = NL80211_CMD_NEW_INTERFACE,
12364 .doit = nl80211_new_interface,
12365 .policy = nl80211_policy,
12366 .flags = GENL_UNS_ADMIN_PERM,
12367 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12368 NL80211_FLAG_NEED_RTNL,
12369 },
12370 {
12371 .cmd = NL80211_CMD_DEL_INTERFACE,
12372 .doit = nl80211_del_interface,
12373 .policy = nl80211_policy,
12374 .flags = GENL_UNS_ADMIN_PERM,
12375 .internal_flags = NL80211_FLAG_NEED_WDEV |
12376 NL80211_FLAG_NEED_RTNL,
12377 },
12378 {
12379 .cmd = NL80211_CMD_GET_KEY,
12380 .doit = nl80211_get_key,
12381 .policy = nl80211_policy,
12382 .flags = GENL_UNS_ADMIN_PERM,
12383 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12384 NL80211_FLAG_NEED_RTNL,
12385 },
12386 {
12387 .cmd = NL80211_CMD_SET_KEY,
12388 .doit = nl80211_set_key,
12389 .policy = nl80211_policy,
12390 .flags = GENL_UNS_ADMIN_PERM,
12391 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12392 NL80211_FLAG_NEED_RTNL |
12393 NL80211_FLAG_CLEAR_SKB,
12394 },
12395 {
12396 .cmd = NL80211_CMD_NEW_KEY,
12397 .doit = nl80211_new_key,
12398 .policy = nl80211_policy,
12399 .flags = GENL_UNS_ADMIN_PERM,
12400 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12401 NL80211_FLAG_NEED_RTNL |
12402 NL80211_FLAG_CLEAR_SKB,
12403 },
12404 {
12405 .cmd = NL80211_CMD_DEL_KEY,
12406 .doit = nl80211_del_key,
12407 .policy = nl80211_policy,
12408 .flags = GENL_UNS_ADMIN_PERM,
12409 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12410 NL80211_FLAG_NEED_RTNL,
12411 },
12412 {
12413 .cmd = NL80211_CMD_SET_BEACON,
12414 .policy = nl80211_policy,
12415 .flags = GENL_UNS_ADMIN_PERM,
12416 .doit = nl80211_set_beacon,
12417 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12418 NL80211_FLAG_NEED_RTNL,
12419 },
12420 {
12421 .cmd = NL80211_CMD_START_AP,
12422 .policy = nl80211_policy,
12423 .flags = GENL_UNS_ADMIN_PERM,
12424 .doit = nl80211_start_ap,
12425 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12426 NL80211_FLAG_NEED_RTNL,
12427 },
12428 {
12429 .cmd = NL80211_CMD_STOP_AP,
12430 .policy = nl80211_policy,
12431 .flags = GENL_UNS_ADMIN_PERM,
12432 .doit = nl80211_stop_ap,
12433 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12434 NL80211_FLAG_NEED_RTNL,
12435 },
12436 {
12437 .cmd = NL80211_CMD_GET_STATION,
12438 .doit = nl80211_get_station,
12439 .dumpit = nl80211_dump_station,
12440 .policy = nl80211_policy,
12441 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12442 NL80211_FLAG_NEED_RTNL,
12443 },
12444 {
12445 .cmd = NL80211_CMD_SET_STATION,
12446 .doit = nl80211_set_station,
12447 .policy = nl80211_policy,
12448 .flags = GENL_UNS_ADMIN_PERM,
12449 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12450 NL80211_FLAG_NEED_RTNL,
12451 },
12452 {
12453 .cmd = NL80211_CMD_NEW_STATION,
12454 .doit = nl80211_new_station,
12455 .policy = nl80211_policy,
12456 .flags = GENL_UNS_ADMIN_PERM,
12457 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12458 NL80211_FLAG_NEED_RTNL,
12459 },
12460 {
12461 .cmd = NL80211_CMD_DEL_STATION,
12462 .doit = nl80211_del_station,
12463 .policy = nl80211_policy,
12464 .flags = GENL_UNS_ADMIN_PERM,
12465 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12466 NL80211_FLAG_NEED_RTNL,
12467 },
12468 {
12469 .cmd = NL80211_CMD_GET_MPATH,
12470 .doit = nl80211_get_mpath,
12471 .dumpit = nl80211_dump_mpath,
12472 .policy = nl80211_policy,
12473 .flags = GENL_UNS_ADMIN_PERM,
12474 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12475 NL80211_FLAG_NEED_RTNL,
12476 },
12477 {
12478 .cmd = NL80211_CMD_GET_MPP,
12479 .doit = nl80211_get_mpp,
12480 .dumpit = nl80211_dump_mpp,
12481 .policy = nl80211_policy,
12482 .flags = GENL_UNS_ADMIN_PERM,
12483 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12484 NL80211_FLAG_NEED_RTNL,
12485 },
12486 {
12487 .cmd = NL80211_CMD_SET_MPATH,
12488 .doit = nl80211_set_mpath,
12489 .policy = nl80211_policy,
12490 .flags = GENL_UNS_ADMIN_PERM,
12491 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12492 NL80211_FLAG_NEED_RTNL,
12493 },
12494 {
12495 .cmd = NL80211_CMD_NEW_MPATH,
12496 .doit = nl80211_new_mpath,
12497 .policy = nl80211_policy,
12498 .flags = GENL_UNS_ADMIN_PERM,
12499 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12500 NL80211_FLAG_NEED_RTNL,
12501 },
12502 {
12503 .cmd = NL80211_CMD_DEL_MPATH,
12504 .doit = nl80211_del_mpath,
12505 .policy = nl80211_policy,
12506 .flags = GENL_UNS_ADMIN_PERM,
12507 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12508 NL80211_FLAG_NEED_RTNL,
12509 },
12510 {
12511 .cmd = NL80211_CMD_SET_BSS,
12512 .doit = nl80211_set_bss,
12513 .policy = nl80211_policy,
12514 .flags = GENL_UNS_ADMIN_PERM,
12515 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12516 NL80211_FLAG_NEED_RTNL,
12517 },
12518 {
12519 .cmd = NL80211_CMD_GET_REG,
12520 .doit = nl80211_get_reg_do,
12521 .dumpit = nl80211_get_reg_dump,
12522 .policy = nl80211_policy,
12523 .internal_flags = NL80211_FLAG_NEED_RTNL,
12524 /* can be retrieved by unprivileged users */
12525 },
12526 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
12527 {
12528 .cmd = NL80211_CMD_SET_REG,
12529 .doit = nl80211_set_reg,
12530 .policy = nl80211_policy,
12531 .flags = GENL_ADMIN_PERM,
12532 .internal_flags = NL80211_FLAG_NEED_RTNL,
12533 },
12534 #endif
12535 {
12536 .cmd = NL80211_CMD_REQ_SET_REG,
12537 .doit = nl80211_req_set_reg,
12538 .policy = nl80211_policy,
12539 .flags = GENL_ADMIN_PERM,
12540 },
12541 {
12542 .cmd = NL80211_CMD_GET_MESH_CONFIG,
12543 .doit = nl80211_get_mesh_config,
12544 .policy = nl80211_policy,
12545 /* can be retrieved by unprivileged users */
12546 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12547 NL80211_FLAG_NEED_RTNL,
12548 },
12549 {
12550 .cmd = NL80211_CMD_SET_MESH_CONFIG,
12551 .doit = nl80211_update_mesh_config,
12552 .policy = nl80211_policy,
12553 .flags = GENL_UNS_ADMIN_PERM,
12554 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12555 NL80211_FLAG_NEED_RTNL,
12556 },
12557 {
12558 .cmd = NL80211_CMD_TRIGGER_SCAN,
12559 .doit = nl80211_trigger_scan,
12560 .policy = nl80211_policy,
12561 .flags = GENL_UNS_ADMIN_PERM,
12562 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12563 NL80211_FLAG_NEED_RTNL,
12564 },
12565 {
12566 .cmd = NL80211_CMD_ABORT_SCAN,
12567 .doit = nl80211_abort_scan,
12568 .policy = nl80211_policy,
12569 .flags = GENL_UNS_ADMIN_PERM,
12570 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12571 NL80211_FLAG_NEED_RTNL,
12572 },
12573 {
12574 .cmd = NL80211_CMD_GET_SCAN,
12575 .policy = nl80211_policy,
12576 .dumpit = nl80211_dump_scan,
12577 },
12578 {
12579 .cmd = NL80211_CMD_START_SCHED_SCAN,
12580 .doit = nl80211_start_sched_scan,
12581 .policy = nl80211_policy,
12582 .flags = GENL_UNS_ADMIN_PERM,
12583 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12584 NL80211_FLAG_NEED_RTNL,
12585 },
12586 {
12587 .cmd = NL80211_CMD_STOP_SCHED_SCAN,
12588 .doit = nl80211_stop_sched_scan,
12589 .policy = nl80211_policy,
12590 .flags = GENL_UNS_ADMIN_PERM,
12591 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12592 NL80211_FLAG_NEED_RTNL,
12593 },
12594 {
12595 .cmd = NL80211_CMD_AUTHENTICATE,
12596 .doit = nl80211_authenticate,
12597 .policy = nl80211_policy,
12598 .flags = GENL_UNS_ADMIN_PERM,
12599 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12600 NL80211_FLAG_NEED_RTNL |
12601 NL80211_FLAG_CLEAR_SKB,
12602 },
12603 {
12604 .cmd = NL80211_CMD_ASSOCIATE,
12605 .doit = nl80211_associate,
12606 .policy = nl80211_policy,
12607 .flags = GENL_UNS_ADMIN_PERM,
12608 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12609 NL80211_FLAG_NEED_RTNL,
12610 },
12611 {
12612 .cmd = NL80211_CMD_DEAUTHENTICATE,
12613 .doit = nl80211_deauthenticate,
12614 .policy = nl80211_policy,
12615 .flags = GENL_UNS_ADMIN_PERM,
12616 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12617 NL80211_FLAG_NEED_RTNL,
12618 },
12619 {
12620 .cmd = NL80211_CMD_DISASSOCIATE,
12621 .doit = nl80211_disassociate,
12622 .policy = nl80211_policy,
12623 .flags = GENL_UNS_ADMIN_PERM,
12624 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12625 NL80211_FLAG_NEED_RTNL,
12626 },
12627 {
12628 .cmd = NL80211_CMD_JOIN_IBSS,
12629 .doit = nl80211_join_ibss,
12630 .policy = nl80211_policy,
12631 .flags = GENL_UNS_ADMIN_PERM,
12632 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12633 NL80211_FLAG_NEED_RTNL,
12634 },
12635 {
12636 .cmd = NL80211_CMD_LEAVE_IBSS,
12637 .doit = nl80211_leave_ibss,
12638 .policy = nl80211_policy,
12639 .flags = GENL_UNS_ADMIN_PERM,
12640 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12641 NL80211_FLAG_NEED_RTNL,
12642 },
12643 #ifdef CONFIG_NL80211_TESTMODE
12644 {
12645 .cmd = NL80211_CMD_TESTMODE,
12646 .doit = nl80211_testmode_do,
12647 .dumpit = nl80211_testmode_dump,
12648 .policy = nl80211_policy,
12649 .flags = GENL_UNS_ADMIN_PERM,
12650 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12651 NL80211_FLAG_NEED_RTNL,
12652 },
12653 #endif
12654 {
12655 .cmd = NL80211_CMD_CONNECT,
12656 .doit = nl80211_connect,
12657 .policy = nl80211_policy,
12658 .flags = GENL_UNS_ADMIN_PERM,
12659 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12660 NL80211_FLAG_NEED_RTNL,
12661 },
12662 {
12663 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
12664 .doit = nl80211_update_connect_params,
12665 .policy = nl80211_policy,
12666 .flags = GENL_ADMIN_PERM,
12667 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12668 NL80211_FLAG_NEED_RTNL,
12669 },
12670 {
12671 .cmd = NL80211_CMD_DISCONNECT,
12672 .doit = nl80211_disconnect,
12673 .policy = nl80211_policy,
12674 .flags = GENL_UNS_ADMIN_PERM,
12675 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12676 NL80211_FLAG_NEED_RTNL,
12677 },
12678 {
12679 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
12680 .doit = nl80211_wiphy_netns,
12681 .policy = nl80211_policy,
12682 .flags = GENL_UNS_ADMIN_PERM,
12683 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12684 NL80211_FLAG_NEED_RTNL,
12685 },
12686 {
12687 .cmd = NL80211_CMD_GET_SURVEY,
12688 .policy = nl80211_policy,
12689 .dumpit = nl80211_dump_survey,
12690 },
12691 {
12692 .cmd = NL80211_CMD_SET_PMKSA,
12693 .doit = nl80211_setdel_pmksa,
12694 .policy = nl80211_policy,
12695 .flags = GENL_UNS_ADMIN_PERM,
12696 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12697 NL80211_FLAG_NEED_RTNL,
12698 },
12699 {
12700 .cmd = NL80211_CMD_DEL_PMKSA,
12701 .doit = nl80211_setdel_pmksa,
12702 .policy = nl80211_policy,
12703 .flags = GENL_UNS_ADMIN_PERM,
12704 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12705 NL80211_FLAG_NEED_RTNL,
12706 },
12707 {
12708 .cmd = NL80211_CMD_FLUSH_PMKSA,
12709 .doit = nl80211_flush_pmksa,
12710 .policy = nl80211_policy,
12711 .flags = GENL_UNS_ADMIN_PERM,
12712 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12713 NL80211_FLAG_NEED_RTNL,
12714 },
12715 {
12716 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
12717 .doit = nl80211_remain_on_channel,
12718 .policy = nl80211_policy,
12719 .flags = GENL_UNS_ADMIN_PERM,
12720 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12721 NL80211_FLAG_NEED_RTNL,
12722 },
12723 {
12724 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
12725 .doit = nl80211_cancel_remain_on_channel,
12726 .policy = nl80211_policy,
12727 .flags = GENL_UNS_ADMIN_PERM,
12728 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12729 NL80211_FLAG_NEED_RTNL,
12730 },
12731 {
12732 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
12733 .doit = nl80211_set_tx_bitrate_mask,
12734 .policy = nl80211_policy,
12735 .flags = GENL_UNS_ADMIN_PERM,
12736 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12737 NL80211_FLAG_NEED_RTNL,
12738 },
12739 {
12740 .cmd = NL80211_CMD_REGISTER_FRAME,
12741 .doit = nl80211_register_mgmt,
12742 .policy = nl80211_policy,
12743 .flags = GENL_UNS_ADMIN_PERM,
12744 .internal_flags = NL80211_FLAG_NEED_WDEV |
12745 NL80211_FLAG_NEED_RTNL,
12746 },
12747 {
12748 .cmd = NL80211_CMD_FRAME,
12749 .doit = nl80211_tx_mgmt,
12750 .policy = nl80211_policy,
12751 .flags = GENL_UNS_ADMIN_PERM,
12752 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12753 NL80211_FLAG_NEED_RTNL,
12754 },
12755 {
12756 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
12757 .doit = nl80211_tx_mgmt_cancel_wait,
12758 .policy = nl80211_policy,
12759 .flags = GENL_UNS_ADMIN_PERM,
12760 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12761 NL80211_FLAG_NEED_RTNL,
12762 },
12763 {
12764 .cmd = NL80211_CMD_SET_POWER_SAVE,
12765 .doit = nl80211_set_power_save,
12766 .policy = nl80211_policy,
12767 .flags = GENL_UNS_ADMIN_PERM,
12768 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12769 NL80211_FLAG_NEED_RTNL,
12770 },
12771 {
12772 .cmd = NL80211_CMD_GET_POWER_SAVE,
12773 .doit = nl80211_get_power_save,
12774 .policy = nl80211_policy,
12775 /* can be retrieved by unprivileged users */
12776 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12777 NL80211_FLAG_NEED_RTNL,
12778 },
12779 {
12780 .cmd = NL80211_CMD_SET_CQM,
12781 .doit = nl80211_set_cqm,
12782 .policy = nl80211_policy,
12783 .flags = GENL_UNS_ADMIN_PERM,
12784 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12785 NL80211_FLAG_NEED_RTNL,
12786 },
12787 {
12788 .cmd = NL80211_CMD_SET_CHANNEL,
12789 .doit = nl80211_set_channel,
12790 .policy = nl80211_policy,
12791 .flags = GENL_UNS_ADMIN_PERM,
12792 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12793 NL80211_FLAG_NEED_RTNL,
12794 },
12795 {
12796 .cmd = NL80211_CMD_SET_WDS_PEER,
12797 .doit = nl80211_set_wds_peer,
12798 .policy = nl80211_policy,
12799 .flags = GENL_UNS_ADMIN_PERM,
12800 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12801 NL80211_FLAG_NEED_RTNL,
12802 },
12803 {
12804 .cmd = NL80211_CMD_JOIN_MESH,
12805 .doit = nl80211_join_mesh,
12806 .policy = nl80211_policy,
12807 .flags = GENL_UNS_ADMIN_PERM,
12808 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12809 NL80211_FLAG_NEED_RTNL,
12810 },
12811 {
12812 .cmd = NL80211_CMD_LEAVE_MESH,
12813 .doit = nl80211_leave_mesh,
12814 .policy = nl80211_policy,
12815 .flags = GENL_UNS_ADMIN_PERM,
12816 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12817 NL80211_FLAG_NEED_RTNL,
12818 },
12819 {
12820 .cmd = NL80211_CMD_JOIN_OCB,
12821 .doit = nl80211_join_ocb,
12822 .policy = nl80211_policy,
12823 .flags = GENL_UNS_ADMIN_PERM,
12824 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12825 NL80211_FLAG_NEED_RTNL,
12826 },
12827 {
12828 .cmd = NL80211_CMD_LEAVE_OCB,
12829 .doit = nl80211_leave_ocb,
12830 .policy = nl80211_policy,
12831 .flags = GENL_UNS_ADMIN_PERM,
12832 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12833 NL80211_FLAG_NEED_RTNL,
12834 },
12835 #ifdef CONFIG_PM
12836 {
12837 .cmd = NL80211_CMD_GET_WOWLAN,
12838 .doit = nl80211_get_wowlan,
12839 .policy = nl80211_policy,
12840 /* can be retrieved by unprivileged users */
12841 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12842 NL80211_FLAG_NEED_RTNL,
12843 },
12844 {
12845 .cmd = NL80211_CMD_SET_WOWLAN,
12846 .doit = nl80211_set_wowlan,
12847 .policy = nl80211_policy,
12848 .flags = GENL_UNS_ADMIN_PERM,
12849 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12850 NL80211_FLAG_NEED_RTNL,
12851 },
12852 #endif
12853 {
12854 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
12855 .doit = nl80211_set_rekey_data,
12856 .policy = nl80211_policy,
12857 .flags = GENL_UNS_ADMIN_PERM,
12858 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12859 NL80211_FLAG_NEED_RTNL |
12860 NL80211_FLAG_CLEAR_SKB,
12861 },
12862 {
12863 .cmd = NL80211_CMD_TDLS_MGMT,
12864 .doit = nl80211_tdls_mgmt,
12865 .policy = nl80211_policy,
12866 .flags = GENL_UNS_ADMIN_PERM,
12867 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12868 NL80211_FLAG_NEED_RTNL,
12869 },
12870 {
12871 .cmd = NL80211_CMD_TDLS_OPER,
12872 .doit = nl80211_tdls_oper,
12873 .policy = nl80211_policy,
12874 .flags = GENL_UNS_ADMIN_PERM,
12875 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12876 NL80211_FLAG_NEED_RTNL,
12877 },
12878 {
12879 .cmd = NL80211_CMD_UNEXPECTED_FRAME,
12880 .doit = nl80211_register_unexpected_frame,
12881 .policy = nl80211_policy,
12882 .flags = GENL_UNS_ADMIN_PERM,
12883 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12884 NL80211_FLAG_NEED_RTNL,
12885 },
12886 {
12887 .cmd = NL80211_CMD_PROBE_CLIENT,
12888 .doit = nl80211_probe_client,
12889 .policy = nl80211_policy,
12890 .flags = GENL_UNS_ADMIN_PERM,
12891 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12892 NL80211_FLAG_NEED_RTNL,
12893 },
12894 {
12895 .cmd = NL80211_CMD_REGISTER_BEACONS,
12896 .doit = nl80211_register_beacons,
12897 .policy = nl80211_policy,
12898 .flags = GENL_UNS_ADMIN_PERM,
12899 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12900 NL80211_FLAG_NEED_RTNL,
12901 },
12902 {
12903 .cmd = NL80211_CMD_SET_NOACK_MAP,
12904 .doit = nl80211_set_noack_map,
12905 .policy = nl80211_policy,
12906 .flags = GENL_UNS_ADMIN_PERM,
12907 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12908 NL80211_FLAG_NEED_RTNL,
12909 },
12910 {
12911 .cmd = NL80211_CMD_START_P2P_DEVICE,
12912 .doit = nl80211_start_p2p_device,
12913 .policy = nl80211_policy,
12914 .flags = GENL_UNS_ADMIN_PERM,
12915 .internal_flags = NL80211_FLAG_NEED_WDEV |
12916 NL80211_FLAG_NEED_RTNL,
12917 },
12918 {
12919 .cmd = NL80211_CMD_STOP_P2P_DEVICE,
12920 .doit = nl80211_stop_p2p_device,
12921 .policy = nl80211_policy,
12922 .flags = GENL_UNS_ADMIN_PERM,
12923 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12924 NL80211_FLAG_NEED_RTNL,
12925 },
12926 {
12927 .cmd = NL80211_CMD_START_NAN,
12928 .doit = nl80211_start_nan,
12929 .policy = nl80211_policy,
12930 .flags = GENL_ADMIN_PERM,
12931 .internal_flags = NL80211_FLAG_NEED_WDEV |
12932 NL80211_FLAG_NEED_RTNL,
12933 },
12934 {
12935 .cmd = NL80211_CMD_STOP_NAN,
12936 .doit = nl80211_stop_nan,
12937 .policy = nl80211_policy,
12938 .flags = GENL_ADMIN_PERM,
12939 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12940 NL80211_FLAG_NEED_RTNL,
12941 },
12942 {
12943 .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
12944 .doit = nl80211_nan_add_func,
12945 .policy = nl80211_policy,
12946 .flags = GENL_ADMIN_PERM,
12947 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12948 NL80211_FLAG_NEED_RTNL,
12949 },
12950 {
12951 .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
12952 .doit = nl80211_nan_del_func,
12953 .policy = nl80211_policy,
12954 .flags = GENL_ADMIN_PERM,
12955 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12956 NL80211_FLAG_NEED_RTNL,
12957 },
12958 {
12959 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
12960 .doit = nl80211_nan_change_config,
12961 .policy = nl80211_policy,
12962 .flags = GENL_ADMIN_PERM,
12963 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12964 NL80211_FLAG_NEED_RTNL,
12965 },
12966 {
12967 .cmd = NL80211_CMD_SET_MCAST_RATE,
12968 .doit = nl80211_set_mcast_rate,
12969 .policy = nl80211_policy,
12970 .flags = GENL_UNS_ADMIN_PERM,
12971 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12972 NL80211_FLAG_NEED_RTNL,
12973 },
12974 {
12975 .cmd = NL80211_CMD_SET_MAC_ACL,
12976 .doit = nl80211_set_mac_acl,
12977 .policy = nl80211_policy,
12978 .flags = GENL_UNS_ADMIN_PERM,
12979 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12980 NL80211_FLAG_NEED_RTNL,
12981 },
12982 {
12983 .cmd = NL80211_CMD_RADAR_DETECT,
12984 .doit = nl80211_start_radar_detection,
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_GET_PROTOCOL_FEATURES,
12992 .doit = nl80211_get_protocol_features,
12993 .policy = nl80211_policy,
12994 },
12995 {
12996 .cmd = NL80211_CMD_UPDATE_FT_IES,
12997 .doit = nl80211_update_ft_ies,
12998 .policy = nl80211_policy,
12999 .flags = GENL_UNS_ADMIN_PERM,
13000 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13001 NL80211_FLAG_NEED_RTNL,
13002 },
13003 {
13004 .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
13005 .doit = nl80211_crit_protocol_start,
13006 .policy = nl80211_policy,
13007 .flags = GENL_UNS_ADMIN_PERM,
13008 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13009 NL80211_FLAG_NEED_RTNL,
13010 },
13011 {
13012 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
13013 .doit = nl80211_crit_protocol_stop,
13014 .policy = nl80211_policy,
13015 .flags = GENL_UNS_ADMIN_PERM,
13016 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13017 NL80211_FLAG_NEED_RTNL,
13018 },
13019 {
13020 .cmd = NL80211_CMD_GET_COALESCE,
13021 .doit = nl80211_get_coalesce,
13022 .policy = nl80211_policy,
13023 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13024 NL80211_FLAG_NEED_RTNL,
13025 },
13026 {
13027 .cmd = NL80211_CMD_SET_COALESCE,
13028 .doit = nl80211_set_coalesce,
13029 .policy = nl80211_policy,
13030 .flags = GENL_UNS_ADMIN_PERM,
13031 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13032 NL80211_FLAG_NEED_RTNL,
13033 },
13034 {
13035 .cmd = NL80211_CMD_CHANNEL_SWITCH,
13036 .doit = nl80211_channel_switch,
13037 .policy = nl80211_policy,
13038 .flags = GENL_UNS_ADMIN_PERM,
13039 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13040 NL80211_FLAG_NEED_RTNL,
13041 },
13042 {
13043 .cmd = NL80211_CMD_VENDOR,
13044 .doit = nl80211_vendor_cmd,
13045 .dumpit = nl80211_vendor_cmd_dump,
13046 .policy = nl80211_policy,
13047 .flags = GENL_UNS_ADMIN_PERM,
13048 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13049 NL80211_FLAG_NEED_RTNL,
13050 },
13051 {
13052 .cmd = NL80211_CMD_SET_QOS_MAP,
13053 .doit = nl80211_set_qos_map,
13054 .policy = nl80211_policy,
13055 .flags = GENL_UNS_ADMIN_PERM,
13056 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13057 NL80211_FLAG_NEED_RTNL,
13058 },
13059 {
13060 .cmd = NL80211_CMD_ADD_TX_TS,
13061 .doit = nl80211_add_tx_ts,
13062 .policy = nl80211_policy,
13063 .flags = GENL_UNS_ADMIN_PERM,
13064 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13065 NL80211_FLAG_NEED_RTNL,
13066 },
13067 {
13068 .cmd = NL80211_CMD_DEL_TX_TS,
13069 .doit = nl80211_del_tx_ts,
13070 .policy = nl80211_policy,
13071 .flags = GENL_UNS_ADMIN_PERM,
13072 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13073 NL80211_FLAG_NEED_RTNL,
13074 },
13075 {
13076 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
13077 .doit = nl80211_tdls_channel_switch,
13078 .policy = nl80211_policy,
13079 .flags = GENL_UNS_ADMIN_PERM,
13080 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13081 NL80211_FLAG_NEED_RTNL,
13082 },
13083 {
13084 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
13085 .doit = nl80211_tdls_cancel_channel_switch,
13086 .policy = nl80211_policy,
13087 .flags = GENL_UNS_ADMIN_PERM,
13088 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13089 NL80211_FLAG_NEED_RTNL,
13090 },
13091 {
13092 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
13093 .doit = nl80211_set_multicast_to_unicast,
13094 .policy = nl80211_policy,
13095 .flags = GENL_UNS_ADMIN_PERM,
13096 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13097 NL80211_FLAG_NEED_RTNL,
13098 },
13099 };
13100
13101 static struct genl_family nl80211_fam __ro_after_init = {
13102 .name = NL80211_GENL_NAME, /* have users key off the name instead */
13103 .hdrsize = 0, /* no private header */
13104 .version = 1, /* no particular meaning now */
13105 .maxattr = NL80211_ATTR_MAX,
13106 .netnsok = true,
13107 .pre_doit = nl80211_pre_doit,
13108 .post_doit = nl80211_post_doit,
13109 .module = THIS_MODULE,
13110 .ops = nl80211_ops,
13111 .n_ops = ARRAY_SIZE(nl80211_ops),
13112 .mcgrps = nl80211_mcgrps,
13113 .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
13114 };
13115
13116 /* notification functions */
13117
13118 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
13119 enum nl80211_commands cmd)
13120 {
13121 struct sk_buff *msg;
13122 struct nl80211_dump_wiphy_state state = {};
13123
13124 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
13125 cmd != NL80211_CMD_DEL_WIPHY);
13126
13127 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13128 if (!msg)
13129 return;
13130
13131 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
13132 nlmsg_free(msg);
13133 return;
13134 }
13135
13136 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13137 NL80211_MCGRP_CONFIG, GFP_KERNEL);
13138 }
13139
13140 void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
13141 struct wireless_dev *wdev,
13142 enum nl80211_commands cmd)
13143 {
13144 struct sk_buff *msg;
13145
13146 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
13147 cmd != NL80211_CMD_DEL_INTERFACE);
13148
13149 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13150 if (!msg)
13151 return;
13152
13153 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev,
13154 cmd == NL80211_CMD_DEL_INTERFACE) < 0) {
13155 nlmsg_free(msg);
13156 return;
13157 }
13158
13159 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13160 NL80211_MCGRP_CONFIG, GFP_KERNEL);
13161 }
13162
13163 static int nl80211_add_scan_req(struct sk_buff *msg,
13164 struct cfg80211_registered_device *rdev)
13165 {
13166 struct cfg80211_scan_request *req = rdev->scan_req;
13167 struct nlattr *nest;
13168 int i;
13169
13170 if (WARN_ON(!req))
13171 return 0;
13172
13173 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
13174 if (!nest)
13175 goto nla_put_failure;
13176 for (i = 0; i < req->n_ssids; i++) {
13177 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
13178 goto nla_put_failure;
13179 }
13180 nla_nest_end(msg, nest);
13181
13182 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
13183 if (!nest)
13184 goto nla_put_failure;
13185 for (i = 0; i < req->n_channels; i++) {
13186 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
13187 goto nla_put_failure;
13188 }
13189 nla_nest_end(msg, nest);
13190
13191 if (req->ie &&
13192 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
13193 goto nla_put_failure;
13194
13195 if (req->flags &&
13196 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
13197 goto nla_put_failure;
13198
13199 if (req->info.scan_start_tsf &&
13200 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
13201 req->info.scan_start_tsf, NL80211_BSS_PAD) ||
13202 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
13203 req->info.tsf_bssid)))
13204 goto nla_put_failure;
13205
13206 return 0;
13207 nla_put_failure:
13208 return -ENOBUFS;
13209 }
13210
13211 static int nl80211_prep_scan_msg(struct sk_buff *msg,
13212 struct cfg80211_registered_device *rdev,
13213 struct wireless_dev *wdev,
13214 u32 portid, u32 seq, int flags,
13215 u32 cmd)
13216 {
13217 void *hdr;
13218
13219 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
13220 if (!hdr)
13221 return -1;
13222
13223 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13224 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13225 wdev->netdev->ifindex)) ||
13226 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13227 NL80211_ATTR_PAD))
13228 goto nla_put_failure;
13229
13230 /* ignore errors and send incomplete event anyway */
13231 nl80211_add_scan_req(msg, rdev);
13232
13233 genlmsg_end(msg, hdr);
13234 return 0;
13235
13236 nla_put_failure:
13237 genlmsg_cancel(msg, hdr);
13238 return -EMSGSIZE;
13239 }
13240
13241 static int
13242 nl80211_prep_sched_scan_msg(struct sk_buff *msg,
13243 struct cfg80211_sched_scan_request *req, u32 cmd)
13244 {
13245 void *hdr;
13246
13247 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13248 if (!hdr)
13249 return -1;
13250
13251 if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
13252 wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
13253 nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
13254 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
13255 NL80211_ATTR_PAD))
13256 goto nla_put_failure;
13257
13258 genlmsg_end(msg, hdr);
13259 return 0;
13260
13261 nla_put_failure:
13262 genlmsg_cancel(msg, hdr);
13263 return -EMSGSIZE;
13264 }
13265
13266 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
13267 struct wireless_dev *wdev)
13268 {
13269 struct sk_buff *msg;
13270
13271 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13272 if (!msg)
13273 return;
13274
13275 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
13276 NL80211_CMD_TRIGGER_SCAN) < 0) {
13277 nlmsg_free(msg);
13278 return;
13279 }
13280
13281 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13282 NL80211_MCGRP_SCAN, GFP_KERNEL);
13283 }
13284
13285 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
13286 struct wireless_dev *wdev, bool aborted)
13287 {
13288 struct sk_buff *msg;
13289
13290 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13291 if (!msg)
13292 return NULL;
13293
13294 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
13295 aborted ? NL80211_CMD_SCAN_ABORTED :
13296 NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
13297 nlmsg_free(msg);
13298 return NULL;
13299 }
13300
13301 return msg;
13302 }
13303
13304 /* send message created by nl80211_build_scan_msg() */
13305 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
13306 struct sk_buff *msg)
13307 {
13308 if (!msg)
13309 return;
13310
13311 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13312 NL80211_MCGRP_SCAN, GFP_KERNEL);
13313 }
13314
13315 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
13316 {
13317 struct sk_buff *msg;
13318
13319 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13320 if (!msg)
13321 return;
13322
13323 if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
13324 nlmsg_free(msg);
13325 return;
13326 }
13327
13328 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
13329 NL80211_MCGRP_SCAN, GFP_KERNEL);
13330 }
13331
13332 static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
13333 struct regulatory_request *request)
13334 {
13335 /* Userspace can always count this one always being set */
13336 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
13337 goto nla_put_failure;
13338
13339 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
13340 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13341 NL80211_REGDOM_TYPE_WORLD))
13342 goto nla_put_failure;
13343 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
13344 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13345 NL80211_REGDOM_TYPE_CUSTOM_WORLD))
13346 goto nla_put_failure;
13347 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
13348 request->intersect) {
13349 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13350 NL80211_REGDOM_TYPE_INTERSECTION))
13351 goto nla_put_failure;
13352 } else {
13353 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13354 NL80211_REGDOM_TYPE_COUNTRY) ||
13355 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
13356 request->alpha2))
13357 goto nla_put_failure;
13358 }
13359
13360 if (request->wiphy_idx != WIPHY_IDX_INVALID) {
13361 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
13362
13363 if (wiphy &&
13364 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
13365 goto nla_put_failure;
13366
13367 if (wiphy &&
13368 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
13369 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
13370 goto nla_put_failure;
13371 }
13372
13373 return true;
13374
13375 nla_put_failure:
13376 return false;
13377 }
13378
13379 /*
13380 * This can happen on global regulatory changes or device specific settings
13381 * based on custom regulatory domains.
13382 */
13383 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
13384 struct regulatory_request *request)
13385 {
13386 struct sk_buff *msg;
13387 void *hdr;
13388
13389 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13390 if (!msg)
13391 return;
13392
13393 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
13394 if (!hdr) {
13395 nlmsg_free(msg);
13396 return;
13397 }
13398
13399 if (nl80211_reg_change_event_fill(msg, request) == false)
13400 goto nla_put_failure;
13401
13402 genlmsg_end(msg, hdr);
13403
13404 rcu_read_lock();
13405 genlmsg_multicast_allns(&nl80211_fam, msg, 0,
13406 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
13407 rcu_read_unlock();
13408
13409 return;
13410
13411 nla_put_failure:
13412 genlmsg_cancel(msg, hdr);
13413 nlmsg_free(msg);
13414 }
13415
13416 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
13417 struct net_device *netdev,
13418 const u8 *buf, size_t len,
13419 enum nl80211_commands cmd, gfp_t gfp,
13420 int uapsd_queues)
13421 {
13422 struct sk_buff *msg;
13423 void *hdr;
13424
13425 msg = nlmsg_new(100 + len, gfp);
13426 if (!msg)
13427 return;
13428
13429 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13430 if (!hdr) {
13431 nlmsg_free(msg);
13432 return;
13433 }
13434
13435 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13436 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13437 nla_put(msg, NL80211_ATTR_FRAME, len, buf))
13438 goto nla_put_failure;
13439
13440 if (uapsd_queues >= 0) {
13441 struct nlattr *nla_wmm =
13442 nla_nest_start(msg, NL80211_ATTR_STA_WME);
13443 if (!nla_wmm)
13444 goto nla_put_failure;
13445
13446 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
13447 uapsd_queues))
13448 goto nla_put_failure;
13449
13450 nla_nest_end(msg, nla_wmm);
13451 }
13452
13453 genlmsg_end(msg, hdr);
13454
13455 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13456 NL80211_MCGRP_MLME, gfp);
13457 return;
13458
13459 nla_put_failure:
13460 genlmsg_cancel(msg, hdr);
13461 nlmsg_free(msg);
13462 }
13463
13464 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
13465 struct net_device *netdev, const u8 *buf,
13466 size_t len, gfp_t gfp)
13467 {
13468 nl80211_send_mlme_event(rdev, netdev, buf, len,
13469 NL80211_CMD_AUTHENTICATE, gfp, -1);
13470 }
13471
13472 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
13473 struct net_device *netdev, const u8 *buf,
13474 size_t len, gfp_t gfp, int uapsd_queues)
13475 {
13476 nl80211_send_mlme_event(rdev, netdev, buf, len,
13477 NL80211_CMD_ASSOCIATE, gfp, uapsd_queues);
13478 }
13479
13480 void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
13481 struct net_device *netdev, const u8 *buf,
13482 size_t len, gfp_t gfp)
13483 {
13484 nl80211_send_mlme_event(rdev, netdev, buf, len,
13485 NL80211_CMD_DEAUTHENTICATE, gfp, -1);
13486 }
13487
13488 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
13489 struct net_device *netdev, const u8 *buf,
13490 size_t len, gfp_t gfp)
13491 {
13492 nl80211_send_mlme_event(rdev, netdev, buf, len,
13493 NL80211_CMD_DISASSOCIATE, gfp, -1);
13494 }
13495
13496 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
13497 size_t len)
13498 {
13499 struct wireless_dev *wdev = dev->ieee80211_ptr;
13500 struct wiphy *wiphy = wdev->wiphy;
13501 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13502 const struct ieee80211_mgmt *mgmt = (void *)buf;
13503 u32 cmd;
13504
13505 if (WARN_ON(len < 2))
13506 return;
13507
13508 if (ieee80211_is_deauth(mgmt->frame_control))
13509 cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
13510 else
13511 cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
13512
13513 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
13514 nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1);
13515 }
13516 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
13517
13518 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
13519 struct net_device *netdev, int cmd,
13520 const u8 *addr, gfp_t gfp)
13521 {
13522 struct sk_buff *msg;
13523 void *hdr;
13524
13525 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13526 if (!msg)
13527 return;
13528
13529 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13530 if (!hdr) {
13531 nlmsg_free(msg);
13532 return;
13533 }
13534
13535 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13536 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13537 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
13538 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
13539 goto nla_put_failure;
13540
13541 genlmsg_end(msg, hdr);
13542
13543 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13544 NL80211_MCGRP_MLME, gfp);
13545 return;
13546
13547 nla_put_failure:
13548 genlmsg_cancel(msg, hdr);
13549 nlmsg_free(msg);
13550 }
13551
13552 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
13553 struct net_device *netdev, const u8 *addr,
13554 gfp_t gfp)
13555 {
13556 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
13557 addr, gfp);
13558 }
13559
13560 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
13561 struct net_device *netdev, const u8 *addr,
13562 gfp_t gfp)
13563 {
13564 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
13565 addr, gfp);
13566 }
13567
13568 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
13569 struct net_device *netdev,
13570 struct cfg80211_connect_resp_params *cr,
13571 gfp_t gfp)
13572 {
13573 struct sk_buff *msg;
13574 void *hdr;
13575
13576 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
13577 cr->fils_kek_len + cr->pmk_len +
13578 (cr->pmkid ? WLAN_PMKID_LEN : 0), gfp);
13579 if (!msg)
13580 return;
13581
13582 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
13583 if (!hdr) {
13584 nlmsg_free(msg);
13585 return;
13586 }
13587
13588 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13589 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13590 (cr->bssid &&
13591 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cr->bssid)) ||
13592 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
13593 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
13594 cr->status) ||
13595 (cr->status < 0 &&
13596 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
13597 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
13598 cr->timeout_reason))) ||
13599 (cr->req_ie &&
13600 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
13601 (cr->resp_ie &&
13602 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
13603 cr->resp_ie)) ||
13604 (cr->update_erp_next_seq_num &&
13605 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
13606 cr->fils_erp_next_seq_num)) ||
13607 (cr->status == WLAN_STATUS_SUCCESS &&
13608 ((cr->fils_kek &&
13609 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils_kek_len,
13610 cr->fils_kek)) ||
13611 (cr->pmk &&
13612 nla_put(msg, NL80211_ATTR_PMK, cr->pmk_len, cr->pmk)) ||
13613 (cr->pmkid &&
13614 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->pmkid)))))
13615 goto nla_put_failure;
13616
13617 genlmsg_end(msg, hdr);
13618
13619 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13620 NL80211_MCGRP_MLME, gfp);
13621 return;
13622
13623 nla_put_failure:
13624 genlmsg_cancel(msg, hdr);
13625 nlmsg_free(msg);
13626 }
13627
13628 void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
13629 struct net_device *netdev, const u8 *bssid,
13630 const u8 *req_ie, size_t req_ie_len,
13631 const u8 *resp_ie, size_t resp_ie_len, gfp_t gfp)
13632 {
13633 struct sk_buff *msg;
13634 void *hdr;
13635
13636 msg = nlmsg_new(100 + req_ie_len + resp_ie_len, gfp);
13637 if (!msg)
13638 return;
13639
13640 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
13641 if (!hdr) {
13642 nlmsg_free(msg);
13643 return;
13644 }
13645
13646 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13647 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13648 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
13649 (req_ie &&
13650 nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
13651 (resp_ie &&
13652 nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
13653 goto nla_put_failure;
13654
13655 genlmsg_end(msg, hdr);
13656
13657 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13658 NL80211_MCGRP_MLME, gfp);
13659 return;
13660
13661 nla_put_failure:
13662 genlmsg_cancel(msg, hdr);
13663 nlmsg_free(msg);
13664 }
13665
13666 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
13667 struct net_device *netdev, u16 reason,
13668 const u8 *ie, size_t ie_len, bool from_ap)
13669 {
13670 struct sk_buff *msg;
13671 void *hdr;
13672
13673 msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
13674 if (!msg)
13675 return;
13676
13677 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
13678 if (!hdr) {
13679 nlmsg_free(msg);
13680 return;
13681 }
13682
13683 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13684 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13685 (from_ap && reason &&
13686 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
13687 (from_ap &&
13688 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
13689 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
13690 goto nla_put_failure;
13691
13692 genlmsg_end(msg, hdr);
13693
13694 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13695 NL80211_MCGRP_MLME, GFP_KERNEL);
13696 return;
13697
13698 nla_put_failure:
13699 genlmsg_cancel(msg, hdr);
13700 nlmsg_free(msg);
13701 }
13702
13703 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
13704 struct net_device *netdev, const u8 *bssid,
13705 gfp_t gfp)
13706 {
13707 struct sk_buff *msg;
13708 void *hdr;
13709
13710 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13711 if (!msg)
13712 return;
13713
13714 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
13715 if (!hdr) {
13716 nlmsg_free(msg);
13717 return;
13718 }
13719
13720 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13721 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13722 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
13723 goto nla_put_failure;
13724
13725 genlmsg_end(msg, hdr);
13726
13727 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13728 NL80211_MCGRP_MLME, gfp);
13729 return;
13730
13731 nla_put_failure:
13732 genlmsg_cancel(msg, hdr);
13733 nlmsg_free(msg);
13734 }
13735
13736 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
13737 const u8* ie, u8 ie_len, gfp_t gfp)
13738 {
13739 struct wireless_dev *wdev = dev->ieee80211_ptr;
13740 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
13741 struct sk_buff *msg;
13742 void *hdr;
13743
13744 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
13745 return;
13746
13747 trace_cfg80211_notify_new_peer_candidate(dev, addr);
13748
13749 msg = nlmsg_new(100 + ie_len, gfp);
13750 if (!msg)
13751 return;
13752
13753 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
13754 if (!hdr) {
13755 nlmsg_free(msg);
13756 return;
13757 }
13758
13759 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13760 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
13761 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
13762 (ie_len && ie &&
13763 nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
13764 goto nla_put_failure;
13765
13766 genlmsg_end(msg, hdr);
13767
13768 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13769 NL80211_MCGRP_MLME, gfp);
13770 return;
13771
13772 nla_put_failure:
13773 genlmsg_cancel(msg, hdr);
13774 nlmsg_free(msg);
13775 }
13776 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
13777
13778 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
13779 struct net_device *netdev, const u8 *addr,
13780 enum nl80211_key_type key_type, int key_id,
13781 const u8 *tsc, gfp_t gfp)
13782 {
13783 struct sk_buff *msg;
13784 void *hdr;
13785
13786 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13787 if (!msg)
13788 return;
13789
13790 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
13791 if (!hdr) {
13792 nlmsg_free(msg);
13793 return;
13794 }
13795
13796 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13797 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13798 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
13799 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
13800 (key_id != -1 &&
13801 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
13802 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
13803 goto nla_put_failure;
13804
13805 genlmsg_end(msg, hdr);
13806
13807 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13808 NL80211_MCGRP_MLME, gfp);
13809 return;
13810
13811 nla_put_failure:
13812 genlmsg_cancel(msg, hdr);
13813 nlmsg_free(msg);
13814 }
13815
13816 void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
13817 struct ieee80211_channel *channel_before,
13818 struct ieee80211_channel *channel_after)
13819 {
13820 struct sk_buff *msg;
13821 void *hdr;
13822 struct nlattr *nl_freq;
13823
13824 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
13825 if (!msg)
13826 return;
13827
13828 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
13829 if (!hdr) {
13830 nlmsg_free(msg);
13831 return;
13832 }
13833
13834 /*
13835 * Since we are applying the beacon hint to a wiphy we know its
13836 * wiphy_idx is valid
13837 */
13838 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
13839 goto nla_put_failure;
13840
13841 /* Before */
13842 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
13843 if (!nl_freq)
13844 goto nla_put_failure;
13845 if (nl80211_msg_put_channel(msg, channel_before, false))
13846 goto nla_put_failure;
13847 nla_nest_end(msg, nl_freq);
13848
13849 /* After */
13850 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
13851 if (!nl_freq)
13852 goto nla_put_failure;
13853 if (nl80211_msg_put_channel(msg, channel_after, false))
13854 goto nla_put_failure;
13855 nla_nest_end(msg, nl_freq);
13856
13857 genlmsg_end(msg, hdr);
13858
13859 rcu_read_lock();
13860 genlmsg_multicast_allns(&nl80211_fam, msg, 0,
13861 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
13862 rcu_read_unlock();
13863
13864 return;
13865
13866 nla_put_failure:
13867 genlmsg_cancel(msg, hdr);
13868 nlmsg_free(msg);
13869 }
13870
13871 static void nl80211_send_remain_on_chan_event(
13872 int cmd, struct cfg80211_registered_device *rdev,
13873 struct wireless_dev *wdev, u64 cookie,
13874 struct ieee80211_channel *chan,
13875 unsigned int duration, gfp_t gfp)
13876 {
13877 struct sk_buff *msg;
13878 void *hdr;
13879
13880 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13881 if (!msg)
13882 return;
13883
13884 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13885 if (!hdr) {
13886 nlmsg_free(msg);
13887 return;
13888 }
13889
13890 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13891 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13892 wdev->netdev->ifindex)) ||
13893 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13894 NL80211_ATTR_PAD) ||
13895 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
13896 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
13897 NL80211_CHAN_NO_HT) ||
13898 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
13899 NL80211_ATTR_PAD))
13900 goto nla_put_failure;
13901
13902 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
13903 nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
13904 goto nla_put_failure;
13905
13906 genlmsg_end(msg, hdr);
13907
13908 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13909 NL80211_MCGRP_MLME, gfp);
13910 return;
13911
13912 nla_put_failure:
13913 genlmsg_cancel(msg, hdr);
13914 nlmsg_free(msg);
13915 }
13916
13917 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
13918 struct ieee80211_channel *chan,
13919 unsigned int duration, gfp_t gfp)
13920 {
13921 struct wiphy *wiphy = wdev->wiphy;
13922 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13923
13924 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
13925 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
13926 rdev, wdev, cookie, chan,
13927 duration, gfp);
13928 }
13929 EXPORT_SYMBOL(cfg80211_ready_on_channel);
13930
13931 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
13932 struct ieee80211_channel *chan,
13933 gfp_t gfp)
13934 {
13935 struct wiphy *wiphy = wdev->wiphy;
13936 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13937
13938 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
13939 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
13940 rdev, wdev, cookie, chan, 0, gfp);
13941 }
13942 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
13943
13944 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
13945 struct station_info *sinfo, gfp_t gfp)
13946 {
13947 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
13948 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13949 struct sk_buff *msg;
13950
13951 trace_cfg80211_new_sta(dev, mac_addr, sinfo);
13952
13953 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13954 if (!msg)
13955 return;
13956
13957 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
13958 rdev, dev, mac_addr, sinfo) < 0) {
13959 nlmsg_free(msg);
13960 return;
13961 }
13962
13963 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13964 NL80211_MCGRP_MLME, gfp);
13965 }
13966 EXPORT_SYMBOL(cfg80211_new_sta);
13967
13968 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
13969 struct station_info *sinfo, gfp_t gfp)
13970 {
13971 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
13972 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13973 struct sk_buff *msg;
13974 struct station_info empty_sinfo = {};
13975
13976 if (!sinfo)
13977 sinfo = &empty_sinfo;
13978
13979 trace_cfg80211_del_sta(dev, mac_addr);
13980
13981 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13982 if (!msg)
13983 return;
13984
13985 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
13986 rdev, dev, mac_addr, sinfo) < 0) {
13987 nlmsg_free(msg);
13988 return;
13989 }
13990
13991 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13992 NL80211_MCGRP_MLME, gfp);
13993 }
13994 EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
13995
13996 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
13997 enum nl80211_connect_failed_reason reason,
13998 gfp_t gfp)
13999 {
14000 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
14001 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14002 struct sk_buff *msg;
14003 void *hdr;
14004
14005 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
14006 if (!msg)
14007 return;
14008
14009 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
14010 if (!hdr) {
14011 nlmsg_free(msg);
14012 return;
14013 }
14014
14015 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14016 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
14017 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
14018 goto nla_put_failure;
14019
14020 genlmsg_end(msg, hdr);
14021
14022 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14023 NL80211_MCGRP_MLME, gfp);
14024 return;
14025
14026 nla_put_failure:
14027 genlmsg_cancel(msg, hdr);
14028 nlmsg_free(msg);
14029 }
14030 EXPORT_SYMBOL(cfg80211_conn_failed);
14031
14032 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
14033 const u8 *addr, gfp_t gfp)
14034 {
14035 struct wireless_dev *wdev = dev->ieee80211_ptr;
14036 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14037 struct sk_buff *msg;
14038 void *hdr;
14039 u32 nlportid = ACCESS_ONCE(wdev->ap_unexpected_nlportid);
14040
14041 if (!nlportid)
14042 return false;
14043
14044 msg = nlmsg_new(100, gfp);
14045 if (!msg)
14046 return true;
14047
14048 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
14049 if (!hdr) {
14050 nlmsg_free(msg);
14051 return true;
14052 }
14053
14054 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14055 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14056 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
14057 goto nla_put_failure;
14058
14059 genlmsg_end(msg, hdr);
14060 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
14061 return true;
14062
14063 nla_put_failure:
14064 genlmsg_cancel(msg, hdr);
14065 nlmsg_free(msg);
14066 return true;
14067 }
14068
14069 bool cfg80211_rx_spurious_frame(struct net_device *dev,
14070 const u8 *addr, gfp_t gfp)
14071 {
14072 struct wireless_dev *wdev = dev->ieee80211_ptr;
14073 bool ret;
14074
14075 trace_cfg80211_rx_spurious_frame(dev, addr);
14076
14077 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
14078 wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
14079 trace_cfg80211_return_bool(false);
14080 return false;
14081 }
14082 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
14083 addr, gfp);
14084 trace_cfg80211_return_bool(ret);
14085 return ret;
14086 }
14087 EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
14088
14089 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
14090 const u8 *addr, gfp_t gfp)
14091 {
14092 struct wireless_dev *wdev = dev->ieee80211_ptr;
14093 bool ret;
14094
14095 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
14096
14097 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
14098 wdev->iftype != NL80211_IFTYPE_P2P_GO &&
14099 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
14100 trace_cfg80211_return_bool(false);
14101 return false;
14102 }
14103 ret = __nl80211_unexpected_frame(dev,
14104 NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
14105 addr, gfp);
14106 trace_cfg80211_return_bool(ret);
14107 return ret;
14108 }
14109 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
14110
14111 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
14112 struct wireless_dev *wdev, u32 nlportid,
14113 int freq, int sig_dbm,
14114 const u8 *buf, size_t len, u32 flags, gfp_t gfp)
14115 {
14116 struct net_device *netdev = wdev->netdev;
14117 struct sk_buff *msg;
14118 void *hdr;
14119
14120 msg = nlmsg_new(100 + len, gfp);
14121 if (!msg)
14122 return -ENOMEM;
14123
14124 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
14125 if (!hdr) {
14126 nlmsg_free(msg);
14127 return -ENOMEM;
14128 }
14129
14130 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14131 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14132 netdev->ifindex)) ||
14133 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14134 NL80211_ATTR_PAD) ||
14135 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
14136 (sig_dbm &&
14137 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
14138 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
14139 (flags &&
14140 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
14141 goto nla_put_failure;
14142
14143 genlmsg_end(msg, hdr);
14144
14145 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
14146
14147 nla_put_failure:
14148 genlmsg_cancel(msg, hdr);
14149 nlmsg_free(msg);
14150 return -ENOBUFS;
14151 }
14152
14153 void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
14154 const u8 *buf, size_t len, bool ack, gfp_t gfp)
14155 {
14156 struct wiphy *wiphy = wdev->wiphy;
14157 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14158 struct net_device *netdev = wdev->netdev;
14159 struct sk_buff *msg;
14160 void *hdr;
14161
14162 trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
14163
14164 msg = nlmsg_new(100 + len, gfp);
14165 if (!msg)
14166 return;
14167
14168 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
14169 if (!hdr) {
14170 nlmsg_free(msg);
14171 return;
14172 }
14173
14174 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14175 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14176 netdev->ifindex)) ||
14177 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14178 NL80211_ATTR_PAD) ||
14179 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
14180 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14181 NL80211_ATTR_PAD) ||
14182 (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
14183 goto nla_put_failure;
14184
14185 genlmsg_end(msg, hdr);
14186
14187 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14188 NL80211_MCGRP_MLME, gfp);
14189 return;
14190
14191 nla_put_failure:
14192 genlmsg_cancel(msg, hdr);
14193 nlmsg_free(msg);
14194 }
14195 EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
14196
14197 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
14198 const char *mac, gfp_t gfp)
14199 {
14200 struct wireless_dev *wdev = dev->ieee80211_ptr;
14201 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14202 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14203 void **cb;
14204
14205 if (!msg)
14206 return NULL;
14207
14208 cb = (void **)msg->cb;
14209
14210 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
14211 if (!cb[0]) {
14212 nlmsg_free(msg);
14213 return NULL;
14214 }
14215
14216 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14217 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
14218 goto nla_put_failure;
14219
14220 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
14221 goto nla_put_failure;
14222
14223 cb[1] = nla_nest_start(msg, NL80211_ATTR_CQM);
14224 if (!cb[1])
14225 goto nla_put_failure;
14226
14227 cb[2] = rdev;
14228
14229 return msg;
14230 nla_put_failure:
14231 nlmsg_free(msg);
14232 return NULL;
14233 }
14234
14235 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
14236 {
14237 void **cb = (void **)msg->cb;
14238 struct cfg80211_registered_device *rdev = cb[2];
14239
14240 nla_nest_end(msg, cb[1]);
14241 genlmsg_end(msg, cb[0]);
14242
14243 memset(msg->cb, 0, sizeof(msg->cb));
14244
14245 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14246 NL80211_MCGRP_MLME, gfp);
14247 }
14248
14249 void cfg80211_cqm_rssi_notify(struct net_device *dev,
14250 enum nl80211_cqm_rssi_threshold_event rssi_event,
14251 s32 rssi_level, gfp_t gfp)
14252 {
14253 struct sk_buff *msg;
14254 struct wireless_dev *wdev = dev->ieee80211_ptr;
14255 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14256
14257 trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
14258
14259 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
14260 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
14261 return;
14262
14263 if (wdev->cqm_config) {
14264 wdev->cqm_config->last_rssi_event_value = rssi_level;
14265
14266 cfg80211_cqm_rssi_update(rdev, dev);
14267
14268 if (rssi_level == 0)
14269 rssi_level = wdev->cqm_config->last_rssi_event_value;
14270 }
14271
14272 msg = cfg80211_prepare_cqm(dev, NULL, gfp);
14273 if (!msg)
14274 return;
14275
14276 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
14277 rssi_event))
14278 goto nla_put_failure;
14279
14280 if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
14281 rssi_level))
14282 goto nla_put_failure;
14283
14284 cfg80211_send_cqm(msg, gfp);
14285
14286 return;
14287
14288 nla_put_failure:
14289 nlmsg_free(msg);
14290 }
14291 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
14292
14293 void cfg80211_cqm_txe_notify(struct net_device *dev,
14294 const u8 *peer, u32 num_packets,
14295 u32 rate, u32 intvl, gfp_t gfp)
14296 {
14297 struct sk_buff *msg;
14298
14299 msg = cfg80211_prepare_cqm(dev, peer, gfp);
14300 if (!msg)
14301 return;
14302
14303 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
14304 goto nla_put_failure;
14305
14306 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
14307 goto nla_put_failure;
14308
14309 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
14310 goto nla_put_failure;
14311
14312 cfg80211_send_cqm(msg, gfp);
14313 return;
14314
14315 nla_put_failure:
14316 nlmsg_free(msg);
14317 }
14318 EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
14319
14320 void cfg80211_cqm_pktloss_notify(struct net_device *dev,
14321 const u8 *peer, u32 num_packets, gfp_t gfp)
14322 {
14323 struct sk_buff *msg;
14324
14325 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
14326
14327 msg = cfg80211_prepare_cqm(dev, peer, gfp);
14328 if (!msg)
14329 return;
14330
14331 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
14332 goto nla_put_failure;
14333
14334 cfg80211_send_cqm(msg, gfp);
14335 return;
14336
14337 nla_put_failure:
14338 nlmsg_free(msg);
14339 }
14340 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
14341
14342 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
14343 {
14344 struct sk_buff *msg;
14345
14346 msg = cfg80211_prepare_cqm(dev, NULL, gfp);
14347 if (!msg)
14348 return;
14349
14350 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
14351 goto nla_put_failure;
14352
14353 cfg80211_send_cqm(msg, gfp);
14354 return;
14355
14356 nla_put_failure:
14357 nlmsg_free(msg);
14358 }
14359 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
14360
14361 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
14362 struct net_device *netdev, const u8 *bssid,
14363 const u8 *replay_ctr, gfp_t gfp)
14364 {
14365 struct sk_buff *msg;
14366 struct nlattr *rekey_attr;
14367 void *hdr;
14368
14369 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14370 if (!msg)
14371 return;
14372
14373 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
14374 if (!hdr) {
14375 nlmsg_free(msg);
14376 return;
14377 }
14378
14379 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14380 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14381 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
14382 goto nla_put_failure;
14383
14384 rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
14385 if (!rekey_attr)
14386 goto nla_put_failure;
14387
14388 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
14389 NL80211_REPLAY_CTR_LEN, replay_ctr))
14390 goto nla_put_failure;
14391
14392 nla_nest_end(msg, rekey_attr);
14393
14394 genlmsg_end(msg, hdr);
14395
14396 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14397 NL80211_MCGRP_MLME, gfp);
14398 return;
14399
14400 nla_put_failure:
14401 genlmsg_cancel(msg, hdr);
14402 nlmsg_free(msg);
14403 }
14404
14405 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
14406 const u8 *replay_ctr, gfp_t gfp)
14407 {
14408 struct wireless_dev *wdev = dev->ieee80211_ptr;
14409 struct wiphy *wiphy = wdev->wiphy;
14410 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14411
14412 trace_cfg80211_gtk_rekey_notify(dev, bssid);
14413 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
14414 }
14415 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
14416
14417 static void
14418 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
14419 struct net_device *netdev, int index,
14420 const u8 *bssid, bool preauth, gfp_t gfp)
14421 {
14422 struct sk_buff *msg;
14423 struct nlattr *attr;
14424 void *hdr;
14425
14426 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14427 if (!msg)
14428 return;
14429
14430 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
14431 if (!hdr) {
14432 nlmsg_free(msg);
14433 return;
14434 }
14435
14436 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14437 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
14438 goto nla_put_failure;
14439
14440 attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
14441 if (!attr)
14442 goto nla_put_failure;
14443
14444 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
14445 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
14446 (preauth &&
14447 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
14448 goto nla_put_failure;
14449
14450 nla_nest_end(msg, attr);
14451
14452 genlmsg_end(msg, hdr);
14453
14454 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14455 NL80211_MCGRP_MLME, gfp);
14456 return;
14457
14458 nla_put_failure:
14459 genlmsg_cancel(msg, hdr);
14460 nlmsg_free(msg);
14461 }
14462
14463 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
14464 const u8 *bssid, bool preauth, gfp_t gfp)
14465 {
14466 struct wireless_dev *wdev = dev->ieee80211_ptr;
14467 struct wiphy *wiphy = wdev->wiphy;
14468 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14469
14470 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
14471 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
14472 }
14473 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
14474
14475 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
14476 struct net_device *netdev,
14477 struct cfg80211_chan_def *chandef,
14478 gfp_t gfp,
14479 enum nl80211_commands notif,
14480 u8 count)
14481 {
14482 struct sk_buff *msg;
14483 void *hdr;
14484
14485 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14486 if (!msg)
14487 return;
14488
14489 hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
14490 if (!hdr) {
14491 nlmsg_free(msg);
14492 return;
14493 }
14494
14495 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
14496 goto nla_put_failure;
14497
14498 if (nl80211_send_chandef(msg, chandef))
14499 goto nla_put_failure;
14500
14501 if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
14502 (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
14503 goto nla_put_failure;
14504
14505 genlmsg_end(msg, hdr);
14506
14507 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14508 NL80211_MCGRP_MLME, gfp);
14509 return;
14510
14511 nla_put_failure:
14512 genlmsg_cancel(msg, hdr);
14513 nlmsg_free(msg);
14514 }
14515
14516 void cfg80211_ch_switch_notify(struct net_device *dev,
14517 struct cfg80211_chan_def *chandef)
14518 {
14519 struct wireless_dev *wdev = dev->ieee80211_ptr;
14520 struct wiphy *wiphy = wdev->wiphy;
14521 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14522
14523 ASSERT_WDEV_LOCK(wdev);
14524
14525 trace_cfg80211_ch_switch_notify(dev, chandef);
14526
14527 wdev->chandef = *chandef;
14528 wdev->preset_chandef = *chandef;
14529 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
14530 NL80211_CMD_CH_SWITCH_NOTIFY, 0);
14531 }
14532 EXPORT_SYMBOL(cfg80211_ch_switch_notify);
14533
14534 void cfg80211_ch_switch_started_notify(struct net_device *dev,
14535 struct cfg80211_chan_def *chandef,
14536 u8 count)
14537 {
14538 struct wireless_dev *wdev = dev->ieee80211_ptr;
14539 struct wiphy *wiphy = wdev->wiphy;
14540 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14541
14542 trace_cfg80211_ch_switch_started_notify(dev, chandef);
14543
14544 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
14545 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
14546 }
14547 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
14548
14549 void
14550 nl80211_radar_notify(struct cfg80211_registered_device *rdev,
14551 const struct cfg80211_chan_def *chandef,
14552 enum nl80211_radar_event event,
14553 struct net_device *netdev, gfp_t gfp)
14554 {
14555 struct sk_buff *msg;
14556 void *hdr;
14557
14558 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14559 if (!msg)
14560 return;
14561
14562 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
14563 if (!hdr) {
14564 nlmsg_free(msg);
14565 return;
14566 }
14567
14568 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
14569 goto nla_put_failure;
14570
14571 /* NOP and radar events don't need a netdev parameter */
14572 if (netdev) {
14573 struct wireless_dev *wdev = netdev->ieee80211_ptr;
14574
14575 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14576 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14577 NL80211_ATTR_PAD))
14578 goto nla_put_failure;
14579 }
14580
14581 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
14582 goto nla_put_failure;
14583
14584 if (nl80211_send_chandef(msg, chandef))
14585 goto nla_put_failure;
14586
14587 genlmsg_end(msg, hdr);
14588
14589 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14590 NL80211_MCGRP_MLME, gfp);
14591 return;
14592
14593 nla_put_failure:
14594 genlmsg_cancel(msg, hdr);
14595 nlmsg_free(msg);
14596 }
14597
14598 void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
14599 u64 cookie, bool acked, gfp_t gfp)
14600 {
14601 struct wireless_dev *wdev = dev->ieee80211_ptr;
14602 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14603 struct sk_buff *msg;
14604 void *hdr;
14605
14606 trace_cfg80211_probe_status(dev, addr, cookie, acked);
14607
14608 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14609
14610 if (!msg)
14611 return;
14612
14613 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
14614 if (!hdr) {
14615 nlmsg_free(msg);
14616 return;
14617 }
14618
14619 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14620 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14621 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
14622 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14623 NL80211_ATTR_PAD) ||
14624 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)))
14625 goto nla_put_failure;
14626
14627 genlmsg_end(msg, hdr);
14628
14629 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14630 NL80211_MCGRP_MLME, gfp);
14631 return;
14632
14633 nla_put_failure:
14634 genlmsg_cancel(msg, hdr);
14635 nlmsg_free(msg);
14636 }
14637 EXPORT_SYMBOL(cfg80211_probe_status);
14638
14639 void cfg80211_report_obss_beacon(struct wiphy *wiphy,
14640 const u8 *frame, size_t len,
14641 int freq, int sig_dbm)
14642 {
14643 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14644 struct sk_buff *msg;
14645 void *hdr;
14646 struct cfg80211_beacon_registration *reg;
14647
14648 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
14649
14650 spin_lock_bh(&rdev->beacon_registrations_lock);
14651 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
14652 msg = nlmsg_new(len + 100, GFP_ATOMIC);
14653 if (!msg) {
14654 spin_unlock_bh(&rdev->beacon_registrations_lock);
14655 return;
14656 }
14657
14658 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
14659 if (!hdr)
14660 goto nla_put_failure;
14661
14662 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14663 (freq &&
14664 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
14665 (sig_dbm &&
14666 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
14667 nla_put(msg, NL80211_ATTR_FRAME, len, frame))
14668 goto nla_put_failure;
14669
14670 genlmsg_end(msg, hdr);
14671
14672 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
14673 }
14674 spin_unlock_bh(&rdev->beacon_registrations_lock);
14675 return;
14676
14677 nla_put_failure:
14678 spin_unlock_bh(&rdev->beacon_registrations_lock);
14679 if (hdr)
14680 genlmsg_cancel(msg, hdr);
14681 nlmsg_free(msg);
14682 }
14683 EXPORT_SYMBOL(cfg80211_report_obss_beacon);
14684
14685 #ifdef CONFIG_PM
14686 static int cfg80211_net_detect_results(struct sk_buff *msg,
14687 struct cfg80211_wowlan_wakeup *wakeup)
14688 {
14689 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
14690 struct nlattr *nl_results, *nl_match, *nl_freqs;
14691 int i, j;
14692
14693 nl_results = nla_nest_start(
14694 msg, NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
14695 if (!nl_results)
14696 return -EMSGSIZE;
14697
14698 for (i = 0; i < nd->n_matches; i++) {
14699 struct cfg80211_wowlan_nd_match *match = nd->matches[i];
14700
14701 nl_match = nla_nest_start(msg, i);
14702 if (!nl_match)
14703 break;
14704
14705 /* The SSID attribute is optional in nl80211, but for
14706 * simplicity reasons it's always present in the
14707 * cfg80211 structure. If a driver can't pass the
14708 * SSID, that needs to be changed. A zero length SSID
14709 * is still a valid SSID (wildcard), so it cannot be
14710 * used for this purpose.
14711 */
14712 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
14713 match->ssid.ssid)) {
14714 nla_nest_cancel(msg, nl_match);
14715 goto out;
14716 }
14717
14718 if (match->n_channels) {
14719 nl_freqs = nla_nest_start(
14720 msg, NL80211_ATTR_SCAN_FREQUENCIES);
14721 if (!nl_freqs) {
14722 nla_nest_cancel(msg, nl_match);
14723 goto out;
14724 }
14725
14726 for (j = 0; j < match->n_channels; j++) {
14727 if (nla_put_u32(msg, j, match->channels[j])) {
14728 nla_nest_cancel(msg, nl_freqs);
14729 nla_nest_cancel(msg, nl_match);
14730 goto out;
14731 }
14732 }
14733
14734 nla_nest_end(msg, nl_freqs);
14735 }
14736
14737 nla_nest_end(msg, nl_match);
14738 }
14739
14740 out:
14741 nla_nest_end(msg, nl_results);
14742 return 0;
14743 }
14744
14745 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
14746 struct cfg80211_wowlan_wakeup *wakeup,
14747 gfp_t gfp)
14748 {
14749 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14750 struct sk_buff *msg;
14751 void *hdr;
14752 int size = 200;
14753
14754 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
14755
14756 if (wakeup)
14757 size += wakeup->packet_present_len;
14758
14759 msg = nlmsg_new(size, gfp);
14760 if (!msg)
14761 return;
14762
14763 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
14764 if (!hdr)
14765 goto free_msg;
14766
14767 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14768 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14769 NL80211_ATTR_PAD))
14770 goto free_msg;
14771
14772 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14773 wdev->netdev->ifindex))
14774 goto free_msg;
14775
14776 if (wakeup) {
14777 struct nlattr *reasons;
14778
14779 reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
14780 if (!reasons)
14781 goto free_msg;
14782
14783 if (wakeup->disconnect &&
14784 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
14785 goto free_msg;
14786 if (wakeup->magic_pkt &&
14787 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
14788 goto free_msg;
14789 if (wakeup->gtk_rekey_failure &&
14790 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
14791 goto free_msg;
14792 if (wakeup->eap_identity_req &&
14793 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
14794 goto free_msg;
14795 if (wakeup->four_way_handshake &&
14796 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
14797 goto free_msg;
14798 if (wakeup->rfkill_release &&
14799 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
14800 goto free_msg;
14801
14802 if (wakeup->pattern_idx >= 0 &&
14803 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
14804 wakeup->pattern_idx))
14805 goto free_msg;
14806
14807 if (wakeup->tcp_match &&
14808 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
14809 goto free_msg;
14810
14811 if (wakeup->tcp_connlost &&
14812 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
14813 goto free_msg;
14814
14815 if (wakeup->tcp_nomoretokens &&
14816 nla_put_flag(msg,
14817 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
14818 goto free_msg;
14819
14820 if (wakeup->packet) {
14821 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
14822 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
14823
14824 if (!wakeup->packet_80211) {
14825 pkt_attr =
14826 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
14827 len_attr =
14828 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
14829 }
14830
14831 if (wakeup->packet_len &&
14832 nla_put_u32(msg, len_attr, wakeup->packet_len))
14833 goto free_msg;
14834
14835 if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
14836 wakeup->packet))
14837 goto free_msg;
14838 }
14839
14840 if (wakeup->net_detect &&
14841 cfg80211_net_detect_results(msg, wakeup))
14842 goto free_msg;
14843
14844 nla_nest_end(msg, reasons);
14845 }
14846
14847 genlmsg_end(msg, hdr);
14848
14849 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14850 NL80211_MCGRP_MLME, gfp);
14851 return;
14852
14853 free_msg:
14854 nlmsg_free(msg);
14855 }
14856 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
14857 #endif
14858
14859 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
14860 enum nl80211_tdls_operation oper,
14861 u16 reason_code, gfp_t gfp)
14862 {
14863 struct wireless_dev *wdev = dev->ieee80211_ptr;
14864 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14865 struct sk_buff *msg;
14866 void *hdr;
14867
14868 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
14869 reason_code);
14870
14871 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14872 if (!msg)
14873 return;
14874
14875 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
14876 if (!hdr) {
14877 nlmsg_free(msg);
14878 return;
14879 }
14880
14881 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14882 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14883 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
14884 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
14885 (reason_code > 0 &&
14886 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
14887 goto nla_put_failure;
14888
14889 genlmsg_end(msg, hdr);
14890
14891 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14892 NL80211_MCGRP_MLME, gfp);
14893 return;
14894
14895 nla_put_failure:
14896 genlmsg_cancel(msg, hdr);
14897 nlmsg_free(msg);
14898 }
14899 EXPORT_SYMBOL(cfg80211_tdls_oper_request);
14900
14901 static int nl80211_netlink_notify(struct notifier_block * nb,
14902 unsigned long state,
14903 void *_notify)
14904 {
14905 struct netlink_notify *notify = _notify;
14906 struct cfg80211_registered_device *rdev;
14907 struct wireless_dev *wdev;
14908 struct cfg80211_beacon_registration *reg, *tmp;
14909
14910 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
14911 return NOTIFY_DONE;
14912
14913 rcu_read_lock();
14914
14915 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
14916 struct cfg80211_sched_scan_request *sched_scan_req;
14917
14918 list_for_each_entry_rcu(sched_scan_req,
14919 &rdev->sched_scan_req_list,
14920 list) {
14921 if (sched_scan_req->owner_nlportid == notify->portid) {
14922 sched_scan_req->nl_owner_dead = true;
14923 schedule_work(&rdev->sched_scan_stop_wk);
14924 }
14925 }
14926
14927 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
14928 cfg80211_mlme_unregister_socket(wdev, notify->portid);
14929
14930 if (wdev->owner_nlportid == notify->portid) {
14931 wdev->nl_owner_dead = true;
14932 schedule_work(&rdev->destroy_work);
14933 } else if (wdev->conn_owner_nlportid == notify->portid) {
14934 schedule_work(&wdev->disconnect_wk);
14935 }
14936 }
14937
14938 spin_lock_bh(&rdev->beacon_registrations_lock);
14939 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
14940 list) {
14941 if (reg->nlportid == notify->portid) {
14942 list_del(&reg->list);
14943 kfree(reg);
14944 break;
14945 }
14946 }
14947 spin_unlock_bh(&rdev->beacon_registrations_lock);
14948 }
14949
14950 rcu_read_unlock();
14951
14952 /*
14953 * It is possible that the user space process that is controlling the
14954 * indoor setting disappeared, so notify the regulatory core.
14955 */
14956 regulatory_netlink_notify(notify->portid);
14957 return NOTIFY_OK;
14958 }
14959
14960 static struct notifier_block nl80211_netlink_notifier = {
14961 .notifier_call = nl80211_netlink_notify,
14962 };
14963
14964 void cfg80211_ft_event(struct net_device *netdev,
14965 struct cfg80211_ft_event_params *ft_event)
14966 {
14967 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
14968 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14969 struct sk_buff *msg;
14970 void *hdr;
14971
14972 trace_cfg80211_ft_event(wiphy, netdev, ft_event);
14973
14974 if (!ft_event->target_ap)
14975 return;
14976
14977 msg = nlmsg_new(100 + ft_event->ric_ies_len, GFP_KERNEL);
14978 if (!msg)
14979 return;
14980
14981 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
14982 if (!hdr)
14983 goto out;
14984
14985 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14986 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14987 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
14988 goto out;
14989
14990 if (ft_event->ies &&
14991 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
14992 goto out;
14993 if (ft_event->ric_ies &&
14994 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
14995 ft_event->ric_ies))
14996 goto out;
14997
14998 genlmsg_end(msg, hdr);
14999
15000 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15001 NL80211_MCGRP_MLME, GFP_KERNEL);
15002 return;
15003 out:
15004 nlmsg_free(msg);
15005 }
15006 EXPORT_SYMBOL(cfg80211_ft_event);
15007
15008 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
15009 {
15010 struct cfg80211_registered_device *rdev;
15011 struct sk_buff *msg;
15012 void *hdr;
15013 u32 nlportid;
15014
15015 rdev = wiphy_to_rdev(wdev->wiphy);
15016 if (!rdev->crit_proto_nlportid)
15017 return;
15018
15019 nlportid = rdev->crit_proto_nlportid;
15020 rdev->crit_proto_nlportid = 0;
15021
15022 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15023 if (!msg)
15024 return;
15025
15026 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
15027 if (!hdr)
15028 goto nla_put_failure;
15029
15030 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15031 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15032 NL80211_ATTR_PAD))
15033 goto nla_put_failure;
15034
15035 genlmsg_end(msg, hdr);
15036
15037 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15038 return;
15039
15040 nla_put_failure:
15041 if (hdr)
15042 genlmsg_cancel(msg, hdr);
15043 nlmsg_free(msg);
15044 }
15045 EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
15046
15047 void nl80211_send_ap_stopped(struct wireless_dev *wdev)
15048 {
15049 struct wiphy *wiphy = wdev->wiphy;
15050 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15051 struct sk_buff *msg;
15052 void *hdr;
15053
15054 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15055 if (!msg)
15056 return;
15057
15058 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
15059 if (!hdr)
15060 goto out;
15061
15062 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15063 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
15064 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15065 NL80211_ATTR_PAD))
15066 goto out;
15067
15068 genlmsg_end(msg, hdr);
15069
15070 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
15071 NL80211_MCGRP_MLME, GFP_KERNEL);
15072 return;
15073 out:
15074 nlmsg_free(msg);
15075 }
15076
15077 /* initialisation/exit functions */
15078
15079 int __init nl80211_init(void)
15080 {
15081 int err;
15082
15083 err = genl_register_family(&nl80211_fam);
15084 if (err)
15085 return err;
15086
15087 err = netlink_register_notifier(&nl80211_netlink_notifier);
15088 if (err)
15089 goto err_out;
15090
15091 return 0;
15092 err_out:
15093 genl_unregister_family(&nl80211_fam);
15094 return err;
15095 }
15096
15097 void nl80211_exit(void)
15098 {
15099 netlink_unregister_notifier(&nl80211_netlink_notifier);
15100 genl_unregister_family(&nl80211_fam);
15101 }
Ubuntu Artful kernel mirror