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