]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - net/wireless/nl80211.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
cfg80211: provide a function to report a match for NAN
[mirror_ubuntu-bionic-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
0c9ca11b 6 * Copyright 2015-2016 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,
50bcd31d 59 NL80211_MCGRP_NAN,
2a94fe48
JB		 60 NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
61};
62
63static const struct genl_multicast_group nl80211_mcgrps[] = {
71b836ec
JB		 64 [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
65 [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
66 [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
67 [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
68 [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
50bcd31d 69 [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
2a94fe48 70#ifdef CONFIG_NL80211_TESTMODE
71b836ec 71 [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
2a94fe48
JB		 72#endif
73};
74
89a54e48
JB		 75/* returns ERR_PTR values */
76static struct wireless_dev *
77__cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
55682965 78{
89a54e48
JB		 79 struct cfg80211_registered_device *rdev;
80 struct wireless_dev *result = NULL;
81 bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
82 bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
83 u64 wdev_id;
84 int wiphy_idx = -1;
85 int ifidx = -1;
55682965 86
5fe231e8 87 ASSERT_RTNL();
55682965 88
89a54e48
JB		 89 if (!have_ifidx && !have_wdev_id)
90 return ERR_PTR(-EINVAL);
55682965 91
89a54e48
JB		 92 if (have_ifidx)
93 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
94 if (have_wdev_id) {
95 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
96 wiphy_idx = wdev_id >> 32;
55682965
JB		 97 }
98
89a54e48
JB		 99 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
100 struct wireless_dev *wdev;
101
102 if (wiphy_net(&rdev->wiphy) != netns)
103 continue;
104
105 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
106 continue;
107
53873f13 108 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
89a54e48
JB		 109 if (have_ifidx && wdev->netdev &&
110 wdev->netdev->ifindex == ifidx) {
111 result = wdev;
112 break;
113 }
114 if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
115 result = wdev;
116 break;
117 }
118 }
89a54e48
JB		 119
120 if (result)
121 break;
122 }
123
124 if (result)
125 return result;
126 return ERR_PTR(-ENODEV);
55682965
JB		 127}
128
a9455408 129static struct cfg80211_registered_device *
878d9ec7 130__cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
a9455408 131{
7fee4778
JB		 132 struct cfg80211_registered_device *rdev = NULL, *tmp;
133 struct net_device *netdev;
a9455408 134
5fe231e8 135 ASSERT_RTNL();
a9455408 136
878d9ec7 137 if (!attrs[NL80211_ATTR_WIPHY] &&
89a54e48
JB		 138 !attrs[NL80211_ATTR_IFINDEX] &&
139 !attrs[NL80211_ATTR_WDEV])
7fee4778
JB		 140 return ERR_PTR(-EINVAL);
141
878d9ec7 142 if (attrs[NL80211_ATTR_WIPHY])
7fee4778 143 rdev = cfg80211_rdev_by_wiphy_idx(
878d9ec7 144 nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
a9455408 145
89a54e48
JB		 146 if (attrs[NL80211_ATTR_WDEV]) {
147 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
148 struct wireless_dev *wdev;
149 bool found = false;
150
151 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
152 if (tmp) {
153 /* make sure wdev exists */
53873f13 154 list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
89a54e48
JB		 155 if (wdev->identifier != (u32)wdev_id)
156 continue;
157 found = true;
158 break;
159 }
89a54e48
JB		 160
161 if (!found)
162 tmp = NULL;
163
164 if (rdev && tmp != rdev)
165 return ERR_PTR(-EINVAL);
166 rdev = tmp;
167 }
168 }
169
878d9ec7
JB		 170 if (attrs[NL80211_ATTR_IFINDEX]) {
171 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
7a087e74 172
7f2b8562 173 netdev = __dev_get_by_index(netns, ifindex);
7fee4778
JB		 174 if (netdev) {
175 if (netdev->ieee80211_ptr)
f26cbf40
ZG		 176 tmp = wiphy_to_rdev(
177 netdev->ieee80211_ptr->wiphy);
7fee4778
JB		 178 else
179 tmp = NULL;
180
7fee4778
JB		 181 /* not wireless device -- return error */
182 if (!tmp)
183 return ERR_PTR(-EINVAL);
184
185 /* mismatch -- return error */
186 if (rdev && tmp != rdev)
187 return ERR_PTR(-EINVAL);
188
189 rdev = tmp;
a9455408 190 }
a9455408 191 }
a9455408 192
4f7eff10
JB		 193 if (!rdev)
194 return ERR_PTR(-ENODEV);
a9455408 195
4f7eff10
JB		 196 if (netns != wiphy_net(&rdev->wiphy))
197 return ERR_PTR(-ENODEV);
198
199 return rdev;
a9455408
JB		 200}
201
202/*
203 * This function returns a pointer to the driver
204 * that the genl_info item that is passed refers to.
a9455408
JB		 205 *
206 * The result of this can be a PTR_ERR and hence must
207 * be checked with IS_ERR() for errors.
208 */
209static struct cfg80211_registered_device *
4f7eff10 210cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
a9455408 211{
5fe231e8 212 return __cfg80211_rdev_from_attrs(netns, info->attrs);
a9455408
JB		 213}
214
55682965 215/* policy for the attributes */
8cd4d456 216static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
55682965
JB		 217 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
218 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
079e24ed 219 .len = 20-1 },
31888487 220 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
3d9d1d66 221
72bdcf34 222 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
094d05dc 223 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
3d9d1d66
JB		 224 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
225 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
226 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
227
b9a5f8ca
JM		 228 [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
229 [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
230 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
231 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
81077e82 232 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
3057dbfd 233 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
55682965
JB		 234
235 [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
236 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
237 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
41ade00f 238
e007b857
EP		 239 [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
240 [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
41ade00f 241
b9454e83 242 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
41ade00f
JB		 243 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
244 .len = WLAN_MAX_KEY_LEN },
245 [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
246 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
247 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
81962267 248 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
e31b8213 249 [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
ed1b6cc7
JB		 250
251 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
252 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
253 [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
254 .len = IEEE80211_MAX_DATA_LEN },
255 [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
256 .len = IEEE80211_MAX_DATA_LEN },
5727ef1b
JB		 257 [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
258 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
259 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
260 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
261 .len = NL80211_MAX_SUPP_RATES },
2ec600d6 262 [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
5727ef1b 263 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
0a9542ee 264 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
2ec600d6 265 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
a4f606ea 266 .len = IEEE80211_MAX_MESH_ID_LEN },
2ec600d6 267 [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
9f1ba906 268
b2e1b302
LR		 269 [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
270 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
271
9f1ba906
JM		 272 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
273 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
274 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
90c97a04
JM		 275 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
276 .len = NL80211_MAX_SUPP_RATES },
50b12f59 277 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
36aedc90 278
24bdd9f4 279 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
15d5dda6 280 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
93da9cc1 281
6c739419 282 [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
9aed3cc1
JM		 283
284 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
285 [NL80211_ATTR_IE] = { .type = NLA_BINARY,
286 .len = IEEE80211_MAX_DATA_LEN },
2a519311
JB		 287 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
288 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
636a5d36
JM		 289
290 [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
291 .len = IEEE80211_MAX_SSID_LEN },
292 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
293 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
04a773ad 294 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
1965c853 295 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
dc6382ce 296 [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
eccb8e8f
JB		 297 [NL80211_ATTR_STA_FLAGS2] = {
298 .len = sizeof(struct nl80211_sta_flag_update),
299 },
3f77316c 300 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
c0692b8f
JB		 301 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
302 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
b23aa676
SO		 303 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
304 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
305 [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
463d0183 306 [NL80211_ATTR_PID] = { .type = NLA_U32 },
8b787643 307 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
67fbb16b
SO		 308 [NL80211_ATTR_PMKID] = { .type = NLA_BINARY,
309 .len = WLAN_PMKID_LEN },
9588bbd5
JM		 310 [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
311 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
13ae75b1 312 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
026331c4
JM		 313 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
314 .len = IEEE80211_MAX_DATA_LEN },
315 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
ffb9eb3d 316 [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
d6dc1a38 317 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
d5cdfacb 318 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
fd8aaaf3 319 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
98d2ff8b
JO		 320 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
321 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
2e161f78 322 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
afe0cbf8
BR		 323 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
324 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
885a46d0 325 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
f7ca38df 326 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
dbd2fd65 327 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
ff1b6e69 328 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
9c3990aa 329 [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
bbe6ad6d 330 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
e5497d76 331 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
34850ab2 332 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
32e9de84 333 [NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
9946ecfb
JM		 334 [NL80211_ATTR_IE_PROBE_RESP] = { .type = NLA_BINARY,
335 .len = IEEE80211_MAX_DATA_LEN },
336 [NL80211_ATTR_IE_ASSOC_RESP] = { .type = NLA_BINARY,
337 .len = IEEE80211_MAX_DATA_LEN },
f4b34b55 338 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
a1f1c21c 339 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
e9f935e3 340 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
109086ce
AN		 341 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
342 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
343 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
344 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
345 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
31fa97c5 346 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
e247bd90 347 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
00f740e1
AN		 348 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
349 .len = IEEE80211_MAX_DATA_LEN },
8b60b078 350 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
7e7c8926
BG		 351 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
352 [NL80211_ATTR_HT_CAPABILITY_MASK] = {
353 .len = NL80211_HT_CAPABILITY_LEN
354 },
1d9d9213 355 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
1b658f11 356 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
4486ea98 357 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
89a54e48 358 [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
57b5ce07 359 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
e39e5b5e 360 [NL80211_ATTR_SAE_DATA] = { .type = NLA_BINARY, },
f461be3e 361 [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
ed473771 362 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
53cabad7
JB		 363 [NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
364 [NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
77765eaf
VT		 365 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
366 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
9d62a986
JM		 367 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
368 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
3713b4e3 369 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
ee2aca34
JB		 370 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
371 [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
372 .len = NL80211_VHT_CAPABILITY_LEN,
373 },
355199e0
JM		 374 [NL80211_ATTR_MDID] = { .type = NLA_U16 },
375 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
376 .len = IEEE80211_MAX_DATA_LEN },
5e4b6f56 377 [NL80211_ATTR_PEER_AID] = { .type = NLA_U16 },
16ef1fe2
SW		 378 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
379 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
380 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
9a774c78
AO		 381 [NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
382 [NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
c01fc9ad
SD		 383 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
384 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
5336fa88 385 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
60f4a7b1 386 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
ad7e718c
JB		 387 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
388 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
389 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
fa9ffc74
KP		 390 [NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
391 .len = IEEE80211_QOS_MAP_LEN_MAX },
1df4a510
JM		 392 [NL80211_ATTR_MAC_HINT] = { .len = ETH_ALEN },
393 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
df942e7b 394 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
18e5ca65 395 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
34d22ce2 396 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
bab5ab7d 397 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
960d01ac
JB		 398 [NL80211_ATTR_TSID] = { .type = NLA_U8 },
399 [NL80211_ATTR_USER_PRIO] = { .type = NLA_U8 },
400 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
18998c38 401 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
ad2b26ab 402 [NL80211_ATTR_MAC_MASK] = { .len = ETH_ALEN },
1bdd716c 403 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
4b681c82 404 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
9c748934 405 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
05050753 406 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
34d50519 407 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
38de03d2 408 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
17b94247 409 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = { .type = NLA_U8 },
c6e6a0c8
AE		 410 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
411 .len = VHT_MUMIMO_GROUPS_DATA_LEN
412 },
413 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = { .len = ETH_ALEN },
cb3b7d87
AB		 414 [NL80211_ATTR_NAN_MASTER_PREF] = { .type = NLA_U8 },
415 [NL80211_ATTR_NAN_DUAL] = { .type = NLA_U8 },
a442b761 416 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
55682965
JB		 417};
418
e31b8213 419/* policy for the key attributes */
b54452b0 420static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
fffd0934 421 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
b9454e83
JB		 422 [NL80211_KEY_IDX] = { .type = NLA_U8 },
423 [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
81962267 424 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
b9454e83
JB		 425 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
426 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
e31b8213 427 [NL80211_KEY_TYPE] = { .type = NLA_U32 },
dbd2fd65
JB		 428 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
429};
430
431/* policy for the key default flags */
432static const struct nla_policy
433nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
434 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
435 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
b9454e83
JB		 436};
437
ff1b6e69
JB		 438/* policy for WoWLAN attributes */
439static const struct nla_policy
440nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
441 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
442 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
443 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
444 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
77dbbb13
JB		 445 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
446 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
447 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
448 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
2a0e047e 449 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
8cd4d456 450 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
2a0e047e
JB		 451};
452
453static const struct nla_policy
454nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
455 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
456 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
457 [NL80211_WOWLAN_TCP_DST_MAC] = { .len = ETH_ALEN },
458 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
459 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
460 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .len = 1 },
461 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
462 .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
463 },
464 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
465 .len = sizeof(struct nl80211_wowlan_tcp_data_token)
466 },
467 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
468 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .len = 1 },
469 [NL80211_WOWLAN_TCP_WAKE_MASK] = { .len = 1 },
ff1b6e69
JB		 470};
471
be29b99a
AK		 472/* policy for coalesce rule attributes */
473static const struct nla_policy
474nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
475 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
476 [NL80211_ATTR_COALESCE_RULE_CONDITION] = { .type = NLA_U32 },
477 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
478};
479
e5497d76
JB		 480/* policy for GTK rekey offload attributes */
481static const struct nla_policy
482nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
483 [NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
484 [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
485 [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
486};
487
a1f1c21c
LC		 488static const struct nla_policy
489nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
4a4ab0d7 490 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
a1f1c21c 491 .len = IEEE80211_MAX_SSID_LEN },
88e920b4 492 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
a1f1c21c
LC		 493};
494
3b06d277
AS		 495static const struct nla_policy
496nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
497 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
498 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
499};
500
38de03d2
AS		 501static const struct nla_policy
502nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
503 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
504 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
505 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
506 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
507 },
508};
509
a442b761
AB		 510/* policy for NAN function attributes */
511static const struct nla_policy
512nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
513 [NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
514 [NL80211_NAN_FUNC_SERVICE_ID] = { .type = NLA_BINARY,
515 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
516 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
517 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
518 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
519 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
520 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
521 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = { .len = ETH_ALEN },
522 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
523 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
524 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
525 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
526 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
527 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
528 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
529 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
530 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
531};
532
533/* policy for Service Response Filter attributes */
534static const struct nla_policy
535nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
536 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
537 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
538 .len = NL80211_NAN_FUNC_SRF_MAX_LEN },
539 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
540 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
541};
542
97990a06
JB		 543static int nl80211_prepare_wdev_dump(struct sk_buff *skb,
544 struct netlink_callback *cb,
545 struct cfg80211_registered_device **rdev,
546 struct wireless_dev **wdev)
a043897a 547{
97990a06 548 int err;
a043897a 549
97990a06 550 rtnl_lock();
a043897a 551
97990a06
JB		 552 if (!cb->args[0]) {
553 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
554 nl80211_fam.attrbuf, nl80211_fam.maxattr,
555 nl80211_policy);
556 if (err)
557 goto out_unlock;
67748893 558
97990a06
JB		 559 *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk),
560 nl80211_fam.attrbuf);
561 if (IS_ERR(*wdev)) {
562 err = PTR_ERR(*wdev);
563 goto out_unlock;
564 }
f26cbf40 565 *rdev = wiphy_to_rdev((*wdev)->wiphy);
c319d50b
JB		 566 /* 0 is the first index - add 1 to parse only once */
567 cb->args[0] = (*rdev)->wiphy_idx + 1;
97990a06
JB		 568 cb->args[1] = (*wdev)->identifier;
569 } else {
c319d50b
JB		 570 /* subtract the 1 again here */
571 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
97990a06 572 struct wireless_dev *tmp;
67748893 573
97990a06
JB		 574 if (!wiphy) {
575 err = -ENODEV;
576 goto out_unlock;
577 }
f26cbf40 578 *rdev = wiphy_to_rdev(wiphy);
97990a06 579 *wdev = NULL;
67748893 580
53873f13 581 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
97990a06
JB		 582 if (tmp->identifier == cb->args[1]) {
583 *wdev = tmp;
584 break;
585 }
586 }
67748893 587
97990a06
JB		 588 if (!*wdev) {
589 err = -ENODEV;
590 goto out_unlock;
591 }
67748893
JB		 592 }
593
67748893 594 return 0;
97990a06 595 out_unlock:
67748893
JB		 596 rtnl_unlock();
597 return err;
598}
599
97990a06 600static void nl80211_finish_wdev_dump(struct cfg80211_registered_device *rdev)
67748893 601{
67748893
JB		 602 rtnl_unlock();
603}
604
f4a11bb0
JB		 605/* IE validation */
606static bool is_valid_ie_attr(const struct nlattr *attr)
607{
608 const u8 *pos;
609 int len;
610
611 if (!attr)
612 return true;
613
614 pos = nla_data(attr);
615 len = nla_len(attr);
616
617 while (len) {
618 u8 elemlen;
619
620 if (len < 2)
621 return false;
622 len -= 2;
623
624 elemlen = pos[1];
625 if (elemlen > len)
626 return false;
627
628 len -= elemlen;
629 pos += 2 + elemlen;
630 }
631
632 return true;
633}
634
55682965 635/* message building helper */
15e47304 636static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
55682965
JB		 637 int flags, u8 cmd)
638{
639 /* since there is no private header just add the generic one */
15e47304 640 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
55682965
JB		 641}
642
5dab3b8a 643static int nl80211_msg_put_channel(struct sk_buff *msg,
cdc89b97
JB		 644 struct ieee80211_channel *chan,
645 bool large)
5dab3b8a 646{
ea077c1c
RL		 647 /* Some channels must be completely excluded from the
648 * list to protect old user-space tools from breaking
649 */
650 if (!large && chan->flags &
651 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
652 return 0;
653
9360ffd1
DM		 654 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
655 chan->center_freq))
656 goto nla_put_failure;
5dab3b8a 657
9360ffd1
DM		 658 if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
659 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
660 goto nla_put_failure;
8fe02e16
LR		 661 if (chan->flags & IEEE80211_CHAN_NO_IR) {
662 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
663 goto nla_put_failure;
664 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
665 goto nla_put_failure;
666 }
cdc89b97
JB		 667 if (chan->flags & IEEE80211_CHAN_RADAR) {
668 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
669 goto nla_put_failure;
670 if (large) {
671 u32 time;
672
673 time = elapsed_jiffies_msecs(chan->dfs_state_entered);
674
675 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
676 chan->dfs_state))
677 goto nla_put_failure;
678 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
679 time))
680 goto nla_put_failure;
089027e5
JD		 681 if (nla_put_u32(msg,
682 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
683 chan->dfs_cac_ms))
684 goto nla_put_failure;
cdc89b97
JB		 685 }
686 }
5dab3b8a 687
fe1abafd
JB		 688 if (large) {
689 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
690 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
691 goto nla_put_failure;
692 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
693 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
694 goto nla_put_failure;
695 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
696 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
697 goto nla_put_failure;
698 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
699 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
700 goto nla_put_failure;
570dbde1
DS		 701 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
702 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
703 goto nla_put_failure;
06f207fc
AN		 704 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
705 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
570dbde1 706 goto nla_put_failure;
ea077c1c
RL		 707 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
708 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
709 goto nla_put_failure;
710 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
711 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
712 goto nla_put_failure;
fe1abafd
JB		 713 }
714
9360ffd1
DM		 715 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
716 DBM_TO_MBM(chan->max_power)))
717 goto nla_put_failure;
5dab3b8a
LR		 718
719 return 0;
720
721 nla_put_failure:
722 return -ENOBUFS;
723}
724
55682965
JB		 725/* netlink command implementations */
726
b9454e83
JB		 727struct key_parse {
728 struct key_params p;
729 int idx;
e31b8213 730 int type;
b9454e83 731 bool def, defmgmt;
dbd2fd65 732 bool def_uni, def_multi;
b9454e83
JB		 733};
734
735static int nl80211_parse_key_new(struct nlattr *key, struct key_parse *k)
736{
737 struct nlattr *tb[NL80211_KEY_MAX + 1];
738 int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
739 nl80211_key_policy);
740 if (err)
741 return err;
742
743 k->def = !!tb[NL80211_KEY_DEFAULT];
744 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
745
dbd2fd65
JB		 746 if (k->def) {
747 k->def_uni = true;
748 k->def_multi = true;
749 }
750 if (k->defmgmt)
751 k->def_multi = true;
752
b9454e83
JB		 753 if (tb[NL80211_KEY_IDX])
754 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
755
756 if (tb[NL80211_KEY_DATA]) {
757 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
758 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
759 }
760
761 if (tb[NL80211_KEY_SEQ]) {
762 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
763 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
764 }
765
766 if (tb[NL80211_KEY_CIPHER])
767 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
768
e31b8213
JB		 769 if (tb[NL80211_KEY_TYPE]) {
770 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
771 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
772 return -EINVAL;
773 }
774
dbd2fd65
JB		 775 if (tb[NL80211_KEY_DEFAULT_TYPES]) {
776 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
7a087e74 777
2da8f419
JB		 778 err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
779 tb[NL80211_KEY_DEFAULT_TYPES],
780 nl80211_key_default_policy);
dbd2fd65
JB		 781 if (err)
782 return err;
783
784 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
785 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
786 }
787
b9454e83
JB		 788 return 0;
789}
790
791static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
792{
793 if (info->attrs[NL80211_ATTR_KEY_DATA]) {
794 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
795 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
796 }
797
798 if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
799 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
800 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
801 }
802
803 if (info->attrs[NL80211_ATTR_KEY_IDX])
804 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
805
806 if (info->attrs[NL80211_ATTR_KEY_CIPHER])
807 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
808
809 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
810 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
811
dbd2fd65
JB		 812 if (k->def) {
813 k->def_uni = true;
814 k->def_multi = true;
815 }
816 if (k->defmgmt)
817 k->def_multi = true;
818
e31b8213
JB		 819 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
820 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
821 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
822 return -EINVAL;
823 }
824
dbd2fd65
JB		 825 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
826 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
827 int err = nla_parse_nested(
828 kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
829 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
830 nl80211_key_default_policy);
831 if (err)
832 return err;
833
834 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
835 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
836 }
837
b9454e83
JB		 838 return 0;
839}
840
841static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
842{
843 int err;
844
845 memset(k, 0, sizeof(*k));
846 k->idx = -1;
e31b8213 847 k->type = -1;
b9454e83
JB		 848
849 if (info->attrs[NL80211_ATTR_KEY])
850 err = nl80211_parse_key_new(info->attrs[NL80211_ATTR_KEY], k);
851 else
852 err = nl80211_parse_key_old(info, k);
853
854 if (err)
855 return err;
856
857 if (k->def && k->defmgmt)
858 return -EINVAL;
859
dbd2fd65
JB		 860 if (k->defmgmt) {
861 if (k->def_uni || !k->def_multi)
862 return -EINVAL;
863 }
864
b9454e83
JB		 865 if (k->idx != -1) {
866 if (k->defmgmt) {
867 if (k->idx < 4 || k->idx > 5)
868 return -EINVAL;
869 } else if (k->def) {
870 if (k->idx < 0 || k->idx > 3)
871 return -EINVAL;
872 } else {
873 if (k->idx < 0 || k->idx > 5)
874 return -EINVAL;
875 }
876 }
877
878 return 0;
879}
880
fffd0934
JB		 881static struct cfg80211_cached_keys *
882nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
de7044ee 883 struct nlattr *keys, bool *no_ht)
fffd0934
JB		 884{
885 struct key_parse parse;
886 struct nlattr *key;
887 struct cfg80211_cached_keys *result;
888 int rem, err, def = 0;
f1c1f17a
JB		 889 bool have_key = false;
890
891 nla_for_each_nested(key, keys, rem) {
892 have_key = true;
893 break;
894 }
895
896 if (!have_key)
897 return NULL;
fffd0934
JB		 898
899 result = kzalloc(sizeof(*result), GFP_KERNEL);
900 if (!result)
901 return ERR_PTR(-ENOMEM);
902
903 result->def = -1;
fffd0934
JB		 904
905 nla_for_each_nested(key, keys, rem) {
906 memset(&parse, 0, sizeof(parse));
907 parse.idx = -1;
908
909 err = nl80211_parse_key_new(key, &parse);
910 if (err)
911 goto error;
912 err = -EINVAL;
913 if (!parse.p.key)
914 goto error;
42ee231c 915 if (parse.idx < 0 || parse.idx > 3)
fffd0934
JB		 916 goto error;
917 if (parse.def) {
918 if (def)
919 goto error;
920 def = 1;
921 result->def = parse.idx;
dbd2fd65
JB		 922 if (!parse.def_uni || !parse.def_multi)
923 goto error;
fffd0934
JB		 924 } else if (parse.defmgmt)
925 goto error;
926 err = cfg80211_validate_key_settings(rdev, &parse.p,
e31b8213 927 parse.idx, false, NULL);
fffd0934
JB		 928 if (err)
929 goto error;
386b1f27
JB		 930 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
931 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
932 err = -EINVAL;
933 goto error;
934 }
fffd0934
JB		 935 result->params[parse.idx].cipher = parse.p.cipher;
936 result->params[parse.idx].key_len = parse.p.key_len;
937 result->params[parse.idx].key = result->data[parse.idx];
938 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
de7044ee 939
386b1f27
JB		 940 /* must be WEP key if we got here */
941 if (no_ht)
942 *no_ht = true;
fffd0934
JB		 943 }
944
f1c1f17a
JB		 945 if (result->def < 0) {
946 err = -EINVAL;
947 goto error;
948 }
949
fffd0934
JB		 950 return result;
951 error:
952 kfree(result);
953 return ERR_PTR(err);
954}
955
956static int nl80211_key_allowed(struct wireless_dev *wdev)
957{
958 ASSERT_WDEV_LOCK(wdev);
959
fffd0934
JB		 960 switch (wdev->iftype) {
961 case NL80211_IFTYPE_AP:
962 case NL80211_IFTYPE_AP_VLAN:
074ac8df 963 case NL80211_IFTYPE_P2P_GO:
ff973af7 964 case NL80211_IFTYPE_MESH_POINT:
fffd0934
JB		 965 break;
966 case NL80211_IFTYPE_ADHOC:
fffd0934 967 case NL80211_IFTYPE_STATION:
074ac8df 968 case NL80211_IFTYPE_P2P_CLIENT:
ceca7b71 969 if (!wdev->current_bss)
fffd0934
JB		 970 return -ENOLINK;
971 break;
de4fcbad 972 case NL80211_IFTYPE_UNSPECIFIED:
6e0bd6c3 973 case NL80211_IFTYPE_OCB:
de4fcbad 974 case NL80211_IFTYPE_MONITOR:
cb3b7d87 975 case NL80211_IFTYPE_NAN:
de4fcbad
JB		 976 case NL80211_IFTYPE_P2P_DEVICE:
977 case NL80211_IFTYPE_WDS:
978 case NUM_NL80211_IFTYPES:
fffd0934
JB		 979 return -EINVAL;
980 }
981
982 return 0;
983}
984
664834de
JM		 985static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
986 struct nlattr *tb)
987{
988 struct ieee80211_channel *chan;
989
990 if (tb == NULL)
991 return NULL;
992 chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
993 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
994 return NULL;
995 return chan;
996}
997
7527a782
JB		 998static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
999{
1000 struct nlattr *nl_modes = nla_nest_start(msg, attr);
1001 int i;
1002
1003 if (!nl_modes)
1004 goto nla_put_failure;
1005
1006 i = 0;
1007 while (ifmodes) {
9360ffd1
DM		 1008 if ((ifmodes & 1) && nla_put_flag(msg, i))
1009 goto nla_put_failure;
7527a782
JB		 1010 ifmodes >>= 1;
1011 i++;
1012 }
1013
1014 nla_nest_end(msg, nl_modes);
1015 return 0;
1016
1017nla_put_failure:
1018 return -ENOBUFS;
1019}
1020
1021static int nl80211_put_iface_combinations(struct wiphy *wiphy,
cdc89b97
JB		 1022 struct sk_buff *msg,
1023 bool large)
7527a782
JB		 1024{
1025 struct nlattr *nl_combis;
1026 int i, j;
1027
1028 nl_combis = nla_nest_start(msg,
1029 NL80211_ATTR_INTERFACE_COMBINATIONS);
1030 if (!nl_combis)
1031 goto nla_put_failure;
1032
1033 for (i = 0; i < wiphy->n_iface_combinations; i++) {
1034 const struct ieee80211_iface_combination *c;
1035 struct nlattr *nl_combi, *nl_limits;
1036
1037 c = &wiphy->iface_combinations[i];
1038
1039 nl_combi = nla_nest_start(msg, i + 1);
1040 if (!nl_combi)
1041 goto nla_put_failure;
1042
1043 nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
1044 if (!nl_limits)
1045 goto nla_put_failure;
1046
1047 for (j = 0; j < c->n_limits; j++) {
1048 struct nlattr *nl_limit;
1049
1050 nl_limit = nla_nest_start(msg, j + 1);
1051 if (!nl_limit)
1052 goto nla_put_failure;
9360ffd1
DM		 1053 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
1054 c->limits[j].max))
1055 goto nla_put_failure;
7527a782
JB		 1056 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
1057 c->limits[j].types))
1058 goto nla_put_failure;
1059 nla_nest_end(msg, nl_limit);
1060 }
1061
1062 nla_nest_end(msg, nl_limits);
1063
9360ffd1
DM		 1064 if (c->beacon_int_infra_match &&
1065 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
1066 goto nla_put_failure;
1067 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
1068 c->num_different_channels) ||
1069 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
1070 c->max_interfaces))
1071 goto nla_put_failure;
cdc89b97 1072 if (large &&
8c48b50a
FF		 1073 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
1074 c->radar_detect_widths) ||
1075 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
1076 c->radar_detect_regions)))
cdc89b97 1077 goto nla_put_failure;
7527a782
JB		 1078
1079 nla_nest_end(msg, nl_combi);
1080 }
1081
1082 nla_nest_end(msg, nl_combis);
1083
1084 return 0;
1085nla_put_failure:
1086 return -ENOBUFS;
1087}
1088
3713b4e3 1089#ifdef CONFIG_PM
b56cf720
JB		 1090static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
1091 struct sk_buff *msg)
1092{
964dc9e2 1093 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
b56cf720
JB		 1094 struct nlattr *nl_tcp;
1095
1096 if (!tcp)
1097 return 0;
1098
1099 nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
1100 if (!nl_tcp)
1101 return -ENOBUFS;
1102
1103 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1104 tcp->data_payload_max))
1105 return -ENOBUFS;
1106
1107 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1108 tcp->data_payload_max))
1109 return -ENOBUFS;
1110
1111 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
1112 return -ENOBUFS;
1113
1114 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
1115 sizeof(*tcp->tok), tcp->tok))
1116 return -ENOBUFS;
1117
1118 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
1119 tcp->data_interval_max))
1120 return -ENOBUFS;
1121
1122 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
1123 tcp->wake_payload_max))
1124 return -ENOBUFS;
1125
1126 nla_nest_end(msg, nl_tcp);
1127 return 0;
1128}
1129
3713b4e3 1130static int nl80211_send_wowlan(struct sk_buff *msg,
1b8ec87a 1131 struct cfg80211_registered_device *rdev,
b56cf720 1132 bool large)
55682965 1133{
3713b4e3 1134 struct nlattr *nl_wowlan;
55682965 1135
1b8ec87a 1136 if (!rdev->wiphy.wowlan)
3713b4e3 1137 return 0;
55682965 1138
3713b4e3
JB		 1139 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1140 if (!nl_wowlan)
1141 return -ENOBUFS;
9360ffd1 1142
1b8ec87a 1143 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
3713b4e3 1144 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1b8ec87a 1145 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
3713b4e3 1146 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1b8ec87a 1147 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
3713b4e3 1148 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1b8ec87a 1149 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
3713b4e3 1150 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1b8ec87a 1151 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
3713b4e3 1152 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1b8ec87a 1153 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
3713b4e3 1154 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1b8ec87a 1155 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
3713b4e3 1156 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1b8ec87a 1157 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
3713b4e3
JB		 1158 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1159 return -ENOBUFS;
9360ffd1 1160
1b8ec87a 1161 if (rdev->wiphy.wowlan->n_patterns) {
50ac6607 1162 struct nl80211_pattern_support pat = {
1b8ec87a
ZG		 1163 .max_patterns = rdev->wiphy.wowlan->n_patterns,
1164 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
1165 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
1166 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
3713b4e3 1167 };
9360ffd1 1168
3713b4e3
JB		 1169 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1170 sizeof(pat), &pat))
1171 return -ENOBUFS;
1172 }
9360ffd1 1173
75453ccb
LC		 1174 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
1175 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
1176 rdev->wiphy.wowlan->max_nd_match_sets))
1177 return -ENOBUFS;
1178
1b8ec87a 1179 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
b56cf720
JB		 1180 return -ENOBUFS;
1181
3713b4e3 1182 nla_nest_end(msg, nl_wowlan);
9360ffd1 1183
3713b4e3
JB		 1184 return 0;
1185}
1186#endif
9360ffd1 1187
be29b99a 1188static int nl80211_send_coalesce(struct sk_buff *msg,
1b8ec87a 1189 struct cfg80211_registered_device *rdev)
be29b99a
AK		 1190{
1191 struct nl80211_coalesce_rule_support rule;
1192
1b8ec87a 1193 if (!rdev->wiphy.coalesce)
be29b99a
AK		 1194 return 0;
1195
1b8ec87a
ZG		 1196 rule.max_rules = rdev->wiphy.coalesce->n_rules;
1197 rule.max_delay = rdev->wiphy.coalesce->max_delay;
1198 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
1199 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
1200 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
1201 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
be29b99a
AK		 1202
1203 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
1204 return -ENOBUFS;
1205
1206 return 0;
1207}
1208
3713b4e3
JB		 1209static int nl80211_send_band_rateinfo(struct sk_buff *msg,
1210 struct ieee80211_supported_band *sband)
1211{
1212 struct nlattr *nl_rates, *nl_rate;
1213 struct ieee80211_rate *rate;
1214 int i;
87bbbe22 1215
3713b4e3
JB		 1216 /* add HT info */
1217 if (sband->ht_cap.ht_supported &&
1218 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
1219 sizeof(sband->ht_cap.mcs),
1220 &sband->ht_cap.mcs) ||
1221 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
1222 sband->ht_cap.cap) ||
1223 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1224 sband->ht_cap.ampdu_factor) ||
1225 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1226 sband->ht_cap.ampdu_density)))
1227 return -ENOBUFS;
afe0cbf8 1228
3713b4e3
JB		 1229 /* add VHT info */
1230 if (sband->vht_cap.vht_supported &&
1231 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1232 sizeof(sband->vht_cap.vht_mcs),
1233 &sband->vht_cap.vht_mcs) ||
1234 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1235 sband->vht_cap.cap)))
1236 return -ENOBUFS;
f59ac048 1237
3713b4e3
JB		 1238 /* add bitrates */
1239 nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
1240 if (!nl_rates)
1241 return -ENOBUFS;
ee688b00 1242
3713b4e3
JB		 1243 for (i = 0; i < sband->n_bitrates; i++) {
1244 nl_rate = nla_nest_start(msg, i);
1245 if (!nl_rate)
1246 return -ENOBUFS;
ee688b00 1247
3713b4e3
JB		 1248 rate = &sband->bitrates[i];
1249 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1250 rate->bitrate))
1251 return -ENOBUFS;
1252 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1253 nla_put_flag(msg,
1254 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1255 return -ENOBUFS;
ee688b00 1256
3713b4e3
JB		 1257 nla_nest_end(msg, nl_rate);
1258 }
d51626df 1259
3713b4e3 1260 nla_nest_end(msg, nl_rates);
bf0c111e 1261
3713b4e3
JB		 1262 return 0;
1263}
ee688b00 1264
3713b4e3
JB		 1265static int
1266nl80211_send_mgmt_stypes(struct sk_buff *msg,
1267 const struct ieee80211_txrx_stypes *mgmt_stypes)
1268{
1269 u16 stypes;
1270 struct nlattr *nl_ftypes, *nl_ifs;
1271 enum nl80211_iftype ift;
1272 int i;
ee688b00 1273
3713b4e3
JB		 1274 if (!mgmt_stypes)
1275 return 0;
5dab3b8a 1276
3713b4e3
JB		 1277 nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
1278 if (!nl_ifs)
1279 return -ENOBUFS;
e2f367f2 1280
3713b4e3
JB		 1281 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1282 nl_ftypes = nla_nest_start(msg, ift);
1283 if (!nl_ftypes)
1284 return -ENOBUFS;
1285 i = 0;
1286 stypes = mgmt_stypes[ift].tx;
1287 while (stypes) {
1288 if ((stypes & 1) &&
1289 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1290 (i << 4) | IEEE80211_FTYPE_MGMT))
1291 return -ENOBUFS;
1292 stypes >>= 1;
1293 i++;
ee688b00 1294 }
3713b4e3
JB		 1295 nla_nest_end(msg, nl_ftypes);
1296 }
ee688b00 1297
3713b4e3 1298 nla_nest_end(msg, nl_ifs);
ee688b00 1299
3713b4e3
JB		 1300 nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
1301 if (!nl_ifs)
1302 return -ENOBUFS;
ee688b00 1303
3713b4e3
JB		 1304 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1305 nl_ftypes = nla_nest_start(msg, ift);
1306 if (!nl_ftypes)
1307 return -ENOBUFS;
1308 i = 0;
1309 stypes = mgmt_stypes[ift].rx;
1310 while (stypes) {
1311 if ((stypes & 1) &&
1312 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1313 (i << 4) | IEEE80211_FTYPE_MGMT))
1314 return -ENOBUFS;
1315 stypes >>= 1;
1316 i++;
1317 }
1318 nla_nest_end(msg, nl_ftypes);
1319 }
1320 nla_nest_end(msg, nl_ifs);
ee688b00 1321
3713b4e3
JB		 1322 return 0;
1323}
ee688b00 1324
86e8cf98
JB		 1325struct nl80211_dump_wiphy_state {
1326 s64 filter_wiphy;
1327 long start;
019ae3a9 1328 long split_start, band_start, chan_start, capa_start;
86e8cf98
JB		 1329 bool split;
1330};
1331
1b8ec87a 1332static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
3bb20556 1333 enum nl80211_commands cmd,
3713b4e3 1334 struct sk_buff *msg, u32 portid, u32 seq,
86e8cf98 1335 int flags, struct nl80211_dump_wiphy_state *state)
3713b4e3
JB		 1336{
1337 void *hdr;
1338 struct nlattr *nl_bands, *nl_band;
1339 struct nlattr *nl_freqs, *nl_freq;
1340 struct nlattr *nl_cmds;
57fbcce3 1341 enum nl80211_band band;
3713b4e3
JB		 1342 struct ieee80211_channel *chan;
1343 int i;
1344 const struct ieee80211_txrx_stypes *mgmt_stypes =
1b8ec87a 1345 rdev->wiphy.mgmt_stypes;
fe1abafd 1346 u32 features;
ee688b00 1347
3bb20556 1348 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
3713b4e3
JB		 1349 if (!hdr)
1350 return -ENOBUFS;
ee688b00 1351
86e8cf98
JB		 1352 if (WARN_ON(!state))
1353 return -EINVAL;
ee688b00 1354
1b8ec87a 1355 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
3713b4e3 1356 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
1b8ec87a 1357 wiphy_name(&rdev->wiphy)) ||
3713b4e3
JB		 1358 nla_put_u32(msg, NL80211_ATTR_GENERATION,
1359 cfg80211_rdev_list_generation))
8fdc621d
JB		 1360 goto nla_put_failure;
1361
3bb20556
JB		 1362 if (cmd != NL80211_CMD_NEW_WIPHY)
1363 goto finish;
1364
86e8cf98 1365 switch (state->split_start) {
3713b4e3
JB		 1366 case 0:
1367 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
1b8ec87a 1368 rdev->wiphy.retry_short) ||
3713b4e3 1369 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
1b8ec87a 1370 rdev->wiphy.retry_long) ||
3713b4e3 1371 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
1b8ec87a 1372 rdev->wiphy.frag_threshold) ||
3713b4e3 1373 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
1b8ec87a 1374 rdev->wiphy.rts_threshold) ||
3713b4e3 1375 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
1b8ec87a 1376 rdev->wiphy.coverage_class) ||
3713b4e3 1377 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
1b8ec87a 1378 rdev->wiphy.max_scan_ssids) ||
3713b4e3 1379 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
1b8ec87a 1380 rdev->wiphy.max_sched_scan_ssids) ||
3713b4e3 1381 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
1b8ec87a 1382 rdev->wiphy.max_scan_ie_len) ||
3713b4e3 1383 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
1b8ec87a 1384 rdev->wiphy.max_sched_scan_ie_len) ||
3713b4e3 1385 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
3b06d277
AS		 1386 rdev->wiphy.max_match_sets) ||
1387 nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
1388 rdev->wiphy.max_sched_scan_plans) ||
1389 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
1390 rdev->wiphy.max_sched_scan_plan_interval) ||
1391 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
1392 rdev->wiphy.max_sched_scan_plan_iterations))
9360ffd1 1393 goto nla_put_failure;
3713b4e3 1394
1b8ec87a 1395 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
3713b4e3 1396 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
aa430da4 1397 goto nla_put_failure;
1b8ec87a 1398 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
3713b4e3
JB		 1399 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
1400 goto nla_put_failure;
1b8ec87a 1401 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
3713b4e3
JB		 1402 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
1403 goto nla_put_failure;
1b8ec87a 1404 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
3713b4e3
JB		 1405 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
1406 goto nla_put_failure;
1b8ec87a 1407 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
3713b4e3
JB		 1408 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
1409 goto nla_put_failure;
1b8ec87a 1410 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
3713b4e3 1411 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
9360ffd1 1412 goto nla_put_failure;
86e8cf98
JB		 1413 state->split_start++;
1414 if (state->split)
3713b4e3
JB		 1415 break;
1416 case 1:
1417 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
1b8ec87a
ZG		 1418 sizeof(u32) * rdev->wiphy.n_cipher_suites,
1419 rdev->wiphy.cipher_suites))
3713b4e3 1420 goto nla_put_failure;
4745fc09 1421
3713b4e3 1422 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
1b8ec87a 1423 rdev->wiphy.max_num_pmkids))
3713b4e3 1424 goto nla_put_failure;
b23aa676 1425
1b8ec87a 1426 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
3713b4e3 1427 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
9360ffd1 1428 goto nla_put_failure;
b23aa676 1429
3713b4e3 1430 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
1b8ec87a 1431 rdev->wiphy.available_antennas_tx) ||
3713b4e3 1432 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
1b8ec87a 1433 rdev->wiphy.available_antennas_rx))
9360ffd1 1434 goto nla_put_failure;
b23aa676 1435
1b8ec87a 1436 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
3713b4e3 1437 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
1b8ec87a 1438 rdev->wiphy.probe_resp_offload))
3713b4e3 1439 goto nla_put_failure;
8fdc621d 1440
1b8ec87a
ZG		 1441 if ((rdev->wiphy.available_antennas_tx ||
1442 rdev->wiphy.available_antennas_rx) &&
1443 rdev->ops->get_antenna) {
3713b4e3
JB		 1444 u32 tx_ant = 0, rx_ant = 0;
1445 int res;
7a087e74 1446
1b8ec87a 1447 res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
3713b4e3
JB		 1448 if (!res) {
1449 if (nla_put_u32(msg,
1450 NL80211_ATTR_WIPHY_ANTENNA_TX,
1451 tx_ant) ||
1452 nla_put_u32(msg,
1453 NL80211_ATTR_WIPHY_ANTENNA_RX,
1454 rx_ant))
1455 goto nla_put_failure;
1456 }
1457 }
a293911d 1458
86e8cf98
JB		 1459 state->split_start++;
1460 if (state->split)
3713b4e3
JB		 1461 break;
1462 case 2:
1463 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
1b8ec87a 1464 rdev->wiphy.interface_modes))
3713b4e3 1465 goto nla_put_failure;
86e8cf98
JB		 1466 state->split_start++;
1467 if (state->split)
3713b4e3
JB		 1468 break;
1469 case 3:
1470 nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
1471 if (!nl_bands)
1472 goto nla_put_failure;
f7ca38df 1473
86e8cf98 1474 for (band = state->band_start;
57fbcce3 1475 band < NUM_NL80211_BANDS; band++) {
3713b4e3 1476 struct ieee80211_supported_band *sband;
2e161f78 1477
1b8ec87a 1478 sband = rdev->wiphy.bands[band];
2e161f78 1479
3713b4e3
JB		 1480 if (!sband)
1481 continue;
1482
1483 nl_band = nla_nest_start(msg, band);
1484 if (!nl_band)
2e161f78 1485 goto nla_put_failure;
3713b4e3 1486
86e8cf98 1487 switch (state->chan_start) {
3713b4e3
JB		 1488 case 0:
1489 if (nl80211_send_band_rateinfo(msg, sband))
9360ffd1 1490 goto nla_put_failure;
86e8cf98
JB		 1491 state->chan_start++;
1492 if (state->split)
3713b4e3
JB		 1493 break;
1494 default:
1495 /* add frequencies */
1496 nl_freqs = nla_nest_start(
1497 msg, NL80211_BAND_ATTR_FREQS);
1498 if (!nl_freqs)
1499 goto nla_put_failure;
1500
86e8cf98 1501 for (i = state->chan_start - 1;
3713b4e3
JB		 1502 i < sband->n_channels;
1503 i++) {
1504 nl_freq = nla_nest_start(msg, i);
1505 if (!nl_freq)
1506 goto nla_put_failure;
1507
1508 chan = &sband->channels[i];
1509
86e8cf98
JB		 1510 if (nl80211_msg_put_channel(
1511 msg, chan,
1512 state->split))
3713b4e3
JB		 1513 goto nla_put_failure;
1514
1515 nla_nest_end(msg, nl_freq);
86e8cf98 1516 if (state->split)
3713b4e3
JB		 1517 break;
1518 }
1519 if (i < sband->n_channels)
86e8cf98 1520 state->chan_start = i + 2;
3713b4e3 1521 else
86e8cf98 1522 state->chan_start = 0;
3713b4e3
JB		 1523 nla_nest_end(msg, nl_freqs);
1524 }
1525
1526 nla_nest_end(msg, nl_band);
1527
86e8cf98 1528 if (state->split) {
3713b4e3 1529 /* start again here */
86e8cf98 1530 if (state->chan_start)
3713b4e3
JB		 1531 band--;
1532 break;
2e161f78 1533 }
2e161f78 1534 }
3713b4e3 1535 nla_nest_end(msg, nl_bands);
2e161f78 1536
57fbcce3 1537 if (band < NUM_NL80211_BANDS)
86e8cf98 1538 state->band_start = band + 1;
3713b4e3 1539 else
86e8cf98 1540 state->band_start = 0;
74b70a4e 1541
3713b4e3 1542 /* if bands & channels are done, continue outside */
86e8cf98
JB		 1543 if (state->band_start == 0 && state->chan_start == 0)
1544 state->split_start++;
1545 if (state->split)
3713b4e3
JB		 1546 break;
1547 case 4:
1548 nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
1549 if (!nl_cmds)
2e161f78
JB		 1550 goto nla_put_failure;
1551
3713b4e3
JB		 1552 i = 0;
1553#define CMD(op, n) \
1554 do { \
1b8ec87a 1555 if (rdev->ops->op) { \
3713b4e3
JB		 1556 i++; \
1557 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
1558 goto nla_put_failure; \
1559 } \
1560 } while (0)
1561
1562 CMD(add_virtual_intf, NEW_INTERFACE);
1563 CMD(change_virtual_intf, SET_INTERFACE);
1564 CMD(add_key, NEW_KEY);
1565 CMD(start_ap, START_AP);
1566 CMD(add_station, NEW_STATION);
1567 CMD(add_mpath, NEW_MPATH);
1568 CMD(update_mesh_config, SET_MESH_CONFIG);
1569 CMD(change_bss, SET_BSS);
1570 CMD(auth, AUTHENTICATE);
1571 CMD(assoc, ASSOCIATE);
1572 CMD(deauth, DEAUTHENTICATE);
1573 CMD(disassoc, DISASSOCIATE);
1574 CMD(join_ibss, JOIN_IBSS);
1575 CMD(join_mesh, JOIN_MESH);
1576 CMD(set_pmksa, SET_PMKSA);
1577 CMD(del_pmksa, DEL_PMKSA);
1578 CMD(flush_pmksa, FLUSH_PMKSA);
1b8ec87a 1579 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
3713b4e3
JB		 1580 CMD(remain_on_channel, REMAIN_ON_CHANNEL);
1581 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
1582 CMD(mgmt_tx, FRAME);
1583 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
1b8ec87a 1584 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
3713b4e3
JB		 1585 i++;
1586 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
2e161f78 1587 goto nla_put_failure;
2e161f78 1588 }
1b8ec87a
ZG		 1589 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
1590 rdev->ops->join_mesh) {
3713b4e3
JB		 1591 i++;
1592 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1593 goto nla_put_failure;
1594 }
1595 CMD(set_wds_peer, SET_WDS_PEER);
1b8ec87a 1596 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
3713b4e3
JB		 1597 CMD(tdls_mgmt, TDLS_MGMT);
1598 CMD(tdls_oper, TDLS_OPER);
1599 }
1b8ec87a 1600 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN)
3713b4e3
JB		 1601 CMD(sched_scan_start, START_SCHED_SCAN);
1602 CMD(probe_client, PROBE_CLIENT);
1603 CMD(set_noack_map, SET_NOACK_MAP);
1b8ec87a 1604 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
3713b4e3
JB		 1605 i++;
1606 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1607 goto nla_put_failure;
1608 }
1609 CMD(start_p2p_device, START_P2P_DEVICE);
1610 CMD(set_mcast_rate, SET_MCAST_RATE);
02df00eb
JB		 1611#ifdef CONFIG_NL80211_TESTMODE
1612 CMD(testmode_cmd, TESTMODE);
1613#endif
86e8cf98 1614 if (state->split) {
5de17984
AS		 1615 CMD(crit_proto_start, CRIT_PROTOCOL_START);
1616 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
1b8ec87a 1617 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
16ef1fe2 1618 CMD(channel_switch, CHANNEL_SWITCH);
02df00eb 1619 CMD(set_qos_map, SET_QOS_MAP);
723e73ac
JB		 1620 if (rdev->wiphy.features &
1621 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
960d01ac 1622 CMD(add_tx_ts, ADD_TX_TS);
5de17984 1623 }
02df00eb 1624 /* add into the if now */
3713b4e3 1625#undef CMD
ff1b6e69 1626
1b8ec87a 1627 if (rdev->ops->connect || rdev->ops->auth) {
3713b4e3
JB		 1628 i++;
1629 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
9360ffd1 1630 goto nla_put_failure;
ff1b6e69
JB		 1631 }
1632
1b8ec87a 1633 if (rdev->ops->disconnect || rdev->ops->deauth) {
3713b4e3
JB		 1634 i++;
1635 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1636 goto nla_put_failure;
1637 }
1638
1639 nla_nest_end(msg, nl_cmds);
86e8cf98
JB		 1640 state->split_start++;
1641 if (state->split)
3713b4e3
JB		 1642 break;
1643 case 5:
1b8ec87a
ZG		 1644 if (rdev->ops->remain_on_channel &&
1645 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
3713b4e3
JB		 1646 nla_put_u32(msg,
1647 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
1b8ec87a 1648 rdev->wiphy.max_remain_on_channel_duration))
3713b4e3
JB		 1649 goto nla_put_failure;
1650
1b8ec87a 1651 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
3713b4e3
JB		 1652 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
1653 goto nla_put_failure;
1654
1655 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
1656 goto nla_put_failure;
86e8cf98
JB		 1657 state->split_start++;
1658 if (state->split)
3713b4e3
JB		 1659 break;
1660 case 6:
1661#ifdef CONFIG_PM
1b8ec87a 1662 if (nl80211_send_wowlan(msg, rdev, state->split))
3713b4e3 1663 goto nla_put_failure;
86e8cf98
JB		 1664 state->split_start++;
1665 if (state->split)
3713b4e3
JB		 1666 break;
1667#else
86e8cf98 1668 state->split_start++;
dfb89c56 1669#endif
3713b4e3
JB		 1670 case 7:
1671 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
1b8ec87a 1672 rdev->wiphy.software_iftypes))
3713b4e3 1673 goto nla_put_failure;
ff1b6e69 1674
1b8ec87a 1675 if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
86e8cf98 1676 state->split))
3713b4e3 1677 goto nla_put_failure;
7527a782 1678
86e8cf98
JB		 1679 state->split_start++;
1680 if (state->split)
3713b4e3
JB		 1681 break;
1682 case 8:
1b8ec87a 1683 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
3713b4e3 1684 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
1b8ec87a 1685 rdev->wiphy.ap_sme_capa))
3713b4e3 1686 goto nla_put_failure;
7527a782 1687
1b8ec87a 1688 features = rdev->wiphy.features;
fe1abafd
JB		 1689 /*
1690 * We can only add the per-channel limit information if the
1691 * dump is split, otherwise it makes it too big. Therefore
1692 * only advertise it in that case.
1693 */
86e8cf98 1694 if (state->split)
fe1abafd
JB		 1695 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
1696 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
3713b4e3 1697 goto nla_put_failure;
562a7480 1698
1b8ec87a 1699 if (rdev->wiphy.ht_capa_mod_mask &&
3713b4e3 1700 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
1b8ec87a
ZG		 1701 sizeof(*rdev->wiphy.ht_capa_mod_mask),
1702 rdev->wiphy.ht_capa_mod_mask))
3713b4e3 1703 goto nla_put_failure;
1f074bd8 1704
1b8ec87a
ZG		 1705 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
1706 rdev->wiphy.max_acl_mac_addrs &&
3713b4e3 1707 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
1b8ec87a 1708 rdev->wiphy.max_acl_mac_addrs))
3713b4e3 1709 goto nla_put_failure;
7e7c8926 1710
3713b4e3
JB		 1711 /*
1712 * Any information below this point is only available to
1713 * applications that can deal with it being split. This
1714 * helps ensure that newly added capabilities don't break
1715 * older tools by overrunning their buffers.
1716 *
1717 * We still increment split_start so that in the split
1718 * case we'll continue with more data in the next round,
1719 * but break unconditionally so unsplit data stops here.
1720 */
86e8cf98 1721 state->split_start++;
3713b4e3
JB		 1722 break;
1723 case 9:
1b8ec87a 1724 if (rdev->wiphy.extended_capabilities &&
fe1abafd 1725 (nla_put(msg, NL80211_ATTR_EXT_CAPA,
1b8ec87a
ZG		 1726 rdev->wiphy.extended_capabilities_len,
1727 rdev->wiphy.extended_capabilities) ||
fe1abafd 1728 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1b8ec87a
ZG		 1729 rdev->wiphy.extended_capabilities_len,
1730 rdev->wiphy.extended_capabilities_mask)))
fe1abafd 1731 goto nla_put_failure;
a50df0c4 1732
1b8ec87a 1733 if (rdev->wiphy.vht_capa_mod_mask &&
ee2aca34 1734 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
1b8ec87a
ZG		 1735 sizeof(*rdev->wiphy.vht_capa_mod_mask),
1736 rdev->wiphy.vht_capa_mod_mask))
ee2aca34
JB		 1737 goto nla_put_failure;
1738
be29b99a
AK		 1739 state->split_start++;
1740 break;
1741 case 10:
1b8ec87a 1742 if (nl80211_send_coalesce(msg, rdev))
be29b99a
AK		 1743 goto nla_put_failure;
1744
1b8ec87a 1745 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
01e0daa4
FF		 1746 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
1747 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
1748 goto nla_put_failure;
b43504cf 1749
1b8ec87a 1750 if (rdev->wiphy.max_ap_assoc_sta &&
b43504cf 1751 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
1b8ec87a 1752 rdev->wiphy.max_ap_assoc_sta))
b43504cf
JM		 1753 goto nla_put_failure;
1754
ad7e718c
JB		 1755 state->split_start++;
1756 break;
1757 case 11:
1b8ec87a 1758 if (rdev->wiphy.n_vendor_commands) {
567ffc35
JB		 1759 const struct nl80211_vendor_cmd_info *info;
1760 struct nlattr *nested;
1761
1762 nested = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA);
1763 if (!nested)
1764 goto nla_put_failure;
1765
1b8ec87a
ZG		 1766 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
1767 info = &rdev->wiphy.vendor_commands[i].info;
567ffc35
JB		 1768 if (nla_put(msg, i + 1, sizeof(*info), info))
1769 goto nla_put_failure;
1770 }
1771 nla_nest_end(msg, nested);
1772 }
1773
1b8ec87a 1774 if (rdev->wiphy.n_vendor_events) {
567ffc35
JB		 1775 const struct nl80211_vendor_cmd_info *info;
1776 struct nlattr *nested;
ad7e718c 1777
567ffc35
JB		 1778 nested = nla_nest_start(msg,
1779 NL80211_ATTR_VENDOR_EVENTS);
1780 if (!nested)
ad7e718c 1781 goto nla_put_failure;
567ffc35 1782
1b8ec87a
ZG		 1783 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
1784 info = &rdev->wiphy.vendor_events[i];
567ffc35
JB		 1785 if (nla_put(msg, i + 1, sizeof(*info), info))
1786 goto nla_put_failure;
1787 }
1788 nla_nest_end(msg, nested);
1789 }
9a774c78
AO		 1790 state->split_start++;
1791 break;
1792 case 12:
1793 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
1794 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
1795 rdev->wiphy.max_num_csa_counters))
1796 goto nla_put_failure;
01e0daa4 1797
1bdd716c
AN		 1798 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
1799 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
1800 goto nla_put_failure;
1801
d75bb06b
GKS		 1802 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
1803 sizeof(rdev->wiphy.ext_features),
1804 rdev->wiphy.ext_features))
1805 goto nla_put_failure;
1806
38de03d2
AS		 1807 if (rdev->wiphy.bss_select_support) {
1808 struct nlattr *nested;
1809 u32 bss_select_support = rdev->wiphy.bss_select_support;
1810
1811 nested = nla_nest_start(msg, NL80211_ATTR_BSS_SELECT);
1812 if (!nested)
1813 goto nla_put_failure;
1814
1815 i = 0;
1816 while (bss_select_support) {
1817 if ((bss_select_support & 1) &&
1818 nla_put_flag(msg, i))
1819 goto nla_put_failure;
1820 i++;
1821 bss_select_support >>= 1;
1822 }
1823 nla_nest_end(msg, nested);
1824 }
1825
019ae3a9
KV		 1826 state->split_start++;
1827 break;
1828 case 13:
1829 if (rdev->wiphy.num_iftype_ext_capab &&
1830 rdev->wiphy.iftype_ext_capab) {
1831 struct nlattr *nested_ext_capab, *nested;
1832
1833 nested = nla_nest_start(msg,
1834 NL80211_ATTR_IFTYPE_EXT_CAPA);
1835 if (!nested)
1836 goto nla_put_failure;
1837
1838 for (i = state->capa_start;
1839 i < rdev->wiphy.num_iftype_ext_capab; i++) {
1840 const struct wiphy_iftype_ext_capab *capab;
1841
1842 capab = &rdev->wiphy.iftype_ext_capab[i];
1843
1844 nested_ext_capab = nla_nest_start(msg, i);
1845 if (!nested_ext_capab ||
1846 nla_put_u32(msg, NL80211_ATTR_IFTYPE,
1847 capab->iftype) ||
1848 nla_put(msg, NL80211_ATTR_EXT_CAPA,
1849 capab->extended_capabilities_len,
1850 capab->extended_capabilities) ||
1851 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1852 capab->extended_capabilities_len,
1853 capab->extended_capabilities_mask))
1854 goto nla_put_failure;
1855
1856 nla_nest_end(msg, nested_ext_capab);
1857 if (state->split)
1858 break;
1859 }
1860 nla_nest_end(msg, nested);
1861 if (i < rdev->wiphy.num_iftype_ext_capab) {
1862 state->capa_start = i + 1;
1863 break;
1864 }
1865 }
1866
3713b4e3 1867 /* done */
86e8cf98 1868 state->split_start = 0;
3713b4e3
JB		 1869 break;
1870 }
3bb20556 1871 finish:
053c095a
JB		 1872 genlmsg_end(msg, hdr);
1873 return 0;
55682965
JB		 1874
1875 nla_put_failure:
bc3ed28c
TG		 1876 genlmsg_cancel(msg, hdr);
1877 return -EMSGSIZE;
55682965
JB		 1878}
1879
86e8cf98
JB		 1880static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
1881 struct netlink_callback *cb,
1882 struct nl80211_dump_wiphy_state *state)
1883{
1884 struct nlattr **tb = nl80211_fam.attrbuf;
1885 int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
1886 tb, nl80211_fam.maxattr, nl80211_policy);
1887 /* ignore parse errors for backward compatibility */
1888 if (ret)
1889 return 0;
1890
1891 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
1892 if (tb[NL80211_ATTR_WIPHY])
1893 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
1894 if (tb[NL80211_ATTR_WDEV])
1895 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
1896 if (tb[NL80211_ATTR_IFINDEX]) {
1897 struct net_device *netdev;
1898 struct cfg80211_registered_device *rdev;
1899 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
1900
7f2b8562 1901 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
86e8cf98
JB		 1902 if (!netdev)
1903 return -ENODEV;
1904 if (netdev->ieee80211_ptr) {
f26cbf40 1905 rdev = wiphy_to_rdev(
86e8cf98
JB		 1906 netdev->ieee80211_ptr->wiphy);
1907 state->filter_wiphy = rdev->wiphy_idx;
1908 }
86e8cf98
JB		 1909 }
1910
1911 return 0;
1912}
1913
55682965
JB		 1914static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
1915{
645e77de 1916 int idx = 0, ret;
86e8cf98 1917 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
1b8ec87a 1918 struct cfg80211_registered_device *rdev;
3a5a423b 1919
5fe231e8 1920 rtnl_lock();
86e8cf98
JB		 1921 if (!state) {
1922 state = kzalloc(sizeof(*state), GFP_KERNEL);
57ed5cd6
JL		 1923 if (!state) {
1924 rtnl_unlock();
86e8cf98 1925 return -ENOMEM;
3713b4e3 1926 }
86e8cf98
JB		 1927 state->filter_wiphy = -1;
1928 ret = nl80211_dump_wiphy_parse(skb, cb, state);
1929 if (ret) {
1930 kfree(state);
1931 rtnl_unlock();
1932 return ret;
3713b4e3 1933 }
86e8cf98 1934 cb->args[0] = (long)state;
3713b4e3
JB		 1935 }
1936
1b8ec87a
ZG		 1937 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1938 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
463d0183 1939 continue;
86e8cf98 1940 if (++idx <= state->start)
55682965 1941 continue;
86e8cf98 1942 if (state->filter_wiphy != -1 &&
1b8ec87a 1943 state->filter_wiphy != rdev->wiphy_idx)
3713b4e3
JB		 1944 continue;
1945 /* attempt to fit multiple wiphy data chunks into the skb */
1946 do {
3bb20556
JB		 1947 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
1948 skb,
3713b4e3
JB		 1949 NETLINK_CB(cb->skb).portid,
1950 cb->nlh->nlmsg_seq,
86e8cf98 1951 NLM_F_MULTI, state);
3713b4e3
JB		 1952 if (ret < 0) {
1953 /*
1954 * If sending the wiphy data didn't fit (ENOBUFS
1955 * or EMSGSIZE returned), this SKB is still
1956 * empty (so it's not too big because another
1957 * wiphy dataset is already in the skb) and
1958 * we've not tried to adjust the dump allocation
1959 * yet ... then adjust the alloc size to be
1960 * bigger, and return 1 but with the empty skb.
1961 * This results in an empty message being RX'ed
1962 * in userspace, but that is ignored.
1963 *
1964 * We can then retry with the larger buffer.
1965 */
1966 if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
f12cb289 1967 !skb->len && !state->split &&
3713b4e3
JB		 1968 cb->min_dump_alloc < 4096) {
1969 cb->min_dump_alloc = 4096;
f12cb289 1970 state->split_start = 0;
d98cae64 1971 rtnl_unlock();
3713b4e3
JB		 1972 return 1;
1973 }
1974 idx--;
1975 break;
645e77de 1976 }
86e8cf98 1977 } while (state->split_start > 0);
3713b4e3 1978 break;
55682965 1979 }
5fe231e8 1980 rtnl_unlock();
55682965 1981
86e8cf98 1982 state->start = idx;
55682965
JB		 1983
1984 return skb->len;
1985}
1986
86e8cf98
JB		 1987static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
1988{
1989 kfree((void *)cb->args[0]);
1990 return 0;
1991}
1992
55682965
JB		 1993static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
1994{
1995 struct sk_buff *msg;
1b8ec87a 1996 struct cfg80211_registered_device *rdev = info->user_ptr[0];
86e8cf98 1997 struct nl80211_dump_wiphy_state state = {};
55682965 1998
645e77de 1999 msg = nlmsg_new(4096, GFP_KERNEL);
55682965 2000 if (!msg)
4c476991 2001 return -ENOMEM;
55682965 2002
3bb20556
JB		 2003 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
2004 info->snd_portid, info->snd_seq, 0,
86e8cf98 2005 &state) < 0) {
4c476991
JB		 2006 nlmsg_free(msg);
2007 return -ENOBUFS;
2008 }
55682965 2009
134e6375 2010 return genlmsg_reply(msg, info);
55682965
JB		 2011}
2012
31888487
JM		 2013static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
2014 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
2015 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
2016 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
2017 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
2018 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
2019};
2020
2021static int parse_txq_params(struct nlattr *tb[],
2022 struct ieee80211_txq_params *txq_params)
2023{
a3304b0a 2024 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
31888487
JM		 2025 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
2026 !tb[NL80211_TXQ_ATTR_AIFS])
2027 return -EINVAL;
2028
a3304b0a 2029 txq_params->ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
31888487
JM		 2030 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
2031 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
2032 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
2033 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
2034
a3304b0a
JB		 2035 if (txq_params->ac >= NL80211_NUM_ACS)
2036 return -EINVAL;
2037
31888487
JM		 2038 return 0;
2039}
2040
f444de05
JB		 2041static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
2042{
2043 /*
cc1d2806
JB		 2044 * You can only set the channel explicitly for WDS interfaces,
2045 * all others have their channel managed via their respective
2046 * "establish a connection" command (connect, join, ...)
2047 *
2048 * For AP/GO and mesh mode, the channel can be set with the
2049 * channel userspace API, but is only stored and passed to the
2050 * low-level driver when the AP starts or the mesh is joined.
2051 * This is for backward compatibility, userspace can also give
2052 * the channel in the start-ap or join-mesh commands instead.
f444de05
JB		 2053 *
2054 * Monitors are special as they are normally slaved to
e8c9bd5b
JB		 2055 * whatever else is going on, so they have their own special
2056 * operation to set the monitor channel if possible.
f444de05
JB		 2057 */
2058 return !wdev ||
2059 wdev->iftype == NL80211_IFTYPE_AP ||
f444de05 2060 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
074ac8df
JB		 2061 wdev->iftype == NL80211_IFTYPE_MONITOR ||
2062 wdev->iftype == NL80211_IFTYPE_P2P_GO;
f444de05
JB		 2063}
2064
683b6d3b
JB		 2065static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
2066 struct genl_info *info,
2067 struct cfg80211_chan_def *chandef)
2068{
dbeca2ea 2069 u32 control_freq;
683b6d3b
JB		 2070
2071 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
2072 return -EINVAL;
2073
2074 control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
2075
2076 chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
3d9d1d66
JB		 2077 chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
2078 chandef->center_freq1 = control_freq;
2079 chandef->center_freq2 = 0;
683b6d3b
JB		 2080
2081 /* Primary channel not allowed */
2082 if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
2083 return -EINVAL;
2084
3d9d1d66
JB		 2085 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
2086 enum nl80211_channel_type chantype;
2087
2088 chantype = nla_get_u32(
2089 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
2090
2091 switch (chantype) {
2092 case NL80211_CHAN_NO_HT:
2093 case NL80211_CHAN_HT20:
2094 case NL80211_CHAN_HT40PLUS:
2095 case NL80211_CHAN_HT40MINUS:
2096 cfg80211_chandef_create(chandef, chandef->chan,
2097 chantype);
2098 break;
2099 default:
2100 return -EINVAL;
2101 }
2102 } else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
2103 chandef->width =
2104 nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
2105 if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
2106 chandef->center_freq1 =
2107 nla_get_u32(
2108 info->attrs[NL80211_ATTR_CENTER_FREQ1]);
2109 if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
2110 chandef->center_freq2 =
2111 nla_get_u32(
2112 info->attrs[NL80211_ATTR_CENTER_FREQ2]);
2113 }
2114
9f5e8f6e 2115 if (!cfg80211_chandef_valid(chandef))
3d9d1d66
JB		 2116 return -EINVAL;
2117
9f5e8f6e
JB		 2118 if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
2119 IEEE80211_CHAN_DISABLED))
3d9d1d66
JB		 2120 return -EINVAL;
2121
2f301ab2
SW		 2122 if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
2123 chandef->width == NL80211_CHAN_WIDTH_10) &&
2124 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ))
2125 return -EINVAL;
2126
683b6d3b
JB		 2127 return 0;
2128}
2129
f444de05 2130static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
e16821bc 2131 struct net_device *dev,
f444de05
JB		 2132 struct genl_info *info)
2133{
683b6d3b 2134 struct cfg80211_chan_def chandef;
f444de05 2135 int result;
e8c9bd5b 2136 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
e16821bc 2137 struct wireless_dev *wdev = NULL;
e8c9bd5b 2138
e16821bc
JM		 2139 if (dev)
2140 wdev = dev->ieee80211_ptr;
f444de05
JB		 2141 if (!nl80211_can_set_dev_channel(wdev))
2142 return -EOPNOTSUPP;
e16821bc
JM		 2143 if (wdev)
2144 iftype = wdev->iftype;
f444de05 2145
683b6d3b
JB		 2146 result = nl80211_parse_chandef(rdev, info, &chandef);
2147 if (result)
2148 return result;
f444de05 2149
e8c9bd5b 2150 switch (iftype) {
aa430da4
JB		 2151 case NL80211_IFTYPE_AP:
2152 case NL80211_IFTYPE_P2P_GO:
923b352f
AN		 2153 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
2154 iftype)) {
aa430da4
JB		 2155 result = -EINVAL;
2156 break;
2157 }
e16821bc
JM		 2158 if (wdev->beacon_interval) {
2159 if (!dev || !rdev->ops->set_ap_chanwidth ||
2160 !(rdev->wiphy.features &
2161 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
2162 result = -EBUSY;
2163 break;
2164 }
2165
2166 /* Only allow dynamic channel width changes */
2167 if (chandef.chan != wdev->preset_chandef.chan) {
2168 result = -EBUSY;
2169 break;
2170 }
2171 result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
2172 if (result)
2173 break;
2174 }
683b6d3b 2175 wdev->preset_chandef = chandef;
aa430da4
JB		 2176 result = 0;
2177 break;
cc1d2806 2178 case NL80211_IFTYPE_MESH_POINT:
683b6d3b 2179 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
cc1d2806 2180 break;
e8c9bd5b 2181 case NL80211_IFTYPE_MONITOR:
683b6d3b 2182 result = cfg80211_set_monitor_channel(rdev, &chandef);
e8c9bd5b 2183 break;
aa430da4 2184 default:
e8c9bd5b 2185 result = -EINVAL;
f444de05 2186 }
f444de05
JB		 2187
2188 return result;
2189}
2190
2191static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
2192{
4c476991
JB		 2193 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2194 struct net_device *netdev = info->user_ptr[1];
f444de05 2195
e16821bc 2196 return __nl80211_set_channel(rdev, netdev, info);
f444de05
JB		 2197}
2198
e8347eba
BJ		 2199static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
2200{
43b19952
JB		 2201 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2202 struct net_device *dev = info->user_ptr[1];
2203 struct wireless_dev *wdev = dev->ieee80211_ptr;
388ac775 2204 const u8 *bssid;
e8347eba
BJ		 2205
2206 if (!info->attrs[NL80211_ATTR_MAC])
2207 return -EINVAL;
2208
43b19952
JB		 2209 if (netif_running(dev))
2210 return -EBUSY;
e8347eba 2211
43b19952
JB		 2212 if (!rdev->ops->set_wds_peer)
2213 return -EOPNOTSUPP;
e8347eba 2214
43b19952
JB		 2215 if (wdev->iftype != NL80211_IFTYPE_WDS)
2216 return -EOPNOTSUPP;
e8347eba
BJ		 2217
2218 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
e35e4d28 2219 return rdev_set_wds_peer(rdev, dev, bssid);
e8347eba
BJ		 2220}
2221
55682965
JB		 2222static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
2223{
2224 struct cfg80211_registered_device *rdev;
f444de05
JB		 2225 struct net_device *netdev = NULL;
2226 struct wireless_dev *wdev;
a1e567c8 2227 int result = 0, rem_txq_params = 0;
31888487 2228 struct nlattr *nl_txq_params;
b9a5f8ca
JM		 2229 u32 changed;
2230 u8 retry_short = 0, retry_long = 0;
2231 u32 frag_threshold = 0, rts_threshold = 0;
81077e82 2232 u8 coverage_class = 0;
55682965 2233
5fe231e8
JB		 2234 ASSERT_RTNL();
2235
f444de05
JB		 2236 /*
2237 * Try to find the wiphy and netdev. Normally this
2238 * function shouldn't need the netdev, but this is
2239 * done for backward compatibility -- previously
2240 * setting the channel was done per wiphy, but now
2241 * it is per netdev. Previous userland like hostapd
2242 * also passed a netdev to set_wiphy, so that it is
2243 * possible to let that go to the right netdev!
2244 */
4bbf4d56 2245
f444de05
JB		 2246 if (info->attrs[NL80211_ATTR_IFINDEX]) {
2247 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
2248
7f2b8562 2249 netdev = __dev_get_by_index(genl_info_net(info), ifindex);
5fe231e8 2250 if (netdev && netdev->ieee80211_ptr)
f26cbf40 2251 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
5fe231e8 2252 else
f444de05 2253 netdev = NULL;
4bbf4d56
JB		 2254 }
2255
f444de05 2256 if (!netdev) {
878d9ec7
JB		 2257 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
2258 info->attrs);
5fe231e8 2259 if (IS_ERR(rdev))
4c476991 2260 return PTR_ERR(rdev);
f444de05
JB		 2261 wdev = NULL;
2262 netdev = NULL;
2263 result = 0;
71fe96bf 2264 } else
f444de05 2265 wdev = netdev->ieee80211_ptr;
f444de05
JB		 2266
2267 /*
2268 * end workaround code, by now the rdev is available
2269 * and locked, and wdev may or may not be NULL.
2270 */
4bbf4d56
JB		 2271
2272 if (info->attrs[NL80211_ATTR_WIPHY_NAME])
31888487
JM		 2273 result = cfg80211_dev_rename(
2274 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
4bbf4d56 2275
4bbf4d56 2276 if (result)
7f2b8562 2277 return result;
31888487
JM		 2278
2279 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
2280 struct ieee80211_txq_params txq_params;
2281 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
2282
7f2b8562
YX		 2283 if (!rdev->ops->set_txq_params)
2284 return -EOPNOTSUPP;
31888487 2285
7f2b8562
YX		 2286 if (!netdev)
2287 return -EINVAL;
f70f01c2 2288
133a3ff2 2289 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
7f2b8562
YX		 2290 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2291 return -EINVAL;
133a3ff2 2292
7f2b8562
YX		 2293 if (!netif_running(netdev))
2294 return -ENETDOWN;
2b5f8b0b 2295
31888487
JM		 2296 nla_for_each_nested(nl_txq_params,
2297 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
2298 rem_txq_params) {
ae811e21
JB		 2299 result = nla_parse(tb, NL80211_TXQ_ATTR_MAX,
2300 nla_data(nl_txq_params),
2301 nla_len(nl_txq_params),
2302 txq_params_policy);
2303 if (result)
2304 return result;
31888487
JM		 2305 result = parse_txq_params(tb, &txq_params);
2306 if (result)
7f2b8562 2307 return result;
31888487 2308
e35e4d28
HG		 2309 result = rdev_set_txq_params(rdev, netdev,
2310 &txq_params);
31888487 2311 if (result)
7f2b8562 2312 return result;
31888487
JM		 2313 }
2314 }
55682965 2315
72bdcf34 2316 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
e16821bc
JM		 2317 result = __nl80211_set_channel(
2318 rdev,
2319 nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
2320 info);
72bdcf34 2321 if (result)
7f2b8562 2322 return result;
72bdcf34
JM		 2323 }
2324
98d2ff8b 2325 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
c8442118 2326 struct wireless_dev *txp_wdev = wdev;
98d2ff8b
JO		 2327 enum nl80211_tx_power_setting type;
2328 int idx, mbm = 0;
2329
c8442118
JB		 2330 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
2331 txp_wdev = NULL;
2332
7f2b8562
YX		 2333 if (!rdev->ops->set_tx_power)
2334 return -EOPNOTSUPP;
98d2ff8b
JO		 2335
2336 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
2337 type = nla_get_u32(info->attrs[idx]);
2338
2339 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
7f2b8562
YX		 2340 (type != NL80211_TX_POWER_AUTOMATIC))
2341 return -EINVAL;
98d2ff8b
JO		 2342
2343 if (type != NL80211_TX_POWER_AUTOMATIC) {
2344 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
2345 mbm = nla_get_u32(info->attrs[idx]);
2346 }
2347
c8442118 2348 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
98d2ff8b 2349 if (result)
7f2b8562 2350 return result;
98d2ff8b
JO		 2351 }
2352
afe0cbf8
BR		 2353 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
2354 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
2355 u32 tx_ant, rx_ant;
7a087e74 2356
7f531e03
BR		 2357 if ((!rdev->wiphy.available_antennas_tx &&
2358 !rdev->wiphy.available_antennas_rx) ||
7f2b8562
YX		 2359 !rdev->ops->set_antenna)
2360 return -EOPNOTSUPP;
afe0cbf8
BR		 2361
2362 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
2363 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
2364
a7ffac95 2365 /* reject antenna configurations which don't match the
7f531e03
BR		 2366 * available antenna masks, except for the "all" mask */
2367 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
7f2b8562
YX		 2368 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
2369 return -EINVAL;
a7ffac95 2370
7f531e03
BR		 2371 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
2372 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
a7ffac95 2373
e35e4d28 2374 result = rdev_set_antenna(rdev, tx_ant, rx_ant);
afe0cbf8 2375 if (result)
7f2b8562 2376 return result;
afe0cbf8
BR		 2377 }
2378
b9a5f8ca
JM		 2379 changed = 0;
2380
2381 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
2382 retry_short = nla_get_u8(
2383 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
7f2b8562
YX		 2384 if (retry_short == 0)
2385 return -EINVAL;
2386
b9a5f8ca
JM		 2387 changed |= WIPHY_PARAM_RETRY_SHORT;
2388 }
2389
2390 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
2391 retry_long = nla_get_u8(
2392 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
7f2b8562
YX		 2393 if (retry_long == 0)
2394 return -EINVAL;
2395
b9a5f8ca
JM		 2396 changed |= WIPHY_PARAM_RETRY_LONG;
2397 }
2398
2399 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
2400 frag_threshold = nla_get_u32(
2401 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
7f2b8562
YX		 2402 if (frag_threshold < 256)
2403 return -EINVAL;
2404
b9a5f8ca
JM		 2405 if (frag_threshold != (u32) -1) {
2406 /*
2407 * Fragments (apart from the last one) are required to
2408 * have even length. Make the fragmentation code
2409 * simpler by stripping LSB should someone try to use
2410 * odd threshold value.
2411 */
2412 frag_threshold &= ~0x1;
2413 }
2414 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
2415 }
2416
2417 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
2418 rts_threshold = nla_get_u32(
2419 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
2420 changed |= WIPHY_PARAM_RTS_THRESHOLD;
2421 }
2422
81077e82 2423 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
3057dbfd
LB		 2424 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
2425 return -EINVAL;
2426
81077e82
LT		 2427 coverage_class = nla_get_u8(
2428 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
2429 changed |= WIPHY_PARAM_COVERAGE_CLASS;
2430 }
2431
3057dbfd
LB		 2432 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
2433 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
2434 return -EOPNOTSUPP;
2435
2436 changed |= WIPHY_PARAM_DYN_ACK;
81077e82
LT		 2437 }
2438
b9a5f8ca
JM		 2439 if (changed) {
2440 u8 old_retry_short, old_retry_long;
2441 u32 old_frag_threshold, old_rts_threshold;
81077e82 2442 u8 old_coverage_class;
b9a5f8ca 2443
7f2b8562
YX		 2444 if (!rdev->ops->set_wiphy_params)
2445 return -EOPNOTSUPP;
b9a5f8ca
JM		 2446
2447 old_retry_short = rdev->wiphy.retry_short;
2448 old_retry_long = rdev->wiphy.retry_long;
2449 old_frag_threshold = rdev->wiphy.frag_threshold;
2450 old_rts_threshold = rdev->wiphy.rts_threshold;
81077e82 2451 old_coverage_class = rdev->wiphy.coverage_class;
b9a5f8ca
JM		 2452
2453 if (changed & WIPHY_PARAM_RETRY_SHORT)
2454 rdev->wiphy.retry_short = retry_short;
2455 if (changed & WIPHY_PARAM_RETRY_LONG)
2456 rdev->wiphy.retry_long = retry_long;
2457 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
2458 rdev->wiphy.frag_threshold = frag_threshold;
2459 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
2460 rdev->wiphy.rts_threshold = rts_threshold;
81077e82
LT		 2461 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
2462 rdev->wiphy.coverage_class = coverage_class;
b9a5f8ca 2463
e35e4d28 2464 result = rdev_set_wiphy_params(rdev, changed);
b9a5f8ca
JM		 2465 if (result) {
2466 rdev->wiphy.retry_short = old_retry_short;
2467 rdev->wiphy.retry_long = old_retry_long;
2468 rdev->wiphy.frag_threshold = old_frag_threshold;
2469 rdev->wiphy.rts_threshold = old_rts_threshold;
81077e82 2470 rdev->wiphy.coverage_class = old_coverage_class;
9189ee31 2471 return result;
b9a5f8ca
JM		 2472 }
2473 }
7f2b8562 2474 return 0;
55682965
JB		 2475}
2476
71bbc994
JB		 2477static inline u64 wdev_id(struct wireless_dev *wdev)
2478{
2479 return (u64)wdev->identifier |
f26cbf40 2480 ((u64)wiphy_to_rdev(wdev->wiphy)->wiphy_idx << 32);
71bbc994 2481}
55682965 2482
683b6d3b 2483static int nl80211_send_chandef(struct sk_buff *msg,
d2859df5 2484 const struct cfg80211_chan_def *chandef)
683b6d3b 2485{
601555cd
JB		 2486 if (WARN_ON(!cfg80211_chandef_valid(chandef)))
2487 return -EINVAL;
3d9d1d66 2488
683b6d3b
JB		 2489 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
2490 chandef->chan->center_freq))
2491 return -ENOBUFS;
3d9d1d66
JB		 2492 switch (chandef->width) {
2493 case NL80211_CHAN_WIDTH_20_NOHT:
2494 case NL80211_CHAN_WIDTH_20:
2495 case NL80211_CHAN_WIDTH_40:
2496 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
2497 cfg80211_get_chandef_type(chandef)))
2498 return -ENOBUFS;
2499 break;
2500 default:
2501 break;
2502 }
2503 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
2504 return -ENOBUFS;
2505 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
2506 return -ENOBUFS;
2507 if (chandef->center_freq2 &&
2508 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
683b6d3b
JB		 2509 return -ENOBUFS;
2510 return 0;
2511}
2512
15e47304 2513static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
d726405a 2514 struct cfg80211_registered_device *rdev,
8f894be2 2515 struct wireless_dev *wdev, bool removal)
55682965 2516{
72fb2abc 2517 struct net_device *dev = wdev->netdev;
8f894be2 2518 u8 cmd = NL80211_CMD_NEW_INTERFACE;
55682965
JB		 2519 void *hdr;
2520
8f894be2
TB		 2521 if (removal)
2522 cmd = NL80211_CMD_DEL_INTERFACE;
2523
2524 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
55682965
JB		 2525 if (!hdr)
2526 return -1;
2527
72fb2abc
JB		 2528 if (dev &&
2529 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
98104fde 2530 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
72fb2abc
JB		 2531 goto nla_put_failure;
2532
2533 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
2534 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
2dad624e
ND		 2535 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
2536 NL80211_ATTR_PAD) ||
98104fde 2537 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
9360ffd1
DM		 2538 nla_put_u32(msg, NL80211_ATTR_GENERATION,
2539 rdev->devlist_generation ^
2540 (cfg80211_rdev_list_generation << 2)))
2541 goto nla_put_failure;
f5ea9120 2542
5b7ccaf3 2543 if (rdev->ops->get_channel) {
683b6d3b
JB		 2544 int ret;
2545 struct cfg80211_chan_def chandef;
2546
2547 ret = rdev_get_channel(rdev, wdev, &chandef);
2548 if (ret == 0) {
2549 if (nl80211_send_chandef(msg, &chandef))
2550 goto nla_put_failure;
2551 }
d91df0e3
PF		 2552 }
2553
d55d0d59
RM		 2554 if (rdev->ops->get_tx_power) {
2555 int dbm, ret;
2556
2557 ret = rdev_get_tx_power(rdev, wdev, &dbm);
2558 if (ret == 0 &&
2559 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
2560 DBM_TO_MBM(dbm)))
2561 goto nla_put_failure;
2562 }
2563
b84e7a05
AQ		 2564 if (wdev->ssid_len) {
2565 if (nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
2566 goto nla_put_failure;
2567 }
2568
053c095a
JB		 2569 genlmsg_end(msg, hdr);
2570 return 0;
55682965
JB		 2571
2572 nla_put_failure:
bc3ed28c
TG		 2573 genlmsg_cancel(msg, hdr);
2574 return -EMSGSIZE;
55682965
JB		 2575}
2576
2577static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
2578{
2579 int wp_idx = 0;
2580 int if_idx = 0;
2581 int wp_start = cb->args[0];
2582 int if_start = cb->args[1];
b7fb44da 2583 int filter_wiphy = -1;
f5ea9120 2584 struct cfg80211_registered_device *rdev;
55682965
JB		 2585 struct wireless_dev *wdev;
2586
5fe231e8 2587 rtnl_lock();
b7fb44da
DK		 2588 if (!cb->args[2]) {
2589 struct nl80211_dump_wiphy_state state = {
2590 .filter_wiphy = -1,
2591 };
2592 int ret;
2593
2594 ret = nl80211_dump_wiphy_parse(skb, cb, &state);
2595 if (ret)
2596 return ret;
2597
2598 filter_wiphy = state.filter_wiphy;
2599
2600 /*
2601 * if filtering, set cb->args[2] to +1 since 0 is the default
2602 * value needed to determine that parsing is necessary.
2603 */
2604 if (filter_wiphy >= 0)
2605 cb->args[2] = filter_wiphy + 1;
2606 else
2607 cb->args[2] = -1;
2608 } else if (cb->args[2] > 0) {
2609 filter_wiphy = cb->args[2] - 1;
2610 }
2611
f5ea9120
JB		 2612 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2613 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
463d0183 2614 continue;
bba95fef
JB		 2615 if (wp_idx < wp_start) {
2616 wp_idx++;
55682965 2617 continue;
bba95fef 2618 }
b7fb44da
DK		 2619
2620 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
2621 continue;
2622
55682965
JB		 2623 if_idx = 0;
2624
53873f13 2625 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
bba95fef
JB		 2626 if (if_idx < if_start) {
2627 if_idx++;
55682965 2628 continue;
bba95fef 2629 }
15e47304 2630 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
55682965 2631 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8f894be2 2632 rdev, wdev, false) < 0) {
bba95fef
JB		 2633 goto out;
2634 }
2635 if_idx++;
55682965 2636 }
bba95fef
JB		 2637
2638 wp_idx++;
55682965 2639 }
bba95fef 2640 out:
5fe231e8 2641 rtnl_unlock();
55682965
JB		 2642
2643 cb->args[0] = wp_idx;
2644 cb->args[1] = if_idx;
2645
2646 return skb->len;
2647}
2648
2649static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
2650{
2651 struct sk_buff *msg;
1b8ec87a 2652 struct cfg80211_registered_device *rdev = info->user_ptr[0];
72fb2abc 2653 struct wireless_dev *wdev = info->user_ptr[1];
55682965 2654
fd2120ca 2655 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
55682965 2656 if (!msg)
4c476991 2657 return -ENOMEM;
55682965 2658
15e47304 2659 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
8f894be2 2660 rdev, wdev, false) < 0) {
4c476991
JB		 2661 nlmsg_free(msg);
2662 return -ENOBUFS;
2663 }
55682965 2664
134e6375 2665 return genlmsg_reply(msg, info);
55682965
JB		 2666}
2667
66f7ac50
MW		 2668static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
2669 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
2670 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
2671 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
2672 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
2673 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
e057d3c3 2674 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
66f7ac50
MW		 2675};
2676
2677static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
2678{
2679 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
2680 int flag;
2681
2682 *mntrflags = 0;
2683
2684 if (!nla)
2685 return -EINVAL;
2686
2687 if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX,
2688 nla, mntr_flags_policy))
2689 return -EINVAL;
2690
2691 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
2692 if (flags[flag])
2693 *mntrflags |= (1<<flag);
2694
2695 return 0;
2696}
2697
9bc383de 2698static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
ad4bb6f8
JB		 2699 struct net_device *netdev, u8 use_4addr,
2700 enum nl80211_iftype iftype)
9bc383de 2701{
ad4bb6f8 2702 if (!use_4addr) {
f350a0a8 2703 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
ad4bb6f8 2704 return -EBUSY;
9bc383de 2705 return 0;
ad4bb6f8 2706 }
9bc383de
JB		 2707
2708 switch (iftype) {
2709 case NL80211_IFTYPE_AP_VLAN:
2710 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
2711 return 0;
2712 break;
2713 case NL80211_IFTYPE_STATION:
2714 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
2715 return 0;
2716 break;
2717 default:
2718 break;
2719 }
2720
2721 return -EOPNOTSUPP;
2722}
2723
55682965
JB		 2724static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
2725{
4c476991 2726 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2ec600d6 2727 struct vif_params params;
e36d56b6 2728 int err;
04a773ad 2729 enum nl80211_iftype otype, ntype;
4c476991 2730 struct net_device *dev = info->user_ptr[1];
92ffe055 2731 u32 _flags, *flags = NULL;
ac7f9cfa 2732 bool change = false;
55682965 2733
2ec600d6
LCC		 2734 memset(&params, 0, sizeof(params));
2735
04a773ad 2736 otype = ntype = dev->ieee80211_ptr->iftype;
55682965 2737
723b038d 2738 if (info->attrs[NL80211_ATTR_IFTYPE]) {
ac7f9cfa 2739 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
04a773ad 2740 if (otype != ntype)
ac7f9cfa 2741 change = true;
4c476991
JB		 2742 if (ntype > NL80211_IFTYPE_MAX)
2743 return -EINVAL;
723b038d
JB		 2744 }
2745
92ffe055 2746 if (info->attrs[NL80211_ATTR_MESH_ID]) {
29cbe68c
JB		 2747 struct wireless_dev *wdev = dev->ieee80211_ptr;
2748
4c476991
JB		 2749 if (ntype != NL80211_IFTYPE_MESH_POINT)
2750 return -EINVAL;
29cbe68c
JB		 2751 if (netif_running(dev))
2752 return -EBUSY;
2753
2754 wdev_lock(wdev);
2755 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2756 IEEE80211_MAX_MESH_ID_LEN);
2757 wdev->mesh_id_up_len =
2758 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2759 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2760 wdev->mesh_id_up_len);
2761 wdev_unlock(wdev);
2ec600d6
LCC		 2762 }
2763
8b787643
FF		 2764 if (info->attrs[NL80211_ATTR_4ADDR]) {
2765 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2766 change = true;
ad4bb6f8 2767 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
9bc383de 2768 if (err)
4c476991 2769 return err;
8b787643
FF		 2770 } else {
2771 params.use_4addr = -1;
2772 }
2773
92ffe055 2774 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
4c476991
JB		 2775 if (ntype != NL80211_IFTYPE_MONITOR)
2776 return -EINVAL;
92ffe055
JB		 2777 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
2778 &_flags);
ac7f9cfa 2779 if (err)
4c476991 2780 return err;
ac7f9cfa
JB		 2781
2782 flags = &_flags;
2783 change = true;
92ffe055 2784 }
3b85875a 2785
c6e6a0c8
AE		 2786 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
2787 const u8 *mumimo_groups;
2788 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2789
2790 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2791 return -EOPNOTSUPP;
2792
2793 mumimo_groups =
2794 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
2795
2796 /* bits 0 and 63 are reserved and must be zero */
2797 if ((mumimo_groups[0] & BIT(7)) ||
2798 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(0)))
2799 return -EINVAL;
2800
2801 memcpy(params.vht_mumimo_groups, mumimo_groups,
2802 VHT_MUMIMO_GROUPS_DATA_LEN);
2803 change = true;
2804 }
2805
2806 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
2807 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2808
2809 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2810 return -EOPNOTSUPP;
2811
2812 nla_memcpy(params.macaddr,
2813 info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR],
2814 ETH_ALEN);
2815 change = true;
2816 }
2817
18003297 2818 if (flags && (*flags & MONITOR_FLAG_ACTIVE) &&
e057d3c3
FF		 2819 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
2820 return -EOPNOTSUPP;
2821
ac7f9cfa 2822 if (change)
3d54d255 2823 err = cfg80211_change_iface(rdev, dev, ntype, flags, &params);
ac7f9cfa
JB		 2824 else
2825 err = 0;
60719ffd 2826
9bc383de
JB		 2827 if (!err && params.use_4addr != -1)
2828 dev->ieee80211_ptr->use_4addr = params.use_4addr;
2829
55682965
JB		 2830 return err;
2831}
2832
2833static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
2834{
4c476991 2835 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2ec600d6 2836 struct vif_params params;
84efbb84 2837 struct wireless_dev *wdev;
896ff063 2838 struct sk_buff *msg;
55682965
JB		 2839 int err;
2840 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
66f7ac50 2841 u32 flags;
55682965 2842
78f22b6a
JB		 2843 /* to avoid failing a new interface creation due to pending removal */
2844 cfg80211_destroy_ifaces(rdev);
2845
2ec600d6
LCC		 2846 memset(&params, 0, sizeof(params));
2847
55682965
JB		 2848 if (!info->attrs[NL80211_ATTR_IFNAME])
2849 return -EINVAL;
2850
2851 if (info->attrs[NL80211_ATTR_IFTYPE]) {
2852 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2853 if (type > NL80211_IFTYPE_MAX)
2854 return -EINVAL;
2855 }
2856
79c97e97 2857 if (!rdev->ops->add_virtual_intf ||
4c476991
JB		 2858 !(rdev->wiphy.interface_modes & (1 << type)))
2859 return -EOPNOTSUPP;
55682965 2860
cb3b7d87 2861 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
e8f479b1
BG		 2862 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
2863 info->attrs[NL80211_ATTR_MAC]) {
1c18f145
AS		 2864 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
2865 ETH_ALEN);
2866 if (!is_valid_ether_addr(params.macaddr))
2867 return -EADDRNOTAVAIL;
2868 }
2869
9bc383de 2870 if (info->attrs[NL80211_ATTR_4ADDR]) {
8b787643 2871 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
ad4bb6f8 2872 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
9bc383de 2873 if (err)
4c476991 2874 return err;
9bc383de 2875 }
8b787643 2876
66f7ac50
MW		 2877 err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
2878 info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
2879 &flags);
e057d3c3 2880
18003297 2881 if (!err && (flags & MONITOR_FLAG_ACTIVE) &&
e057d3c3
FF		 2882 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
2883 return -EOPNOTSUPP;
2884
a18c7192
JB		 2885 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2886 if (!msg)
2887 return -ENOMEM;
2888
e35e4d28
HG		 2889 wdev = rdev_add_virtual_intf(rdev,
2890 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
6bab2e19
TG		 2891 NET_NAME_USER, type, err ? NULL : &flags,
2892 &params);
d687cbb7
RM		 2893 if (WARN_ON(!wdev)) {
2894 nlmsg_free(msg);
2895 return -EPROTO;
2896 } else if (IS_ERR(wdev)) {
1c90f9d4 2897 nlmsg_free(msg);
84efbb84 2898 return PTR_ERR(wdev);
1c90f9d4 2899 }
2ec600d6 2900
18e5ca65 2901 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
78f22b6a
JB		 2902 wdev->owner_nlportid = info->snd_portid;
2903
98104fde
JB		 2904 switch (type) {
2905 case NL80211_IFTYPE_MESH_POINT:
2906 if (!info->attrs[NL80211_ATTR_MESH_ID])
2907 break;
29cbe68c
JB		 2908 wdev_lock(wdev);
2909 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2910 IEEE80211_MAX_MESH_ID_LEN);
2911 wdev->mesh_id_up_len =
2912 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2913 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2914 wdev->mesh_id_up_len);
2915 wdev_unlock(wdev);
98104fde 2916 break;
cb3b7d87 2917 case NL80211_IFTYPE_NAN:
98104fde
JB		 2918 case NL80211_IFTYPE_P2P_DEVICE:
2919 /*
cb3b7d87 2920 * P2P Device and NAN do not have a netdev, so don't go
98104fde
JB		 2921 * through the netdev notifier and must be added here
2922 */
2923 mutex_init(&wdev->mtx);
2924 INIT_LIST_HEAD(&wdev->event_list);
2925 spin_lock_init(&wdev->event_lock);
2926 INIT_LIST_HEAD(&wdev->mgmt_registrations);
2927 spin_lock_init(&wdev->mgmt_registrations_lock);
2928
98104fde 2929 wdev->identifier = ++rdev->wdev_id;
53873f13 2930 list_add_rcu(&wdev->list, &rdev->wiphy.wdev_list);
98104fde 2931 rdev->devlist_generation++;
98104fde
JB		 2932 break;
2933 default:
2934 break;
29cbe68c
JB		 2935 }
2936
15e47304 2937 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
8f894be2 2938 rdev, wdev, false) < 0) {
1c90f9d4
JB		 2939 nlmsg_free(msg);
2940 return -ENOBUFS;
2941 }
2942
896ff063
DK		 2943 /*
2944 * For wdevs which have no associated netdev object (e.g. of type
2945 * NL80211_IFTYPE_P2P_DEVICE), emit the NEW_INTERFACE event here.
2946 * For all other types, the event will be generated from the
2947 * netdev notifier
2948 */
2949 if (!wdev->netdev)
2950 nl80211_notify_iface(rdev, wdev, NL80211_CMD_NEW_INTERFACE);
8f894be2 2951
1c90f9d4 2952 return genlmsg_reply(msg, info);
55682965
JB		 2953}
2954
2955static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
2956{
4c476991 2957 struct cfg80211_registered_device *rdev = info->user_ptr[0];
84efbb84 2958 struct wireless_dev *wdev = info->user_ptr[1];
55682965 2959
4c476991
JB		 2960 if (!rdev->ops->del_virtual_intf)
2961 return -EOPNOTSUPP;
55682965 2962
84efbb84
JB		 2963 /*
2964 * If we remove a wireless device without a netdev then clear
2965 * user_ptr[1] so that nl80211_post_doit won't dereference it
2966 * to check if it needs to do dev_put(). Otherwise it crashes
2967 * since the wdev has been freed, unlike with a netdev where
2968 * we need the dev_put() for the netdev to really be freed.
2969 */
2970 if (!wdev->netdev)
2971 info->user_ptr[1] = NULL;
2972
7f8ed01e 2973 return rdev_del_virtual_intf(rdev, wdev);
55682965
JB		 2974}
2975
1d9d9213
SW		 2976static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
2977{
2978 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2979 struct net_device *dev = info->user_ptr[1];
2980 u16 noack_map;
2981
2982 if (!info->attrs[NL80211_ATTR_NOACK_MAP])
2983 return -EINVAL;
2984
2985 if (!rdev->ops->set_noack_map)
2986 return -EOPNOTSUPP;
2987
2988 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
2989
e35e4d28 2990 return rdev_set_noack_map(rdev, dev, noack_map);
1d9d9213
SW		 2991}
2992
41ade00f
JB		 2993struct get_key_cookie {
2994 struct sk_buff *msg;
2995 int error;
b9454e83 2996 int idx;
41ade00f
JB		 2997};
2998
2999static void get_key_callback(void *c, struct key_params *params)
3000{
b9454e83 3001 struct nlattr *key;
41ade00f
JB		 3002 struct get_key_cookie *cookie = c;
3003
9360ffd1
DM		 3004 if ((params->key &&
3005 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
3006 params->key_len, params->key)) ||
3007 (params->seq &&
3008 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
3009 params->seq_len, params->seq)) ||
3010 (params->cipher &&
3011 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
3012 params->cipher)))
3013 goto nla_put_failure;
41ade00f 3014
b9454e83
JB		 3015 key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
3016 if (!key)
3017 goto nla_put_failure;
3018
9360ffd1
DM		 3019 if ((params->key &&
3020 nla_put(cookie->msg, NL80211_KEY_DATA,
3021 params->key_len, params->key)) ||
3022 (params->seq &&
3023 nla_put(cookie->msg, NL80211_KEY_SEQ,
3024 params->seq_len, params->seq)) ||
3025 (params->cipher &&
3026 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
3027 params->cipher)))
3028 goto nla_put_failure;
b9454e83 3029
9360ffd1
DM		 3030 if (nla_put_u8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx))
3031 goto nla_put_failure;
b9454e83
JB		 3032
3033 nla_nest_end(cookie->msg, key);
3034
41ade00f
JB		 3035 return;
3036 nla_put_failure:
3037 cookie->error = 1;
3038}
3039
3040static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
3041{
4c476991 3042 struct cfg80211_registered_device *rdev = info->user_ptr[0];
41ade00f 3043 int err;
4c476991 3044 struct net_device *dev = info->user_ptr[1];
41ade00f 3045 u8 key_idx = 0;
e31b8213
JB		 3046 const u8 *mac_addr = NULL;
3047 bool pairwise;
41ade00f
JB		 3048 struct get_key_cookie cookie = {
3049 .error = 0,
3050 };
3051 void *hdr;
3052 struct sk_buff *msg;
3053
3054 if (info->attrs[NL80211_ATTR_KEY_IDX])
3055 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
3056
3cfcf6ac 3057 if (key_idx > 5)
41ade00f
JB		 3058 return -EINVAL;
3059
3060 if (info->attrs[NL80211_ATTR_MAC])
3061 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3062
e31b8213
JB		 3063 pairwise = !!mac_addr;
3064 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
3065 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
7a087e74 3066
e31b8213
JB		 3067 if (kt >= NUM_NL80211_KEYTYPES)
3068 return -EINVAL;
3069 if (kt != NL80211_KEYTYPE_GROUP &&
3070 kt != NL80211_KEYTYPE_PAIRWISE)
3071 return -EINVAL;
3072 pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
3073 }
3074
4c476991
JB		 3075 if (!rdev->ops->get_key)
3076 return -EOPNOTSUPP;
41ade00f 3077
0fa7b391
JB		 3078 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3079 return -ENOENT;
3080
fd2120ca 3081 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4c476991
JB		 3082 if (!msg)
3083 return -ENOMEM;
41ade00f 3084
15e47304 3085 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
41ade00f 3086 NL80211_CMD_NEW_KEY);
cb35fba3 3087 if (!hdr)
9fe271af 3088 goto nla_put_failure;
41ade00f
JB		 3089
3090 cookie.msg = msg;
b9454e83 3091 cookie.idx = key_idx;
41ade00f 3092
9360ffd1
DM		 3093 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3094 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
3095 goto nla_put_failure;
3096 if (mac_addr &&
3097 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
3098 goto nla_put_failure;
41ade00f 3099
e35e4d28
HG		 3100 err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
3101 get_key_callback);
41ade00f
JB		 3102
3103 if (err)
6c95e2a2 3104 goto free_msg;
41ade00f
JB		 3105
3106 if (cookie.error)
3107 goto nla_put_failure;
3108
3109 genlmsg_end(msg, hdr);
4c476991 3110 return genlmsg_reply(msg, info);
41ade00f
JB		 3111
3112 nla_put_failure:
3113 err = -ENOBUFS;
6c95e2a2 3114 free_msg:
41ade00f 3115 nlmsg_free(msg);
41ade00f
JB		 3116 return err;
3117}
3118
3119static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
3120{
4c476991 3121 struct cfg80211_registered_device *rdev = info->user_ptr[0];
b9454e83 3122 struct key_parse key;
41ade00f 3123 int err;
4c476991 3124 struct net_device *dev = info->user_ptr[1];
41ade00f 3125
b9454e83
JB		 3126 err = nl80211_parse_key(info, &key);
3127 if (err)
3128 return err;
41ade00f 3129
b9454e83 3130 if (key.idx < 0)
41ade00f
JB		 3131 return -EINVAL;
3132
b9454e83
JB		 3133 /* only support setting default key */
3134 if (!key.def && !key.defmgmt)
41ade00f
JB		 3135 return -EINVAL;
3136
dbd2fd65 3137 wdev_lock(dev->ieee80211_ptr);
3cfcf6ac 3138
dbd2fd65
JB		 3139 if (key.def) {
3140 if (!rdev->ops->set_default_key) {
3141 err = -EOPNOTSUPP;
3142 goto out;
3143 }
41ade00f 3144
dbd2fd65
JB		 3145 err = nl80211_key_allowed(dev->ieee80211_ptr);
3146 if (err)
3147 goto out;
3148
e35e4d28 3149 err = rdev_set_default_key(rdev, dev, key.idx,
dbd2fd65
JB		 3150 key.def_uni, key.def_multi);
3151
3152 if (err)
3153 goto out;
fffd0934 3154
3d23e349 3155#ifdef CONFIG_CFG80211_WEXT
dbd2fd65
JB		 3156 dev->ieee80211_ptr->wext.default_key = key.idx;
3157#endif
3158 } else {
3159 if (key.def_uni || !key.def_multi) {
3160 err = -EINVAL;
3161 goto out;
3162 }
3163
3164 if (!rdev->ops->set_default_mgmt_key) {
3165 err = -EOPNOTSUPP;
3166 goto out;
3167 }
3168
3169 err = nl80211_key_allowed(dev->ieee80211_ptr);
3170 if (err)
3171 goto out;
3172
e35e4d28 3173 err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
dbd2fd65
JB		 3174 if (err)
3175 goto out;
3176
3177#ifdef CONFIG_CFG80211_WEXT
3178 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
08645126 3179#endif
dbd2fd65
JB		 3180 }
3181
3182 out:
fffd0934 3183 wdev_unlock(dev->ieee80211_ptr);
41ade00f 3184
41ade00f
JB		 3185 return err;
3186}
3187
3188static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
3189{
4c476991 3190 struct cfg80211_registered_device *rdev = info->user_ptr[0];
fffd0934 3191 int err;
4c476991 3192 struct net_device *dev = info->user_ptr[1];
b9454e83 3193 struct key_parse key;
e31b8213 3194 const u8 *mac_addr = NULL;
41ade00f 3195
b9454e83
JB		 3196 err = nl80211_parse_key(info, &key);
3197 if (err)
3198 return err;
41ade00f 3199
b9454e83 3200 if (!key.p.key)
41ade00f
JB		 3201 return -EINVAL;
3202
41ade00f
JB		 3203 if (info->attrs[NL80211_ATTR_MAC])
3204 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3205
e31b8213
JB		 3206 if (key.type == -1) {
3207 if (mac_addr)
3208 key.type = NL80211_KEYTYPE_PAIRWISE;
3209 else
3210 key.type = NL80211_KEYTYPE_GROUP;
3211 }
3212
3213 /* for now */
3214 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3215 key.type != NL80211_KEYTYPE_GROUP)
3216 return -EINVAL;
3217
4c476991
JB		 3218 if (!rdev->ops->add_key)
3219 return -EOPNOTSUPP;
25e47c18 3220
e31b8213
JB		 3221 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
3222 key.type == NL80211_KEYTYPE_PAIRWISE,
3223 mac_addr))
4c476991 3224 return -EINVAL;
41ade00f 3225
fffd0934
JB		 3226 wdev_lock(dev->ieee80211_ptr);
3227 err = nl80211_key_allowed(dev->ieee80211_ptr);
3228 if (!err)
e35e4d28
HG		 3229 err = rdev_add_key(rdev, dev, key.idx,
3230 key.type == NL80211_KEYTYPE_PAIRWISE,
3231 mac_addr, &key.p);
fffd0934 3232 wdev_unlock(dev->ieee80211_ptr);
41ade00f 3233
41ade00f
JB		 3234 return err;
3235}
3236
3237static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
3238{
4c476991 3239 struct cfg80211_registered_device *rdev = info->user_ptr[0];
41ade00f 3240 int err;
4c476991 3241 struct net_device *dev = info->user_ptr[1];
41ade00f 3242 u8 *mac_addr = NULL;
b9454e83 3243 struct key_parse key;
41ade00f 3244
b9454e83
JB		 3245 err = nl80211_parse_key(info, &key);
3246 if (err)
3247 return err;
41ade00f
JB		 3248
3249 if (info->attrs[NL80211_ATTR_MAC])
3250 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3251
e31b8213
JB		 3252 if (key.type == -1) {
3253 if (mac_addr)
3254 key.type = NL80211_KEYTYPE_PAIRWISE;
3255 else
3256 key.type = NL80211_KEYTYPE_GROUP;
3257 }
3258
3259 /* for now */
3260 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3261 key.type != NL80211_KEYTYPE_GROUP)
3262 return -EINVAL;
3263
4c476991
JB		 3264 if (!rdev->ops->del_key)
3265 return -EOPNOTSUPP;
41ade00f 3266
fffd0934
JB		 3267 wdev_lock(dev->ieee80211_ptr);
3268 err = nl80211_key_allowed(dev->ieee80211_ptr);
e31b8213 3269
0fa7b391 3270 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
e31b8213
JB		 3271 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3272 err = -ENOENT;
3273
fffd0934 3274 if (!err)
e35e4d28
HG		 3275 err = rdev_del_key(rdev, dev, key.idx,
3276 key.type == NL80211_KEYTYPE_PAIRWISE,
3277 mac_addr);
41ade00f 3278
3d23e349 3279#ifdef CONFIG_CFG80211_WEXT
08645126 3280 if (!err) {
b9454e83 3281 if (key.idx == dev->ieee80211_ptr->wext.default_key)
08645126 3282 dev->ieee80211_ptr->wext.default_key = -1;
b9454e83 3283 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
08645126
JB		 3284 dev->ieee80211_ptr->wext.default_mgmt_key = -1;
3285 }
3286#endif
fffd0934 3287 wdev_unlock(dev->ieee80211_ptr);
08645126 3288
41ade00f
JB		 3289 return err;
3290}
3291
77765eaf
VT		 3292/* This function returns an error or the number of nested attributes */
3293static int validate_acl_mac_addrs(struct nlattr *nl_attr)
3294{
3295 struct nlattr *attr;
3296 int n_entries = 0, tmp;
3297
3298 nla_for_each_nested(attr, nl_attr, tmp) {
3299 if (nla_len(attr) != ETH_ALEN)
3300 return -EINVAL;
3301
3302 n_entries++;
3303 }
3304
3305 return n_entries;
3306}
3307
3308/*
3309 * This function parses ACL information and allocates memory for ACL data.
3310 * On successful return, the calling function is responsible to free the
3311 * ACL buffer returned by this function.
3312 */
3313static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
3314 struct genl_info *info)
3315{
3316 enum nl80211_acl_policy acl_policy;
3317 struct nlattr *attr;
3318 struct cfg80211_acl_data *acl;
3319 int i = 0, n_entries, tmp;
3320
3321 if (!wiphy->max_acl_mac_addrs)
3322 return ERR_PTR(-EOPNOTSUPP);
3323
3324 if (!info->attrs[NL80211_ATTR_ACL_POLICY])
3325 return ERR_PTR(-EINVAL);
3326
3327 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
3328 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
3329 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
3330 return ERR_PTR(-EINVAL);
3331
3332 if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
3333 return ERR_PTR(-EINVAL);
3334
3335 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
3336 if (n_entries < 0)
3337 return ERR_PTR(n_entries);
3338
3339 if (n_entries > wiphy->max_acl_mac_addrs)
3340 return ERR_PTR(-ENOTSUPP);
3341
3342 acl = kzalloc(sizeof(*acl) + (sizeof(struct mac_address) * n_entries),
3343 GFP_KERNEL);
3344 if (!acl)
3345 return ERR_PTR(-ENOMEM);
3346
3347 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
3348 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
3349 i++;
3350 }
3351
3352 acl->n_acl_entries = n_entries;
3353 acl->acl_policy = acl_policy;
3354
3355 return acl;
3356}
3357
3358static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
3359{
3360 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3361 struct net_device *dev = info->user_ptr[1];
3362 struct cfg80211_acl_data *acl;
3363 int err;
3364
3365 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3366 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3367 return -EOPNOTSUPP;
3368
3369 if (!dev->ieee80211_ptr->beacon_interval)
3370 return -EINVAL;
3371
3372 acl = parse_acl_data(&rdev->wiphy, info);
3373 if (IS_ERR(acl))
3374 return PTR_ERR(acl);
3375
3376 err = rdev_set_mac_acl(rdev, dev, acl);
3377
3378 kfree(acl);
3379
3380 return err;
3381}
3382
a7c7fbff
PK		 3383static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
3384 u8 *rates, u8 rates_len)
3385{
3386 u8 i;
3387 u32 mask = 0;
3388
3389 for (i = 0; i < rates_len; i++) {
3390 int rate = (rates[i] & 0x7f) * 5;
3391 int ridx;
3392
3393 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
3394 struct ieee80211_rate *srate =
3395 &sband->bitrates[ridx];
3396 if (rate == srate->bitrate) {
3397 mask |= 1 << ridx;
3398 break;
3399 }
3400 }
3401 if (ridx == sband->n_bitrates)
3402 return 0; /* rate not found */
3403 }
3404
3405 return mask;
3406}
3407
3408static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
3409 u8 *rates, u8 rates_len,
3410 u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
3411{
3412 u8 i;
3413
3414 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
3415
3416 for (i = 0; i < rates_len; i++) {
3417 int ridx, rbit;
3418
3419 ridx = rates[i] / 8;
3420 rbit = BIT(rates[i] % 8);
3421
3422 /* check validity */
3423 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
3424 return false;
3425
3426 /* check availability */
3427 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
3428 mcs[ridx] |= rbit;
3429 else
3430 return false;
3431 }
3432
3433 return true;
3434}
3435
3436static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
3437{
3438 u16 mcs_mask = 0;
3439
3440 switch (vht_mcs_map) {
3441 case IEEE80211_VHT_MCS_NOT_SUPPORTED:
3442 break;
3443 case IEEE80211_VHT_MCS_SUPPORT_0_7:
3444 mcs_mask = 0x00FF;
3445 break;
3446 case IEEE80211_VHT_MCS_SUPPORT_0_8:
3447 mcs_mask = 0x01FF;
3448 break;
3449 case IEEE80211_VHT_MCS_SUPPORT_0_9:
3450 mcs_mask = 0x03FF;
3451 break;
3452 default:
3453 break;
3454 }
3455
3456 return mcs_mask;
3457}
3458
3459static void vht_build_mcs_mask(u16 vht_mcs_map,
3460 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
3461{
3462 u8 nss;
3463
3464 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
3465 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
3466 vht_mcs_map >>= 2;
3467 }
3468}
3469
3470static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
3471 struct nl80211_txrate_vht *txrate,
3472 u16 mcs[NL80211_VHT_NSS_MAX])
3473{
3474 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3475 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
3476 u8 i;
3477
3478 if (!sband->vht_cap.vht_supported)
3479 return false;
3480
3481 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
3482
3483 /* Build vht_mcs_mask from VHT capabilities */
3484 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
3485
3486 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
3487 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
3488 mcs[i] = txrate->mcs[i];
3489 else
3490 return false;
3491 }
3492
3493 return true;
3494}
3495
3496static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
3497 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
3498 .len = NL80211_MAX_SUPP_RATES },
3499 [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
3500 .len = NL80211_MAX_SUPP_HT_RATES },
3501 [NL80211_TXRATE_VHT] = { .len = sizeof(struct nl80211_txrate_vht)},
3502 [NL80211_TXRATE_GI] = { .type = NLA_U8 },
3503};
3504
3505static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
3506 struct cfg80211_bitrate_mask *mask)
3507{
3508 struct nlattr *tb[NL80211_TXRATE_MAX + 1];
3509 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3510 int rem, i;
3511 struct nlattr *tx_rates;
3512 struct ieee80211_supported_band *sband;
3513 u16 vht_tx_mcs_map;
3514
3515 memset(mask, 0, sizeof(*mask));
3516 /* Default to all rates enabled */
3517 for (i = 0; i < NUM_NL80211_BANDS; i++) {
3518 sband = rdev->wiphy.bands[i];
3519
3520 if (!sband)
3521 continue;
3522
3523 mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
3524 memcpy(mask->control[i].ht_mcs,
3525 sband->ht_cap.mcs.rx_mask,
3526 sizeof(mask->control[i].ht_mcs));
3527
3528 if (!sband->vht_cap.vht_supported)
3529 continue;
3530
3531 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3532 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
3533 }
3534
3535 /* if no rates are given set it back to the defaults */
3536 if (!info->attrs[NL80211_ATTR_TX_RATES])
3537 goto out;
3538
3539 /* The nested attribute uses enum nl80211_band as the index. This maps
3540 * directly to the enum nl80211_band values used in cfg80211.
3541 */
3542 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
3543 nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
3544 enum nl80211_band band = nla_type(tx_rates);
3545 int err;
3546
3547 if (band < 0 || band >= NUM_NL80211_BANDS)
3548 return -EINVAL;
3549 sband = rdev->wiphy.bands[band];
3550 if (sband == NULL)
3551 return -EINVAL;
3552 err = nla_parse(tb, NL80211_TXRATE_MAX, nla_data(tx_rates),
3553 nla_len(tx_rates), nl80211_txattr_policy);
3554 if (err)
3555 return err;
3556 if (tb[NL80211_TXRATE_LEGACY]) {
3557 mask->control[band].legacy = rateset_to_mask(
3558 sband,
3559 nla_data(tb[NL80211_TXRATE_LEGACY]),
3560 nla_len(tb[NL80211_TXRATE_LEGACY]));
3561 if ((mask->control[band].legacy == 0) &&
3562 nla_len(tb[NL80211_TXRATE_LEGACY]))
3563 return -EINVAL;
3564 }
3565 if (tb[NL80211_TXRATE_HT]) {
3566 if (!ht_rateset_to_mask(
3567 sband,
3568 nla_data(tb[NL80211_TXRATE_HT]),
3569 nla_len(tb[NL80211_TXRATE_HT]),
3570 mask->control[band].ht_mcs))
3571 return -EINVAL;
3572 }
3573 if (tb[NL80211_TXRATE_VHT]) {
3574 if (!vht_set_mcs_mask(
3575 sband,
3576 nla_data(tb[NL80211_TXRATE_VHT]),
3577 mask->control[band].vht_mcs))
3578 return -EINVAL;
3579 }
3580 if (tb[NL80211_TXRATE_GI]) {
3581 mask->control[band].gi =
3582 nla_get_u8(tb[NL80211_TXRATE_GI]);
3583 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
3584 return -EINVAL;
3585 }
3586
3587 if (mask->control[band].legacy == 0) {
3588 /* don't allow empty legacy rates if HT or VHT
3589 * are not even supported.
3590 */
3591 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
3592 rdev->wiphy.bands[band]->vht_cap.vht_supported))
3593 return -EINVAL;
3594
3595 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
3596 if (mask->control[band].ht_mcs[i])
3597 goto out;
3598
3599 for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
3600 if (mask->control[band].vht_mcs[i])
3601 goto out;
3602
3603 /* legacy and mcs rates may not be both empty */
3604 return -EINVAL;
3605 }
3606 }
3607
3608out:
3609 return 0;
3610}
3611
8564e382
JB		 3612static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
3613 enum nl80211_band band,
3614 struct cfg80211_bitrate_mask *beacon_rate)
a7c7fbff 3615{
8564e382
JB		 3616 u32 count_ht, count_vht, i;
3617 u32 rate = beacon_rate->control[band].legacy;
a7c7fbff
PK		 3618
3619 /* Allow only one rate */
3620 if (hweight32(rate) > 1)
3621 return -EINVAL;
3622
3623 count_ht = 0;
3624 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
8564e382 3625 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
a7c7fbff 3626 return -EINVAL;
8564e382 3627 } else if (beacon_rate->control[band].ht_mcs[i]) {
a7c7fbff
PK		 3628 count_ht++;
3629 if (count_ht > 1)
3630 return -EINVAL;
3631 }
3632 if (count_ht && rate)
3633 return -EINVAL;
3634 }
3635
3636 count_vht = 0;
3637 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
8564e382 3638 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
a7c7fbff 3639 return -EINVAL;
8564e382 3640 } else if (beacon_rate->control[band].vht_mcs[i]) {
a7c7fbff
PK		 3641 count_vht++;
3642 if (count_vht > 1)
3643 return -EINVAL;
3644 }
3645 if (count_vht && rate)
3646 return -EINVAL;
3647 }
3648
3649 if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
3650 return -EINVAL;
3651
8564e382
JB		 3652 if (rate &&
3653 !wiphy_ext_feature_isset(&rdev->wiphy,
3654 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
3655 return -EINVAL;
3656 if (count_ht &&
3657 !wiphy_ext_feature_isset(&rdev->wiphy,
3658 NL80211_EXT_FEATURE_BEACON_RATE_HT))
3659 return -EINVAL;
3660 if (count_vht &&
3661 !wiphy_ext_feature_isset(&rdev->wiphy,
3662 NL80211_EXT_FEATURE_BEACON_RATE_VHT))
3663 return -EINVAL;
3664
a7c7fbff
PK		 3665 return 0;
3666}
3667
a1193be8 3668static int nl80211_parse_beacon(struct nlattr *attrs[],
8860020e 3669 struct cfg80211_beacon_data *bcn)
ed1b6cc7 3670{
8860020e 3671 bool haveinfo = false;
ed1b6cc7 3672
a1193be8
SW		 3673 if (!is_valid_ie_attr(attrs[NL80211_ATTR_BEACON_TAIL]) ||
3674 !is_valid_ie_attr(attrs[NL80211_ATTR_IE]) ||
3675 !is_valid_ie_attr(attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
3676 !is_valid_ie_attr(attrs[NL80211_ATTR_IE_ASSOC_RESP]))
f4a11bb0
JB		 3677 return -EINVAL;
3678
8860020e 3679 memset(bcn, 0, sizeof(*bcn));
ed1b6cc7 3680
a1193be8
SW		 3681 if (attrs[NL80211_ATTR_BEACON_HEAD]) {
3682 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
3683 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
8860020e
JB		 3684 if (!bcn->head_len)
3685 return -EINVAL;
3686 haveinfo = true;
ed1b6cc7
JB		 3687 }
3688
a1193be8
SW		 3689 if (attrs[NL80211_ATTR_BEACON_TAIL]) {
3690 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
3691 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
8860020e 3692 haveinfo = true;
ed1b6cc7
JB		 3693 }
3694
4c476991
JB		 3695 if (!haveinfo)
3696 return -EINVAL;
3b85875a 3697
a1193be8
SW		 3698 if (attrs[NL80211_ATTR_IE]) {
3699 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
3700 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
9946ecfb
JM		 3701 }
3702
a1193be8 3703 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
8860020e 3704 bcn->proberesp_ies =
a1193be8 3705 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
8860020e 3706 bcn->proberesp_ies_len =
a1193be8 3707 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
9946ecfb
JM		 3708 }
3709
a1193be8 3710 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
8860020e 3711 bcn->assocresp_ies =
a1193be8 3712 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
8860020e 3713 bcn->assocresp_ies_len =
a1193be8 3714 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
9946ecfb
JM		 3715 }
3716
a1193be8
SW		 3717 if (attrs[NL80211_ATTR_PROBE_RESP]) {
3718 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
3719 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
00f740e1
AN		 3720 }
3721
8860020e
JB		 3722 return 0;
3723}
3724
46c1dd0c
FF		 3725static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
3726 struct cfg80211_ap_settings *params)
3727{
3728 struct wireless_dev *wdev;
3729 bool ret = false;
3730
53873f13 3731 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
46c1dd0c
FF		 3732 if (wdev->iftype != NL80211_IFTYPE_AP &&
3733 wdev->iftype != NL80211_IFTYPE_P2P_GO)
3734 continue;
3735
683b6d3b 3736 if (!wdev->preset_chandef.chan)
46c1dd0c
FF		 3737 continue;
3738
683b6d3b 3739 params->chandef = wdev->preset_chandef;
46c1dd0c
FF		 3740 ret = true;
3741 break;
3742 }
3743
46c1dd0c
FF		 3744 return ret;
3745}
3746
e39e5b5e
JM		 3747static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
3748 enum nl80211_auth_type auth_type,
3749 enum nl80211_commands cmd)
3750{
3751 if (auth_type > NL80211_AUTHTYPE_MAX)
3752 return false;
3753
3754 switch (cmd) {
3755 case NL80211_CMD_AUTHENTICATE:
3756 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
3757 auth_type == NL80211_AUTHTYPE_SAE)
3758 return false;
3759 return true;
3760 case NL80211_CMD_CONNECT:
3761 case NL80211_CMD_START_AP:
3762 /* SAE not supported yet */
3763 if (auth_type == NL80211_AUTHTYPE_SAE)
3764 return false;
3765 return true;
3766 default:
3767 return false;
3768 }
3769}
3770
8860020e
JB		 3771static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
3772{
3773 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3774 struct net_device *dev = info->user_ptr[1];
3775 struct wireless_dev *wdev = dev->ieee80211_ptr;
3776 struct cfg80211_ap_settings params;
3777 int err;
3778
3779 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3780 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3781 return -EOPNOTSUPP;
3782
3783 if (!rdev->ops->start_ap)
3784 return -EOPNOTSUPP;
3785
3786 if (wdev->beacon_interval)
3787 return -EALREADY;
3788
3789 memset(&params, 0, sizeof(params));
3790
3791 /* these are required for START_AP */
3792 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
3793 !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
3794 !info->attrs[NL80211_ATTR_BEACON_HEAD])
3795 return -EINVAL;
3796
a1193be8 3797 err = nl80211_parse_beacon(info->attrs, &params.beacon);
8860020e
JB		 3798 if (err)
3799 return err;
3800
3801 params.beacon_interval =
3802 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
3803 params.dtim_period =
3804 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
3805
3806 err = cfg80211_validate_beacon_int(rdev, params.beacon_interval);
3807 if (err)
3808 return err;
3809
3810 /*
3811 * In theory, some of these attributes should be required here
3812 * but since they were not used when the command was originally
3813 * added, keep them optional for old user space programs to let
3814 * them continue to work with drivers that do not need the
3815 * additional information -- drivers must check!
3816 */
3817 if (info->attrs[NL80211_ATTR_SSID]) {
3818 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
3819 params.ssid_len =
3820 nla_len(info->attrs[NL80211_ATTR_SSID]);
3821 if (params.ssid_len == 0 ||
3822 params.ssid_len > IEEE80211_MAX_SSID_LEN)
3823 return -EINVAL;
3824 }
3825
3826 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
3827 params.hidden_ssid = nla_get_u32(
3828 info->attrs[NL80211_ATTR_HIDDEN_SSID]);
3829 if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
3830 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
3831 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
3832 return -EINVAL;
3833 }
3834
3835 params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
3836
3837 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
3838 params.auth_type = nla_get_u32(
3839 info->attrs[NL80211_ATTR_AUTH_TYPE]);
e39e5b5e
JM		 3840 if (!nl80211_valid_auth_type(rdev, params.auth_type,
3841 NL80211_CMD_START_AP))
8860020e
JB		 3842 return -EINVAL;
3843 } else
3844 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
3845
3846 err = nl80211_crypto_settings(rdev, info, &params.crypto,
3847 NL80211_MAX_NR_CIPHER_SUITES);
3848 if (err)
3849 return err;
3850
1b658f11
VT		 3851 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
3852 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
3853 return -EOPNOTSUPP;
3854 params.inactivity_timeout = nla_get_u16(
3855 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
3856 }
3857
53cabad7
JB		 3858 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
3859 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3860 return -EINVAL;
3861 params.p2p_ctwindow =
3862 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
3863 if (params.p2p_ctwindow > 127)
3864 return -EINVAL;
3865 if (params.p2p_ctwindow != 0 &&
3866 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
3867 return -EINVAL;
3868 }
3869
3870 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
3871 u8 tmp;
3872
3873 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3874 return -EINVAL;
3875 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
3876 if (tmp > 1)
3877 return -EINVAL;
3878 params.p2p_opp_ps = tmp;
3879 if (params.p2p_opp_ps != 0 &&
3880 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
3881 return -EINVAL;
3882 }
3883
aa430da4 3884 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
683b6d3b
JB		 3885 err = nl80211_parse_chandef(rdev, info, &params.chandef);
3886 if (err)
3887 return err;
3888 } else if (wdev->preset_chandef.chan) {
3889 params.chandef = wdev->preset_chandef;
46c1dd0c 3890 } else if (!nl80211_get_ap_channel(rdev, &params))
aa430da4
JB		 3891 return -EINVAL;
3892
923b352f
AN		 3893 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
3894 wdev->iftype))
aa430da4
JB		 3895 return -EINVAL;
3896
a7c7fbff
PK		 3897 if (info->attrs[NL80211_ATTR_TX_RATES]) {
3898 err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
3899 if (err)
3900 return err;
3901
8564e382
JB		 3902 err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
3903 &params.beacon_rate);
a7c7fbff
PK		 3904 if (err)
3905 return err;
3906 }
3907
18998c38
EP		 3908 if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
3909 params.smps_mode =
3910 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
3911 switch (params.smps_mode) {
3912 case NL80211_SMPS_OFF:
3913 break;
3914 case NL80211_SMPS_STATIC:
3915 if (!(rdev->wiphy.features &
3916 NL80211_FEATURE_STATIC_SMPS))
3917 return -EINVAL;
3918 break;
3919 case NL80211_SMPS_DYNAMIC:
3920 if (!(rdev->wiphy.features &
3921 NL80211_FEATURE_DYNAMIC_SMPS))
3922 return -EINVAL;
3923 break;
3924 default:
3925 return -EINVAL;
3926 }
3927 } else {
3928 params.smps_mode = NL80211_SMPS_OFF;
3929 }
3930
6e8ef842
PK		 3931 params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
3932 if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
3933 return -EOPNOTSUPP;
3934
4baf6bea
OO		 3935 if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
3936 params.acl = parse_acl_data(&rdev->wiphy, info);
3937 if (IS_ERR(params.acl))
3938 return PTR_ERR(params.acl);
3939 }
3940
c56589ed 3941 wdev_lock(wdev);
e35e4d28 3942 err = rdev_start_ap(rdev, dev, &params);
46c1dd0c 3943 if (!err) {
683b6d3b 3944 wdev->preset_chandef = params.chandef;
8860020e 3945 wdev->beacon_interval = params.beacon_interval;
9e0e2961 3946 wdev->chandef = params.chandef;
06e191e2
AQ		 3947 wdev->ssid_len = params.ssid_len;
3948 memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
46c1dd0c 3949 }
c56589ed 3950 wdev_unlock(wdev);
77765eaf
VT		 3951
3952 kfree(params.acl);
3953
56d1893d 3954 return err;
ed1b6cc7
JB		 3955}
3956
8860020e
JB		 3957static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
3958{
3959 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3960 struct net_device *dev = info->user_ptr[1];
3961 struct wireless_dev *wdev = dev->ieee80211_ptr;
3962 struct cfg80211_beacon_data params;
3963 int err;
3964
3965 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3966 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3967 return -EOPNOTSUPP;
3968
3969 if (!rdev->ops->change_beacon)
3970 return -EOPNOTSUPP;
3971
3972 if (!wdev->beacon_interval)
3973 return -EINVAL;
3974
a1193be8 3975 err = nl80211_parse_beacon(info->attrs, &params);
8860020e
JB		 3976 if (err)
3977 return err;
3978
c56589ed
SW		 3979 wdev_lock(wdev);
3980 err = rdev_change_beacon(rdev, dev, &params);
3981 wdev_unlock(wdev);
3982
3983 return err;
8860020e
JB		 3984}
3985
3986static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
ed1b6cc7 3987{
4c476991
JB		 3988 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3989 struct net_device *dev = info->user_ptr[1];
ed1b6cc7 3990
7c8d5e03 3991 return cfg80211_stop_ap(rdev, dev, false);
ed1b6cc7
JB		 3992}
3993
5727ef1b
JB		 3994static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
3995 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
3996 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
3997 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
0e46724a 3998 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
b39c48fa 3999 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
d83023da 4000 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
5727ef1b
JB		 4001};
4002
eccb8e8f 4003static int parse_station_flags(struct genl_info *info,
bdd3ae3d 4004 enum nl80211_iftype iftype,
eccb8e8f 4005 struct station_parameters *params)
5727ef1b
JB		 4006{
4007 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
eccb8e8f 4008 struct nlattr *nla;
5727ef1b
JB		 4009 int flag;
4010
eccb8e8f
JB		 4011 /*
4012 * Try parsing the new attribute first so userspace
4013 * can specify both for older kernels.
4014 */
4015 nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
4016 if (nla) {
4017 struct nl80211_sta_flag_update *sta_flags;
4018
4019 sta_flags = nla_data(nla);
4020 params->sta_flags_mask = sta_flags->mask;
4021 params->sta_flags_set = sta_flags->set;
77ee7c89 4022 params->sta_flags_set &= params->sta_flags_mask;
eccb8e8f
JB		 4023 if ((params->sta_flags_mask |
4024 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
4025 return -EINVAL;
4026 return 0;
4027 }
4028
4029 /* if present, parse the old attribute */
5727ef1b 4030
eccb8e8f 4031 nla = info->attrs[NL80211_ATTR_STA_FLAGS];
5727ef1b
JB		 4032 if (!nla)
4033 return 0;
4034
4035 if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX,
4036 nla, sta_flags_policy))
4037 return -EINVAL;
4038
bdd3ae3d
JB		 4039 /*
4040 * Only allow certain flags for interface types so that
4041 * other attributes are silently ignored. Remember that
4042 * this is backward compatibility code with old userspace
4043 * and shouldn't be hit in other cases anyway.
4044 */
4045 switch (iftype) {
4046 case NL80211_IFTYPE_AP:
4047 case NL80211_IFTYPE_AP_VLAN:
4048 case NL80211_IFTYPE_P2P_GO:
4049 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4050 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4051 BIT(NL80211_STA_FLAG_WME) |
4052 BIT(NL80211_STA_FLAG_MFP);
4053 break;
4054 case NL80211_IFTYPE_P2P_CLIENT:
4055 case NL80211_IFTYPE_STATION:
4056 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4057 BIT(NL80211_STA_FLAG_TDLS_PEER);
4058 break;
4059 case NL80211_IFTYPE_MESH_POINT:
4060 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4061 BIT(NL80211_STA_FLAG_MFP) |
4062 BIT(NL80211_STA_FLAG_AUTHORIZED);
4063 default:
4064 return -EINVAL;
4065 }
5727ef1b 4066
3383b5a6
JB		 4067 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
4068 if (flags[flag]) {
eccb8e8f 4069 params->sta_flags_set |= (1<<flag);
5727ef1b 4070
3383b5a6
JB		 4071 /* no longer support new API additions in old API */
4072 if (flag > NL80211_STA_FLAG_MAX_OLD_API)
4073 return -EINVAL;
4074 }
4075 }
4076
5727ef1b
JB		 4077 return 0;
4078}
4079
c8dcfd8a
FF		 4080static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
4081 int attr)
4082{
4083 struct nlattr *rate;
8eb41c8d
VK		 4084 u32 bitrate;
4085 u16 bitrate_compat;
b51f3bee 4086 enum nl80211_attrs rate_flg;
c8dcfd8a
FF		 4087
4088 rate = nla_nest_start(msg, attr);
4089 if (!rate)
db9c64cf 4090 return false;
c8dcfd8a
FF		 4091
4092 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
4093 bitrate = cfg80211_calculate_bitrate(info);
8eb41c8d
VK		 4094 /* report 16-bit bitrate only if we can */
4095 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
db9c64cf
JB		 4096 if (bitrate > 0 &&
4097 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
4098 return false;
4099 if (bitrate_compat > 0 &&
4100 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
4101 return false;
4102
b51f3bee
JB		 4103 switch (info->bw) {
4104 case RATE_INFO_BW_5:
4105 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
4106 break;
4107 case RATE_INFO_BW_10:
4108 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
4109 break;
4110 default:
4111 WARN_ON(1);
4112 /* fall through */
4113 case RATE_INFO_BW_20:
4114 rate_flg = 0;
4115 break;
4116 case RATE_INFO_BW_40:
4117 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
4118 break;
4119 case RATE_INFO_BW_80:
4120 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
4121 break;
4122 case RATE_INFO_BW_160:
4123 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
4124 break;
4125 }
4126
4127 if (rate_flg && nla_put_flag(msg, rate_flg))
4128 return false;
4129
db9c64cf
JB		 4130 if (info->flags & RATE_INFO_FLAGS_MCS) {
4131 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
4132 return false;
db9c64cf
JB		 4133 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4134 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4135 return false;
4136 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
4137 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
4138 return false;
4139 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
4140 return false;
db9c64cf
JB		 4141 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4142 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4143 return false;
4144 }
c8dcfd8a
FF		 4145
4146 nla_nest_end(msg, rate);
4147 return true;
c8dcfd8a
FF		 4148}
4149
119363c7
FF		 4150static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
4151 int id)
4152{
4153 void *attr;
4154 int i = 0;
4155
4156 if (!mask)
4157 return true;
4158
4159 attr = nla_nest_start(msg, id);
4160 if (!attr)
4161 return false;
4162
4163 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
4164 if (!(mask & BIT(i)))
4165 continue;
4166
4167 if (nla_put_u8(msg, i, signal[i]))
4168 return false;
4169 }
4170
4171 nla_nest_end(msg, attr);
4172
4173 return true;
4174}
4175
cf5ead82
JB		 4176static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
4177 u32 seq, int flags,
66266b3a
JL		 4178 struct cfg80211_registered_device *rdev,
4179 struct net_device *dev,
98b62183 4180 const u8 *mac_addr, struct station_info *sinfo)
fd5b74dc
JB		 4181{
4182 void *hdr;
f4263c98 4183 struct nlattr *sinfoattr, *bss_param;
fd5b74dc 4184
cf5ead82 4185 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
fd5b74dc
JB		 4186 if (!hdr)
4187 return -1;
4188
9360ffd1
DM		 4189 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
4190 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
4191 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
4192 goto nla_put_failure;
f5ea9120 4193
2ec600d6
LCC		 4194 sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
4195 if (!sinfoattr)
fd5b74dc 4196 goto nla_put_failure;
319090bf
JB		 4197
4198#define PUT_SINFO(attr, memb, type) do { \
d686b920 4199 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \
739960f1 4200 if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
319090bf
JB		 4201 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \
4202 sinfo->memb)) \
4203 goto nla_put_failure; \
4204 } while (0)
d686b920
JB		 4205#define PUT_SINFO_U64(attr, memb) do { \
4206 if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
4207 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \
4208 sinfo->memb, NL80211_STA_INFO_PAD)) \
4209 goto nla_put_failure; \
4210 } while (0)
319090bf
JB		 4211
4212 PUT_SINFO(CONNECTED_TIME, connected_time, u32);
4213 PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
4214
4215 if (sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES) |
4216 BIT(NL80211_STA_INFO_RX_BYTES64)) &&
9360ffd1 4217 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
42745e03 4218 (u32)sinfo->rx_bytes))
9360ffd1 4219 goto nla_put_failure;
319090bf
JB		 4220
4221 if (sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES) |
4222 BIT(NL80211_STA_INFO_TX_BYTES64)) &&
9360ffd1 4223 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
42745e03
VK		 4224 (u32)sinfo->tx_bytes))
4225 goto nla_put_failure;
319090bf 4226
d686b920
JB		 4227 PUT_SINFO_U64(RX_BYTES64, rx_bytes);
4228 PUT_SINFO_U64(TX_BYTES64, tx_bytes);
319090bf
JB		 4229 PUT_SINFO(LLID, llid, u16);
4230 PUT_SINFO(PLID, plid, u16);
4231 PUT_SINFO(PLINK_STATE, plink_state, u8);
d686b920 4232 PUT_SINFO_U64(RX_DURATION, rx_duration);
319090bf 4233
66266b3a
JL		 4234 switch (rdev->wiphy.signal_type) {
4235 case CFG80211_SIGNAL_TYPE_MBM:
319090bf
JB		 4236 PUT_SINFO(SIGNAL, signal, u8);
4237 PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
66266b3a
JL		 4238 break;
4239 default:
4240 break;
4241 }
319090bf 4242 if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL)) {
119363c7
FF		 4243 if (!nl80211_put_signal(msg, sinfo->chains,
4244 sinfo->chain_signal,
4245 NL80211_STA_INFO_CHAIN_SIGNAL))
4246 goto nla_put_failure;
4247 }
319090bf 4248 if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
119363c7
FF		 4249 if (!nl80211_put_signal(msg, sinfo->chains,
4250 sinfo->chain_signal_avg,
4251 NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
4252 goto nla_put_failure;
4253 }
319090bf 4254 if (sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE)) {
c8dcfd8a
FF		 4255 if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
4256 NL80211_STA_INFO_TX_BITRATE))
4257 goto nla_put_failure;
4258 }
319090bf 4259 if (sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE)) {
c8dcfd8a
FF		 4260 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
4261 NL80211_STA_INFO_RX_BITRATE))
420e7fab 4262 goto nla_put_failure;
420e7fab 4263 }
319090bf
JB		 4264
4265 PUT_SINFO(RX_PACKETS, rx_packets, u32);
4266 PUT_SINFO(TX_PACKETS, tx_packets, u32);
4267 PUT_SINFO(TX_RETRIES, tx_retries, u32);
4268 PUT_SINFO(TX_FAILED, tx_failed, u32);
4269 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
4270 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
4271 PUT_SINFO(LOCAL_PM, local_pm, u32);
4272 PUT_SINFO(PEER_PM, peer_pm, u32);
4273 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
4274
4275 if (sinfo->filled & BIT(NL80211_STA_INFO_BSS_PARAM)) {
f4263c98
PS		 4276 bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
4277 if (!bss_param)
4278 goto nla_put_failure;
4279
9360ffd1
DM		 4280 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
4281 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
4282 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
4283 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
4284 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
4285 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
4286 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
4287 sinfo->bss_param.dtim_period) ||
4288 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
4289 sinfo->bss_param.beacon_interval))
4290 goto nla_put_failure;
f4263c98
PS		 4291
4292 nla_nest_end(msg, bss_param);
4293 }
319090bf 4294 if ((sinfo->filled & BIT(NL80211_STA_INFO_STA_FLAGS)) &&
9360ffd1
DM		 4295 nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
4296 sizeof(struct nl80211_sta_flag_update),
4297 &sinfo->sta_flags))
4298 goto nla_put_failure;
319090bf 4299
d686b920
JB		 4300 PUT_SINFO_U64(T_OFFSET, t_offset);
4301 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
4302 PUT_SINFO_U64(BEACON_RX, rx_beacon);
a76b1942 4303 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
319090bf
JB		 4304
4305#undef PUT_SINFO
d686b920 4306#undef PUT_SINFO_U64
6de39808
JB		 4307
4308 if (sinfo->filled & BIT(NL80211_STA_INFO_TID_STATS)) {
4309 struct nlattr *tidsattr;
4310 int tid;
4311
4312 tidsattr = nla_nest_start(msg, NL80211_STA_INFO_TID_STATS);
4313 if (!tidsattr)
4314 goto nla_put_failure;
4315
4316 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
4317 struct cfg80211_tid_stats *tidstats;
4318 struct nlattr *tidattr;
4319
4320 tidstats = &sinfo->pertid[tid];
4321
4322 if (!tidstats->filled)
4323 continue;
4324
4325 tidattr = nla_nest_start(msg, tid + 1);
4326 if (!tidattr)
4327 goto nla_put_failure;
4328
d686b920 4329#define PUT_TIDVAL_U64(attr, memb) do { \
6de39808 4330 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \
d686b920
JB		 4331 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \
4332 tidstats->memb, NL80211_TID_STATS_PAD)) \
6de39808
JB		 4333 goto nla_put_failure; \
4334 } while (0)
4335
d686b920
JB		 4336 PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
4337 PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
4338 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
4339 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
6de39808 4340
d686b920 4341#undef PUT_TIDVAL_U64
6de39808
JB		 4342 nla_nest_end(msg, tidattr);
4343 }
4344
4345 nla_nest_end(msg, tidsattr);
4346 }
4347
2ec600d6 4348 nla_nest_end(msg, sinfoattr);
fd5b74dc 4349
319090bf 4350 if (sinfo->assoc_req_ies_len &&
9360ffd1
DM		 4351 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
4352 sinfo->assoc_req_ies))
4353 goto nla_put_failure;
50d3dfb7 4354
053c095a
JB		 4355 genlmsg_end(msg, hdr);
4356 return 0;
fd5b74dc
JB		 4357
4358 nla_put_failure:
bc3ed28c
TG		 4359 genlmsg_cancel(msg, hdr);
4360 return -EMSGSIZE;
fd5b74dc
JB		 4361}
4362
2ec600d6 4363static int nl80211_dump_station(struct sk_buff *skb,
bba95fef 4364 struct netlink_callback *cb)
2ec600d6 4365{
2ec600d6 4366 struct station_info sinfo;
1b8ec87a 4367 struct cfg80211_registered_device *rdev;
97990a06 4368 struct wireless_dev *wdev;
2ec600d6 4369 u8 mac_addr[ETH_ALEN];
97990a06 4370 int sta_idx = cb->args[2];
2ec600d6 4371 int err;
2ec600d6 4372
1b8ec87a 4373 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
67748893
JB		 4374 if (err)
4375 return err;
bba95fef 4376
97990a06
JB		 4377 if (!wdev->netdev) {
4378 err = -EINVAL;
4379 goto out_err;
4380 }
4381
1b8ec87a 4382 if (!rdev->ops->dump_station) {
eec60b03 4383 err = -EOPNOTSUPP;
bba95fef
JB		 4384 goto out_err;
4385 }
4386
bba95fef 4387 while (1) {
f612cedf 4388 memset(&sinfo, 0, sizeof(sinfo));
1b8ec87a 4389 err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
e35e4d28 4390 mac_addr, &sinfo);
bba95fef
JB		 4391 if (err == -ENOENT)
4392 break;
4393 if (err)
3b85875a 4394 goto out_err;
bba95fef 4395
cf5ead82 4396 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
15e47304 4397 NETLINK_CB(cb->skb).portid,
bba95fef 4398 cb->nlh->nlmsg_seq, NLM_F_MULTI,
1b8ec87a 4399 rdev, wdev->netdev, mac_addr,
bba95fef
JB		 4400 &sinfo) < 0)
4401 goto out;
4402
4403 sta_idx++;
4404 }
4405
bba95fef 4406 out:
97990a06 4407 cb->args[2] = sta_idx;
bba95fef 4408 err = skb->len;
bba95fef 4409 out_err:
1b8ec87a 4410 nl80211_finish_wdev_dump(rdev);
bba95fef
JB		 4411
4412 return err;
2ec600d6 4413}
fd5b74dc 4414
5727ef1b
JB		 4415static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
4416{
4c476991
JB		 4417 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4418 struct net_device *dev = info->user_ptr[1];
2ec600d6 4419 struct station_info sinfo;
fd5b74dc
JB		 4420 struct sk_buff *msg;
4421 u8 *mac_addr = NULL;
4c476991 4422 int err;
fd5b74dc 4423
2ec600d6 4424 memset(&sinfo, 0, sizeof(sinfo));
fd5b74dc
JB		 4425
4426 if (!info->attrs[NL80211_ATTR_MAC])
4427 return -EINVAL;
4428
4429 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4430
4c476991
JB		 4431 if (!rdev->ops->get_station)
4432 return -EOPNOTSUPP;
3b85875a 4433
e35e4d28 4434 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
fd5b74dc 4435 if (err)
4c476991 4436 return err;
2ec600d6 4437
fd2120ca 4438 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
fd5b74dc 4439 if (!msg)
4c476991 4440 return -ENOMEM;
fd5b74dc 4441
cf5ead82
JB		 4442 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
4443 info->snd_portid, info->snd_seq, 0,
66266b3a 4444 rdev, dev, mac_addr, &sinfo) < 0) {
4c476991
JB		 4445 nlmsg_free(msg);
4446 return -ENOBUFS;
4447 }
3b85875a 4448
4c476991 4449 return genlmsg_reply(msg, info);
5727ef1b
JB		 4450}
4451
77ee7c89
JB		 4452int cfg80211_check_station_change(struct wiphy *wiphy,
4453 struct station_parameters *params,
4454 enum cfg80211_station_type statype)
4455{
e4208427
AB		 4456 if (params->listen_interval != -1 &&
4457 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
77ee7c89 4458 return -EINVAL;
e4208427 4459
17b94247
AB		 4460 if (params->support_p2p_ps != -1 &&
4461 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4462 return -EINVAL;
4463
c72e1140 4464 if (params->aid &&
e4208427
AB		 4465 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
4466 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
77ee7c89
JB		 4467 return -EINVAL;
4468
4469 /* When you run into this, adjust the code below for the new flag */
4470 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
4471
4472 switch (statype) {
eef941e6
TP		 4473 case CFG80211_STA_MESH_PEER_KERNEL:
4474 case CFG80211_STA_MESH_PEER_USER:
77ee7c89
JB		 4475 /*
4476 * No ignoring the TDLS flag here -- the userspace mesh
4477 * code doesn't have the bug of including TDLS in the
4478 * mask everywhere.
4479 */
4480 if (params->sta_flags_mask &
4481 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4482 BIT(NL80211_STA_FLAG_MFP) |
4483 BIT(NL80211_STA_FLAG_AUTHORIZED)))
4484 return -EINVAL;
4485 break;
4486 case CFG80211_STA_TDLS_PEER_SETUP:
4487 case CFG80211_STA_TDLS_PEER_ACTIVE:
4488 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
4489 return -EINVAL;
4490 /* ignore since it can't change */
4491 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4492 break;
4493 default:
4494 /* disallow mesh-specific things */
4495 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
4496 return -EINVAL;
4497 if (params->local_pm)
4498 return -EINVAL;
4499 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4500 return -EINVAL;
4501 }
4502
4503 if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4504 statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
4505 /* TDLS can't be set, ... */
4506 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
4507 return -EINVAL;
4508 /*
4509 * ... but don't bother the driver with it. This works around
4510 * a hostapd/wpa_supplicant issue -- it always includes the
4511 * TLDS_PEER flag in the mask even for AP mode.
4512 */
4513 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4514 }
4515
47edb11b
AB		 4516 if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4517 statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
77ee7c89
JB		 4518 /* reject other things that can't change */
4519 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
4520 return -EINVAL;
4521 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
4522 return -EINVAL;
4523 if (params->supported_rates)
4524 return -EINVAL;
4525 if (params->ext_capab || params->ht_capa || params->vht_capa)
4526 return -EINVAL;
4527 }
4528
47edb11b
AB		 4529 if (statype != CFG80211_STA_AP_CLIENT &&
4530 statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
77ee7c89
JB		 4531 if (params->vlan)
4532 return -EINVAL;
4533 }
4534
4535 switch (statype) {
4536 case CFG80211_STA_AP_MLME_CLIENT:
4537 /* Use this only for authorizing/unauthorizing a station */
4538 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
4539 return -EOPNOTSUPP;
4540 break;
4541 case CFG80211_STA_AP_CLIENT:
47edb11b 4542 case CFG80211_STA_AP_CLIENT_UNASSOC:
77ee7c89
JB		 4543 /* accept only the listed bits */
4544 if (params->sta_flags_mask &
4545 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4546 BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4547 BIT(NL80211_STA_FLAG_ASSOCIATED) |
4548 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4549 BIT(NL80211_STA_FLAG_WME) |
4550 BIT(NL80211_STA_FLAG_MFP)))
4551 return -EINVAL;
4552
4553 /* but authenticated/associated only if driver handles it */
4554 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
4555 params->sta_flags_mask &
4556 (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4557 BIT(NL80211_STA_FLAG_ASSOCIATED)))
4558 return -EINVAL;
4559 break;
4560 case CFG80211_STA_IBSS:
4561 case CFG80211_STA_AP_STA:
4562 /* reject any changes other than AUTHORIZED */
4563 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
4564 return -EINVAL;
4565 break;
4566 case CFG80211_STA_TDLS_PEER_SETUP:
4567 /* reject any changes other than AUTHORIZED or WME */
4568 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4569 BIT(NL80211_STA_FLAG_WME)))
4570 return -EINVAL;
4571 /* force (at least) rates when authorizing */
4572 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
4573 !params->supported_rates)
4574 return -EINVAL;
4575 break;
4576 case CFG80211_STA_TDLS_PEER_ACTIVE:
4577 /* reject any changes */
4578 return -EINVAL;
eef941e6 4579 case CFG80211_STA_MESH_PEER_KERNEL:
77ee7c89
JB		 4580 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4581 return -EINVAL;
4582 break;
eef941e6 4583 case CFG80211_STA_MESH_PEER_USER:
42925040
CYY		 4584 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
4585 params->plink_action != NL80211_PLINK_ACTION_BLOCK)
77ee7c89
JB		 4586 return -EINVAL;
4587 break;
4588 }
4589
4590 return 0;
4591}
4592EXPORT_SYMBOL(cfg80211_check_station_change);
4593
5727ef1b 4594/*
c258d2de 4595 * Get vlan interface making sure it is running and on the right wiphy.
5727ef1b 4596 */
80b99899
JB		 4597static struct net_device *get_vlan(struct genl_info *info,
4598 struct cfg80211_registered_device *rdev)
5727ef1b 4599{
463d0183 4600 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
80b99899
JB		 4601 struct net_device *v;
4602 int ret;
4603
4604 if (!vlanattr)
4605 return NULL;
4606
4607 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
4608 if (!v)
4609 return ERR_PTR(-ENODEV);
4610
4611 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
4612 ret = -EINVAL;
4613 goto error;
5727ef1b 4614 }
80b99899 4615
77ee7c89
JB		 4616 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
4617 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4618 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
4619 ret = -EINVAL;
4620 goto error;
4621 }
4622
80b99899
JB		 4623 if (!netif_running(v)) {
4624 ret = -ENETDOWN;
4625 goto error;
4626 }
4627
4628 return v;
4629 error:
4630 dev_put(v);
4631 return ERR_PTR(ret);
5727ef1b
JB		 4632}
4633
94e860f1
JB		 4634static const struct nla_policy
4635nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
df881293
JM		 4636 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
4637 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
4638};
4639
ff276691
JB		 4640static int nl80211_parse_sta_wme(struct genl_info *info,
4641 struct station_parameters *params)
df881293 4642{
df881293
JM		 4643 struct nlattr *tb[NL80211_STA_WME_MAX + 1];
4644 struct nlattr *nla;
4645 int err;
4646
df881293
JM		 4647 /* parse WME attributes if present */
4648 if (!info->attrs[NL80211_ATTR_STA_WME])
4649 return 0;
4650
4651 nla = info->attrs[NL80211_ATTR_STA_WME];
4652 err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
4653 nl80211_sta_wme_policy);
4654 if (err)
4655 return err;
4656
4657 if (tb[NL80211_STA_WME_UAPSD_QUEUES])
4658 params->uapsd_queues = nla_get_u8(
4659 tb[NL80211_STA_WME_UAPSD_QUEUES]);
4660 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
4661 return -EINVAL;
4662
4663 if (tb[NL80211_STA_WME_MAX_SP])
4664 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
4665
4666 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
4667 return -EINVAL;
4668
4669 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
4670
4671 return 0;
4672}
4673
c01fc9ad
SD		 4674static int nl80211_parse_sta_channel_info(struct genl_info *info,
4675 struct station_parameters *params)
4676{
4677 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
4678 params->supported_channels =
4679 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4680 params->supported_channels_len =
4681 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4682 /*
4683 * Need to include at least one (first channel, number of
4684 * channels) tuple for each subband, and must have proper
4685 * tuples for the rest of the data as well.
4686 */
4687 if (params->supported_channels_len < 2)
4688 return -EINVAL;
4689 if (params->supported_channels_len % 2)
4690 return -EINVAL;
4691 }
4692
4693 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
4694 params->supported_oper_classes =
4695 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4696 params->supported_oper_classes_len =
4697 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4698 /*
4699 * The value of the Length field of the Supported Operating
4700 * Classes element is between 2 and 253.
4701 */
4702 if (params->supported_oper_classes_len < 2 ||
4703 params->supported_oper_classes_len > 253)
4704 return -EINVAL;
4705 }
4706 return 0;
4707}
4708
ff276691
JB		 4709static int nl80211_set_station_tdls(struct genl_info *info,
4710 struct station_parameters *params)
4711{
c01fc9ad 4712 int err;
ff276691 4713 /* Dummy STA entry gets updated once the peer capabilities are known */
5e4b6f56
JM		 4714 if (info->attrs[NL80211_ATTR_PEER_AID])
4715 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
ff276691
JB		 4716 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
4717 params->ht_capa =
4718 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
4719 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
4720 params->vht_capa =
4721 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
4722
c01fc9ad
SD		 4723 err = nl80211_parse_sta_channel_info(info, params);
4724 if (err)
4725 return err;
4726
ff276691
JB		 4727 return nl80211_parse_sta_wme(info, params);
4728}
4729
5727ef1b
JB		 4730static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
4731{
4c476991 4732 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4c476991 4733 struct net_device *dev = info->user_ptr[1];
5727ef1b 4734 struct station_parameters params;
77ee7c89
JB		 4735 u8 *mac_addr;
4736 int err;
5727ef1b
JB		 4737
4738 memset(&params, 0, sizeof(params));
4739
77ee7c89
JB		 4740 if (!rdev->ops->change_station)
4741 return -EOPNOTSUPP;
4742
e4208427
AB		 4743 /*
4744 * AID and listen_interval properties can be set only for unassociated
4745 * station. Include these parameters here and will check them in
4746 * cfg80211_check_station_change().
4747 */
a9bc31e4
AB		 4748 if (info->attrs[NL80211_ATTR_STA_AID])
4749 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
e4208427
AB		 4750
4751 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
4752 params.listen_interval =
4753 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
4754 else
4755 params.listen_interval = -1;
5727ef1b 4756
17b94247
AB		 4757 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
4758 u8 tmp;
4759
4760 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
4761 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
4762 return -EINVAL;
4763
4764 params.support_p2p_ps = tmp;
4765 } else {
4766 params.support_p2p_ps = -1;
4767 }
4768
5727ef1b
JB		 4769 if (!info->attrs[NL80211_ATTR_MAC])
4770 return -EINVAL;
4771
4772 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4773
4774 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
4775 params.supported_rates =
4776 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4777 params.supported_rates_len =
4778 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4779 }
4780
9d62a986
JM		 4781 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
4782 params.capability =
4783 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
4784 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
4785 }
4786
4787 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
4788 params.ext_capab =
4789 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4790 params.ext_capab_len =
4791 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4792 }
4793
bdd3ae3d 4794 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5727ef1b
JB		 4795 return -EINVAL;
4796
f8bacc21 4797 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
2ec600d6 4798 params.plink_action =
f8bacc21
JB		 4799 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
4800 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
4801 return -EINVAL;
4802 }
2ec600d6 4803
f8bacc21 4804 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
9c3990aa 4805 params.plink_state =
f8bacc21
JB		 4806 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
4807 if (params.plink_state >= NUM_NL80211_PLINK_STATES)
4808 return -EINVAL;
7d27a0ba
MH		 4809 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) {
4810 params.peer_aid = nla_get_u16(
4811 info->attrs[NL80211_ATTR_MESH_PEER_AID]);
4812 if (params.peer_aid > IEEE80211_MAX_AID)
4813 return -EINVAL;
4814 }
f8bacc21
JB		 4815 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
4816 }
9c3990aa 4817
3b1c5a53
MP		 4818 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) {
4819 enum nl80211_mesh_power_mode pm = nla_get_u32(
4820 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
4821
4822 if (pm <= NL80211_MESH_POWER_UNKNOWN ||
4823 pm > NL80211_MESH_POWER_MAX)
4824 return -EINVAL;
4825
4826 params.local_pm = pm;
4827 }
4828
77ee7c89
JB		 4829 /* Include parameters for TDLS peer (will check later) */
4830 err = nl80211_set_station_tdls(info, &params);
4831 if (err)
4832 return err;
4833
4834 params.vlan = get_vlan(info, rdev);
4835 if (IS_ERR(params.vlan))
4836 return PTR_ERR(params.vlan);
4837
a97f4424
JB		 4838 switch (dev->ieee80211_ptr->iftype) {
4839 case NL80211_IFTYPE_AP:
4840 case NL80211_IFTYPE_AP_VLAN:
074ac8df 4841 case NL80211_IFTYPE_P2P_GO:
074ac8df 4842 case NL80211_IFTYPE_P2P_CLIENT:
a97f4424 4843 case NL80211_IFTYPE_STATION:
267335d6 4844 case NL80211_IFTYPE_ADHOC:
a97f4424 4845 case NL80211_IFTYPE_MESH_POINT:
a97f4424
JB		 4846 break;
4847 default:
77ee7c89
JB		 4848 err = -EOPNOTSUPP;
4849 goto out_put_vlan;
034d655e
JB		 4850 }
4851
77ee7c89 4852 /* driver will call cfg80211_check_station_change() */
e35e4d28 4853 err = rdev_change_station(rdev, dev, mac_addr, &params);
5727ef1b 4854
77ee7c89 4855 out_put_vlan:
5727ef1b
JB		 4856 if (params.vlan)
4857 dev_put(params.vlan);
3b85875a 4858
5727ef1b
JB		 4859 return err;
4860}
4861
4862static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
4863{
4c476991 4864 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5727ef1b 4865 int err;
4c476991 4866 struct net_device *dev = info->user_ptr[1];
5727ef1b
JB		 4867 struct station_parameters params;
4868 u8 *mac_addr = NULL;
bda95eb1
JB		 4869 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4870 BIT(NL80211_STA_FLAG_ASSOCIATED);
5727ef1b
JB		 4871
4872 memset(&params, 0, sizeof(params));
4873
984c311b
JB		 4874 if (!rdev->ops->add_station)
4875 return -EOPNOTSUPP;
4876
5727ef1b
JB		 4877 if (!info->attrs[NL80211_ATTR_MAC])
4878 return -EINVAL;
4879
5727ef1b
JB		 4880 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
4881 return -EINVAL;
4882
4883 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
4884 return -EINVAL;
4885
5e4b6f56
JM		 4886 if (!info->attrs[NL80211_ATTR_STA_AID] &&
4887 !info->attrs[NL80211_ATTR_PEER_AID])
0e956c13
TLSC		 4888 return -EINVAL;
4889
5727ef1b
JB		 4890 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4891 params.supported_rates =
4892 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4893 params.supported_rates_len =
4894 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4895 params.listen_interval =
4896 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
51b50fbe 4897
17b94247
AB		 4898 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
4899 u8 tmp;
4900
4901 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
4902 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
4903 return -EINVAL;
4904
4905 params.support_p2p_ps = tmp;
4906 } else {
4907 /*
4908 * if not specified, assume it's supported for P2P GO interface,
4909 * and is NOT supported for AP interface
4910 */
4911 params.support_p2p_ps =
4912 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
4913 }
4914
3d124ea2 4915 if (info->attrs[NL80211_ATTR_PEER_AID])
5e4b6f56 4916 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
3d124ea2
JM		 4917 else
4918 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
0e956c13
TLSC		 4919 if (!params.aid || params.aid > IEEE80211_MAX_AID)
4920 return -EINVAL;
51b50fbe 4921
9d62a986
JM		 4922 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
4923 params.capability =
4924 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
4925 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
4926 }
4927
4928 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
4929 params.ext_capab =
4930 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4931 params.ext_capab_len =
4932 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4933 }
4934
36aedc90
JM		 4935 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
4936 params.ht_capa =
4937 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5727ef1b 4938
f461be3e
MP		 4939 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
4940 params.vht_capa =
4941 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
4942
60f4a7b1
MK		 4943 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
4944 params.opmode_notif_used = true;
4945 params.opmode_notif =
4946 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
4947 }
4948
f8bacc21 4949 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
96b78dff 4950 params.plink_action =
f8bacc21
JB		 4951 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
4952 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
4953 return -EINVAL;
4954 }
96b78dff 4955
c01fc9ad
SD		 4956 err = nl80211_parse_sta_channel_info(info, &params);
4957 if (err)
4958 return err;
4959
ff276691
JB		 4960 err = nl80211_parse_sta_wme(info, &params);
4961 if (err)
4962 return err;
bdd90d5e 4963
bdd3ae3d 4964 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5727ef1b
JB		 4965 return -EINVAL;
4966
496fcc29
JB		 4967 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
4968 * as userspace might just pass through the capabilities from the IEs
4969 * directly, rather than enforcing this restriction and returning an
4970 * error in this case.
4971 */
4972 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
4973 params.ht_capa = NULL;
4974 params.vht_capa = NULL;
4975 }
4976
77ee7c89
JB		 4977 /* When you run into this, adjust the code below for the new flag */
4978 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
4979
bdd90d5e
JB		 4980 switch (dev->ieee80211_ptr->iftype) {
4981 case NL80211_IFTYPE_AP:
4982 case NL80211_IFTYPE_AP_VLAN:
4983 case NL80211_IFTYPE_P2P_GO:
984c311b
JB		 4984 /* ignore WME attributes if iface/sta is not capable */
4985 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
4986 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
4987 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
c75786c9 4988
bdd90d5e 4989 /* TDLS peers cannot be added */
3d124ea2
JM		 4990 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
4991 info->attrs[NL80211_ATTR_PEER_AID])
4319e193 4992 return -EINVAL;
bdd90d5e
JB		 4993 /* but don't bother the driver with it */
4994 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
3b9ce80c 4995
d582cffb
JB		 4996 /* allow authenticated/associated only if driver handles it */
4997 if (!(rdev->wiphy.features &
4998 NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
bda95eb1 4999 params.sta_flags_mask & auth_assoc)
d582cffb
JB		 5000 return -EINVAL;
5001
bda95eb1
JB		 5002 /* Older userspace, or userspace wanting to be compatible with
5003 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
5004 * and assoc flags in the mask, but assumes the station will be
5005 * added as associated anyway since this was the required driver
5006 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
5007 * introduced.
5008 * In order to not bother drivers with this quirk in the API
5009 * set the flags in both the mask and set for new stations in
5010 * this case.
5011 */
5012 if (!(params.sta_flags_mask & auth_assoc)) {
5013 params.sta_flags_mask |= auth_assoc;
5014 params.sta_flags_set |= auth_assoc;
5015 }
5016
bdd90d5e
JB		 5017 /* must be last in here for error handling */
5018 params.vlan = get_vlan(info, rdev);
5019 if (IS_ERR(params.vlan))
5020 return PTR_ERR(params.vlan);
5021 break;
5022 case NL80211_IFTYPE_MESH_POINT:
984c311b
JB		 5023 /* ignore uAPSD data */
5024 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5025
d582cffb
JB		 5026 /* associated is disallowed */
5027 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
5028 return -EINVAL;
bdd90d5e 5029 /* TDLS peers cannot be added */
3d124ea2
JM		 5030 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5031 info->attrs[NL80211_ATTR_PEER_AID])
bdd90d5e
JB		 5032 return -EINVAL;
5033 break;
5034 case NL80211_IFTYPE_STATION:
93d08f0b 5035 case NL80211_IFTYPE_P2P_CLIENT:
984c311b
JB		 5036 /* ignore uAPSD data */
5037 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5038
77ee7c89
JB		 5039 /* these are disallowed */
5040 if (params.sta_flags_mask &
5041 (BIT(NL80211_STA_FLAG_ASSOCIATED) |
5042 BIT(NL80211_STA_FLAG_AUTHENTICATED)))
d582cffb 5043 return -EINVAL;
bdd90d5e
JB		 5044 /* Only TDLS peers can be added */
5045 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
5046 return -EINVAL;
5047 /* Can only add if TDLS ... */
5048 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
5049 return -EOPNOTSUPP;
5050 /* ... with external setup is supported */
5051 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
5052 return -EOPNOTSUPP;
77ee7c89
JB		 5053 /*
5054 * Older wpa_supplicant versions always mark the TDLS peer
5055 * as authorized, but it shouldn't yet be.
5056 */
5057 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
bdd90d5e
JB		 5058 break;
5059 default:
5060 return -EOPNOTSUPP;
c75786c9
EP		 5061 }
5062
bdd90d5e 5063 /* be aware of params.vlan when changing code here */
5727ef1b 5064
e35e4d28 5065 err = rdev_add_station(rdev, dev, mac_addr, &params);
5727ef1b 5066
5727ef1b
JB		 5067 if (params.vlan)
5068 dev_put(params.vlan);
5727ef1b
JB		 5069 return err;
5070}
5071
5072static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
5073{
4c476991
JB		 5074 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5075 struct net_device *dev = info->user_ptr[1];
89c771e5
JM		 5076 struct station_del_parameters params;
5077
5078 memset(&params, 0, sizeof(params));
5727ef1b
JB		 5079
5080 if (info->attrs[NL80211_ATTR_MAC])
89c771e5 5081 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
5727ef1b 5082
e80cf853 5083 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
d5d9de02 5084 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
074ac8df 5085 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
4c476991
JB		 5086 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5087 return -EINVAL;
5727ef1b 5088
4c476991
JB		 5089 if (!rdev->ops->del_station)
5090 return -EOPNOTSUPP;
3b85875a 5091
98856866
JM		 5092 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
5093 params.subtype =
5094 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
5095 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
5096 params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
5097 return -EINVAL;
5098 } else {
5099 /* Default to Deauthentication frame */
5100 params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
5101 }
5102
5103 if (info->attrs[NL80211_ATTR_REASON_CODE]) {
5104 params.reason_code =
5105 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5106 if (params.reason_code == 0)
5107 return -EINVAL; /* 0 is reserved */
5108 } else {
5109 /* Default to reason code 2 */
5110 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
5111 }
5112
89c771e5 5113 return rdev_del_station(rdev, dev, &params);
5727ef1b
JB		 5114}
5115
15e47304 5116static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
2ec600d6
LCC		 5117 int flags, struct net_device *dev,
5118 u8 *dst, u8 *next_hop,
5119 struct mpath_info *pinfo)
5120{
5121 void *hdr;
5122 struct nlattr *pinfoattr;
5123
1ef4c850 5124 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
2ec600d6
LCC		 5125 if (!hdr)
5126 return -1;
5127
9360ffd1
DM		 5128 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5129 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
5130 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
5131 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
5132 goto nla_put_failure;
f5ea9120 5133
2ec600d6
LCC		 5134 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
5135 if (!pinfoattr)
5136 goto nla_put_failure;
9360ffd1
DM		 5137 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
5138 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
5139 pinfo->frame_qlen))
5140 goto nla_put_failure;
5141 if (((pinfo->filled & MPATH_INFO_SN) &&
5142 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
5143 ((pinfo->filled & MPATH_INFO_METRIC) &&
5144 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
5145 pinfo->metric)) ||
5146 ((pinfo->filled & MPATH_INFO_EXPTIME) &&
5147 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
5148 pinfo->exptime)) ||
5149 ((pinfo->filled & MPATH_INFO_FLAGS) &&
5150 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
5151 pinfo->flags)) ||
5152 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
5153 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
5154 pinfo->discovery_timeout)) ||
5155 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
5156 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
5157 pinfo->discovery_retries)))
5158 goto nla_put_failure;
2ec600d6
LCC		 5159
5160 nla_nest_end(msg, pinfoattr);
5161
053c095a
JB		 5162 genlmsg_end(msg, hdr);
5163 return 0;
2ec600d6
LCC		 5164
5165 nla_put_failure:
bc3ed28c
TG		 5166 genlmsg_cancel(msg, hdr);
5167 return -EMSGSIZE;
2ec600d6
LCC		 5168}
5169
5170static int nl80211_dump_mpath(struct sk_buff *skb,
bba95fef 5171 struct netlink_callback *cb)
2ec600d6 5172{
2ec600d6 5173 struct mpath_info pinfo;
1b8ec87a 5174 struct cfg80211_registered_device *rdev;
97990a06 5175 struct wireless_dev *wdev;
2ec600d6
LCC		 5176 u8 dst[ETH_ALEN];
5177 u8 next_hop[ETH_ALEN];
97990a06 5178 int path_idx = cb->args[2];
2ec600d6 5179 int err;
2ec600d6 5180
1b8ec87a 5181 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
67748893
JB		 5182 if (err)
5183 return err;
bba95fef 5184
1b8ec87a 5185 if (!rdev->ops->dump_mpath) {
eec60b03 5186 err = -EOPNOTSUPP;
bba95fef
JB		 5187 goto out_err;
5188 }
5189
97990a06 5190 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
eec60b03 5191 err = -EOPNOTSUPP;
0448b5fc 5192 goto out_err;
eec60b03
JM		 5193 }
5194
bba95fef 5195 while (1) {
1b8ec87a 5196 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
97990a06 5197 next_hop, &pinfo);
bba95fef 5198 if (err == -ENOENT)
2ec600d6 5199 break;
bba95fef 5200 if (err)
3b85875a 5201 goto out_err;
2ec600d6 5202
15e47304 5203 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
bba95fef 5204 cb->nlh->nlmsg_seq, NLM_F_MULTI,
97990a06 5205 wdev->netdev, dst, next_hop,
bba95fef
JB		 5206 &pinfo) < 0)
5207 goto out;
2ec600d6 5208
bba95fef 5209 path_idx++;
2ec600d6 5210 }
2ec600d6 5211
bba95fef 5212 out:
97990a06 5213 cb->args[2] = path_idx;
bba95fef 5214 err = skb->len;
bba95fef 5215 out_err:
1b8ec87a 5216 nl80211_finish_wdev_dump(rdev);
bba95fef 5217 return err;
2ec600d6
LCC		 5218}
5219
5220static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
5221{
4c476991 5222 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2ec600d6 5223 int err;
4c476991 5224 struct net_device *dev = info->user_ptr[1];
2ec600d6
LCC		 5225 struct mpath_info pinfo;
5226 struct sk_buff *msg;
5227 u8 *dst = NULL;
5228 u8 next_hop[ETH_ALEN];
5229
5230 memset(&pinfo, 0, sizeof(pinfo));
5231
5232 if (!info->attrs[NL80211_ATTR_MAC])
5233 return -EINVAL;
5234
5235 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5236
4c476991
JB		 5237 if (!rdev->ops->get_mpath)
5238 return -EOPNOTSUPP;
2ec600d6 5239
4c476991
JB		 5240 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5241 return -EOPNOTSUPP;
eec60b03 5242
e35e4d28 5243 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
2ec600d6 5244 if (err)
4c476991 5245 return err;
2ec600d6 5246
fd2120ca 5247 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2ec600d6 5248 if (!msg)
4c476991 5249 return -ENOMEM;
2ec600d6 5250
15e47304 5251 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
4c476991
JB		 5252 dev, dst, next_hop, &pinfo) < 0) {
5253 nlmsg_free(msg);
5254 return -ENOBUFS;
5255 }
3b85875a 5256
4c476991 5257 return genlmsg_reply(msg, info);
2ec600d6
LCC		 5258}
5259
5260static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
5261{
4c476991
JB		 5262 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5263 struct net_device *dev = info->user_ptr[1];
2ec600d6
LCC		 5264 u8 *dst = NULL;
5265 u8 *next_hop = NULL;
5266
5267 if (!info->attrs[NL80211_ATTR_MAC])
5268 return -EINVAL;
5269
5270 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5271 return -EINVAL;
5272
5273 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5274 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5275
4c476991
JB		 5276 if (!rdev->ops->change_mpath)
5277 return -EOPNOTSUPP;
35a8efe1 5278
4c476991
JB		 5279 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5280 return -EOPNOTSUPP;
2ec600d6 5281
e35e4d28 5282 return rdev_change_mpath(rdev, dev, dst, next_hop);
2ec600d6 5283}
4c476991 5284
2ec600d6
LCC		 5285static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
5286{
4c476991
JB		 5287 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5288 struct net_device *dev = info->user_ptr[1];
2ec600d6
LCC		 5289 u8 *dst = NULL;
5290 u8 *next_hop = NULL;
5291
5292 if (!info->attrs[NL80211_ATTR_MAC])
5293 return -EINVAL;
5294
5295 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5296 return -EINVAL;
5297
5298 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5299 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5300
4c476991
JB		 5301 if (!rdev->ops->add_mpath)
5302 return -EOPNOTSUPP;
35a8efe1 5303
4c476991
JB		 5304 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5305 return -EOPNOTSUPP;
2ec600d6 5306
e35e4d28 5307 return rdev_add_mpath(rdev, dev, dst, next_hop);
2ec600d6
LCC		 5308}
5309
5310static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
5311{
4c476991
JB		 5312 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5313 struct net_device *dev = info->user_ptr[1];
2ec600d6
LCC		 5314 u8 *dst = NULL;
5315
5316 if (info->attrs[NL80211_ATTR_MAC])
5317 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5318
4c476991
JB		 5319 if (!rdev->ops->del_mpath)
5320 return -EOPNOTSUPP;
3b85875a 5321
e35e4d28 5322 return rdev_del_mpath(rdev, dev, dst);
2ec600d6
LCC		 5323}
5324
66be7d2b
HR		 5325static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
5326{
5327 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5328 int err;
5329 struct net_device *dev = info->user_ptr[1];
5330 struct mpath_info pinfo;
5331 struct sk_buff *msg;
5332 u8 *dst = NULL;
5333 u8 mpp[ETH_ALEN];
5334
5335 memset(&pinfo, 0, sizeof(pinfo));
5336
5337 if (!info->attrs[NL80211_ATTR_MAC])
5338 return -EINVAL;
5339
5340 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5341
5342 if (!rdev->ops->get_mpp)
5343 return -EOPNOTSUPP;
5344
5345 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5346 return -EOPNOTSUPP;
5347
5348 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
5349 if (err)
5350 return err;
5351
5352 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5353 if (!msg)
5354 return -ENOMEM;
5355
5356 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
5357 dev, dst, mpp, &pinfo) < 0) {
5358 nlmsg_free(msg);
5359 return -ENOBUFS;
5360 }
5361
5362 return genlmsg_reply(msg, info);
5363}
5364
5365static int nl80211_dump_mpp(struct sk_buff *skb,
5366 struct netlink_callback *cb)
5367{
5368 struct mpath_info pinfo;
5369 struct cfg80211_registered_device *rdev;
5370 struct wireless_dev *wdev;
5371 u8 dst[ETH_ALEN];
5372 u8 mpp[ETH_ALEN];
5373 int path_idx = cb->args[2];
5374 int err;
5375
5376 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
5377 if (err)
5378 return err;
5379
5380 if (!rdev->ops->dump_mpp) {
5381 err = -EOPNOTSUPP;
5382 goto out_err;
5383 }
5384
5385 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5386 err = -EOPNOTSUPP;
5387 goto out_err;
5388 }
5389
5390 while (1) {
5391 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
5392 mpp, &pinfo);
5393 if (err == -ENOENT)
5394 break;
5395 if (err)
5396 goto out_err;
5397
5398 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
5399 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5400 wdev->netdev, dst, mpp,
5401 &pinfo) < 0)
5402 goto out;
5403
5404 path_idx++;
5405 }
5406
5407 out:
5408 cb->args[2] = path_idx;
5409 err = skb->len;
5410 out_err:
5411 nl80211_finish_wdev_dump(rdev);
5412 return err;
5413}
5414
9f1ba906
JM		 5415static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
5416{
4c476991
JB		 5417 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5418 struct net_device *dev = info->user_ptr[1];
c56589ed 5419 struct wireless_dev *wdev = dev->ieee80211_ptr;
9f1ba906 5420 struct bss_parameters params;
c56589ed 5421 int err;
9f1ba906
JM		 5422
5423 memset(&params, 0, sizeof(params));
5424 /* default to not changing parameters */
5425 params.use_cts_prot = -1;
5426 params.use_short_preamble = -1;
5427 params.use_short_slot_time = -1;
fd8aaaf3 5428 params.ap_isolate = -1;
50b12f59 5429 params.ht_opmode = -1;
53cabad7
JB		 5430 params.p2p_ctwindow = -1;
5431 params.p2p_opp_ps = -1;
9f1ba906
JM		 5432
5433 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
5434 params.use_cts_prot =
5435 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
5436 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
5437 params.use_short_preamble =
5438 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
5439 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
5440 params.use_short_slot_time =
5441 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
90c97a04
JM		 5442 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
5443 params.basic_rates =
5444 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5445 params.basic_rates_len =
5446 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5447 }
fd8aaaf3
FF		 5448 if (info->attrs[NL80211_ATTR_AP_ISOLATE])
5449 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
50b12f59
HS		 5450 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
5451 params.ht_opmode =
5452 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
9f1ba906 5453
53cabad7
JB		 5454 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
5455 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5456 return -EINVAL;
5457 params.p2p_ctwindow =
5458 nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
5459 if (params.p2p_ctwindow < 0)
5460 return -EINVAL;
5461 if (params.p2p_ctwindow != 0 &&
5462 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
5463 return -EINVAL;
5464 }
5465
5466 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
5467 u8 tmp;
5468
5469 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5470 return -EINVAL;
5471 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
5472 if (tmp > 1)
5473 return -EINVAL;
5474 params.p2p_opp_ps = tmp;
5475 if (params.p2p_opp_ps &&
5476 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
5477 return -EINVAL;
5478 }
5479
4c476991
JB		 5480 if (!rdev->ops->change_bss)
5481 return -EOPNOTSUPP;
9f1ba906 5482
074ac8df 5483 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4c476991
JB		 5484 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5485 return -EOPNOTSUPP;
3b85875a 5486
c56589ed
SW		 5487 wdev_lock(wdev);
5488 err = rdev_change_bss(rdev, dev, &params);
5489 wdev_unlock(wdev);
5490
5491 return err;
9f1ba906
JM		 5492}
5493
b2e1b302
LR		 5494static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
5495{
b2e1b302 5496 char *data = NULL;
05050753 5497 bool is_indoor;
57b5ce07 5498 enum nl80211_user_reg_hint_type user_reg_hint_type;
05050753
I		 5499 u32 owner_nlportid;
5500
80778f18
LR		 5501 /*
5502 * You should only get this when cfg80211 hasn't yet initialized
5503 * completely when built-in to the kernel right between the time
5504 * window between nl80211_init() and regulatory_init(), if that is
5505 * even possible.
5506 */
458f4f9e 5507 if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
fe33eb39 5508 return -EINPROGRESS;
80778f18 5509
57b5ce07
LR		 5510 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
5511 user_reg_hint_type =
5512 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
5513 else
5514 user_reg_hint_type = NL80211_USER_REG_HINT_USER;
5515
5516 switch (user_reg_hint_type) {
5517 case NL80211_USER_REG_HINT_USER:
5518 case NL80211_USER_REG_HINT_CELL_BASE:
52616f2b
IP		 5519 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
5520 return -EINVAL;
5521
5522 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
5523 return regulatory_hint_user(data, user_reg_hint_type);
5524 case NL80211_USER_REG_HINT_INDOOR:
05050753
I		 5525 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
5526 owner_nlportid = info->snd_portid;
5527 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
5528 } else {
5529 owner_nlportid = 0;
5530 is_indoor = true;
5531 }
5532
5533 return regulatory_hint_indoor(is_indoor, owner_nlportid);
57b5ce07
LR		 5534 default:
5535 return -EINVAL;
5536 }
b2e1b302
LR		 5537}
5538
24bdd9f4 5539static int nl80211_get_mesh_config(struct sk_buff *skb,
29cbe68c 5540 struct genl_info *info)
93da9cc1 5541{
4c476991 5542 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4c476991 5543 struct net_device *dev = info->user_ptr[1];
29cbe68c
JB		 5544 struct wireless_dev *wdev = dev->ieee80211_ptr;
5545 struct mesh_config cur_params;
5546 int err = 0;
93da9cc1 5547 void *hdr;
5548 struct nlattr *pinfoattr;
5549 struct sk_buff *msg;
5550
29cbe68c
JB		 5551 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
5552 return -EOPNOTSUPP;
5553
24bdd9f4 5554 if (!rdev->ops->get_mesh_config)
4c476991 5555 return -EOPNOTSUPP;
f3f92586 5556
29cbe68c
JB		 5557 wdev_lock(wdev);
5558 /* If not connected, get default parameters */
5559 if (!wdev->mesh_id_len)
5560 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
5561 else
e35e4d28 5562 err = rdev_get_mesh_config(rdev, dev, &cur_params);
29cbe68c
JB		 5563 wdev_unlock(wdev);
5564
93da9cc1 5565 if (err)
4c476991 5566 return err;
93da9cc1 5567
5568 /* Draw up a netlink message to send back */
fd2120ca 5569 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4c476991
JB		 5570 if (!msg)
5571 return -ENOMEM;
15e47304 5572 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
24bdd9f4 5573 NL80211_CMD_GET_MESH_CONFIG);
93da9cc1 5574 if (!hdr)
efe1cf0c 5575 goto out;
24bdd9f4 5576 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
93da9cc1 5577 if (!pinfoattr)
5578 goto nla_put_failure;
9360ffd1
DM		 5579 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5580 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
5581 cur_params.dot11MeshRetryTimeout) ||
5582 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
5583 cur_params.dot11MeshConfirmTimeout) ||
5584 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
5585 cur_params.dot11MeshHoldingTimeout) ||
5586 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
5587 cur_params.dot11MeshMaxPeerLinks) ||
5588 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
5589 cur_params.dot11MeshMaxRetries) ||
5590 nla_put_u8(msg, NL80211_MESHCONF_TTL,
5591 cur_params.dot11MeshTTL) ||
5592 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
5593 cur_params.element_ttl) ||
5594 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
5595 cur_params.auto_open_plinks) ||
7eab0f64
JL		 5596 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
5597 cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
9360ffd1
DM		 5598 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
5599 cur_params.dot11MeshHWMPmaxPREQretries) ||
5600 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
5601 cur_params.path_refresh_time) ||
5602 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
5603 cur_params.min_discovery_timeout) ||
5604 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
5605 cur_params.dot11MeshHWMPactivePathTimeout) ||
5606 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
5607 cur_params.dot11MeshHWMPpreqMinInterval) ||
5608 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
5609 cur_params.dot11MeshHWMPperrMinInterval) ||
5610 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
5611 cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
5612 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
5613 cur_params.dot11MeshHWMPRootMode) ||
5614 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
5615 cur_params.dot11MeshHWMPRannInterval) ||
5616 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
5617 cur_params.dot11MeshGateAnnouncementProtocol) ||
5618 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
5619 cur_params.dot11MeshForwarding) ||
5620 nla_put_u32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
70c33eaa
AN		 5621 cur_params.rssi_threshold) ||
5622 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
ac1073a6
CYY		 5623 cur_params.ht_opmode) ||
5624 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
5625 cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
5626 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
728b19e5
CYY		 5627 cur_params.dot11MeshHWMProotInterval) ||
5628 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
3b1c5a53
MP		 5629 cur_params.dot11MeshHWMPconfirmationInterval) ||
5630 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
5631 cur_params.power_mode) ||
5632 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
8e7c0538
CT		 5633 cur_params.dot11MeshAwakeWindowDuration) ||
5634 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
5635 cur_params.plink_timeout))
9360ffd1 5636 goto nla_put_failure;
93da9cc1 5637 nla_nest_end(msg, pinfoattr);
5638 genlmsg_end(msg, hdr);
4c476991 5639 return genlmsg_reply(msg, info);
93da9cc1 5640
3b85875a 5641 nla_put_failure:
93da9cc1 5642 genlmsg_cancel(msg, hdr);
efe1cf0c 5643 out:
d080e275 5644 nlmsg_free(msg);
4c476991 5645 return -ENOBUFS;
93da9cc1 5646}
5647
b54452b0 5648static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
93da9cc1 5649 [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
5650 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
5651 [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
5652 [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
5653 [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
5654 [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
45904f21 5655 [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
93da9cc1 5656 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
d299a1f2 5657 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
93da9cc1 5658 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
5659 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
5660 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
5661 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
5662 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
dca7e943 5663 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
93da9cc1 5664 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
699403db 5665 [NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
0507e159 5666 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
16dd7267 5667 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
94f90656 5668 [NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
a4f606ea
CYY		 5669 [NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
5670 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
ac1073a6
CYY		 5671 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
5672 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
728b19e5 5673 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
3b1c5a53
MP		 5674 [NL80211_MESHCONF_POWER_MODE] = { .type = NLA_U32 },
5675 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
8e7c0538 5676 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
93da9cc1 5677};
5678
c80d545d
JC		 5679static const struct nla_policy
5680 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
d299a1f2 5681 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
c80d545d
JC		 5682 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
5683 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
15d5dda6 5684 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
6e16d90b 5685 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
bb2798d4 5686 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
581a8b0f 5687 [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
a4f606ea 5688 .len = IEEE80211_MAX_DATA_LEN },
b130e5ce 5689 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
c80d545d
JC		 5690};
5691
f151d9db
AB		 5692static int nl80211_check_bool(const struct nlattr *nla, u8 min, u8 max, bool *out)
5693{
5694 u8 val = nla_get_u8(nla);
5695 if (val < min || val > max)
5696 return -EINVAL;
5697 *out = val;
5698 return 0;
5699}
5700
5701static int nl80211_check_u8(const struct nlattr *nla, u8 min, u8 max, u8 *out)
5702{
5703 u8 val = nla_get_u8(nla);
5704 if (val < min || val > max)
5705 return -EINVAL;
5706 *out = val;
5707 return 0;
5708}
5709
5710static int nl80211_check_u16(const struct nlattr *nla, u16 min, u16 max, u16 *out)
5711{
5712 u16 val = nla_get_u16(nla);
5713 if (val < min || val > max)
5714 return -EINVAL;
5715 *out = val;
5716 return 0;
5717}
5718
5719static int nl80211_check_u32(const struct nlattr *nla, u32 min, u32 max, u32 *out)
5720{
5721 u32 val = nla_get_u32(nla);
5722 if (val < min || val > max)
5723 return -EINVAL;
5724 *out = val;
5725 return 0;
5726}
5727
5728static int nl80211_check_s32(const struct nlattr *nla, s32 min, s32 max, s32 *out)
5729{
5730 s32 val = nla_get_s32(nla);
5731 if (val < min || val > max)
5732 return -EINVAL;
5733 *out = val;
5734 return 0;
5735}
5736
ff9a71af
JB		 5737static int nl80211_check_power_mode(const struct nlattr *nla,
5738 enum nl80211_mesh_power_mode min,
5739 enum nl80211_mesh_power_mode max,
5740 enum nl80211_mesh_power_mode *out)
5741{
5742 u32 val = nla_get_u32(nla);
5743 if (val < min || val > max)
5744 return -EINVAL;
5745 *out = val;
5746 return 0;
5747}
5748
24bdd9f4 5749static int nl80211_parse_mesh_config(struct genl_info *info,
bd90fdcc
JB		 5750 struct mesh_config *cfg,
5751 u32 *mask_out)
93da9cc1 5752{
93da9cc1 5753 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
bd90fdcc 5754 u32 mask = 0;
9757235f 5755 u16 ht_opmode;
93da9cc1 5756
ea54fba2
MP		 5757#define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, min, max, mask, attr, fn) \
5758do { \
5759 if (tb[attr]) { \
f151d9db 5760 if (fn(tb[attr], min, max, &cfg->param)) \
ea54fba2 5761 return -EINVAL; \
ea54fba2
MP		 5762 mask |= (1 << (attr - 1)); \
5763 } \
5764} while (0)
bd90fdcc 5765
24bdd9f4 5766 if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
93da9cc1 5767 return -EINVAL;
5768 if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
24bdd9f4 5769 info->attrs[NL80211_ATTR_MESH_CONFIG],
bd90fdcc 5770 nl80211_meshconf_params_policy))
93da9cc1 5771 return -EINVAL;
5772
93da9cc1 5773 /* This makes sure that there aren't more than 32 mesh config
5774 * parameters (otherwise our bitfield scheme would not work.) */
5775 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
5776
5777 /* Fill in the params struct */
ea54fba2 5778 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, 1, 255,
a4f606ea 5779 mask, NL80211_MESHCONF_RETRY_TIMEOUT,
f151d9db 5780 nl80211_check_u16);
ea54fba2 5781 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, 1, 255,
a4f606ea 5782 mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
f151d9db 5783 nl80211_check_u16);
ea54fba2 5784 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, 1, 255,
a4f606ea 5785 mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
f151d9db 5786 nl80211_check_u16);
ea54fba2 5787 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, 0, 255,
a4f606ea 5788 mask, NL80211_MESHCONF_MAX_PEER_LINKS,
f151d9db 5789 nl80211_check_u16);
ea54fba2 5790 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, 0, 16,
a4f606ea 5791 mask, NL80211_MESHCONF_MAX_RETRIES,
f151d9db 5792 nl80211_check_u8);
ea54fba2 5793 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, 1, 255,
f151d9db 5794 mask, NL80211_MESHCONF_TTL, nl80211_check_u8);
ea54fba2 5795 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, 1, 255,
a4f606ea 5796 mask, NL80211_MESHCONF_ELEMENT_TTL,
f151d9db 5797 nl80211_check_u8);
ea54fba2 5798 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, 0, 1,
a4f606ea 5799 mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
f151d9db 5800 nl80211_check_bool);
ea54fba2
MP		 5801 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
5802 1, 255, mask,
a4f606ea 5803 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
f151d9db 5804 nl80211_check_u32);
ea54fba2 5805 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, 0, 255,
a4f606ea 5806 mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
f151d9db 5807 nl80211_check_u8);
ea54fba2 5808 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, 1, 65535,
a4f606ea 5809 mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
f151d9db 5810 nl80211_check_u32);
ea54fba2 5811 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, 1, 65535,
a4f606ea 5812 mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
f151d9db 5813 nl80211_check_u16);
ea54fba2
MP		 5814 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
5815 1, 65535, mask,
a4f606ea 5816 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
f151d9db 5817 nl80211_check_u32);
93da9cc1 5818 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
ea54fba2
MP		 5819 1, 65535, mask,
5820 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
f151d9db 5821 nl80211_check_u16);
dca7e943 5822 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
ea54fba2
MP		 5823 1, 65535, mask,
5824 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
f151d9db 5825 nl80211_check_u16);
93da9cc1 5826 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
ea54fba2
MP		 5827 dot11MeshHWMPnetDiameterTraversalTime,
5828 1, 65535, mask,
a4f606ea 5829 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
f151d9db 5830 nl80211_check_u16);
ea54fba2
MP		 5831 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, 0, 4,
5832 mask, NL80211_MESHCONF_HWMP_ROOTMODE,
f151d9db 5833 nl80211_check_u8);
ea54fba2
MP		 5834 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, 1, 65535,
5835 mask, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
f151d9db 5836 nl80211_check_u16);
63c5723b 5837 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
ea54fba2
MP		 5838 dot11MeshGateAnnouncementProtocol, 0, 1,
5839 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
f151d9db 5840 nl80211_check_bool);
ea54fba2 5841 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, 0, 1,
a4f606ea 5842 mask, NL80211_MESHCONF_FORWARDING,
f151d9db 5843 nl80211_check_bool);
83374fe9 5844 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, -255, 0,
a4f606ea 5845 mask, NL80211_MESHCONF_RSSI_THRESHOLD,
f151d9db 5846 nl80211_check_s32);
9757235f
MH		 5847 /*
5848 * Check HT operation mode based on
5849 * IEEE 802.11 2012 8.4.2.59 HT Operation element.
5850 */
5851 if (tb[NL80211_MESHCONF_HT_OPMODE]) {
5852 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
5853
5854 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
5855 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
5856 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
5857 return -EINVAL;
5858
5859 if ((ht_opmode & IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT) &&
5860 (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
5861 return -EINVAL;
5862
5863 switch (ht_opmode & IEEE80211_HT_OP_MODE_PROTECTION) {
5864 case IEEE80211_HT_OP_MODE_PROTECTION_NONE:
5865 case IEEE80211_HT_OP_MODE_PROTECTION_20MHZ:
5866 if (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)
5867 return -EINVAL;
5868 break;
5869 case IEEE80211_HT_OP_MODE_PROTECTION_NONMEMBER:
5870 case IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED:
5871 if (!(ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
5872 return -EINVAL;
5873 break;
5874 }
5875 cfg->ht_opmode = ht_opmode;
5876 }
ac1073a6 5877 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
ea54fba2 5878 1, 65535, mask,
ac1073a6 5879 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
f151d9db 5880 nl80211_check_u32);
ea54fba2 5881 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, 1, 65535,
ac1073a6 5882 mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
f151d9db 5883 nl80211_check_u16);
728b19e5 5884 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
ea54fba2
MP		 5885 dot11MeshHWMPconfirmationInterval,
5886 1, 65535, mask,
728b19e5 5887 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
f151d9db 5888 nl80211_check_u16);
3b1c5a53
MP		 5889 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode,
5890 NL80211_MESH_POWER_ACTIVE,
5891 NL80211_MESH_POWER_MAX,
5892 mask, NL80211_MESHCONF_POWER_MODE,
ff9a71af 5893 nl80211_check_power_mode);
3b1c5a53
MP		 5894 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration,
5895 0, 65535, mask,
f151d9db 5896 NL80211_MESHCONF_AWAKE_WINDOW, nl80211_check_u16);
31f909a2 5897 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, 0, 0xffffffff,
8e7c0538 5898 mask, NL80211_MESHCONF_PLINK_TIMEOUT,
f151d9db 5899 nl80211_check_u32);
bd90fdcc
JB		 5900 if (mask_out)
5901 *mask_out = mask;
c80d545d 5902
bd90fdcc
JB		 5903 return 0;
5904
5905#undef FILL_IN_MESH_PARAM_IF_SET
5906}
5907
c80d545d
JC		 5908static int nl80211_parse_mesh_setup(struct genl_info *info,
5909 struct mesh_setup *setup)
5910{
bb2798d4 5911 struct cfg80211_registered_device *rdev = info->user_ptr[0];
c80d545d
JC		 5912 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
5913
5914 if (!info->attrs[NL80211_ATTR_MESH_SETUP])
5915 return -EINVAL;
5916 if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
5917 info->attrs[NL80211_ATTR_MESH_SETUP],
5918 nl80211_mesh_setup_params_policy))
5919 return -EINVAL;
5920
d299a1f2
JC		 5921 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
5922 setup->sync_method =
5923 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
5924 IEEE80211_SYNC_METHOD_VENDOR :
5925 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
5926
c80d545d
JC		 5927 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
5928 setup->path_sel_proto =
5929 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
5930 IEEE80211_PATH_PROTOCOL_VENDOR :
5931 IEEE80211_PATH_PROTOCOL_HWMP;
5932
5933 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
5934 setup->path_metric =
5935 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
5936 IEEE80211_PATH_METRIC_VENDOR :
5937 IEEE80211_PATH_METRIC_AIRTIME;
5938
581a8b0f 5939 if (tb[NL80211_MESH_SETUP_IE]) {
c80d545d 5940 struct nlattr *ieattr =
581a8b0f 5941 tb[NL80211_MESH_SETUP_IE];
c80d545d
JC		 5942 if (!is_valid_ie_attr(ieattr))
5943 return -EINVAL;
581a8b0f
JC		 5944 setup->ie = nla_data(ieattr);
5945 setup->ie_len = nla_len(ieattr);
c80d545d 5946 }
bb2798d4
TP		 5947 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
5948 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
5949 return -EINVAL;
5950 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
b130e5ce
JC		 5951 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
5952 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
bb2798d4
TP		 5953 if (setup->is_secure)
5954 setup->user_mpm = true;
c80d545d 5955
6e16d90b
CT		 5956 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
5957 if (!setup->user_mpm)
5958 return -EINVAL;
5959 setup->auth_id =
5960 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
5961 }
5962
c80d545d
JC		 5963 return 0;
5964}
5965
24bdd9f4 5966static int nl80211_update_mesh_config(struct sk_buff *skb,
29cbe68c 5967 struct genl_info *info)
bd90fdcc
JB		 5968{
5969 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5970 struct net_device *dev = info->user_ptr[1];
29cbe68c 5971 struct wireless_dev *wdev = dev->ieee80211_ptr;
bd90fdcc
JB		 5972 struct mesh_config cfg;
5973 u32 mask;
5974 int err;
5975
29cbe68c
JB		 5976 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
5977 return -EOPNOTSUPP;
5978
24bdd9f4 5979 if (!rdev->ops->update_mesh_config)
bd90fdcc
JB		 5980 return -EOPNOTSUPP;
5981
24bdd9f4 5982 err = nl80211_parse_mesh_config(info, &cfg, &mask);
bd90fdcc
JB		 5983 if (err)
5984 return err;
5985
29cbe68c
JB		 5986 wdev_lock(wdev);
5987 if (!wdev->mesh_id_len)
5988 err = -ENOLINK;
5989
5990 if (!err)
e35e4d28 5991 err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
29cbe68c
JB		 5992
5993 wdev_unlock(wdev);
5994
5995 return err;
93da9cc1 5996}
5997
ad30ca2c
AN		 5998static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
5999 struct sk_buff *msg)
f130347c 6000{
f130347c
LR		 6001 struct nlattr *nl_reg_rules;
6002 unsigned int i;
f130347c 6003
458f4f9e
JB		 6004 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
6005 (regdom->dfs_region &&
6006 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
ad30ca2c 6007 goto nla_put_failure;
458f4f9e 6008
f130347c
LR		 6009 nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
6010 if (!nl_reg_rules)
ad30ca2c 6011 goto nla_put_failure;
f130347c 6012
458f4f9e 6013 for (i = 0; i < regdom->n_reg_rules; i++) {
f130347c
LR		 6014 struct nlattr *nl_reg_rule;
6015 const struct ieee80211_reg_rule *reg_rule;
6016 const struct ieee80211_freq_range *freq_range;
6017 const struct ieee80211_power_rule *power_rule;
97524820 6018 unsigned int max_bandwidth_khz;
f130347c 6019
458f4f9e 6020 reg_rule = &regdom->reg_rules[i];
f130347c
LR		 6021 freq_range = &reg_rule->freq_range;
6022 power_rule = &reg_rule->power_rule;
6023
6024 nl_reg_rule = nla_nest_start(msg, i);
6025 if (!nl_reg_rule)
ad30ca2c 6026 goto nla_put_failure;
f130347c 6027
97524820
JD		 6028 max_bandwidth_khz = freq_range->max_bandwidth_khz;
6029 if (!max_bandwidth_khz)
6030 max_bandwidth_khz = reg_get_max_bandwidth(regdom,
6031 reg_rule);
6032
9360ffd1
DM		 6033 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
6034 reg_rule->flags) ||
6035 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
6036 freq_range->start_freq_khz) ||
6037 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
6038 freq_range->end_freq_khz) ||
6039 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
97524820 6040 max_bandwidth_khz) ||
9360ffd1
DM		 6041 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
6042 power_rule->max_antenna_gain) ||
6043 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
089027e5
JD		 6044 power_rule->max_eirp) ||
6045 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
6046 reg_rule->dfs_cac_ms))
ad30ca2c 6047 goto nla_put_failure;
f130347c
LR		 6048
6049 nla_nest_end(msg, nl_reg_rule);
6050 }
6051
6052 nla_nest_end(msg, nl_reg_rules);
ad30ca2c
AN		 6053 return 0;
6054
6055nla_put_failure:
6056 return -EMSGSIZE;
6057}
6058
6059static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
6060{
6061 const struct ieee80211_regdomain *regdom = NULL;
6062 struct cfg80211_registered_device *rdev;
6063 struct wiphy *wiphy = NULL;
6064 struct sk_buff *msg;
6065 void *hdr;
6066
6067 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6068 if (!msg)
6069 return -ENOBUFS;
6070
6071 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6072 NL80211_CMD_GET_REG);
6073 if (!hdr)
6074 goto put_failure;
6075
6076 if (info->attrs[NL80211_ATTR_WIPHY]) {
1bdd716c
AN		 6077 bool self_managed;
6078
ad30ca2c
AN		 6079 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
6080 if (IS_ERR(rdev)) {
6081 nlmsg_free(msg);
6082 return PTR_ERR(rdev);
6083 }
6084
6085 wiphy = &rdev->wiphy;
1bdd716c
AN		 6086 self_managed = wiphy->regulatory_flags &
6087 REGULATORY_WIPHY_SELF_MANAGED;
ad30ca2c
AN		 6088 regdom = get_wiphy_regdom(wiphy);
6089
1bdd716c
AN		 6090 /* a self-managed-reg device must have a private regdom */
6091 if (WARN_ON(!regdom && self_managed)) {
6092 nlmsg_free(msg);
6093 return -EINVAL;
6094 }
6095
ad30ca2c
AN		 6096 if (regdom &&
6097 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6098 goto nla_put_failure;
6099 }
6100
6101 if (!wiphy && reg_last_request_cell_base() &&
6102 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6103 NL80211_USER_REG_HINT_CELL_BASE))
6104 goto nla_put_failure;
6105
6106 rcu_read_lock();
6107
6108 if (!regdom)
6109 regdom = rcu_dereference(cfg80211_regdomain);
6110
6111 if (nl80211_put_regdom(regdom, msg))
6112 goto nla_put_failure_rcu;
6113
6114 rcu_read_unlock();
f130347c
LR		 6115
6116 genlmsg_end(msg, hdr);
5fe231e8 6117 return genlmsg_reply(msg, info);
f130347c 6118
458f4f9e
JB		 6119nla_put_failure_rcu:
6120 rcu_read_unlock();
f130347c
LR		 6121nla_put_failure:
6122 genlmsg_cancel(msg, hdr);
efe1cf0c 6123put_failure:
d080e275 6124 nlmsg_free(msg);
5fe231e8 6125 return -EMSGSIZE;
f130347c
LR		 6126}
6127
ad30ca2c
AN		 6128static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
6129 u32 seq, int flags, struct wiphy *wiphy,
6130 const struct ieee80211_regdomain *regdom)
6131{
6132 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
6133 NL80211_CMD_GET_REG);
6134
6135 if (!hdr)
6136 return -1;
6137
6138 genl_dump_check_consistent(cb, hdr, &nl80211_fam);
6139
6140 if (nl80211_put_regdom(regdom, msg))
6141 goto nla_put_failure;
6142
6143 if (!wiphy && reg_last_request_cell_base() &&
6144 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6145 NL80211_USER_REG_HINT_CELL_BASE))
6146 goto nla_put_failure;
6147
6148 if (wiphy &&
6149 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6150 goto nla_put_failure;
6151
1bdd716c
AN		 6152 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
6153 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
6154 goto nla_put_failure;
6155
053c095a
JB		 6156 genlmsg_end(msg, hdr);
6157 return 0;
ad30ca2c
AN		 6158
6159nla_put_failure:
6160 genlmsg_cancel(msg, hdr);
6161 return -EMSGSIZE;
6162}
6163
6164static int nl80211_get_reg_dump(struct sk_buff *skb,
6165 struct netlink_callback *cb)
6166{
6167 const struct ieee80211_regdomain *regdom = NULL;
6168 struct cfg80211_registered_device *rdev;
6169 int err, reg_idx, start = cb->args[2];
6170
6171 rtnl_lock();
6172
6173 if (cfg80211_regdomain && start == 0) {
6174 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6175 NLM_F_MULTI, NULL,
6176 rtnl_dereference(cfg80211_regdomain));
6177 if (err < 0)
6178 goto out_err;
6179 }
6180
6181 /* the global regdom is idx 0 */
6182 reg_idx = 1;
6183 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
6184 regdom = get_wiphy_regdom(&rdev->wiphy);
6185 if (!regdom)
6186 continue;
6187
6188 if (++reg_idx <= start)
6189 continue;
6190
6191 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6192 NLM_F_MULTI, &rdev->wiphy, regdom);
6193 if (err < 0) {
6194 reg_idx--;
6195 break;
6196 }
6197 }
6198
6199 cb->args[2] = reg_idx;
6200 err = skb->len;
6201out_err:
6202 rtnl_unlock();
6203 return err;
6204}
6205
b6863036
JB		 6206#ifdef CONFIG_CFG80211_CRDA_SUPPORT
6207static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
6208 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
6209 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
6210 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
6211 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
6212 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
6213 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
6214 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 },
6215};
6216
6217static int parse_reg_rule(struct nlattr *tb[],
6218 struct ieee80211_reg_rule *reg_rule)
6219{
6220 struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
6221 struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
6222
6223 if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
6224 return -EINVAL;
6225 if (!tb[NL80211_ATTR_FREQ_RANGE_START])
6226 return -EINVAL;
6227 if (!tb[NL80211_ATTR_FREQ_RANGE_END])
6228 return -EINVAL;
6229 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
6230 return -EINVAL;
6231 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
6232 return -EINVAL;
6233
6234 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
6235
6236 freq_range->start_freq_khz =
6237 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
6238 freq_range->end_freq_khz =
6239 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
6240 freq_range->max_bandwidth_khz =
6241 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
6242
6243 power_rule->max_eirp =
6244 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
6245
6246 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
6247 power_rule->max_antenna_gain =
6248 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
6249
6250 if (tb[NL80211_ATTR_DFS_CAC_TIME])
6251 reg_rule->dfs_cac_ms =
6252 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
6253
6254 return 0;
6255}
6256
b2e1b302
LR		 6257static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
6258{
6259 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
6260 struct nlattr *nl_reg_rule;
ea372c54
JB		 6261 char *alpha2;
6262 int rem_reg_rules, r;
b2e1b302 6263 u32 num_rules = 0, rule_idx = 0, size_of_regd;
4c7d3982 6264 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
ea372c54 6265 struct ieee80211_regdomain *rd;
b2e1b302
LR		 6266
6267 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
6268 return -EINVAL;
6269
6270 if (!info->attrs[NL80211_ATTR_REG_RULES])
6271 return -EINVAL;
6272
6273 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
6274
8b60b078
LR		 6275 if (info->attrs[NL80211_ATTR_DFS_REGION])
6276 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
6277
b2e1b302 6278 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
1a919318 6279 rem_reg_rules) {
b2e1b302
LR		 6280 num_rules++;
6281 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
4776c6e7 6282 return -EINVAL;
b2e1b302
LR		 6283 }
6284
e438768f
LR		 6285 if (!reg_is_valid_request(alpha2))
6286 return -EINVAL;
6287
b2e1b302 6288 size_of_regd = sizeof(struct ieee80211_regdomain) +
1a919318 6289 num_rules * sizeof(struct ieee80211_reg_rule);
b2e1b302
LR		 6290
6291 rd = kzalloc(size_of_regd, GFP_KERNEL);
6913b49a
JB		 6292 if (!rd)
6293 return -ENOMEM;
b2e1b302
LR		 6294
6295 rd->n_reg_rules = num_rules;
6296 rd->alpha2[0] = alpha2[0];
6297 rd->alpha2[1] = alpha2[1];
6298
8b60b078
LR		 6299 /*
6300 * Disable DFS master mode if the DFS region was
6301 * not supported or known on this kernel.
6302 */
6303 if (reg_supported_dfs_region(dfs_region))
6304 rd->dfs_region = dfs_region;
6305
b2e1b302 6306 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
1a919318 6307 rem_reg_rules) {
ae811e21
JB		 6308 r = nla_parse(tb, NL80211_REG_RULE_ATTR_MAX,
6309 nla_data(nl_reg_rule), nla_len(nl_reg_rule),
6310 reg_rule_policy);
6311 if (r)
6312 goto bad_reg;
b2e1b302
LR		 6313 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
6314 if (r)
6315 goto bad_reg;
6316
6317 rule_idx++;
6318
d0e18f83
LR		 6319 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
6320 r = -EINVAL;
b2e1b302 6321 goto bad_reg;
d0e18f83 6322 }
b2e1b302
LR		 6323 }
6324
06627990
JB		 6325 /* set_regdom takes ownership of rd */
6326 return set_regdom(rd, REGD_SOURCE_CRDA);
d2372b31 6327 bad_reg:
b2e1b302 6328 kfree(rd);
d0e18f83 6329 return r;
b2e1b302 6330}
b6863036 6331#endif /* CONFIG_CFG80211_CRDA_SUPPORT */
b2e1b302 6332
83f5e2cf
JB		 6333static int validate_scan_freqs(struct nlattr *freqs)
6334{
6335 struct nlattr *attr1, *attr2;
6336 int n_channels = 0, tmp1, tmp2;
6337
6338 nla_for_each_nested(attr1, freqs, tmp1) {
6339 n_channels++;
6340 /*
6341 * Some hardware has a limited channel list for
6342 * scanning, and it is pretty much nonsensical
6343 * to scan for a channel twice, so disallow that
6344 * and don't require drivers to check that the
6345 * channel list they get isn't longer than what
6346 * they can scan, as long as they can scan all
6347 * the channels they registered at once.
6348 */
6349 nla_for_each_nested(attr2, freqs, tmp2)
6350 if (attr1 != attr2 &&
6351 nla_get_u32(attr1) == nla_get_u32(attr2))
6352 return 0;
6353 }
6354
6355 return n_channels;
6356}
6357
57fbcce3 6358static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
38de03d2 6359{
57fbcce3 6360 return b < NUM_NL80211_BANDS && wiphy->bands[b];
38de03d2
AS		 6361}
6362
6363static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
6364 struct cfg80211_bss_selection *bss_select)
6365{
6366 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
6367 struct nlattr *nest;
6368 int err;
6369 bool found = false;
6370 int i;
6371
6372 /* only process one nested attribute */
6373 nest = nla_data(nla);
6374 if (!nla_ok(nest, nla_len(nest)))
6375 return -EINVAL;
6376
6377 err = nla_parse(attr, NL80211_BSS_SELECT_ATTR_MAX, nla_data(nest),
6378 nla_len(nest), nl80211_bss_select_policy);
6379 if (err)
6380 return err;
6381
6382 /* only one attribute may be given */
6383 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
6384 if (attr[i]) {
6385 if (found)
6386 return -EINVAL;
6387 found = true;
6388 }
6389 }
6390
6391 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
6392
6393 if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
6394 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
6395
6396 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
6397 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
6398 bss_select->param.band_pref =
6399 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
6400 if (!is_band_valid(wiphy, bss_select->param.band_pref))
6401 return -EINVAL;
6402 }
6403
6404 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
6405 struct nl80211_bss_select_rssi_adjust *adj_param;
6406
6407 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
6408 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
6409 bss_select->param.adjust.band = adj_param->band;
6410 bss_select->param.adjust.delta = adj_param->delta;
6411 if (!is_band_valid(wiphy, bss_select->param.adjust.band))
6412 return -EINVAL;
6413 }
6414
6415 /* user-space did not provide behaviour attribute */
6416 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
6417 return -EINVAL;
6418
6419 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
6420 return -EINVAL;
6421
6422 return 0;
6423}
6424
ad2b26ab
JB		 6425static int nl80211_parse_random_mac(struct nlattr **attrs,
6426 u8 *mac_addr, u8 *mac_addr_mask)
6427{
6428 int i;
6429
6430 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
d2beae10
JP		 6431 eth_zero_addr(mac_addr);
6432 eth_zero_addr(mac_addr_mask);
ad2b26ab
JB		 6433 mac_addr[0] = 0x2;
6434 mac_addr_mask[0] = 0x3;
6435
6436 return 0;
6437 }
6438
6439 /* need both or none */
6440 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
6441 return -EINVAL;
6442
6443 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
6444 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
6445
6446 /* don't allow or configure an mcast address */
6447 if (!is_multicast_ether_addr(mac_addr_mask) ||
6448 is_multicast_ether_addr(mac_addr))
6449 return -EINVAL;
6450
6451 /*
6452 * allow users to pass a MAC address that has bits set outside
6453 * of the mask, but don't bother drivers with having to deal
6454 * with such bits
6455 */
6456 for (i = 0; i < ETH_ALEN; i++)
6457 mac_addr[i] &= mac_addr_mask[i];
6458
6459 return 0;
6460}
6461
2a519311
JB		 6462static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
6463{
4c476991 6464 struct cfg80211_registered_device *rdev = info->user_ptr[0];
fd014284 6465 struct wireless_dev *wdev = info->user_ptr[1];
2a519311 6466 struct cfg80211_scan_request *request;
2a519311
JB		 6467 struct nlattr *attr;
6468 struct wiphy *wiphy;
83f5e2cf 6469 int err, tmp, n_ssids = 0, n_channels, i;
70692ad2 6470 size_t ie_len;
2a519311 6471
f4a11bb0
JB		 6472 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
6473 return -EINVAL;
6474
79c97e97 6475 wiphy = &rdev->wiphy;
2a519311 6476
cb3b7d87
AB		 6477 if (wdev->iftype == NL80211_IFTYPE_NAN)
6478 return -EOPNOTSUPP;
6479
4c476991
JB		 6480 if (!rdev->ops->scan)
6481 return -EOPNOTSUPP;
2a519311 6482
f9d15d16 6483 if (rdev->scan_req || rdev->scan_msg) {
f9f47529
JB		 6484 err = -EBUSY;
6485 goto unlock;
6486 }
2a519311
JB		 6487
6488 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
83f5e2cf
JB		 6489 n_channels = validate_scan_freqs(
6490 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
f9f47529
JB		 6491 if (!n_channels) {
6492 err = -EINVAL;
6493 goto unlock;
6494 }
2a519311 6495 } else {
bdfbec2d 6496 n_channels = ieee80211_get_num_supported_channels(wiphy);
2a519311
JB		 6497 }
6498
6499 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
6500 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
6501 n_ssids++;
6502
f9f47529
JB		 6503 if (n_ssids > wiphy->max_scan_ssids) {
6504 err = -EINVAL;
6505 goto unlock;
6506 }
2a519311 6507
70692ad2
JM		 6508 if (info->attrs[NL80211_ATTR_IE])
6509 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
6510 else
6511 ie_len = 0;
6512
f9f47529
JB		 6513 if (ie_len > wiphy->max_scan_ie_len) {
6514 err = -EINVAL;
6515 goto unlock;
6516 }
18a83659 6517
2a519311 6518 request = kzalloc(sizeof(*request)
a2cd43c5
LC		 6519 + sizeof(*request->ssids) * n_ssids
6520 + sizeof(*request->channels) * n_channels
70692ad2 6521 + ie_len, GFP_KERNEL);
f9f47529
JB		 6522 if (!request) {
6523 err = -ENOMEM;
6524 goto unlock;
6525 }
2a519311 6526
2a519311 6527 if (n_ssids)
5ba63533 6528 request->ssids = (void *)&request->channels[n_channels];
2a519311 6529 request->n_ssids = n_ssids;
70692ad2 6530 if (ie_len) {
13874e4b 6531 if (n_ssids)
70692ad2
JM		 6532 request->ie = (void *)(request->ssids + n_ssids);
6533 else
6534 request->ie = (void *)(request->channels + n_channels);
6535 }
2a519311 6536
584991dc 6537 i = 0;
2a519311
JB		 6538 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6539 /* user specified, bail out if channel not found */
2a519311 6540 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
584991dc
JB		 6541 struct ieee80211_channel *chan;
6542
6543 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
6544
6545 if (!chan) {
2a519311
JB		 6546 err = -EINVAL;
6547 goto out_free;
6548 }
584991dc
JB		 6549
6550 /* ignore disabled channels */
6551 if (chan->flags & IEEE80211_CHAN_DISABLED)
6552 continue;
6553
6554 request->channels[i] = chan;
2a519311
JB		 6555 i++;
6556 }
6557 } else {
57fbcce3 6558 enum nl80211_band band;
34850ab2 6559
2a519311 6560 /* all channels */
57fbcce3 6561 for (band = 0; band < NUM_NL80211_BANDS; band++) {
2a519311 6562 int j;
7a087e74 6563
2a519311
JB		 6564 if (!wiphy->bands[band])
6565 continue;
6566 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
584991dc
JB		 6567 struct ieee80211_channel *chan;
6568
6569 chan = &wiphy->bands[band]->channels[j];
6570
6571 if (chan->flags & IEEE80211_CHAN_DISABLED)
6572 continue;
6573
6574 request->channels[i] = chan;
2a519311
JB		 6575 i++;
6576 }
6577 }
6578 }
6579
584991dc
JB		 6580 if (!i) {
6581 err = -EINVAL;
6582 goto out_free;
6583 }
6584
6585 request->n_channels = i;
6586
2a519311 6587 i = 0;
13874e4b 6588 if (n_ssids) {
2a519311 6589 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
57a27e1d 6590 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
2a519311
JB		 6591 err = -EINVAL;
6592 goto out_free;
6593 }
57a27e1d 6594 request->ssids[i].ssid_len = nla_len(attr);
2a519311 6595 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
2a519311
JB		 6596 i++;
6597 }
6598 }
6599
70692ad2
JM		 6600 if (info->attrs[NL80211_ATTR_IE]) {
6601 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
de95a54b
JB		 6602 memcpy((void *)request->ie,
6603 nla_data(info->attrs[NL80211_ATTR_IE]),
70692ad2
JM		 6604 request->ie_len);
6605 }
6606
57fbcce3 6607 for (i = 0; i < NUM_NL80211_BANDS; i++)
a401d2bb
JB		 6608 if (wiphy->bands[i])
6609 request->rates[i] =
6610 (1 << wiphy->bands[i]->n_bitrates) - 1;
34850ab2
JB		 6611
6612 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
6613 nla_for_each_nested(attr,
6614 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
6615 tmp) {
57fbcce3 6616 enum nl80211_band band = nla_type(attr);
34850ab2 6617
57fbcce3 6618 if (band < 0 || band >= NUM_NL80211_BANDS) {
34850ab2
JB		 6619 err = -EINVAL;
6620 goto out_free;
6621 }
1b09cd82
FF		 6622
6623 if (!wiphy->bands[band])
6624 continue;
6625
34850ab2
JB		 6626 err = ieee80211_get_ratemask(wiphy->bands[band],
6627 nla_data(attr),
6628 nla_len(attr),
6629 &request->rates[band]);
6630 if (err)
6631 goto out_free;
6632 }
6633 }
6634
1d76250b
AS		 6635 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
6636 if (!wiphy_ext_feature_isset(wiphy,
6637 NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
6638 err = -EOPNOTSUPP;
6639 goto out_free;
6640 }
6641
6642 request->duration =
6643 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
6644 request->duration_mandatory =
6645 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
6646 }
6647
46856bbf 6648 if (info->attrs[NL80211_ATTR_SCAN_FLAGS]) {
ed473771
SL		 6649 request->flags = nla_get_u32(
6650 info->attrs[NL80211_ATTR_SCAN_FLAGS]);
00c3a6ed
JB		 6651 if ((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
6652 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) {
46856bbf
SL		 6653 err = -EOPNOTSUPP;
6654 goto out_free;
6655 }
ad2b26ab
JB		 6656
6657 if (request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
6658 if (!(wiphy->features &
6659 NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR)) {
6660 err = -EOPNOTSUPP;
6661 goto out_free;
6662 }
6663
6664 if (wdev->current_bss) {
6665 err = -EOPNOTSUPP;
6666 goto out_free;
6667 }
6668
6669 err = nl80211_parse_random_mac(info->attrs,
6670 request->mac_addr,
6671 request->mac_addr_mask);
6672 if (err)
6673 goto out_free;
6674 }
46856bbf 6675 }
ed473771 6676
e9f935e3
RM		 6677 request->no_cck =
6678 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
6679
818965d3
JM		 6680 if (info->attrs[NL80211_ATTR_MAC])
6681 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
6682 ETH_ALEN);
6683 else
6684 eth_broadcast_addr(request->bssid);
6685
fd014284 6686 request->wdev = wdev;
79c97e97 6687 request->wiphy = &rdev->wiphy;
15d6030b 6688 request->scan_start = jiffies;
2a519311 6689
79c97e97 6690 rdev->scan_req = request;
e35e4d28 6691 err = rdev_scan(rdev, request);
2a519311 6692
463d0183 6693 if (!err) {
fd014284
JB		 6694 nl80211_send_scan_start(rdev, wdev);
6695 if (wdev->netdev)
6696 dev_hold(wdev->netdev);
4c476991 6697 } else {
2a519311 6698 out_free:
79c97e97 6699 rdev->scan_req = NULL;
2a519311
JB		 6700 kfree(request);
6701 }
3b85875a 6702
f9f47529 6703 unlock:
2a519311
JB		 6704 return err;
6705}
6706
91d3ab46
VK		 6707static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
6708{
6709 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6710 struct wireless_dev *wdev = info->user_ptr[1];
6711
6712 if (!rdev->ops->abort_scan)
6713 return -EOPNOTSUPP;
6714
6715 if (rdev->scan_msg)
6716 return 0;
6717
6718 if (!rdev->scan_req)
6719 return -ENOENT;
6720
6721 rdev_abort_scan(rdev, wdev);
6722 return 0;
6723}
6724
3b06d277
AS		 6725static int
6726nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
6727 struct cfg80211_sched_scan_request *request,
6728 struct nlattr **attrs)
6729{
6730 int tmp, err, i = 0;
6731 struct nlattr *attr;
6732
6733 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
6734 u32 interval;
6735
6736 /*
6737 * If scan plans are not specified,
6738 * %NL80211_ATTR_SCHED_SCAN_INTERVAL must be specified. In this
6739 * case one scan plan will be set with the specified scan
6740 * interval and infinite number of iterations.
6741 */
6742 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
6743 return -EINVAL;
6744
6745 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
6746 if (!interval)
6747 return -EINVAL;
6748
6749 request->scan_plans[0].interval =
6750 DIV_ROUND_UP(interval, MSEC_PER_SEC);
6751 if (!request->scan_plans[0].interval)
6752 return -EINVAL;
6753
6754 if (request->scan_plans[0].interval >
6755 wiphy->max_sched_scan_plan_interval)
6756 request->scan_plans[0].interval =
6757 wiphy->max_sched_scan_plan_interval;
6758
6759 return 0;
6760 }
6761
6762 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
6763 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
6764
6765 if (WARN_ON(i >= n_plans))
6766 return -EINVAL;
6767
6768 err = nla_parse(plan, NL80211_SCHED_SCAN_PLAN_MAX,
6769 nla_data(attr), nla_len(attr),
6770 nl80211_plan_policy);
6771 if (err)
6772 return err;
6773
6774 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
6775 return -EINVAL;
6776
6777 request->scan_plans[i].interval =
6778 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
6779 if (!request->scan_plans[i].interval ||
6780 request->scan_plans[i].interval >
6781 wiphy->max_sched_scan_plan_interval)
6782 return -EINVAL;
6783
6784 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
6785 request->scan_plans[i].iterations =
6786 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
6787 if (!request->scan_plans[i].iterations ||
6788 (request->scan_plans[i].iterations >
6789 wiphy->max_sched_scan_plan_iterations))
6790 return -EINVAL;
6791 } else if (i < n_plans - 1) {
6792 /*
6793 * All scan plans but the last one must specify
6794 * a finite number of iterations
6795 */
6796 return -EINVAL;
6797 }
6798
6799 i++;
6800 }
6801
6802 /*
6803 * The last scan plan must not specify the number of
6804 * iterations, it is supposed to run infinitely
6805 */
6806 if (request->scan_plans[n_plans - 1].iterations)
6807 return -EINVAL;
6808
6809 return 0;
6810}
6811
256da02d 6812static struct cfg80211_sched_scan_request *
ad2b26ab 6813nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
256da02d 6814 struct nlattr **attrs)
807f8a8c
LC		 6815{
6816 struct cfg80211_sched_scan_request *request;
807f8a8c 6817 struct nlattr *attr;
3b06d277 6818 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
57fbcce3 6819 enum nl80211_band band;
807f8a8c 6820 size_t ie_len;
a1f1c21c 6821 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
ea73cbce 6822 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
807f8a8c 6823
256da02d
LC		 6824 if (!is_valid_ie_attr(attrs[NL80211_ATTR_IE]))
6825 return ERR_PTR(-EINVAL);
807f8a8c 6826
256da02d 6827 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
807f8a8c 6828 n_channels = validate_scan_freqs(
256da02d 6829 attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
807f8a8c 6830 if (!n_channels)
256da02d 6831 return ERR_PTR(-EINVAL);
807f8a8c 6832 } else {
bdfbec2d 6833 n_channels = ieee80211_get_num_supported_channels(wiphy);
807f8a8c
LC		 6834 }
6835
256da02d
LC		 6836 if (attrs[NL80211_ATTR_SCAN_SSIDS])
6837 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
807f8a8c
LC		 6838 tmp)
6839 n_ssids++;
6840
93b6aa69 6841 if (n_ssids > wiphy->max_sched_scan_ssids)
256da02d 6842 return ERR_PTR(-EINVAL);
807f8a8c 6843
ea73cbce
JB		 6844 /*
6845 * First, count the number of 'real' matchsets. Due to an issue with
6846 * the old implementation, matchsets containing only the RSSI attribute
6847 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
6848 * RSSI for all matchsets, rather than their own matchset for reporting
6849 * all APs with a strong RSSI. This is needed to be compatible with
6850 * older userspace that treated a matchset with only the RSSI as the
6851 * global RSSI for all other matchsets - if there are other matchsets.
6852 */
256da02d 6853 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
a1f1c21c 6854 nla_for_each_nested(attr,
256da02d 6855 attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
ea73cbce
JB		 6856 tmp) {
6857 struct nlattr *rssi;
6858
6859 err = nla_parse(tb, NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
6860 nla_data(attr), nla_len(attr),
6861 nl80211_match_policy);
6862 if (err)
256da02d 6863 return ERR_PTR(err);
ea73cbce
JB		 6864 /* add other standalone attributes here */
6865 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]) {
6866 n_match_sets++;
6867 continue;
6868 }
6869 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
6870 if (rssi)
6871 default_match_rssi = nla_get_s32(rssi);
6872 }
6873 }
6874
6875 /* However, if there's no other matchset, add the RSSI one */
6876 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
6877 n_match_sets = 1;
a1f1c21c
LC		 6878
6879 if (n_match_sets > wiphy->max_match_sets)
256da02d 6880 return ERR_PTR(-EINVAL);
a1f1c21c 6881
256da02d
LC		 6882 if (attrs[NL80211_ATTR_IE])
6883 ie_len = nla_len(attrs[NL80211_ATTR_IE]);
807f8a8c
LC		 6884 else
6885 ie_len = 0;
6886
5a865bad 6887 if (ie_len > wiphy->max_sched_scan_ie_len)
256da02d 6888 return ERR_PTR(-EINVAL);
c10841ca 6889
3b06d277
AS		 6890 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
6891 /*
6892 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
6893 * each scan plan already specifies its own interval
6894 */
6895 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
6896 return ERR_PTR(-EINVAL);
6897
6898 nla_for_each_nested(attr,
6899 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
6900 n_plans++;
6901 } else {
6902 /*
6903 * The scan interval attribute is kept for backward
6904 * compatibility. If no scan plans are specified and sched scan
6905 * interval is specified, one scan plan will be set with this
6906 * scan interval and infinite number of iterations.
6907 */
6908 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
6909 return ERR_PTR(-EINVAL);
6910
6911 n_plans = 1;
6912 }
6913
6914 if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
6915 return ERR_PTR(-EINVAL);
6916
807f8a8c 6917 request = kzalloc(sizeof(*request)
a2cd43c5 6918 + sizeof(*request->ssids) * n_ssids
a1f1c21c 6919 + sizeof(*request->match_sets) * n_match_sets
3b06d277 6920 + sizeof(*request->scan_plans) * n_plans
a2cd43c5 6921 + sizeof(*request->channels) * n_channels
807f8a8c 6922 + ie_len, GFP_KERNEL);
256da02d
LC		 6923 if (!request)
6924 return ERR_PTR(-ENOMEM);
807f8a8c
LC		 6925
6926 if (n_ssids)
6927 request->ssids = (void *)&request->channels[n_channels];
6928 request->n_ssids = n_ssids;
6929 if (ie_len) {
13874e4b 6930 if (n_ssids)
807f8a8c
LC		 6931 request->ie = (void *)(request->ssids + n_ssids);
6932 else
6933 request->ie = (void *)(request->channels + n_channels);
6934 }
6935
a1f1c21c
LC		 6936 if (n_match_sets) {
6937 if (request->ie)
6938 request->match_sets = (void *)(request->ie + ie_len);
13874e4b 6939 else if (n_ssids)
a1f1c21c
LC		 6940 request->match_sets =
6941 (void *)(request->ssids + n_ssids);
6942 else
6943 request->match_sets =
6944 (void *)(request->channels + n_channels);
6945 }
6946 request->n_match_sets = n_match_sets;
6947
3b06d277
AS		 6948 if (n_match_sets)
6949 request->scan_plans = (void *)(request->match_sets +
6950 n_match_sets);
6951 else if (request->ie)
6952 request->scan_plans = (void *)(request->ie + ie_len);
6953 else if (n_ssids)
6954 request->scan_plans = (void *)(request->ssids + n_ssids);
6955 else
6956 request->scan_plans = (void *)(request->channels + n_channels);
6957
6958 request->n_scan_plans = n_plans;
6959
807f8a8c 6960 i = 0;
256da02d 6961 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
807f8a8c
LC		 6962 /* user specified, bail out if channel not found */
6963 nla_for_each_nested(attr,
256da02d 6964 attrs[NL80211_ATTR_SCAN_FREQUENCIES],
807f8a8c
LC		 6965 tmp) {
6966 struct ieee80211_channel *chan;
6967
6968 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
6969
6970 if (!chan) {
6971 err = -EINVAL;
6972 goto out_free;
6973 }
6974
6975 /* ignore disabled channels */
6976 if (chan->flags & IEEE80211_CHAN_DISABLED)
6977 continue;
6978
6979 request->channels[i] = chan;
6980 i++;
6981 }
6982 } else {
6983 /* all channels */
57fbcce3 6984 for (band = 0; band < NUM_NL80211_BANDS; band++) {
807f8a8c 6985 int j;
7a087e74 6986
807f8a8c
LC		 6987 if (!wiphy->bands[band])
6988 continue;
6989 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
6990 struct ieee80211_channel *chan;
6991
6992 chan = &wiphy->bands[band]->channels[j];
6993
6994 if (chan->flags & IEEE80211_CHAN_DISABLED)
6995 continue;
6996
6997 request->channels[i] = chan;
6998 i++;
6999 }
7000 }
7001 }
7002
7003 if (!i) {
7004 err = -EINVAL;
7005 goto out_free;
7006 }
7007
7008 request->n_channels = i;
7009
7010 i = 0;
13874e4b 7011 if (n_ssids) {
256da02d 7012 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
807f8a8c 7013 tmp) {
57a27e1d 7014 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
807f8a8c
LC		 7015 err = -EINVAL;
7016 goto out_free;
7017 }
57a27e1d 7018 request->ssids[i].ssid_len = nla_len(attr);
807f8a8c
LC		 7019 memcpy(request->ssids[i].ssid, nla_data(attr),
7020 nla_len(attr));
807f8a8c
LC		 7021 i++;
7022 }
7023 }
7024
a1f1c21c 7025 i = 0;
256da02d 7026 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
a1f1c21c 7027 nla_for_each_nested(attr,
256da02d 7028 attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
a1f1c21c 7029 tmp) {
88e920b4 7030 struct nlattr *ssid, *rssi;
a1f1c21c 7031
ae811e21
JB		 7032 err = nla_parse(tb, NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7033 nla_data(attr), nla_len(attr),
7034 nl80211_match_policy);
7035 if (err)
7036 goto out_free;
4a4ab0d7 7037 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
a1f1c21c 7038 if (ssid) {
ea73cbce
JB		 7039 if (WARN_ON(i >= n_match_sets)) {
7040 /* this indicates a programming error,
7041 * the loop above should have verified
7042 * things properly
7043 */
7044 err = -EINVAL;
7045 goto out_free;
7046 }
7047
a1f1c21c
LC		 7048 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
7049 err = -EINVAL;
7050 goto out_free;
7051 }
7052 memcpy(request->match_sets[i].ssid.ssid,
7053 nla_data(ssid), nla_len(ssid));
7054 request->match_sets[i].ssid.ssid_len =
7055 nla_len(ssid);
56ab364f 7056 /* special attribute - old implementation w/a */
ea73cbce
JB		 7057 request->match_sets[i].rssi_thold =
7058 default_match_rssi;
7059 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7060 if (rssi)
7061 request->match_sets[i].rssi_thold =
7062 nla_get_s32(rssi);
a1f1c21c
LC		 7063 }
7064 i++;
7065 }
ea73cbce
JB		 7066
7067 /* there was no other matchset, so the RSSI one is alone */
f89f46cf 7068 if (i == 0 && n_match_sets)
ea73cbce
JB		 7069 request->match_sets[0].rssi_thold = default_match_rssi;
7070
7071 request->min_rssi_thold = INT_MAX;
7072 for (i = 0; i < n_match_sets; i++)
7073 request->min_rssi_thold =
7074 min(request->match_sets[i].rssi_thold,
7075 request->min_rssi_thold);
7076 } else {
7077 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
a1f1c21c
LC		 7078 }
7079
9900e484
JB		 7080 if (ie_len) {
7081 request->ie_len = ie_len;
807f8a8c 7082 memcpy((void *)request->ie,
256da02d 7083 nla_data(attrs[NL80211_ATTR_IE]),
807f8a8c
LC		 7084 request->ie_len);
7085 }
7086
256da02d 7087 if (attrs[NL80211_ATTR_SCAN_FLAGS]) {
ed473771 7088 request->flags = nla_get_u32(
256da02d 7089 attrs[NL80211_ATTR_SCAN_FLAGS]);
00c3a6ed
JB		 7090 if ((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
7091 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) {
46856bbf
SL		 7092 err = -EOPNOTSUPP;
7093 goto out_free;
7094 }
ad2b26ab
JB		 7095
7096 if (request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
7097 u32 flg = NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR;
7098
7099 if (!wdev) /* must be net-detect */
7100 flg = NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
7101
7102 if (!(wiphy->features & flg)) {
7103 err = -EOPNOTSUPP;
7104 goto out_free;
7105 }
7106
7107 if (wdev && wdev->current_bss) {
7108 err = -EOPNOTSUPP;
7109 goto out_free;
7110 }
7111
7112 err = nl80211_parse_random_mac(attrs, request->mac_addr,
7113 request->mac_addr_mask);
7114 if (err)
7115 goto out_free;
7116 }
46856bbf 7117 }
ed473771 7118
9c748934
LC		 7119 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
7120 request->delay =
7121 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
7122
3b06d277
AS		 7123 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
7124 if (err)
7125 goto out_free;
7126
15d6030b 7127 request->scan_start = jiffies;
807f8a8c 7128
256da02d 7129 return request;
807f8a8c
LC		 7130
7131out_free:
7132 kfree(request);
256da02d
LC		 7133 return ERR_PTR(err);
7134}
7135
7136static int nl80211_start_sched_scan(struct sk_buff *skb,
7137 struct genl_info *info)
7138{
7139 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7140 struct net_device *dev = info->user_ptr[1];
ad2b26ab 7141 struct wireless_dev *wdev = dev->ieee80211_ptr;
31a60ed1 7142 struct cfg80211_sched_scan_request *sched_scan_req;
256da02d
LC		 7143 int err;
7144
7145 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
7146 !rdev->ops->sched_scan_start)
7147 return -EOPNOTSUPP;
7148
7149 if (rdev->sched_scan_req)
7150 return -EINPROGRESS;
7151
31a60ed1
JR		 7152 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
7153 info->attrs);
7154
7155 err = PTR_ERR_OR_ZERO(sched_scan_req);
256da02d
LC		 7156 if (err)
7157 goto out_err;
7158
31a60ed1 7159 err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
256da02d
LC		 7160 if (err)
7161 goto out_free;
7162
31a60ed1
JR		 7163 sched_scan_req->dev = dev;
7164 sched_scan_req->wiphy = &rdev->wiphy;
7165
93a1e86c
JR		 7166 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
7167 sched_scan_req->owner_nlportid = info->snd_portid;
7168
31a60ed1 7169 rcu_assign_pointer(rdev->sched_scan_req, sched_scan_req);
256da02d
LC		 7170
7171 nl80211_send_sched_scan(rdev, dev,
7172 NL80211_CMD_START_SCHED_SCAN);
7173 return 0;
7174
7175out_free:
31a60ed1 7176 kfree(sched_scan_req);
256da02d 7177out_err:
807f8a8c
LC		 7178 return err;
7179}
7180
7181static int nl80211_stop_sched_scan(struct sk_buff *skb,
7182 struct genl_info *info)
7183{
7184 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7185
7186 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
7187 !rdev->ops->sched_scan_stop)
7188 return -EOPNOTSUPP;
7189
5fe231e8 7190 return __cfg80211_stop_sched_scan(rdev, false);
807f8a8c
LC		 7191}
7192
04f39047
SW		 7193static int nl80211_start_radar_detection(struct sk_buff *skb,
7194 struct genl_info *info)
7195{
7196 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7197 struct net_device *dev = info->user_ptr[1];
7198 struct wireless_dev *wdev = dev->ieee80211_ptr;
7199 struct cfg80211_chan_def chandef;
55f7435c 7200 enum nl80211_dfs_regions dfs_region;
31559f35 7201 unsigned int cac_time_ms;
04f39047
SW		 7202 int err;
7203
55f7435c
LR		 7204 dfs_region = reg_get_dfs_region(wdev->wiphy);
7205 if (dfs_region == NL80211_DFS_UNSET)
7206 return -EINVAL;
7207
04f39047
SW		 7208 err = nl80211_parse_chandef(rdev, info, &chandef);
7209 if (err)
7210 return err;
7211
ff311bc1
SW		 7212 if (netif_carrier_ok(dev))
7213 return -EBUSY;
7214
04f39047
SW		 7215 if (wdev->cac_started)
7216 return -EBUSY;
7217
2beb6dab 7218 err = cfg80211_chandef_dfs_required(wdev->wiphy, &chandef,
00ec75fc 7219 wdev->iftype);
04f39047
SW		 7220 if (err < 0)
7221 return err;
7222
7223 if (err == 0)
7224 return -EINVAL;
7225
fe7c3a1f 7226 if (!cfg80211_chandef_dfs_usable(wdev->wiphy, &chandef))
04f39047
SW		 7227 return -EINVAL;
7228
7229 if (!rdev->ops->start_radar_detection)
7230 return -EOPNOTSUPP;
7231
31559f35
JD		 7232 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
7233 if (WARN_ON(!cac_time_ms))
7234 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
7235
a1056b1b 7236 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
04f39047 7237 if (!err) {
9e0e2961 7238 wdev->chandef = chandef;
04f39047
SW		 7239 wdev->cac_started = true;
7240 wdev->cac_start_time = jiffies;
31559f35 7241 wdev->cac_time_ms = cac_time_ms;
04f39047 7242 }
04f39047
SW		 7243 return err;
7244}
7245
16ef1fe2
SW		 7246static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
7247{
7248 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7249 struct net_device *dev = info->user_ptr[1];
7250 struct wireless_dev *wdev = dev->ieee80211_ptr;
7251 struct cfg80211_csa_settings params;
7252 /* csa_attrs is defined static to avoid waste of stack size - this
7253 * function is called under RTNL lock, so this should not be a problem.
7254 */
7255 static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
16ef1fe2 7256 int err;
ee4bc9e7 7257 bool need_new_beacon = false;
9a774c78 7258 int len, i;
252e07ca 7259 u32 cs_count;
16ef1fe2
SW		 7260
7261 if (!rdev->ops->channel_switch ||
7262 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
7263 return -EOPNOTSUPP;
7264
ee4bc9e7
SW		 7265 switch (dev->ieee80211_ptr->iftype) {
7266 case NL80211_IFTYPE_AP:
7267 case NL80211_IFTYPE_P2P_GO:
7268 need_new_beacon = true;
7269
7270 /* useless if AP is not running */
7271 if (!wdev->beacon_interval)
1ff79dfa 7272 return -ENOTCONN;
ee4bc9e7
SW		 7273 break;
7274 case NL80211_IFTYPE_ADHOC:
1ff79dfa
JB		 7275 if (!wdev->ssid_len)
7276 return -ENOTCONN;
7277 break;
c6da674a 7278 case NL80211_IFTYPE_MESH_POINT:
1ff79dfa
JB		 7279 if (!wdev->mesh_id_len)
7280 return -ENOTCONN;
ee4bc9e7
SW		 7281 break;
7282 default:
16ef1fe2 7283 return -EOPNOTSUPP;
ee4bc9e7 7284 }
16ef1fe2
SW		 7285
7286 memset(&params, 0, sizeof(params));
7287
7288 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
7289 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
7290 return -EINVAL;
7291
7292 /* only important for AP, IBSS and mesh create IEs internally */
d0a361a5 7293 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
16ef1fe2
SW		 7294 return -EINVAL;
7295
252e07ca
LC		 7296 /* Even though the attribute is u32, the specification says
7297 * u8, so let's make sure we don't overflow.
7298 */
7299 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
7300 if (cs_count > 255)
7301 return -EINVAL;
7302
7303 params.count = cs_count;
16ef1fe2 7304
ee4bc9e7
SW		 7305 if (!need_new_beacon)
7306 goto skip_beacons;
7307
16ef1fe2
SW		 7308 err = nl80211_parse_beacon(info->attrs, &params.beacon_after);
7309 if (err)
7310 return err;
7311
7312 err = nla_parse_nested(csa_attrs, NL80211_ATTR_MAX,
7313 info->attrs[NL80211_ATTR_CSA_IES],
7314 nl80211_policy);
7315 if (err)
7316 return err;
7317
7318 err = nl80211_parse_beacon(csa_attrs, &params.beacon_csa);
7319 if (err)
7320 return err;
7321
7322 if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
7323 return -EINVAL;
7324
9a774c78
AO		 7325 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7326 if (!len || (len % sizeof(u16)))
16ef1fe2
SW		 7327 return -EINVAL;
7328
9a774c78
AO		 7329 params.n_counter_offsets_beacon = len / sizeof(u16);
7330 if (rdev->wiphy.max_num_csa_counters &&
7331 (params.n_counter_offsets_beacon >
7332 rdev->wiphy.max_num_csa_counters))
16ef1fe2
SW		 7333 return -EINVAL;
7334
9a774c78
AO		 7335 params.counter_offsets_beacon =
7336 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7337
7338 /* sanity checks - counters should fit and be the same */
7339 for (i = 0; i < params.n_counter_offsets_beacon; i++) {
7340 u16 offset = params.counter_offsets_beacon[i];
7341
7342 if (offset >= params.beacon_csa.tail_len)
7343 return -EINVAL;
7344
7345 if (params.beacon_csa.tail[offset] != params.count)
7346 return -EINVAL;
7347 }
7348
16ef1fe2 7349 if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
9a774c78
AO		 7350 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7351 if (!len || (len % sizeof(u16)))
16ef1fe2
SW		 7352 return -EINVAL;
7353
9a774c78
AO		 7354 params.n_counter_offsets_presp = len / sizeof(u16);
7355 if (rdev->wiphy.max_num_csa_counters &&
7356 (params.n_counter_offsets_beacon >
7357 rdev->wiphy.max_num_csa_counters))
16ef1fe2 7358 return -EINVAL;
9a774c78
AO		 7359
7360 params.counter_offsets_presp =
7361 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7362
7363 /* sanity checks - counters should fit and be the same */
7364 for (i = 0; i < params.n_counter_offsets_presp; i++) {
7365 u16 offset = params.counter_offsets_presp[i];
7366
7367 if (offset >= params.beacon_csa.probe_resp_len)
7368 return -EINVAL;
7369
7370 if (params.beacon_csa.probe_resp[offset] !=
7371 params.count)
7372 return -EINVAL;
7373 }
16ef1fe2
SW		 7374 }
7375
ee4bc9e7 7376skip_beacons:
16ef1fe2
SW		 7377 err = nl80211_parse_chandef(rdev, info, &params.chandef);
7378 if (err)
7379 return err;
7380
923b352f
AN		 7381 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
7382 wdev->iftype))
16ef1fe2
SW		 7383 return -EINVAL;
7384
2beb6dab
LC		 7385 err = cfg80211_chandef_dfs_required(wdev->wiphy,
7386 &params.chandef,
7387 wdev->iftype);
7388 if (err < 0)
7389 return err;
7390
dcc6c2f5 7391 if (err > 0)
2beb6dab 7392 params.radar_required = true;
16ef1fe2 7393
16ef1fe2
SW		 7394 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
7395 params.block_tx = true;
7396
c56589ed
SW		 7397 wdev_lock(wdev);
7398 err = rdev_channel_switch(rdev, dev, &params);
7399 wdev_unlock(wdev);
7400
7401 return err;
16ef1fe2
SW		 7402}
7403
9720bb3a
JB		 7404static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
7405 u32 seq, int flags,
2a519311 7406 struct cfg80211_registered_device *rdev,
48ab905d
JB		 7407 struct wireless_dev *wdev,
7408 struct cfg80211_internal_bss *intbss)
2a519311 7409{
48ab905d 7410 struct cfg80211_bss *res = &intbss->pub;
9caf0364 7411 const struct cfg80211_bss_ies *ies;
2a519311
JB		 7412 void *hdr;
7413 struct nlattr *bss;
48ab905d
JB		 7414
7415 ASSERT_WDEV_LOCK(wdev);
2a519311 7416
15e47304 7417 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
2a519311
JB		 7418 NL80211_CMD_NEW_SCAN_RESULTS);
7419 if (!hdr)
7420 return -1;
7421
9720bb3a
JB		 7422 genl_dump_check_consistent(cb, hdr, &nl80211_fam);
7423
97990a06
JB		 7424 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
7425 goto nla_put_failure;
7426 if (wdev->netdev &&
9360ffd1
DM		 7427 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
7428 goto nla_put_failure;
2dad624e
ND		 7429 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
7430 NL80211_ATTR_PAD))
97990a06 7431 goto nla_put_failure;
2a519311
JB		 7432
7433 bss = nla_nest_start(msg, NL80211_ATTR_BSS);
7434 if (!bss)
7435 goto nla_put_failure;
9360ffd1 7436 if ((!is_zero_ether_addr(res->bssid) &&
9caf0364 7437 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
9360ffd1 7438 goto nla_put_failure;
9caf0364
JB		 7439
7440 rcu_read_lock();
0e227084
JB		 7441 /* indicate whether we have probe response data or not */
7442 if (rcu_access_pointer(res->proberesp_ies) &&
7443 nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
7444 goto fail_unlock_rcu;
7445
7446 /* this pointer prefers to be pointed to probe response data
7447 * but is always valid
7448 */
9caf0364 7449 ies = rcu_dereference(res->ies);
8cef2c9d 7450 if (ies) {
2dad624e
ND		 7451 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
7452 NL80211_BSS_PAD))
8cef2c9d 7453 goto fail_unlock_rcu;
8cef2c9d
JB		 7454 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
7455 ies->len, ies->data))
7456 goto fail_unlock_rcu;
9caf0364 7457 }
0e227084
JB		 7458
7459 /* and this pointer is always (unless driver didn't know) beacon data */
9caf0364 7460 ies = rcu_dereference(res->beacon_ies);
0e227084 7461 if (ies && ies->from_beacon) {
2dad624e
ND		 7462 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
7463 NL80211_BSS_PAD))
8cef2c9d
JB		 7464 goto fail_unlock_rcu;
7465 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
7466 ies->len, ies->data))
7467 goto fail_unlock_rcu;
9caf0364
JB		 7468 }
7469 rcu_read_unlock();
7470
9360ffd1
DM		 7471 if (res->beacon_interval &&
7472 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
7473 goto nla_put_failure;
7474 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
7475 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
dcd6eac1 7476 nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
9360ffd1
DM		 7477 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
7478 jiffies_to_msecs(jiffies - intbss->ts)))
7479 goto nla_put_failure;
2a519311 7480
1d76250b
AS		 7481 if (intbss->parent_tsf &&
7482 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
7483 intbss->parent_tsf, NL80211_BSS_PAD) ||
7484 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
7485 intbss->parent_bssid)))
7486 goto nla_put_failure;
7487
6e19bc4b 7488 if (intbss->ts_boottime &&
2dad624e
ND		 7489 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
7490 intbss->ts_boottime, NL80211_BSS_PAD))
6e19bc4b
DS		 7491 goto nla_put_failure;
7492
77965c97 7493 switch (rdev->wiphy.signal_type) {
2a519311 7494 case CFG80211_SIGNAL_TYPE_MBM:
9360ffd1
DM		 7495 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
7496 goto nla_put_failure;
2a519311
JB		 7497 break;
7498 case CFG80211_SIGNAL_TYPE_UNSPEC:
9360ffd1
DM		 7499 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
7500 goto nla_put_failure;
2a519311
JB		 7501 break;
7502 default:
7503 break;
7504 }
7505
48ab905d 7506 switch (wdev->iftype) {
074ac8df 7507 case NL80211_IFTYPE_P2P_CLIENT:
48ab905d 7508 case NL80211_IFTYPE_STATION:
9360ffd1
DM		 7509 if (intbss == wdev->current_bss &&
7510 nla_put_u32(msg, NL80211_BSS_STATUS,
7511 NL80211_BSS_STATUS_ASSOCIATED))
7512 goto nla_put_failure;
48ab905d
JB		 7513 break;
7514 case NL80211_IFTYPE_ADHOC:
9360ffd1
DM		 7515 if (intbss == wdev->current_bss &&
7516 nla_put_u32(msg, NL80211_BSS_STATUS,
7517 NL80211_BSS_STATUS_IBSS_JOINED))
7518 goto nla_put_failure;
48ab905d
JB		 7519 break;
7520 default:
7521 break;
7522 }
7523
2a519311
JB		 7524 nla_nest_end(msg, bss);
7525
053c095a
JB		 7526 genlmsg_end(msg, hdr);
7527 return 0;
2a519311 7528
8cef2c9d
JB		 7529 fail_unlock_rcu:
7530 rcu_read_unlock();
2a519311
JB		 7531 nla_put_failure:
7532 genlmsg_cancel(msg, hdr);
7533 return -EMSGSIZE;
7534}
7535
97990a06 7536static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
2a519311 7537{
48ab905d 7538 struct cfg80211_registered_device *rdev;
2a519311 7539 struct cfg80211_internal_bss *scan;
48ab905d 7540 struct wireless_dev *wdev;
97990a06 7541 int start = cb->args[2], idx = 0;
2a519311
JB		 7542 int err;
7543
97990a06 7544 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
67748893
JB		 7545 if (err)
7546 return err;
2a519311 7547
48ab905d
JB		 7548 wdev_lock(wdev);
7549 spin_lock_bh(&rdev->bss_lock);
7550 cfg80211_bss_expire(rdev);
7551
9720bb3a
JB		 7552 cb->seq = rdev->bss_generation;
7553
48ab905d 7554 list_for_each_entry(scan, &rdev->bss_list, list) {
2a519311
JB		 7555 if (++idx <= start)
7556 continue;
9720bb3a 7557 if (nl80211_send_bss(skb, cb,
2a519311 7558 cb->nlh->nlmsg_seq, NLM_F_MULTI,
48ab905d 7559 rdev, wdev, scan) < 0) {
2a519311 7560 idx--;
67748893 7561 break;
2a519311
JB		 7562 }
7563 }
7564
48ab905d
JB		 7565 spin_unlock_bh(&rdev->bss_lock);
7566 wdev_unlock(wdev);
2a519311 7567
97990a06
JB		 7568 cb->args[2] = idx;
7569 nl80211_finish_wdev_dump(rdev);
2a519311 7570
67748893 7571 return skb->len;
2a519311
JB		 7572}
7573
15e47304 7574static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
11f78ac3
JB		 7575 int flags, struct net_device *dev,
7576 bool allow_radio_stats,
7577 struct survey_info *survey)
61fa713c
HS		 7578{
7579 void *hdr;
7580 struct nlattr *infoattr;
7581
11f78ac3
JB		 7582 /* skip radio stats if userspace didn't request them */
7583 if (!survey->channel && !allow_radio_stats)
7584 return 0;
7585
15e47304 7586 hdr = nl80211hdr_put(msg, portid, seq, flags,
61fa713c
HS		 7587 NL80211_CMD_NEW_SURVEY_RESULTS);
7588 if (!hdr)
7589 return -ENOMEM;
7590
9360ffd1
DM		 7591 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
7592 goto nla_put_failure;
61fa713c
HS		 7593
7594 infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
7595 if (!infoattr)
7596 goto nla_put_failure;
7597
11f78ac3
JB		 7598 if (survey->channel &&
7599 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
9360ffd1
DM		 7600 survey->channel->center_freq))
7601 goto nla_put_failure;
7602
7603 if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
7604 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
7605 goto nla_put_failure;
7606 if ((survey->filled & SURVEY_INFO_IN_USE) &&
7607 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
7608 goto nla_put_failure;
4ed20beb 7609 if ((survey->filled & SURVEY_INFO_TIME) &&
2dad624e
ND		 7610 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
7611 survey->time, NL80211_SURVEY_INFO_PAD))
9360ffd1 7612 goto nla_put_failure;
4ed20beb 7613 if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
2dad624e
ND		 7614 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
7615 survey->time_busy, NL80211_SURVEY_INFO_PAD))
9360ffd1 7616 goto nla_put_failure;
4ed20beb 7617 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
2dad624e
ND		 7618 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
7619 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
9360ffd1 7620 goto nla_put_failure;
4ed20beb 7621 if ((survey->filled & SURVEY_INFO_TIME_RX) &&
2dad624e
ND		 7622 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
7623 survey->time_rx, NL80211_SURVEY_INFO_PAD))
9360ffd1 7624 goto nla_put_failure;
4ed20beb 7625 if ((survey->filled & SURVEY_INFO_TIME_TX) &&
2dad624e
ND		 7626 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
7627 survey->time_tx, NL80211_SURVEY_INFO_PAD))
9360ffd1 7628 goto nla_put_failure;
052536ab 7629 if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
2dad624e
ND		 7630 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
7631 survey->time_scan, NL80211_SURVEY_INFO_PAD))
052536ab 7632 goto nla_put_failure;
61fa713c
HS		 7633
7634 nla_nest_end(msg, infoattr);
7635
053c095a
JB		 7636 genlmsg_end(msg, hdr);
7637 return 0;
61fa713c
HS		 7638
7639 nla_put_failure:
7640 genlmsg_cancel(msg, hdr);
7641 return -EMSGSIZE;
7642}
7643
11f78ac3 7644static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
61fa713c
HS		 7645{
7646 struct survey_info survey;
1b8ec87a 7647 struct cfg80211_registered_device *rdev;
97990a06
JB		 7648 struct wireless_dev *wdev;
7649 int survey_idx = cb->args[2];
61fa713c 7650 int res;
11f78ac3 7651 bool radio_stats;
61fa713c 7652
1b8ec87a 7653 res = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
67748893
JB		 7654 if (res)
7655 return res;
61fa713c 7656
11f78ac3
JB		 7657 /* prepare_wdev_dump parsed the attributes */
7658 radio_stats = nl80211_fam.attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
7659
97990a06
JB		 7660 if (!wdev->netdev) {
7661 res = -EINVAL;
7662 goto out_err;
7663 }
7664
1b8ec87a 7665 if (!rdev->ops->dump_survey) {
61fa713c
HS		 7666 res = -EOPNOTSUPP;
7667 goto out_err;
7668 }
7669
7670 while (1) {
1b8ec87a 7671 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
61fa713c
HS		 7672 if (res == -ENOENT)
7673 break;
7674 if (res)
7675 goto out_err;
7676
11f78ac3
JB		 7677 /* don't send disabled channels, but do send non-channel data */
7678 if (survey.channel &&
7679 survey.channel->flags & IEEE80211_CHAN_DISABLED) {
180cdc79
LR		 7680 survey_idx++;
7681 continue;
7682 }
7683
61fa713c 7684 if (nl80211_send_survey(skb,
15e47304 7685 NETLINK_CB(cb->skb).portid,
61fa713c 7686 cb->nlh->nlmsg_seq, NLM_F_MULTI,
11f78ac3 7687 wdev->netdev, radio_stats, &survey) < 0)
61fa713c
HS		 7688 goto out;
7689 survey_idx++;
7690 }
7691
7692 out:
97990a06 7693 cb->args[2] = survey_idx;
61fa713c
HS		 7694 res = skb->len;
7695 out_err:
1b8ec87a 7696 nl80211_finish_wdev_dump(rdev);
61fa713c
HS		 7697 return res;
7698}
7699
b23aa676
SO		 7700static bool nl80211_valid_wpa_versions(u32 wpa_versions)
7701{
7702 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
7703 NL80211_WPA_VERSION_2));
7704}
7705
636a5d36
JM		 7706static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
7707{
4c476991
JB		 7708 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7709 struct net_device *dev = info->user_ptr[1];
19957bb3 7710 struct ieee80211_channel *chan;
e39e5b5e
JM		 7711 const u8 *bssid, *ssid, *ie = NULL, *sae_data = NULL;
7712 int err, ssid_len, ie_len = 0, sae_data_len = 0;
19957bb3 7713 enum nl80211_auth_type auth_type;
fffd0934 7714 struct key_parse key;
d5cdfacb 7715 bool local_state_change;
636a5d36 7716
f4a11bb0
JB		 7717 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
7718 return -EINVAL;
7719
7720 if (!info->attrs[NL80211_ATTR_MAC])
7721 return -EINVAL;
7722
1778092e
JM		 7723 if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
7724 return -EINVAL;
7725
19957bb3
JB		 7726 if (!info->attrs[NL80211_ATTR_SSID])
7727 return -EINVAL;
7728
7729 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
7730 return -EINVAL;
7731
fffd0934
JB		 7732 err = nl80211_parse_key(info, &key);
7733 if (err)
7734 return err;
7735
7736 if (key.idx >= 0) {
e31b8213
JB		 7737 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
7738 return -EINVAL;
fffd0934
JB		 7739 if (!key.p.key || !key.p.key_len)
7740 return -EINVAL;
7741 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
7742 key.p.key_len != WLAN_KEY_LEN_WEP40) &&
7743 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
7744 key.p.key_len != WLAN_KEY_LEN_WEP104))
7745 return -EINVAL;
b6b5555b 7746 if (key.idx > 3)
fffd0934
JB		 7747 return -EINVAL;
7748 } else {
7749 key.p.key_len = 0;
7750 key.p.key = NULL;
7751 }
7752
afea0b7a
JB		 7753 if (key.idx >= 0) {
7754 int i;
7755 bool ok = false;
7a087e74 7756
afea0b7a
JB		 7757 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
7758 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
7759 ok = true;
7760 break;
7761 }
7762 }
4c476991
JB		 7763 if (!ok)
7764 return -EINVAL;
afea0b7a
JB		 7765 }
7766
4c476991
JB		 7767 if (!rdev->ops->auth)
7768 return -EOPNOTSUPP;
636a5d36 7769
074ac8df 7770 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 7771 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
7772 return -EOPNOTSUPP;
eec60b03 7773
19957bb3 7774 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
664834de
JM		 7775 chan = nl80211_get_valid_chan(&rdev->wiphy,
7776 info->attrs[NL80211_ATTR_WIPHY_FREQ]);
7777 if (!chan)
4c476991 7778 return -EINVAL;
636a5d36 7779
19957bb3
JB		 7780 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
7781 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
636a5d36
JM		 7782
7783 if (info->attrs[NL80211_ATTR_IE]) {
19957bb3
JB		 7784 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
7785 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
636a5d36
JM		 7786 }
7787
19957bb3 7788 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
e39e5b5e 7789 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
4c476991 7790 return -EINVAL;
636a5d36 7791
e39e5b5e
JM		 7792 if (auth_type == NL80211_AUTHTYPE_SAE &&
7793 !info->attrs[NL80211_ATTR_SAE_DATA])
7794 return -EINVAL;
7795
7796 if (info->attrs[NL80211_ATTR_SAE_DATA]) {
7797 if (auth_type != NL80211_AUTHTYPE_SAE)
7798 return -EINVAL;
7799 sae_data = nla_data(info->attrs[NL80211_ATTR_SAE_DATA]);
7800 sae_data_len = nla_len(info->attrs[NL80211_ATTR_SAE_DATA]);
7801 /* need to include at least Auth Transaction and Status Code */
7802 if (sae_data_len < 4)
7803 return -EINVAL;
7804 }
7805
d5cdfacb
JM		 7806 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
7807
95de817b
JB		 7808 /*
7809 * Since we no longer track auth state, ignore
7810 * requests to only change local state.
7811 */
7812 if (local_state_change)
7813 return 0;
7814
91bf9b26
JB		 7815 wdev_lock(dev->ieee80211_ptr);
7816 err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
7817 ssid, ssid_len, ie, ie_len,
7818 key.p.key, key.p.key_len, key.idx,
7819 sae_data, sae_data_len);
7820 wdev_unlock(dev->ieee80211_ptr);
7821 return err;
636a5d36
JM		 7822}
7823
c0692b8f
JB		 7824static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
7825 struct genl_info *info,
3dc27d25
JB		 7826 struct cfg80211_crypto_settings *settings,
7827 int cipher_limit)
b23aa676 7828{
c0b2bbd8
JB		 7829 memset(settings, 0, sizeof(*settings));
7830
b23aa676
SO		 7831 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
7832
c0692b8f
JB		 7833 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
7834 u16 proto;
7a087e74 7835
c0692b8f
JB		 7836 proto = nla_get_u16(
7837 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
7838 settings->control_port_ethertype = cpu_to_be16(proto);
7839 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
7840 proto != ETH_P_PAE)
7841 return -EINVAL;
7842 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
7843 settings->control_port_no_encrypt = true;
7844 } else
7845 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
7846
b23aa676
SO		 7847 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
7848 void *data;
7849 int len, i;
7850
7851 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
7852 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
7853 settings->n_ciphers_pairwise = len / sizeof(u32);
7854
7855 if (len % sizeof(u32))
7856 return -EINVAL;
7857
3dc27d25 7858 if (settings->n_ciphers_pairwise > cipher_limit)
b23aa676
SO		 7859 return -EINVAL;
7860
7861 memcpy(settings->ciphers_pairwise, data, len);
7862
7863 for (i = 0; i < settings->n_ciphers_pairwise; i++)
38ba3c57
JM		 7864 if (!cfg80211_supported_cipher_suite(
7865 &rdev->wiphy,
b23aa676
SO		 7866 settings->ciphers_pairwise[i]))
7867 return -EINVAL;
7868 }
7869
7870 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
7871 settings->cipher_group =
7872 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
38ba3c57
JM		 7873 if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
7874 settings->cipher_group))
b23aa676
SO		 7875 return -EINVAL;
7876 }
7877
7878 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
7879 settings->wpa_versions =
7880 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
7881 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
7882 return -EINVAL;
7883 }
7884
7885 if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
7886 void *data;
6d30240e 7887 int len;
b23aa676
SO		 7888
7889 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
7890 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
7891 settings->n_akm_suites = len / sizeof(u32);
7892
7893 if (len % sizeof(u32))
7894 return -EINVAL;
7895
1b9ca027
JM		 7896 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
7897 return -EINVAL;
7898
b23aa676 7899 memcpy(settings->akm_suites, data, len);
b23aa676
SO		 7900 }
7901
7902 return 0;
7903}
7904
636a5d36
JM		 7905static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
7906{
4c476991
JB		 7907 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7908 struct net_device *dev = info->user_ptr[1];
f444de05 7909 struct ieee80211_channel *chan;
f62fab73
JB		 7910 struct cfg80211_assoc_request req = {};
7911 const u8 *bssid, *ssid;
7912 int err, ssid_len = 0;
636a5d36 7913
f4a11bb0
JB		 7914 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
7915 return -EINVAL;
7916
7917 if (!info->attrs[NL80211_ATTR_MAC] ||
19957bb3
JB		 7918 !info->attrs[NL80211_ATTR_SSID] ||
7919 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
f4a11bb0
JB		 7920 return -EINVAL;
7921
4c476991
JB		 7922 if (!rdev->ops->assoc)
7923 return -EOPNOTSUPP;
636a5d36 7924
074ac8df 7925 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 7926 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
7927 return -EOPNOTSUPP;
eec60b03 7928
19957bb3 7929 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
636a5d36 7930
664834de
JM		 7931 chan = nl80211_get_valid_chan(&rdev->wiphy,
7932 info->attrs[NL80211_ATTR_WIPHY_FREQ]);
7933 if (!chan)
4c476991 7934 return -EINVAL;
636a5d36 7935
19957bb3
JB		 7936 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
7937 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
636a5d36
JM		 7938
7939 if (info->attrs[NL80211_ATTR_IE]) {
f62fab73
JB		 7940 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
7941 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
636a5d36
JM		 7942 }
7943
dc6382ce 7944 if (info->attrs[NL80211_ATTR_USE_MFP]) {
4f5dadce 7945 enum nl80211_mfp mfp =
dc6382ce 7946 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
4f5dadce 7947 if (mfp == NL80211_MFP_REQUIRED)
f62fab73 7948 req.use_mfp = true;
4c476991
JB		 7949 else if (mfp != NL80211_MFP_NO)
7950 return -EINVAL;
dc6382ce
JM		 7951 }
7952
3e5d7649 7953 if (info->attrs[NL80211_ATTR_PREV_BSSID])
f62fab73 7954 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
3e5d7649 7955
7e7c8926 7956 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
f62fab73 7957 req.flags |= ASSOC_REQ_DISABLE_HT;
7e7c8926
BG		 7958
7959 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
f62fab73
JB		 7960 memcpy(&req.ht_capa_mask,
7961 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
7962 sizeof(req.ht_capa_mask));
7e7c8926
BG		 7963
7964 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
f62fab73 7965 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
7e7c8926 7966 return -EINVAL;
f62fab73
JB		 7967 memcpy(&req.ht_capa,
7968 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
7969 sizeof(req.ht_capa));
7e7c8926
BG		 7970 }
7971
ee2aca34 7972 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
f62fab73 7973 req.flags |= ASSOC_REQ_DISABLE_VHT;
ee2aca34
JB		 7974
7975 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
f62fab73
JB		 7976 memcpy(&req.vht_capa_mask,
7977 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
7978 sizeof(req.vht_capa_mask));
ee2aca34
JB		 7979
7980 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
f62fab73 7981 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
ee2aca34 7982 return -EINVAL;
f62fab73
JB		 7983 memcpy(&req.vht_capa,
7984 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
7985 sizeof(req.vht_capa));
ee2aca34
JB		 7986 }
7987
bab5ab7d 7988 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
0c9ca11b
BL		 7989 if (!((rdev->wiphy.features &
7990 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
7991 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
7992 !wiphy_ext_feature_isset(&rdev->wiphy,
7993 NL80211_EXT_FEATURE_RRM))
bab5ab7d
AK		 7994 return -EINVAL;
7995 req.flags |= ASSOC_REQ_USE_RRM;
7996 }
7997
f62fab73 7998 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
91bf9b26
JB		 7999 if (!err) {
8000 wdev_lock(dev->ieee80211_ptr);
f62fab73
JB		 8001 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
8002 ssid, ssid_len, &req);
91bf9b26
JB		 8003 wdev_unlock(dev->ieee80211_ptr);
8004 }
636a5d36 8005
636a5d36
JM		 8006 return err;
8007}
8008
8009static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
8010{
4c476991
JB		 8011 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8012 struct net_device *dev = info->user_ptr[1];
19957bb3 8013 const u8 *ie = NULL, *bssid;
91bf9b26 8014 int ie_len = 0, err;
19957bb3 8015 u16 reason_code;
d5cdfacb 8016 bool local_state_change;
636a5d36 8017
f4a11bb0
JB		 8018 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8019 return -EINVAL;
8020
8021 if (!info->attrs[NL80211_ATTR_MAC])
8022 return -EINVAL;
8023
8024 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8025 return -EINVAL;
8026
4c476991
JB		 8027 if (!rdev->ops->deauth)
8028 return -EOPNOTSUPP;
636a5d36 8029
074ac8df 8030 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 8031 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8032 return -EOPNOTSUPP;
eec60b03 8033
19957bb3 8034 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
636a5d36 8035
19957bb3
JB		 8036 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8037 if (reason_code == 0) {
f4a11bb0 8038 /* Reason Code 0 is reserved */
4c476991 8039 return -EINVAL;
255e737e 8040 }
636a5d36
JM		 8041
8042 if (info->attrs[NL80211_ATTR_IE]) {
19957bb3
JB		 8043 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8044 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
636a5d36
JM		 8045 }
8046
d5cdfacb
JM		 8047 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8048
91bf9b26
JB		 8049 wdev_lock(dev->ieee80211_ptr);
8050 err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
8051 local_state_change);
8052 wdev_unlock(dev->ieee80211_ptr);
8053 return err;
636a5d36
JM		 8054}
8055
8056static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
8057{
4c476991
JB		 8058 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8059 struct net_device *dev = info->user_ptr[1];
19957bb3 8060 const u8 *ie = NULL, *bssid;
91bf9b26 8061 int ie_len = 0, err;
19957bb3 8062 u16 reason_code;
d5cdfacb 8063 bool local_state_change;
636a5d36 8064
f4a11bb0
JB		 8065 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8066 return -EINVAL;
8067
8068 if (!info->attrs[NL80211_ATTR_MAC])
8069 return -EINVAL;
8070
8071 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8072 return -EINVAL;
8073
4c476991
JB		 8074 if (!rdev->ops->disassoc)
8075 return -EOPNOTSUPP;
636a5d36 8076
074ac8df 8077 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 8078 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8079 return -EOPNOTSUPP;
eec60b03 8080
19957bb3 8081 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
636a5d36 8082
19957bb3
JB		 8083 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8084 if (reason_code == 0) {
f4a11bb0 8085 /* Reason Code 0 is reserved */
4c476991 8086 return -EINVAL;
255e737e 8087 }
636a5d36
JM		 8088
8089 if (info->attrs[NL80211_ATTR_IE]) {
19957bb3
JB		 8090 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8091 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
636a5d36
JM		 8092 }
8093
d5cdfacb
JM		 8094 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8095
91bf9b26
JB		 8096 wdev_lock(dev->ieee80211_ptr);
8097 err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
8098 local_state_change);
8099 wdev_unlock(dev->ieee80211_ptr);
8100 return err;
636a5d36
JM		 8101}
8102
dd5b4cc7
FF		 8103static bool
8104nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
57fbcce3 8105 int mcast_rate[NUM_NL80211_BANDS],
dd5b4cc7
FF		 8106 int rateval)
8107{
8108 struct wiphy *wiphy = &rdev->wiphy;
8109 bool found = false;
8110 int band, i;
8111
57fbcce3 8112 for (band = 0; band < NUM_NL80211_BANDS; band++) {
dd5b4cc7
FF		 8113 struct ieee80211_supported_band *sband;
8114
8115 sband = wiphy->bands[band];
8116 if (!sband)
8117 continue;
8118
8119 for (i = 0; i < sband->n_bitrates; i++) {
8120 if (sband->bitrates[i].bitrate == rateval) {
8121 mcast_rate[band] = i + 1;
8122 found = true;
8123 break;
8124 }
8125 }
8126 }
8127
8128 return found;
8129}
8130
04a773ad
JB		 8131static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
8132{
4c476991
JB		 8133 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8134 struct net_device *dev = info->user_ptr[1];
04a773ad
JB		 8135 struct cfg80211_ibss_params ibss;
8136 struct wiphy *wiphy;
fffd0934 8137 struct cfg80211_cached_keys *connkeys = NULL;
04a773ad
JB		 8138 int err;
8139
8e30bc55
JB		 8140 memset(&ibss, 0, sizeof(ibss));
8141
04a773ad
JB		 8142 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8143 return -EINVAL;
8144
683b6d3b 8145 if (!info->attrs[NL80211_ATTR_SSID] ||
04a773ad
JB		 8146 !nla_len(info->attrs[NL80211_ATTR_SSID]))
8147 return -EINVAL;
8148
8e30bc55
JB		 8149 ibss.beacon_interval = 100;
8150
12d20fc9 8151 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
8e30bc55
JB		 8152 ibss.beacon_interval =
8153 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
12d20fc9
PK		 8154
8155 err = cfg80211_validate_beacon_int(rdev, ibss.beacon_interval);
8156 if (err)
8157 return err;
8e30bc55 8158
4c476991
JB		 8159 if (!rdev->ops->join_ibss)
8160 return -EOPNOTSUPP;
04a773ad 8161
4c476991
JB		 8162 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8163 return -EOPNOTSUPP;
04a773ad 8164
79c97e97 8165 wiphy = &rdev->wiphy;
04a773ad 8166
39193498 8167 if (info->attrs[NL80211_ATTR_MAC]) {
04a773ad 8168 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
39193498
JB		 8169
8170 if (!is_valid_ether_addr(ibss.bssid))
8171 return -EINVAL;
8172 }
04a773ad
JB		 8173 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8174 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8175
8176 if (info->attrs[NL80211_ATTR_IE]) {
8177 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8178 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8179 }
8180
683b6d3b
JB		 8181 err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
8182 if (err)
8183 return err;
04a773ad 8184
174e0cd2
IP		 8185 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
8186 NL80211_IFTYPE_ADHOC))
54858ee5
AS		 8187 return -EINVAL;
8188
2f301ab2 8189 switch (ibss.chandef.width) {
bf372645
SW		 8190 case NL80211_CHAN_WIDTH_5:
8191 case NL80211_CHAN_WIDTH_10:
2f301ab2
SW		 8192 case NL80211_CHAN_WIDTH_20_NOHT:
8193 break;
8194 case NL80211_CHAN_WIDTH_20:
8195 case NL80211_CHAN_WIDTH_40:
ffc11991
JD		 8196 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8197 return -EINVAL;
8198 break;
8199 case NL80211_CHAN_WIDTH_80:
8200 case NL80211_CHAN_WIDTH_80P80:
8201 case NL80211_CHAN_WIDTH_160:
8202 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8203 return -EINVAL;
8204 if (!wiphy_ext_feature_isset(&rdev->wiphy,
8205 NL80211_EXT_FEATURE_VHT_IBSS))
8206 return -EINVAL;
8207 break;
2f301ab2 8208 default:
c04d6150 8209 return -EINVAL;
2f301ab2 8210 }
db9c64cf 8211
04a773ad 8212 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
fffd0934
JB		 8213 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
8214
fbd2c8dc
TP		 8215 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
8216 u8 *rates =
8217 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8218 int n_rates =
8219 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8220 struct ieee80211_supported_band *sband =
683b6d3b 8221 wiphy->bands[ibss.chandef.chan->band];
fbd2c8dc 8222
34850ab2
JB		 8223 err = ieee80211_get_ratemask(sband, rates, n_rates,
8224 &ibss.basic_rates);
8225 if (err)
8226 return err;
fbd2c8dc 8227 }
dd5b4cc7 8228
803768f5
SW		 8229 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8230 memcpy(&ibss.ht_capa_mask,
8231 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8232 sizeof(ibss.ht_capa_mask));
8233
8234 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8235 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8236 return -EINVAL;
8237 memcpy(&ibss.ht_capa,
8238 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8239 sizeof(ibss.ht_capa));
8240 }
8241
dd5b4cc7
FF		 8242 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
8243 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
8244 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
8245 return -EINVAL;
fbd2c8dc 8246
4c476991 8247 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
de7044ee
SM		 8248 bool no_ht = false;
8249
4c476991 8250 connkeys = nl80211_parse_connkeys(rdev,
de7044ee
SM		 8251 info->attrs[NL80211_ATTR_KEYS],
8252 &no_ht);
4c476991
JB		 8253 if (IS_ERR(connkeys))
8254 return PTR_ERR(connkeys);
de7044ee 8255
3d9d1d66
JB		 8256 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
8257 no_ht) {
5e950a78 8258 kzfree(connkeys);
de7044ee
SM		 8259 return -EINVAL;
8260 }
4c476991 8261 }
04a773ad 8262
267335d6
AQ		 8263 ibss.control_port =
8264 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
8265
5336fa88
SW		 8266 ibss.userspace_handles_dfs =
8267 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
8268
4c476991 8269 err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
fffd0934 8270 if (err)
b47f610b 8271 kzfree(connkeys);
04a773ad
JB		 8272 return err;
8273}
8274
8275static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
8276{
4c476991
JB		 8277 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8278 struct net_device *dev = info->user_ptr[1];
04a773ad 8279
4c476991
JB		 8280 if (!rdev->ops->leave_ibss)
8281 return -EOPNOTSUPP;
04a773ad 8282
4c476991
JB		 8283 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8284 return -EOPNOTSUPP;
04a773ad 8285
4c476991 8286 return cfg80211_leave_ibss(rdev, dev, false);
04a773ad
JB		 8287}
8288
f4e583c8
AQ		 8289static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
8290{
8291 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8292 struct net_device *dev = info->user_ptr[1];
57fbcce3 8293 int mcast_rate[NUM_NL80211_BANDS];
f4e583c8
AQ		 8294 u32 nla_rate;
8295 int err;
8296
8297 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
876dc930
BVB		 8298 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
8299 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
f4e583c8
AQ		 8300 return -EOPNOTSUPP;
8301
8302 if (!rdev->ops->set_mcast_rate)
8303 return -EOPNOTSUPP;
8304
8305 memset(mcast_rate, 0, sizeof(mcast_rate));
8306
8307 if (!info->attrs[NL80211_ATTR_MCAST_RATE])
8308 return -EINVAL;
8309
8310 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
8311 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
8312 return -EINVAL;
8313
a1056b1b 8314 err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
f4e583c8
AQ		 8315
8316 return err;
8317}
8318
ad7e718c
JB		 8319static struct sk_buff *
8320__cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
6c09e791
AK		 8321 struct wireless_dev *wdev, int approxlen,
8322 u32 portid, u32 seq, enum nl80211_commands cmd,
567ffc35
JB		 8323 enum nl80211_attrs attr,
8324 const struct nl80211_vendor_cmd_info *info,
8325 gfp_t gfp)
ad7e718c
JB		 8326{
8327 struct sk_buff *skb;
8328 void *hdr;
8329 struct nlattr *data;
8330
8331 skb = nlmsg_new(approxlen + 100, gfp);
8332 if (!skb)
8333 return NULL;
8334
8335 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
8336 if (!hdr) {
8337 kfree_skb(skb);
8338 return NULL;
8339 }
8340
8341 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
8342 goto nla_put_failure;
567ffc35
JB		 8343
8344 if (info) {
8345 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
8346 info->vendor_id))
8347 goto nla_put_failure;
8348 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
8349 info->subcmd))
8350 goto nla_put_failure;
8351 }
8352
6c09e791 8353 if (wdev) {
2dad624e
ND		 8354 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
8355 wdev_id(wdev), NL80211_ATTR_PAD))
6c09e791
AK		 8356 goto nla_put_failure;
8357 if (wdev->netdev &&
8358 nla_put_u32(skb, NL80211_ATTR_IFINDEX,
8359 wdev->netdev->ifindex))
8360 goto nla_put_failure;
8361 }
8362
ad7e718c 8363 data = nla_nest_start(skb, attr);
76e1fb4b
JB		 8364 if (!data)
8365 goto nla_put_failure;
ad7e718c
JB		 8366
8367 ((void **)skb->cb)[0] = rdev;
8368 ((void **)skb->cb)[1] = hdr;
8369 ((void **)skb->cb)[2] = data;
8370
8371 return skb;
8372
8373 nla_put_failure:
8374 kfree_skb(skb);
8375 return NULL;
8376}
f4e583c8 8377
e03ad6ea 8378struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
6c09e791 8379 struct wireless_dev *wdev,
e03ad6ea
JB		 8380 enum nl80211_commands cmd,
8381 enum nl80211_attrs attr,
8382 int vendor_event_idx,
8383 int approxlen, gfp_t gfp)
8384{
f26cbf40 8385 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
e03ad6ea
JB		 8386 const struct nl80211_vendor_cmd_info *info;
8387
8388 switch (cmd) {
8389 case NL80211_CMD_TESTMODE:
8390 if (WARN_ON(vendor_event_idx != -1))
8391 return NULL;
8392 info = NULL;
8393 break;
8394 case NL80211_CMD_VENDOR:
8395 if (WARN_ON(vendor_event_idx < 0 ||
8396 vendor_event_idx >= wiphy->n_vendor_events))
8397 return NULL;
8398 info = &wiphy->vendor_events[vendor_event_idx];
8399 break;
8400 default:
8401 WARN_ON(1);
8402 return NULL;
8403 }
8404
6c09e791 8405 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, 0, 0,
e03ad6ea
JB		 8406 cmd, attr, info, gfp);
8407}
8408EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
8409
8410void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
8411{
8412 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
8413 void *hdr = ((void **)skb->cb)[1];
8414 struct nlattr *data = ((void **)skb->cb)[2];
8415 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
8416
bd8c78e7
JB		 8417 /* clear CB data for netlink core to own from now on */
8418 memset(skb->cb, 0, sizeof(skb->cb));
8419
e03ad6ea
JB		 8420 nla_nest_end(skb, data);
8421 genlmsg_end(skb, hdr);
8422
8423 if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
8424 mcgrp = NL80211_MCGRP_VENDOR;
8425
8426 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), skb, 0,
8427 mcgrp, gfp);
8428}
8429EXPORT_SYMBOL(__cfg80211_send_event_skb);
8430
aff89a9b 8431#ifdef CONFIG_NL80211_TESTMODE
aff89a9b
JB		 8432static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
8433{
4c476991 8434 struct cfg80211_registered_device *rdev = info->user_ptr[0];
fc73f11f
DS		 8435 struct wireless_dev *wdev =
8436 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
aff89a9b
JB		 8437 int err;
8438
fc73f11f
DS		 8439 if (!rdev->ops->testmode_cmd)
8440 return -EOPNOTSUPP;
8441
8442 if (IS_ERR(wdev)) {
8443 err = PTR_ERR(wdev);
8444 if (err != -EINVAL)
8445 return err;
8446 wdev = NULL;
8447 } else if (wdev->wiphy != &rdev->wiphy) {
8448 return -EINVAL;
8449 }
8450
aff89a9b
JB		 8451 if (!info->attrs[NL80211_ATTR_TESTDATA])
8452 return -EINVAL;
8453
ad7e718c 8454 rdev->cur_cmd_info = info;
fc73f11f 8455 err = rdev_testmode_cmd(rdev, wdev,
aff89a9b
JB		 8456 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
8457 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
ad7e718c 8458 rdev->cur_cmd_info = NULL;
aff89a9b 8459
aff89a9b
JB		 8460 return err;
8461}
8462
71063f0e
WYG		 8463static int nl80211_testmode_dump(struct sk_buff *skb,
8464 struct netlink_callback *cb)
8465{
00918d33 8466 struct cfg80211_registered_device *rdev;
71063f0e
WYG		 8467 int err;
8468 long phy_idx;
8469 void *data = NULL;
8470 int data_len = 0;
8471
5fe231e8
JB		 8472 rtnl_lock();
8473
71063f0e
WYG		 8474 if (cb->args[0]) {
8475 /*
8476 * 0 is a valid index, but not valid for args[0],
8477 * so we need to offset by 1.
8478 */
8479 phy_idx = cb->args[0] - 1;
8480 } else {
8481 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
8482 nl80211_fam.attrbuf, nl80211_fam.maxattr,
8483 nl80211_policy);
8484 if (err)
5fe231e8 8485 goto out_err;
00918d33 8486
2bd7e35d
JB		 8487 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk),
8488 nl80211_fam.attrbuf);
8489 if (IS_ERR(rdev)) {
5fe231e8
JB		 8490 err = PTR_ERR(rdev);
8491 goto out_err;
00918d33 8492 }
2bd7e35d
JB		 8493 phy_idx = rdev->wiphy_idx;
8494 rdev = NULL;
2bd7e35d 8495
71063f0e
WYG		 8496 if (nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA])
8497 cb->args[1] =
8498 (long)nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA];
8499 }
8500
8501 if (cb->args[1]) {
8502 data = nla_data((void *)cb->args[1]);
8503 data_len = nla_len((void *)cb->args[1]);
8504 }
8505
00918d33
JB		 8506 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
8507 if (!rdev) {
5fe231e8
JB		 8508 err = -ENOENT;
8509 goto out_err;
71063f0e 8510 }
71063f0e 8511
00918d33 8512 if (!rdev->ops->testmode_dump) {
71063f0e
WYG		 8513 err = -EOPNOTSUPP;
8514 goto out_err;
8515 }
8516
8517 while (1) {
15e47304 8518 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
71063f0e
WYG		 8519 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8520 NL80211_CMD_TESTMODE);
8521 struct nlattr *tmdata;
8522
cb35fba3
DC		 8523 if (!hdr)
8524 break;
8525
9360ffd1 8526 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
71063f0e
WYG		 8527 genlmsg_cancel(skb, hdr);
8528 break;
8529 }
8530
8531 tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
8532 if (!tmdata) {
8533 genlmsg_cancel(skb, hdr);
8534 break;
8535 }
e35e4d28 8536 err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
71063f0e
WYG		 8537 nla_nest_end(skb, tmdata);
8538
8539 if (err == -ENOBUFS || err == -ENOENT) {
8540 genlmsg_cancel(skb, hdr);
8541 break;
8542 } else if (err) {
8543 genlmsg_cancel(skb, hdr);
8544 goto out_err;
8545 }
8546
8547 genlmsg_end(skb, hdr);
8548 }
8549
8550 err = skb->len;
8551 /* see above */
8552 cb->args[0] = phy_idx + 1;
8553 out_err:
5fe231e8 8554 rtnl_unlock();
71063f0e
WYG		 8555 return err;
8556}
aff89a9b
JB		 8557#endif
8558
b23aa676
SO		 8559static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
8560{
4c476991
JB		 8561 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8562 struct net_device *dev = info->user_ptr[1];
b23aa676
SO		 8563 struct cfg80211_connect_params connect;
8564 struct wiphy *wiphy;
fffd0934 8565 struct cfg80211_cached_keys *connkeys = NULL;
b23aa676
SO		 8566 int err;
8567
8568 memset(&connect, 0, sizeof(connect));
8569
8570 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8571 return -EINVAL;
8572
8573 if (!info->attrs[NL80211_ATTR_SSID] ||
8574 !nla_len(info->attrs[NL80211_ATTR_SSID]))
8575 return -EINVAL;
8576
8577 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
8578 connect.auth_type =
8579 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
e39e5b5e
JM		 8580 if (!nl80211_valid_auth_type(rdev, connect.auth_type,
8581 NL80211_CMD_CONNECT))
b23aa676
SO		 8582 return -EINVAL;
8583 } else
8584 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
8585
8586 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
8587
c0692b8f 8588 err = nl80211_crypto_settings(rdev, info, &connect.crypto,
3dc27d25 8589 NL80211_MAX_NR_CIPHER_SUITES);
b23aa676
SO		 8590 if (err)
8591 return err;
b23aa676 8592
074ac8df 8593 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 8594 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8595 return -EOPNOTSUPP;
b23aa676 8596
79c97e97 8597 wiphy = &rdev->wiphy;
b23aa676 8598
4486ea98
BS		 8599 connect.bg_scan_period = -1;
8600 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
8601 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
8602 connect.bg_scan_period =
8603 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
8604 }
8605
b23aa676
SO		 8606 if (info->attrs[NL80211_ATTR_MAC])
8607 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
1df4a510
JM		 8608 else if (info->attrs[NL80211_ATTR_MAC_HINT])
8609 connect.bssid_hint =
8610 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
b23aa676
SO		 8611 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8612 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8613
8614 if (info->attrs[NL80211_ATTR_IE]) {
8615 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8616 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8617 }
8618
cee00a95
JM		 8619 if (info->attrs[NL80211_ATTR_USE_MFP]) {
8620 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
8621 if (connect.mfp != NL80211_MFP_REQUIRED &&
8622 connect.mfp != NL80211_MFP_NO)
8623 return -EINVAL;
8624 } else {
8625 connect.mfp = NL80211_MFP_NO;
8626 }
8627
ba6fbacf
JM		 8628 if (info->attrs[NL80211_ATTR_PREV_BSSID])
8629 connect.prev_bssid =
8630 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
8631
b23aa676 8632 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
664834de
JM		 8633 connect.channel = nl80211_get_valid_chan(
8634 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8635 if (!connect.channel)
1df4a510
JM		 8636 return -EINVAL;
8637 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
664834de
JM		 8638 connect.channel_hint = nl80211_get_valid_chan(
8639 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
8640 if (!connect.channel_hint)
4c476991 8641 return -EINVAL;
b23aa676
SO		 8642 }
8643
fffd0934
JB		 8644 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
8645 connkeys = nl80211_parse_connkeys(rdev,
de7044ee 8646 info->attrs[NL80211_ATTR_KEYS], NULL);
4c476991
JB		 8647 if (IS_ERR(connkeys))
8648 return PTR_ERR(connkeys);
fffd0934
JB		 8649 }
8650
7e7c8926
BG		 8651 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
8652 connect.flags |= ASSOC_REQ_DISABLE_HT;
8653
8654 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8655 memcpy(&connect.ht_capa_mask,
8656 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8657 sizeof(connect.ht_capa_mask));
8658
8659 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
b4e4f47e 8660 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
b47f610b 8661 kzfree(connkeys);
7e7c8926 8662 return -EINVAL;
b4e4f47e 8663 }
7e7c8926
BG		 8664 memcpy(&connect.ht_capa,
8665 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8666 sizeof(connect.ht_capa));
8667 }
8668
ee2aca34
JB		 8669 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
8670 connect.flags |= ASSOC_REQ_DISABLE_VHT;
8671
8672 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
8673 memcpy(&connect.vht_capa_mask,
8674 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
8675 sizeof(connect.vht_capa_mask));
8676
8677 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
8678 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
b47f610b 8679 kzfree(connkeys);
ee2aca34
JB		 8680 return -EINVAL;
8681 }
8682 memcpy(&connect.vht_capa,
8683 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
8684 sizeof(connect.vht_capa));
8685 }
8686
bab5ab7d 8687 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
0c9ca11b
BL		 8688 if (!((rdev->wiphy.features &
8689 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
8690 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
8691 !wiphy_ext_feature_isset(&rdev->wiphy,
8692 NL80211_EXT_FEATURE_RRM)) {
707554b4 8693 kzfree(connkeys);
bab5ab7d 8694 return -EINVAL;
707554b4 8695 }
bab5ab7d
AK		 8696 connect.flags |= ASSOC_REQ_USE_RRM;
8697 }
8698
34d50519 8699 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
57fbcce3 8700 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
34d50519
LD		 8701 kzfree(connkeys);
8702 return -EOPNOTSUPP;
8703 }
8704
38de03d2
AS		 8705 if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
8706 /* bss selection makes no sense if bssid is set */
8707 if (connect.bssid) {
8708 kzfree(connkeys);
8709 return -EINVAL;
8710 }
8711
8712 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
8713 wiphy, &connect.bss_select);
8714 if (err) {
8715 kzfree(connkeys);
8716 return err;
8717 }
8718 }
8719
83739b03 8720 wdev_lock(dev->ieee80211_ptr);
4ce2bd9c
JM		 8721 err = cfg80211_connect(rdev, dev, &connect, connkeys,
8722 connect.prev_bssid);
83739b03 8723 wdev_unlock(dev->ieee80211_ptr);
fffd0934 8724 if (err)
b47f610b 8725 kzfree(connkeys);
b23aa676
SO		 8726 return err;
8727}
8728
8729static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
8730{
4c476991
JB		 8731 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8732 struct net_device *dev = info->user_ptr[1];
b23aa676 8733 u16 reason;
83739b03 8734 int ret;
b23aa676
SO		 8735
8736 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8737 reason = WLAN_REASON_DEAUTH_LEAVING;
8738 else
8739 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8740
8741 if (reason == 0)
8742 return -EINVAL;
8743
074ac8df 8744 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 8745 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8746 return -EOPNOTSUPP;
b23aa676 8747
83739b03
JB		 8748 wdev_lock(dev->ieee80211_ptr);
8749 ret = cfg80211_disconnect(rdev, dev, reason, true);
8750 wdev_unlock(dev->ieee80211_ptr);
8751 return ret;
b23aa676
SO		 8752}
8753
463d0183
JB		 8754static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
8755{
4c476991 8756 struct cfg80211_registered_device *rdev = info->user_ptr[0];
463d0183
JB		 8757 struct net *net;
8758 int err;
463d0183 8759
4b681c82
VK		 8760 if (info->attrs[NL80211_ATTR_PID]) {
8761 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
8762
8763 net = get_net_ns_by_pid(pid);
8764 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
8765 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
463d0183 8766
4b681c82
VK		 8767 net = get_net_ns_by_fd(fd);
8768 } else {
8769 return -EINVAL;
8770 }
463d0183 8771
4c476991
JB		 8772 if (IS_ERR(net))
8773 return PTR_ERR(net);
463d0183
JB		 8774
8775 err = 0;
8776
8777 /* check if anything to do */
4c476991
JB		 8778 if (!net_eq(wiphy_net(&rdev->wiphy), net))
8779 err = cfg80211_switch_netns(rdev, net);
463d0183 8780
463d0183 8781 put_net(net);
463d0183
JB		 8782 return err;
8783}
8784
67fbb16b
SO		 8785static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
8786{
4c476991 8787 struct cfg80211_registered_device *rdev = info->user_ptr[0];
67fbb16b
SO		 8788 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
8789 struct cfg80211_pmksa *pmksa) = NULL;
4c476991 8790 struct net_device *dev = info->user_ptr[1];
67fbb16b
SO		 8791 struct cfg80211_pmksa pmksa;
8792
8793 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
8794
8795 if (!info->attrs[NL80211_ATTR_MAC])
8796 return -EINVAL;
8797
8798 if (!info->attrs[NL80211_ATTR_PMKID])
8799 return -EINVAL;
8800
67fbb16b
SO		 8801 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
8802 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8803
074ac8df 8804 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 8805 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8806 return -EOPNOTSUPP;
67fbb16b
SO		 8807
8808 switch (info->genlhdr->cmd) {
8809 case NL80211_CMD_SET_PMKSA:
8810 rdev_ops = rdev->ops->set_pmksa;
8811 break;
8812 case NL80211_CMD_DEL_PMKSA:
8813 rdev_ops = rdev->ops->del_pmksa;
8814 break;
8815 default:
8816 WARN_ON(1);
8817 break;
8818 }
8819
4c476991
JB		 8820 if (!rdev_ops)
8821 return -EOPNOTSUPP;
67fbb16b 8822
4c476991 8823 return rdev_ops(&rdev->wiphy, dev, &pmksa);
67fbb16b
SO		 8824}
8825
8826static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
8827{
4c476991
JB		 8828 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8829 struct net_device *dev = info->user_ptr[1];
67fbb16b 8830
074ac8df 8831 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 8832 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8833 return -EOPNOTSUPP;
67fbb16b 8834
4c476991
JB		 8835 if (!rdev->ops->flush_pmksa)
8836 return -EOPNOTSUPP;
67fbb16b 8837
e35e4d28 8838 return rdev_flush_pmksa(rdev, dev);
67fbb16b
SO		 8839}
8840
109086ce
AN		 8841static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
8842{
8843 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8844 struct net_device *dev = info->user_ptr[1];
8845 u8 action_code, dialog_token;
df942e7b 8846 u32 peer_capability = 0;
109086ce
AN		 8847 u16 status_code;
8848 u8 *peer;
31fa97c5 8849 bool initiator;
109086ce
AN		 8850
8851 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
8852 !rdev->ops->tdls_mgmt)
8853 return -EOPNOTSUPP;
8854
8855 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
8856 !info->attrs[NL80211_ATTR_STATUS_CODE] ||
8857 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
8858 !info->attrs[NL80211_ATTR_IE] ||
8859 !info->attrs[NL80211_ATTR_MAC])
8860 return -EINVAL;
8861
8862 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
8863 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
8864 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
8865 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
31fa97c5 8866 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
df942e7b
SDU		 8867 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
8868 peer_capability =
8869 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
109086ce 8870
e35e4d28 8871 return rdev_tdls_mgmt(rdev, dev, peer, action_code,
df942e7b 8872 dialog_token, status_code, peer_capability,
31fa97c5 8873 initiator,
e35e4d28
HG		 8874 nla_data(info->attrs[NL80211_ATTR_IE]),
8875 nla_len(info->attrs[NL80211_ATTR_IE]));
109086ce
AN		 8876}
8877
8878static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
8879{
8880 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8881 struct net_device *dev = info->user_ptr[1];
8882 enum nl80211_tdls_operation operation;
8883 u8 *peer;
8884
8885 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
8886 !rdev->ops->tdls_oper)
8887 return -EOPNOTSUPP;
8888
8889 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
8890 !info->attrs[NL80211_ATTR_MAC])
8891 return -EINVAL;
8892
8893 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
8894 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
8895
e35e4d28 8896 return rdev_tdls_oper(rdev, dev, peer, operation);
109086ce
AN		 8897}
8898
9588bbd5
JM		 8899static int nl80211_remain_on_channel(struct sk_buff *skb,
8900 struct genl_info *info)
8901{
4c476991 8902 struct cfg80211_registered_device *rdev = info->user_ptr[0];
71bbc994 8903 struct wireless_dev *wdev = info->user_ptr[1];
683b6d3b 8904 struct cfg80211_chan_def chandef;
9588bbd5
JM		 8905 struct sk_buff *msg;
8906 void *hdr;
8907 u64 cookie;
683b6d3b 8908 u32 duration;
9588bbd5
JM		 8909 int err;
8910
8911 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
8912 !info->attrs[NL80211_ATTR_DURATION])
8913 return -EINVAL;
8914
8915 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
8916
ebf348fc
JB		 8917 if (!rdev->ops->remain_on_channel ||
8918 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
8919 return -EOPNOTSUPP;
8920
9588bbd5 8921 /*
ebf348fc
JB		 8922 * We should be on that channel for at least a minimum amount of
8923 * time (10ms) but no longer than the driver supports.
9588bbd5 8924 */
ebf348fc 8925 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
a293911d 8926 duration > rdev->wiphy.max_remain_on_channel_duration)
9588bbd5
JM		 8927 return -EINVAL;
8928
683b6d3b
JB		 8929 err = nl80211_parse_chandef(rdev, info, &chandef);
8930 if (err)
8931 return err;
9588bbd5
JM		 8932
8933 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4c476991
JB		 8934 if (!msg)
8935 return -ENOMEM;
9588bbd5 8936
15e47304 8937 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9588bbd5 8938 NL80211_CMD_REMAIN_ON_CHANNEL);
cb35fba3
DC		 8939 if (!hdr) {
8940 err = -ENOBUFS;
9588bbd5
JM		 8941 goto free_msg;
8942 }
8943
683b6d3b
JB		 8944 err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
8945 duration, &cookie);
9588bbd5
JM		 8946
8947 if (err)
8948 goto free_msg;
8949
2dad624e
ND		 8950 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
8951 NL80211_ATTR_PAD))
9360ffd1 8952 goto nla_put_failure;
9588bbd5
JM		 8953
8954 genlmsg_end(msg, hdr);
4c476991
JB		 8955
8956 return genlmsg_reply(msg, info);
9588bbd5
JM		 8957
8958 nla_put_failure:
8959 err = -ENOBUFS;
8960 free_msg:
8961 nlmsg_free(msg);
9588bbd5
JM		 8962 return err;
8963}
8964
8965static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
8966 struct genl_info *info)
8967{
4c476991 8968 struct cfg80211_registered_device *rdev = info->user_ptr[0];
71bbc994 8969 struct wireless_dev *wdev = info->user_ptr[1];
9588bbd5 8970 u64 cookie;
9588bbd5
JM		 8971
8972 if (!info->attrs[NL80211_ATTR_COOKIE])
8973 return -EINVAL;
8974
4c476991
JB		 8975 if (!rdev->ops->cancel_remain_on_channel)
8976 return -EOPNOTSUPP;
9588bbd5 8977
9588bbd5
JM		 8978 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
8979
e35e4d28 8980 return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
9588bbd5
JM		 8981}
8982
13ae75b1
JM		 8983static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
8984 struct genl_info *info)
8985{
13ae75b1 8986 struct cfg80211_bitrate_mask mask;
a7c7fbff 8987 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4c476991 8988 struct net_device *dev = info->user_ptr[1];
a7c7fbff 8989 int err;
13ae75b1 8990
4c476991
JB		 8991 if (!rdev->ops->set_bitrate_mask)
8992 return -EOPNOTSUPP;
13ae75b1 8993
a7c7fbff
PK		 8994 err = nl80211_parse_tx_bitrate_mask(info, &mask);
8995 if (err)
8996 return err;
13ae75b1 8997
e35e4d28 8998 return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
13ae75b1
JM		 8999}
9000
2e161f78 9001static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
026331c4 9002{
4c476991 9003 struct cfg80211_registered_device *rdev = info->user_ptr[0];
71bbc994 9004 struct wireless_dev *wdev = info->user_ptr[1];
2e161f78 9005 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
026331c4
JM		 9006
9007 if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
9008 return -EINVAL;
9009
2e161f78
JB		 9010 if (info->attrs[NL80211_ATTR_FRAME_TYPE])
9011 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
026331c4 9012
71bbc994
JB		 9013 switch (wdev->iftype) {
9014 case NL80211_IFTYPE_STATION:
9015 case NL80211_IFTYPE_ADHOC:
9016 case NL80211_IFTYPE_P2P_CLIENT:
9017 case NL80211_IFTYPE_AP:
9018 case NL80211_IFTYPE_AP_VLAN:
9019 case NL80211_IFTYPE_MESH_POINT:
9020 case NL80211_IFTYPE_P2P_GO:
98104fde 9021 case NL80211_IFTYPE_P2P_DEVICE:
71bbc994 9022 break;
cb3b7d87 9023 case NL80211_IFTYPE_NAN:
71bbc994 9024 default:
4c476991 9025 return -EOPNOTSUPP;
71bbc994 9026 }
026331c4
JM		 9027
9028 /* not much point in registering if we can't reply */
4c476991
JB		 9029 if (!rdev->ops->mgmt_tx)
9030 return -EOPNOTSUPP;
026331c4 9031
15e47304 9032 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
026331c4
JM		 9033 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
9034 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
026331c4
JM		 9035}
9036
2e161f78 9037static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
026331c4 9038{
4c476991 9039 struct cfg80211_registered_device *rdev = info->user_ptr[0];
71bbc994 9040 struct wireless_dev *wdev = info->user_ptr[1];
683b6d3b 9041 struct cfg80211_chan_def chandef;
026331c4 9042 int err;
d64d373f 9043 void *hdr = NULL;
026331c4 9044 u64 cookie;
e247bd90 9045 struct sk_buff *msg = NULL;
b176e629
AO		 9046 struct cfg80211_mgmt_tx_params params = {
9047 .dont_wait_for_ack =
9048 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
9049 };
026331c4 9050
683b6d3b 9051 if (!info->attrs[NL80211_ATTR_FRAME])
026331c4
JM		 9052 return -EINVAL;
9053
4c476991
JB		 9054 if (!rdev->ops->mgmt_tx)
9055 return -EOPNOTSUPP;
026331c4 9056
71bbc994 9057 switch (wdev->iftype) {
ea141b75
AQ		 9058 case NL80211_IFTYPE_P2P_DEVICE:
9059 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
9060 return -EINVAL;
71bbc994
JB		 9061 case NL80211_IFTYPE_STATION:
9062 case NL80211_IFTYPE_ADHOC:
9063 case NL80211_IFTYPE_P2P_CLIENT:
9064 case NL80211_IFTYPE_AP:
9065 case NL80211_IFTYPE_AP_VLAN:
9066 case NL80211_IFTYPE_MESH_POINT:
9067 case NL80211_IFTYPE_P2P_GO:
9068 break;
cb3b7d87 9069 case NL80211_IFTYPE_NAN:
71bbc994 9070 default:
4c476991 9071 return -EOPNOTSUPP;
71bbc994 9072 }
026331c4 9073
f7ca38df 9074 if (info->attrs[NL80211_ATTR_DURATION]) {
7c4ef712 9075 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
f7ca38df 9076 return -EINVAL;
b176e629 9077 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
ebf348fc
JB		 9078
9079 /*
9080 * We should wait on the channel for at least a minimum amount
9081 * of time (10ms) but no longer than the driver supports.
9082 */
b176e629
AO		 9083 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9084 params.wait > rdev->wiphy.max_remain_on_channel_duration)
ebf348fc 9085 return -EINVAL;
f7ca38df
JB		 9086 }
9087
b176e629 9088 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
f7ca38df 9089
b176e629 9090 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
7c4ef712
JB		 9091 return -EINVAL;
9092
b176e629 9093 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
e9f935e3 9094
ea141b75
AQ		 9095 /* get the channel if any has been specified, otherwise pass NULL to
9096 * the driver. The latter will use the current one
9097 */
9098 chandef.chan = NULL;
9099 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9100 err = nl80211_parse_chandef(rdev, info, &chandef);
9101 if (err)
9102 return err;
9103 }
9104
b176e629 9105 if (!chandef.chan && params.offchan)
ea141b75 9106 return -EINVAL;
026331c4 9107
34d22ce2
AO		 9108 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
9109 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
9110
9111 if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
9112 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9113 int i;
9114
9115 if (len % sizeof(u16))
9116 return -EINVAL;
9117
9118 params.n_csa_offsets = len / sizeof(u16);
9119 params.csa_offsets =
9120 nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9121
9122 /* check that all the offsets fit the frame */
9123 for (i = 0; i < params.n_csa_offsets; i++) {
9124 if (params.csa_offsets[i] >= params.len)
9125 return -EINVAL;
9126 }
9127 }
9128
b176e629 9129 if (!params.dont_wait_for_ack) {
e247bd90
JB		 9130 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9131 if (!msg)
9132 return -ENOMEM;
026331c4 9133
15e47304 9134 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
e247bd90 9135 NL80211_CMD_FRAME);
cb35fba3
DC		 9136 if (!hdr) {
9137 err = -ENOBUFS;
e247bd90
JB		 9138 goto free_msg;
9139 }
026331c4 9140 }
e247bd90 9141
b176e629
AO		 9142 params.chan = chandef.chan;
9143 err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
026331c4
JM		 9144 if (err)
9145 goto free_msg;
9146
e247bd90 9147 if (msg) {
2dad624e
ND		 9148 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
9149 NL80211_ATTR_PAD))
9360ffd1 9150 goto nla_put_failure;
026331c4 9151
e247bd90
JB		 9152 genlmsg_end(msg, hdr);
9153 return genlmsg_reply(msg, info);
9154 }
9155
9156 return 0;
026331c4
JM		 9157
9158 nla_put_failure:
9159 err = -ENOBUFS;
9160 free_msg:
9161 nlmsg_free(msg);
026331c4
JM		 9162 return err;
9163}
9164
f7ca38df
JB		 9165static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
9166{
9167 struct cfg80211_registered_device *rdev = info->user_ptr[0];
71bbc994 9168 struct wireless_dev *wdev = info->user_ptr[1];
f7ca38df
JB		 9169 u64 cookie;
9170
9171 if (!info->attrs[NL80211_ATTR_COOKIE])
9172 return -EINVAL;
9173
9174 if (!rdev->ops->mgmt_tx_cancel_wait)
9175 return -EOPNOTSUPP;
9176
71bbc994
JB		 9177 switch (wdev->iftype) {
9178 case NL80211_IFTYPE_STATION:
9179 case NL80211_IFTYPE_ADHOC:
9180 case NL80211_IFTYPE_P2P_CLIENT:
9181 case NL80211_IFTYPE_AP:
9182 case NL80211_IFTYPE_AP_VLAN:
9183 case NL80211_IFTYPE_P2P_GO:
98104fde 9184 case NL80211_IFTYPE_P2P_DEVICE:
71bbc994 9185 break;
cb3b7d87 9186 case NL80211_IFTYPE_NAN:
71bbc994 9187 default:
f7ca38df 9188 return -EOPNOTSUPP;
71bbc994 9189 }
f7ca38df
JB		 9190
9191 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
9192
e35e4d28 9193 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
f7ca38df
JB		 9194}
9195
ffb9eb3d
KV		 9196static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
9197{
4c476991 9198 struct cfg80211_registered_device *rdev = info->user_ptr[0];
ffb9eb3d 9199 struct wireless_dev *wdev;
4c476991 9200 struct net_device *dev = info->user_ptr[1];
ffb9eb3d
KV		 9201 u8 ps_state;
9202 bool state;
9203 int err;
9204
4c476991
JB		 9205 if (!info->attrs[NL80211_ATTR_PS_STATE])
9206 return -EINVAL;
ffb9eb3d
KV		 9207
9208 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
9209
4c476991
JB		 9210 if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
9211 return -EINVAL;
ffb9eb3d
KV		 9212
9213 wdev = dev->ieee80211_ptr;
9214
4c476991
JB		 9215 if (!rdev->ops->set_power_mgmt)
9216 return -EOPNOTSUPP;
ffb9eb3d
KV		 9217
9218 state = (ps_state == NL80211_PS_ENABLED) ? true : false;
9219
9220 if (state == wdev->ps)
4c476991 9221 return 0;
ffb9eb3d 9222
e35e4d28 9223 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
4c476991
JB		 9224 if (!err)
9225 wdev->ps = state;
ffb9eb3d
KV		 9226 return err;
9227}
9228
9229static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
9230{
4c476991 9231 struct cfg80211_registered_device *rdev = info->user_ptr[0];
ffb9eb3d
KV		 9232 enum nl80211_ps_state ps_state;
9233 struct wireless_dev *wdev;
4c476991 9234 struct net_device *dev = info->user_ptr[1];
ffb9eb3d
KV		 9235 struct sk_buff *msg;
9236 void *hdr;
9237 int err;
9238
ffb9eb3d
KV		 9239 wdev = dev->ieee80211_ptr;
9240
4c476991
JB		 9241 if (!rdev->ops->set_power_mgmt)
9242 return -EOPNOTSUPP;
ffb9eb3d
KV		 9243
9244 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4c476991
JB		 9245 if (!msg)
9246 return -ENOMEM;
ffb9eb3d 9247
15e47304 9248 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
ffb9eb3d
KV		 9249 NL80211_CMD_GET_POWER_SAVE);
9250 if (!hdr) {
4c476991 9251 err = -ENOBUFS;
ffb9eb3d
KV		 9252 goto free_msg;
9253 }
9254
9255 if (wdev->ps)
9256 ps_state = NL80211_PS_ENABLED;
9257 else
9258 ps_state = NL80211_PS_DISABLED;
9259
9360ffd1
DM		 9260 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
9261 goto nla_put_failure;
ffb9eb3d
KV		 9262
9263 genlmsg_end(msg, hdr);
4c476991 9264 return genlmsg_reply(msg, info);
ffb9eb3d 9265
4c476991 9266 nla_put_failure:
ffb9eb3d 9267 err = -ENOBUFS;
4c476991 9268 free_msg:
ffb9eb3d 9269 nlmsg_free(msg);
ffb9eb3d
KV		 9270 return err;
9271}
9272
94e860f1
JB		 9273static const struct nla_policy
9274nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
d6dc1a38
JO		 9275 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
9276 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
9277 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
84f10708
TP		 9278 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
9279 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
9280 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
d6dc1a38
JO		 9281};
9282
84f10708 9283static int nl80211_set_cqm_txe(struct genl_info *info,
d9d8b019 9284 u32 rate, u32 pkts, u32 intvl)
84f10708
TP		 9285{
9286 struct cfg80211_registered_device *rdev = info->user_ptr[0];
84f10708 9287 struct net_device *dev = info->user_ptr[1];
1da5fcc8 9288 struct wireless_dev *wdev = dev->ieee80211_ptr;
84f10708 9289
d9d8b019 9290 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
84f10708
TP		 9291 return -EINVAL;
9292
84f10708
TP		 9293 if (!rdev->ops->set_cqm_txe_config)
9294 return -EOPNOTSUPP;
9295
9296 if (wdev->iftype != NL80211_IFTYPE_STATION &&
9297 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9298 return -EOPNOTSUPP;
9299
e35e4d28 9300 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
84f10708
TP		 9301}
9302
d6dc1a38
JO		 9303static int nl80211_set_cqm_rssi(struct genl_info *info,
9304 s32 threshold, u32 hysteresis)
9305{
4c476991 9306 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4c476991 9307 struct net_device *dev = info->user_ptr[1];
1da5fcc8 9308 struct wireless_dev *wdev = dev->ieee80211_ptr;
d6dc1a38
JO		 9309
9310 if (threshold > 0)
9311 return -EINVAL;
9312
1da5fcc8
JB		 9313 /* disabling - hysteresis should also be zero then */
9314 if (threshold == 0)
9315 hysteresis = 0;
d6dc1a38 9316
4c476991
JB		 9317 if (!rdev->ops->set_cqm_rssi_config)
9318 return -EOPNOTSUPP;
d6dc1a38 9319
074ac8df 9320 if (wdev->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 9321 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9322 return -EOPNOTSUPP;
d6dc1a38 9323
e35e4d28 9324 return rdev_set_cqm_rssi_config(rdev, dev, threshold, hysteresis);
d6dc1a38
JO		 9325}
9326
9327static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
9328{
9329 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
9330 struct nlattr *cqm;
9331 int err;
9332
9333 cqm = info->attrs[NL80211_ATTR_CQM];
1da5fcc8
JB		 9334 if (!cqm)
9335 return -EINVAL;
d6dc1a38
JO		 9336
9337 err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
9338 nl80211_attr_cqm_policy);
9339 if (err)
1da5fcc8 9340 return err;
d6dc1a38
JO		 9341
9342 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
9343 attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
1da5fcc8
JB		 9344 s32 threshold = nla_get_s32(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
9345 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
d6dc1a38 9346
1da5fcc8
JB		 9347 return nl80211_set_cqm_rssi(info, threshold, hysteresis);
9348 }
9349
9350 if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
9351 attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
9352 attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
9353 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
9354 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
9355 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
9356
9357 return nl80211_set_cqm_txe(info, rate, pkts, intvl);
9358 }
9359
9360 return -EINVAL;
d6dc1a38
JO		 9361}
9362
6e0bd6c3
RL		 9363static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
9364{
9365 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9366 struct net_device *dev = info->user_ptr[1];
9367 struct ocb_setup setup = {};
9368 int err;
9369
9370 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
9371 if (err)
9372 return err;
9373
9374 return cfg80211_join_ocb(rdev, dev, &setup);
9375}
9376
9377static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
9378{
9379 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9380 struct net_device *dev = info->user_ptr[1];
9381
9382 return cfg80211_leave_ocb(rdev, dev);
9383}
9384
29cbe68c
JB		 9385static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
9386{
9387 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9388 struct net_device *dev = info->user_ptr[1];
9389 struct mesh_config cfg;
c80d545d 9390 struct mesh_setup setup;
29cbe68c
JB		 9391 int err;
9392
9393 /* start with default */
9394 memcpy(&cfg, &default_mesh_config, sizeof(cfg));
c80d545d 9395 memcpy(&setup, &default_mesh_setup, sizeof(setup));
29cbe68c 9396
24bdd9f4 9397 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
29cbe68c 9398 /* and parse parameters if given */
24bdd9f4 9399 err = nl80211_parse_mesh_config(info, &cfg, NULL);
29cbe68c
JB		 9400 if (err)
9401 return err;
9402 }
9403
9404 if (!info->attrs[NL80211_ATTR_MESH_ID] ||
9405 !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
9406 return -EINVAL;
9407
c80d545d
JC		 9408 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
9409 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
9410
4bb62344
CYY		 9411 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
9412 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
9413 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
9414 return -EINVAL;
9415
9bdbf04d
MP		 9416 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
9417 setup.beacon_interval =
9418 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
12d20fc9
PK		 9419
9420 err = cfg80211_validate_beacon_int(rdev, setup.beacon_interval);
9421 if (err)
9422 return err;
9bdbf04d
MP		 9423 }
9424
9425 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
9426 setup.dtim_period =
9427 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
9428 if (setup.dtim_period < 1 || setup.dtim_period > 100)
9429 return -EINVAL;
9430 }
9431
c80d545d
JC		 9432 if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
9433 /* parse additional setup parameters if given */
9434 err = nl80211_parse_mesh_setup(info, &setup);
9435 if (err)
9436 return err;
9437 }
9438
d37bb18a
TP		 9439 if (setup.user_mpm)
9440 cfg.auto_open_plinks = false;
9441
cc1d2806 9442 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
683b6d3b
JB		 9443 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
9444 if (err)
9445 return err;
cc1d2806
JB		 9446 } else {
9447 /* cfg80211_join_mesh() will sort it out */
683b6d3b 9448 setup.chandef.chan = NULL;
cc1d2806
JB		 9449 }
9450
ffb3cf30
AN		 9451 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
9452 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9453 int n_rates =
9454 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9455 struct ieee80211_supported_band *sband;
9456
9457 if (!setup.chandef.chan)
9458 return -EINVAL;
9459
9460 sband = rdev->wiphy.bands[setup.chandef.chan->band];
9461
9462 err = ieee80211_get_ratemask(sband, rates, n_rates,
9463 &setup.basic_rates);
9464 if (err)
9465 return err;
9466 }
9467
8564e382
JB		 9468 if (info->attrs[NL80211_ATTR_TX_RATES]) {
9469 err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
9470 if (err)
9471 return err;
9472
9473 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
9474 &setup.beacon_rate);
9475 if (err)
9476 return err;
9477 }
9478
c80d545d 9479 return cfg80211_join_mesh(rdev, dev, &setup, &cfg);
29cbe68c
JB		 9480}
9481
9482static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
9483{
9484 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9485 struct net_device *dev = info->user_ptr[1];
9486
9487 return cfg80211_leave_mesh(rdev, dev);
9488}
9489
dfb89c56 9490#ifdef CONFIG_PM
bb92d199
AK		 9491static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
9492 struct cfg80211_registered_device *rdev)
9493{
6abb9cb9 9494 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
bb92d199
AK		 9495 struct nlattr *nl_pats, *nl_pat;
9496 int i, pat_len;
9497
6abb9cb9 9498 if (!wowlan->n_patterns)
bb92d199
AK		 9499 return 0;
9500
9501 nl_pats = nla_nest_start(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
9502 if (!nl_pats)
9503 return -ENOBUFS;
9504
6abb9cb9 9505 for (i = 0; i < wowlan->n_patterns; i++) {
bb92d199
AK		 9506 nl_pat = nla_nest_start(msg, i + 1);
9507 if (!nl_pat)
9508 return -ENOBUFS;
6abb9cb9 9509 pat_len = wowlan->patterns[i].pattern_len;
50ac6607 9510 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
6abb9cb9 9511 wowlan->patterns[i].mask) ||
50ac6607
AK		 9512 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
9513 wowlan->patterns[i].pattern) ||
9514 nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
6abb9cb9 9515 wowlan->patterns[i].pkt_offset))
bb92d199
AK		 9516 return -ENOBUFS;
9517 nla_nest_end(msg, nl_pat);
9518 }
9519 nla_nest_end(msg, nl_pats);
9520
9521 return 0;
9522}
9523
2a0e047e
JB		 9524static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
9525 struct cfg80211_wowlan_tcp *tcp)
9526{
9527 struct nlattr *nl_tcp;
9528
9529 if (!tcp)
9530 return 0;
9531
9532 nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
9533 if (!nl_tcp)
9534 return -ENOBUFS;
9535
930345ea
JB		 9536 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
9537 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
2a0e047e
JB		 9538 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
9539 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
9540 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
9541 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
9542 tcp->payload_len, tcp->payload) ||
9543 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
9544 tcp->data_interval) ||
9545 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
9546 tcp->wake_len, tcp->wake_data) ||
9547 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
9548 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
9549 return -ENOBUFS;
9550
9551 if (tcp->payload_seq.len &&
9552 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
9553 sizeof(tcp->payload_seq), &tcp->payload_seq))
9554 return -ENOBUFS;
9555
9556 if (tcp->payload_tok.len &&
9557 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
9558 sizeof(tcp->payload_tok) + tcp->tokens_size,
9559 &tcp->payload_tok))
9560 return -ENOBUFS;
9561
e248ad30
JB		 9562 nla_nest_end(msg, nl_tcp);
9563
2a0e047e
JB		 9564 return 0;
9565}
9566
75453ccb
LC		 9567static int nl80211_send_wowlan_nd(struct sk_buff *msg,
9568 struct cfg80211_sched_scan_request *req)
9569{
3b06d277 9570 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
75453ccb
LC		 9571 int i;
9572
9573 if (!req)
9574 return 0;
9575
9576 nd = nla_nest_start(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
9577 if (!nd)
9578 return -ENOBUFS;
9579
3b06d277
AS		 9580 if (req->n_scan_plans == 1 &&
9581 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
9582 req->scan_plans[0].interval * 1000))
75453ccb
LC		 9583 return -ENOBUFS;
9584
21fea567
LC		 9585 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
9586 return -ENOBUFS;
9587
75453ccb
LC		 9588 freqs = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
9589 if (!freqs)
9590 return -ENOBUFS;
9591
53b18980
JB		 9592 for (i = 0; i < req->n_channels; i++) {
9593 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
9594 return -ENOBUFS;
9595 }
75453ccb
LC		 9596
9597 nla_nest_end(msg, freqs);
9598
9599 if (req->n_match_sets) {
9600 matches = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_MATCH);
76e1fb4b
JB		 9601 if (!matches)
9602 return -ENOBUFS;
9603
75453ccb
LC		 9604 for (i = 0; i < req->n_match_sets; i++) {
9605 match = nla_nest_start(msg, i);
76e1fb4b
JB		 9606 if (!match)
9607 return -ENOBUFS;
9608
53b18980
JB		 9609 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
9610 req->match_sets[i].ssid.ssid_len,
9611 req->match_sets[i].ssid.ssid))
9612 return -ENOBUFS;
75453ccb
LC		 9613 nla_nest_end(msg, match);
9614 }
9615 nla_nest_end(msg, matches);
9616 }
9617
3b06d277
AS		 9618 scan_plans = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
9619 if (!scan_plans)
9620 return -ENOBUFS;
9621
9622 for (i = 0; i < req->n_scan_plans; i++) {
9623 scan_plan = nla_nest_start(msg, i + 1);
76e1fb4b
JB		 9624 if (!scan_plan)
9625 return -ENOBUFS;
9626
3b06d277
AS		 9627 if (!scan_plan ||
9628 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
9629 req->scan_plans[i].interval) ||
9630 (req->scan_plans[i].iterations &&
9631 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
9632 req->scan_plans[i].iterations)))
9633 return -ENOBUFS;
9634 nla_nest_end(msg, scan_plan);
9635 }
9636 nla_nest_end(msg, scan_plans);
9637
75453ccb
LC		 9638 nla_nest_end(msg, nd);
9639
9640 return 0;
9641}
9642
ff1b6e69
JB		 9643static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
9644{
9645 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9646 struct sk_buff *msg;
9647 void *hdr;
2a0e047e 9648 u32 size = NLMSG_DEFAULT_SIZE;
ff1b6e69 9649
964dc9e2 9650 if (!rdev->wiphy.wowlan)
ff1b6e69
JB		 9651 return -EOPNOTSUPP;
9652
6abb9cb9 9653 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
2a0e047e 9654 /* adjust size to have room for all the data */
6abb9cb9
JB		 9655 size += rdev->wiphy.wowlan_config->tcp->tokens_size +
9656 rdev->wiphy.wowlan_config->tcp->payload_len +
9657 rdev->wiphy.wowlan_config->tcp->wake_len +
9658 rdev->wiphy.wowlan_config->tcp->wake_len / 8;
2a0e047e
JB		 9659 }
9660
9661 msg = nlmsg_new(size, GFP_KERNEL);
ff1b6e69
JB		 9662 if (!msg)
9663 return -ENOMEM;
9664
15e47304 9665 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
ff1b6e69
JB		 9666 NL80211_CMD_GET_WOWLAN);
9667 if (!hdr)
9668 goto nla_put_failure;
9669
6abb9cb9 9670 if (rdev->wiphy.wowlan_config) {
ff1b6e69
JB		 9671 struct nlattr *nl_wowlan;
9672
9673 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
9674 if (!nl_wowlan)
9675 goto nla_put_failure;
9676
6abb9cb9 9677 if ((rdev->wiphy.wowlan_config->any &&
9360ffd1 9678 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
6abb9cb9 9679 (rdev->wiphy.wowlan_config->disconnect &&
9360ffd1 9680 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
6abb9cb9 9681 (rdev->wiphy.wowlan_config->magic_pkt &&
9360ffd1 9682 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
6abb9cb9 9683 (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
9360ffd1 9684 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
6abb9cb9 9685 (rdev->wiphy.wowlan_config->eap_identity_req &&
9360ffd1 9686 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
6abb9cb9 9687 (rdev->wiphy.wowlan_config->four_way_handshake &&
9360ffd1 9688 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
6abb9cb9 9689 (rdev->wiphy.wowlan_config->rfkill_release &&
9360ffd1
DM		 9690 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
9691 goto nla_put_failure;
2a0e047e 9692
bb92d199
AK		 9693 if (nl80211_send_wowlan_patterns(msg, rdev))
9694 goto nla_put_failure;
2a0e047e 9695
6abb9cb9
JB		 9696 if (nl80211_send_wowlan_tcp(msg,
9697 rdev->wiphy.wowlan_config->tcp))
2a0e047e 9698 goto nla_put_failure;
75453ccb
LC		 9699
9700 if (nl80211_send_wowlan_nd(
9701 msg,
9702 rdev->wiphy.wowlan_config->nd_config))
9703 goto nla_put_failure;
2a0e047e 9704
ff1b6e69
JB		 9705 nla_nest_end(msg, nl_wowlan);
9706 }
9707
9708 genlmsg_end(msg, hdr);
9709 return genlmsg_reply(msg, info);
9710
9711nla_put_failure:
9712 nlmsg_free(msg);
9713 return -ENOBUFS;
9714}
9715
2a0e047e
JB		 9716static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
9717 struct nlattr *attr,
9718 struct cfg80211_wowlan *trig)
9719{
9720 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
9721 struct cfg80211_wowlan_tcp *cfg;
9722 struct nl80211_wowlan_tcp_data_token *tok = NULL;
9723 struct nl80211_wowlan_tcp_data_seq *seq = NULL;
9724 u32 size;
9725 u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
9726 int err, port;
9727
964dc9e2 9728 if (!rdev->wiphy.wowlan->tcp)
2a0e047e
JB		 9729 return -EINVAL;
9730
9731 err = nla_parse(tb, MAX_NL80211_WOWLAN_TCP,
9732 nla_data(attr), nla_len(attr),
9733 nl80211_wowlan_tcp_policy);
9734 if (err)
9735 return err;
9736
9737 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
9738 !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
9739 !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
9740 !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
9741 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
9742 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
9743 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
9744 !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
9745 return -EINVAL;
9746
9747 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
964dc9e2 9748 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
2a0e047e
JB		 9749 return -EINVAL;
9750
9751 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
964dc9e2 9752 rdev->wiphy.wowlan->tcp->data_interval_max ||
723d568a 9753 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
2a0e047e
JB		 9754 return -EINVAL;
9755
9756 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
964dc9e2 9757 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
2a0e047e
JB		 9758 return -EINVAL;
9759
9760 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
9761 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
9762 return -EINVAL;
9763
9764 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
9765 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
9766
9767 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
9768 tokens_size = tokln - sizeof(*tok);
9769
9770 if (!tok->len || tokens_size % tok->len)
9771 return -EINVAL;
964dc9e2 9772 if (!rdev->wiphy.wowlan->tcp->tok)
2a0e047e 9773 return -EINVAL;
964dc9e2 9774 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
2a0e047e 9775 return -EINVAL;
964dc9e2 9776 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
2a0e047e 9777 return -EINVAL;
964dc9e2 9778 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
2a0e047e
JB		 9779 return -EINVAL;
9780 if (tok->offset + tok->len > data_size)
9781 return -EINVAL;
9782 }
9783
9784 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
9785 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
964dc9e2 9786 if (!rdev->wiphy.wowlan->tcp->seq)
2a0e047e
JB		 9787 return -EINVAL;
9788 if (seq->len == 0 || seq->len > 4)
9789 return -EINVAL;
9790 if (seq->len + seq->offset > data_size)
9791 return -EINVAL;
9792 }
9793
9794 size = sizeof(*cfg);
9795 size += data_size;
9796 size += wake_size + wake_mask_size;
9797 size += tokens_size;
9798
9799 cfg = kzalloc(size, GFP_KERNEL);
9800 if (!cfg)
9801 return -ENOMEM;
67b61f6c
JB		 9802 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
9803 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
2a0e047e
JB		 9804 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
9805 ETH_ALEN);
9806 if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
9807 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
9808 else
9809 port = 0;
9810#ifdef CONFIG_INET
9811 /* allocate a socket and port for it and use it */
9812 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
9813 IPPROTO_TCP, &cfg->sock, 1);
9814 if (err) {
9815 kfree(cfg);
9816 return err;
9817 }
9818 if (inet_csk_get_port(cfg->sock->sk, port)) {
9819 sock_release(cfg->sock);
9820 kfree(cfg);
9821 return -EADDRINUSE;
9822 }
9823 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
9824#else
9825 if (!port) {
9826 kfree(cfg);
9827 return -EINVAL;
9828 }
9829 cfg->src_port = port;
9830#endif
9831
9832 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
9833 cfg->payload_len = data_size;
9834 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
9835 memcpy((void *)cfg->payload,
9836 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
9837 data_size);
9838 if (seq)
9839 cfg->payload_seq = *seq;
9840 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
9841 cfg->wake_len = wake_size;
9842 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
9843 memcpy((void *)cfg->wake_data,
9844 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
9845 wake_size);
9846 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
9847 data_size + wake_size;
9848 memcpy((void *)cfg->wake_mask,
9849 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
9850 wake_mask_size);
9851 if (tok) {
9852 cfg->tokens_size = tokens_size;
9853 memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
9854 }
9855
9856 trig->tcp = cfg;
9857
9858 return 0;
9859}
9860
8cd4d456
LC		 9861static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
9862 const struct wiphy_wowlan_support *wowlan,
9863 struct nlattr *attr,
9864 struct cfg80211_wowlan *trig)
9865{
9866 struct nlattr **tb;
9867 int err;
9868
9869 tb = kzalloc(NUM_NL80211_ATTR * sizeof(*tb), GFP_KERNEL);
9870 if (!tb)
9871 return -ENOMEM;
9872
9873 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
9874 err = -EOPNOTSUPP;
9875 goto out;
9876 }
9877
9878 err = nla_parse(tb, NL80211_ATTR_MAX,
9879 nla_data(attr), nla_len(attr),
9880 nl80211_policy);
9881 if (err)
9882 goto out;
9883
ad2b26ab 9884 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb);
8cd4d456
LC		 9885 err = PTR_ERR_OR_ZERO(trig->nd_config);
9886 if (err)
9887 trig->nd_config = NULL;
9888
9889out:
9890 kfree(tb);
9891 return err;
9892}
9893
ff1b6e69
JB		 9894static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
9895{
9896 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9897 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
ff1b6e69 9898 struct cfg80211_wowlan new_triggers = {};
ae33bd81 9899 struct cfg80211_wowlan *ntrig;
964dc9e2 9900 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
ff1b6e69 9901 int err, i;
6abb9cb9 9902 bool prev_enabled = rdev->wiphy.wowlan_config;
98fc4386 9903 bool regular = false;
ff1b6e69 9904
964dc9e2 9905 if (!wowlan)
ff1b6e69
JB		 9906 return -EOPNOTSUPP;
9907
ae33bd81
JB		 9908 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
9909 cfg80211_rdev_free_wowlan(rdev);
6abb9cb9 9910 rdev->wiphy.wowlan_config = NULL;
ae33bd81
JB		 9911 goto set_wakeup;
9912 }
ff1b6e69
JB		 9913
9914 err = nla_parse(tb, MAX_NL80211_WOWLAN_TRIG,
9915 nla_data(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
9916 nla_len(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
9917 nl80211_wowlan_policy);
9918 if (err)
9919 return err;
9920
9921 if (tb[NL80211_WOWLAN_TRIG_ANY]) {
9922 if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
9923 return -EINVAL;
9924 new_triggers.any = true;
9925 }
9926
9927 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
9928 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
9929 return -EINVAL;
9930 new_triggers.disconnect = true;
98fc4386 9931 regular = true;
ff1b6e69
JB		 9932 }
9933
9934 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
9935 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
9936 return -EINVAL;
9937 new_triggers.magic_pkt = true;
98fc4386 9938 regular = true;
ff1b6e69
JB		 9939 }
9940
77dbbb13
JB		 9941 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
9942 return -EINVAL;
9943
9944 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
9945 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
9946 return -EINVAL;
9947 new_triggers.gtk_rekey_failure = true;
98fc4386 9948 regular = true;
77dbbb13
JB		 9949 }
9950
9951 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
9952 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
9953 return -EINVAL;
9954 new_triggers.eap_identity_req = true;
98fc4386 9955 regular = true;
77dbbb13
JB		 9956 }
9957
9958 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
9959 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
9960 return -EINVAL;
9961 new_triggers.four_way_handshake = true;
98fc4386 9962 regular = true;
77dbbb13
JB		 9963 }
9964
9965 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
9966 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
9967 return -EINVAL;
9968 new_triggers.rfkill_release = true;
98fc4386 9969 regular = true;
77dbbb13
JB		 9970 }
9971
ff1b6e69
JB		 9972 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
9973 struct nlattr *pat;
9974 int n_patterns = 0;
bb92d199 9975 int rem, pat_len, mask_len, pkt_offset;
50ac6607 9976 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
ff1b6e69 9977
98fc4386
JB		 9978 regular = true;
9979
ff1b6e69
JB		 9980 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
9981 rem)
9982 n_patterns++;
9983 if (n_patterns > wowlan->n_patterns)
9984 return -EINVAL;
9985
9986 new_triggers.patterns = kcalloc(n_patterns,
9987 sizeof(new_triggers.patterns[0]),
9988 GFP_KERNEL);
9989 if (!new_triggers.patterns)
9990 return -ENOMEM;
9991
9992 new_triggers.n_patterns = n_patterns;
9993 i = 0;
9994
9995 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
9996 rem) {
922bd80f
JB		 9997 u8 *mask_pat;
9998
50ac6607
AK		 9999 nla_parse(pat_tb, MAX_NL80211_PKTPAT, nla_data(pat),
10000 nla_len(pat), NULL);
ff1b6e69 10001 err = -EINVAL;
50ac6607
AK		 10002 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10003 !pat_tb[NL80211_PKTPAT_PATTERN])
ff1b6e69 10004 goto error;
50ac6607 10005 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
ff1b6e69 10006 mask_len = DIV_ROUND_UP(pat_len, 8);
50ac6607 10007 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
ff1b6e69
JB		 10008 goto error;
10009 if (pat_len > wowlan->pattern_max_len ||
10010 pat_len < wowlan->pattern_min_len)
10011 goto error;
10012
50ac6607 10013 if (!pat_tb[NL80211_PKTPAT_OFFSET])
bb92d199
AK		 10014 pkt_offset = 0;
10015 else
10016 pkt_offset = nla_get_u32(
50ac6607 10017 pat_tb[NL80211_PKTPAT_OFFSET]);
bb92d199
AK		 10018 if (pkt_offset > wowlan->max_pkt_offset)
10019 goto error;
10020 new_triggers.patterns[i].pkt_offset = pkt_offset;
10021
922bd80f
JB		 10022 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10023 if (!mask_pat) {
ff1b6e69
JB		 10024 err = -ENOMEM;
10025 goto error;
10026 }
922bd80f
JB		 10027 new_triggers.patterns[i].mask = mask_pat;
10028 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
ff1b6e69 10029 mask_len);
922bd80f
JB		 10030 mask_pat += mask_len;
10031 new_triggers.patterns[i].pattern = mask_pat;
ff1b6e69 10032 new_triggers.patterns[i].pattern_len = pat_len;
922bd80f 10033 memcpy(mask_pat,
50ac6607 10034 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
ff1b6e69
JB		 10035 pat_len);
10036 i++;
10037 }
10038 }
10039
2a0e047e 10040 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
98fc4386 10041 regular = true;
2a0e047e
JB		 10042 err = nl80211_parse_wowlan_tcp(
10043 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
10044 &new_triggers);
10045 if (err)
10046 goto error;
10047 }
10048
8cd4d456 10049 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
98fc4386 10050 regular = true;
8cd4d456
LC		 10051 err = nl80211_parse_wowlan_nd(
10052 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
10053 &new_triggers);
10054 if (err)
10055 goto error;
10056 }
10057
98fc4386
JB		 10058 /* The 'any' trigger means the device continues operating more or less
10059 * as in its normal operation mode and wakes up the host on most of the
10060 * normal interrupts (like packet RX, ...)
10061 * It therefore makes little sense to combine with the more constrained
10062 * wakeup trigger modes.
10063 */
10064 if (new_triggers.any && regular) {
10065 err = -EINVAL;
10066 goto error;
10067 }
10068
ae33bd81
JB		 10069 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
10070 if (!ntrig) {
10071 err = -ENOMEM;
10072 goto error;
ff1b6e69 10073 }
ae33bd81 10074 cfg80211_rdev_free_wowlan(rdev);
6abb9cb9 10075 rdev->wiphy.wowlan_config = ntrig;
ff1b6e69 10076
ae33bd81 10077 set_wakeup:
6abb9cb9
JB		 10078 if (rdev->ops->set_wakeup &&
10079 prev_enabled != !!rdev->wiphy.wowlan_config)
10080 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
6d52563f 10081
ff1b6e69
JB		 10082 return 0;
10083 error:
10084 for (i = 0; i < new_triggers.n_patterns; i++)
10085 kfree(new_triggers.patterns[i].mask);
10086 kfree(new_triggers.patterns);
2a0e047e
JB		 10087 if (new_triggers.tcp && new_triggers.tcp->sock)
10088 sock_release(new_triggers.tcp->sock);
10089 kfree(new_triggers.tcp);
e5dbe070 10090 kfree(new_triggers.nd_config);
ff1b6e69
JB		 10091 return err;
10092}
dfb89c56 10093#endif
ff1b6e69 10094
be29b99a
AK		 10095static int nl80211_send_coalesce_rules(struct sk_buff *msg,
10096 struct cfg80211_registered_device *rdev)
10097{
10098 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
10099 int i, j, pat_len;
10100 struct cfg80211_coalesce_rules *rule;
10101
10102 if (!rdev->coalesce->n_rules)
10103 return 0;
10104
10105 nl_rules = nla_nest_start(msg, NL80211_ATTR_COALESCE_RULE);
10106 if (!nl_rules)
10107 return -ENOBUFS;
10108
10109 for (i = 0; i < rdev->coalesce->n_rules; i++) {
10110 nl_rule = nla_nest_start(msg, i + 1);
10111 if (!nl_rule)
10112 return -ENOBUFS;
10113
10114 rule = &rdev->coalesce->rules[i];
10115 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
10116 rule->delay))
10117 return -ENOBUFS;
10118
10119 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
10120 rule->condition))
10121 return -ENOBUFS;
10122
10123 nl_pats = nla_nest_start(msg,
10124 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
10125 if (!nl_pats)
10126 return -ENOBUFS;
10127
10128 for (j = 0; j < rule->n_patterns; j++) {
10129 nl_pat = nla_nest_start(msg, j + 1);
10130 if (!nl_pat)
10131 return -ENOBUFS;
10132 pat_len = rule->patterns[j].pattern_len;
10133 if (nla_put(msg, NL80211_PKTPAT_MASK,
10134 DIV_ROUND_UP(pat_len, 8),
10135 rule->patterns[j].mask) ||
10136 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
10137 rule->patterns[j].pattern) ||
10138 nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
10139 rule->patterns[j].pkt_offset))
10140 return -ENOBUFS;
10141 nla_nest_end(msg, nl_pat);
10142 }
10143 nla_nest_end(msg, nl_pats);
10144 nla_nest_end(msg, nl_rule);
10145 }
10146 nla_nest_end(msg, nl_rules);
10147
10148 return 0;
10149}
10150
10151static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
10152{
10153 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10154 struct sk_buff *msg;
10155 void *hdr;
10156
10157 if (!rdev->wiphy.coalesce)
10158 return -EOPNOTSUPP;
10159
10160 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10161 if (!msg)
10162 return -ENOMEM;
10163
10164 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10165 NL80211_CMD_GET_COALESCE);
10166 if (!hdr)
10167 goto nla_put_failure;
10168
10169 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
10170 goto nla_put_failure;
10171
10172 genlmsg_end(msg, hdr);
10173 return genlmsg_reply(msg, info);
10174
10175nla_put_failure:
10176 nlmsg_free(msg);
10177 return -ENOBUFS;
10178}
10179
10180void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
10181{
10182 struct cfg80211_coalesce *coalesce = rdev->coalesce;
10183 int i, j;
10184 struct cfg80211_coalesce_rules *rule;
10185
10186 if (!coalesce)
10187 return;
10188
10189 for (i = 0; i < coalesce->n_rules; i++) {
10190 rule = &coalesce->rules[i];
10191 for (j = 0; j < rule->n_patterns; j++)
10192 kfree(rule->patterns[j].mask);
10193 kfree(rule->patterns);
10194 }
10195 kfree(coalesce->rules);
10196 kfree(coalesce);
10197 rdev->coalesce = NULL;
10198}
10199
10200static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
10201 struct nlattr *rule,
10202 struct cfg80211_coalesce_rules *new_rule)
10203{
10204 int err, i;
10205 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10206 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
10207 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
10208 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
10209
10210 err = nla_parse(tb, NL80211_ATTR_COALESCE_RULE_MAX, nla_data(rule),
10211 nla_len(rule), nl80211_coalesce_policy);
10212 if (err)
10213 return err;
10214
10215 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
10216 new_rule->delay =
10217 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
10218 if (new_rule->delay > coalesce->max_delay)
10219 return -EINVAL;
10220
10221 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
10222 new_rule->condition =
10223 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
10224 if (new_rule->condition != NL80211_COALESCE_CONDITION_MATCH &&
10225 new_rule->condition != NL80211_COALESCE_CONDITION_NO_MATCH)
10226 return -EINVAL;
10227
10228 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
10229 return -EINVAL;
10230
10231 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10232 rem)
10233 n_patterns++;
10234 if (n_patterns > coalesce->n_patterns)
10235 return -EINVAL;
10236
10237 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
10238 GFP_KERNEL);
10239 if (!new_rule->patterns)
10240 return -ENOMEM;
10241
10242 new_rule->n_patterns = n_patterns;
10243 i = 0;
10244
10245 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10246 rem) {
922bd80f
JB		 10247 u8 *mask_pat;
10248
be29b99a
AK		 10249 nla_parse(pat_tb, MAX_NL80211_PKTPAT, nla_data(pat),
10250 nla_len(pat), NULL);
10251 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10252 !pat_tb[NL80211_PKTPAT_PATTERN])
10253 return -EINVAL;
10254 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
10255 mask_len = DIV_ROUND_UP(pat_len, 8);
10256 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
10257 return -EINVAL;
10258 if (pat_len > coalesce->pattern_max_len ||
10259 pat_len < coalesce->pattern_min_len)
10260 return -EINVAL;
10261
10262 if (!pat_tb[NL80211_PKTPAT_OFFSET])
10263 pkt_offset = 0;
10264 else
10265 pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
10266 if (pkt_offset > coalesce->max_pkt_offset)
10267 return -EINVAL;
10268 new_rule->patterns[i].pkt_offset = pkt_offset;
10269
922bd80f
JB		 10270 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10271 if (!mask_pat)
be29b99a 10272 return -ENOMEM;
922bd80f
JB		 10273
10274 new_rule->patterns[i].mask = mask_pat;
10275 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
10276 mask_len);
10277
10278 mask_pat += mask_len;
10279 new_rule->patterns[i].pattern = mask_pat;
be29b99a 10280 new_rule->patterns[i].pattern_len = pat_len;
922bd80f
JB		 10281 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
10282 pat_len);
be29b99a
AK		 10283 i++;
10284 }
10285
10286 return 0;
10287}
10288
10289static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
10290{
10291 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10292 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10293 struct cfg80211_coalesce new_coalesce = {};
10294 struct cfg80211_coalesce *n_coalesce;
10295 int err, rem_rule, n_rules = 0, i, j;
10296 struct nlattr *rule;
10297 struct cfg80211_coalesce_rules *tmp_rule;
10298
10299 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
10300 return -EOPNOTSUPP;
10301
10302 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
10303 cfg80211_rdev_free_coalesce(rdev);
a1056b1b 10304 rdev_set_coalesce(rdev, NULL);
be29b99a
AK		 10305 return 0;
10306 }
10307
10308 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10309 rem_rule)
10310 n_rules++;
10311 if (n_rules > coalesce->n_rules)
10312 return -EINVAL;
10313
10314 new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
10315 GFP_KERNEL);
10316 if (!new_coalesce.rules)
10317 return -ENOMEM;
10318
10319 new_coalesce.n_rules = n_rules;
10320 i = 0;
10321
10322 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10323 rem_rule) {
10324 err = nl80211_parse_coalesce_rule(rdev, rule,
10325 &new_coalesce.rules[i]);
10326 if (err)
10327 goto error;
10328
10329 i++;
10330 }
10331
a1056b1b 10332 err = rdev_set_coalesce(rdev, &new_coalesce);
be29b99a
AK		 10333 if (err)
10334 goto error;
10335
10336 n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
10337 if (!n_coalesce) {
10338 err = -ENOMEM;
10339 goto error;
10340 }
10341 cfg80211_rdev_free_coalesce(rdev);
10342 rdev->coalesce = n_coalesce;
10343
10344 return 0;
10345error:
10346 for (i = 0; i < new_coalesce.n_rules; i++) {
10347 tmp_rule = &new_coalesce.rules[i];
10348 for (j = 0; j < tmp_rule->n_patterns; j++)
10349 kfree(tmp_rule->patterns[j].mask);
10350 kfree(tmp_rule->patterns);
10351 }
10352 kfree(new_coalesce.rules);
10353
10354 return err;
10355}
10356
e5497d76
JB		 10357static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
10358{
10359 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10360 struct net_device *dev = info->user_ptr[1];
10361 struct wireless_dev *wdev = dev->ieee80211_ptr;
10362 struct nlattr *tb[NUM_NL80211_REKEY_DATA];
10363 struct cfg80211_gtk_rekey_data rekey_data;
10364 int err;
10365
10366 if (!info->attrs[NL80211_ATTR_REKEY_DATA])
10367 return -EINVAL;
10368
10369 err = nla_parse(tb, MAX_NL80211_REKEY_DATA,
10370 nla_data(info->attrs[NL80211_ATTR_REKEY_DATA]),
10371 nla_len(info->attrs[NL80211_ATTR_REKEY_DATA]),
10372 nl80211_rekey_policy);
10373 if (err)
10374 return err;
10375
10376 if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
10377 return -ERANGE;
10378 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
10379 return -ERANGE;
10380 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
10381 return -ERANGE;
10382
78f686ca
JB		 10383 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
10384 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
10385 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
e5497d76
JB		 10386
10387 wdev_lock(wdev);
10388 if (!wdev->current_bss) {
10389 err = -ENOTCONN;
10390 goto out;
10391 }
10392
10393 if (!rdev->ops->set_rekey_data) {
10394 err = -EOPNOTSUPP;
10395 goto out;
10396 }
10397
e35e4d28 10398 err = rdev_set_rekey_data(rdev, dev, &rekey_data);
e5497d76
JB		 10399 out:
10400 wdev_unlock(wdev);
10401 return err;
10402}
10403
28946da7
JB		 10404static int nl80211_register_unexpected_frame(struct sk_buff *skb,
10405 struct genl_info *info)
10406{
10407 struct net_device *dev = info->user_ptr[1];
10408 struct wireless_dev *wdev = dev->ieee80211_ptr;
10409
10410 if (wdev->iftype != NL80211_IFTYPE_AP &&
10411 wdev->iftype != NL80211_IFTYPE_P2P_GO)
10412 return -EINVAL;
10413
15e47304 10414 if (wdev->ap_unexpected_nlportid)
28946da7
JB		 10415 return -EBUSY;
10416
15e47304 10417 wdev->ap_unexpected_nlportid = info->snd_portid;
28946da7
JB		 10418 return 0;
10419}
10420
7f6cf311
JB		 10421static int nl80211_probe_client(struct sk_buff *skb,
10422 struct genl_info *info)
10423{
10424 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10425 struct net_device *dev = info->user_ptr[1];
10426 struct wireless_dev *wdev = dev->ieee80211_ptr;
10427 struct sk_buff *msg;
10428 void *hdr;
10429 const u8 *addr;
10430 u64 cookie;
10431 int err;
10432
10433 if (wdev->iftype != NL80211_IFTYPE_AP &&
10434 wdev->iftype != NL80211_IFTYPE_P2P_GO)
10435 return -EOPNOTSUPP;
10436
10437 if (!info->attrs[NL80211_ATTR_MAC])
10438 return -EINVAL;
10439
10440 if (!rdev->ops->probe_client)
10441 return -EOPNOTSUPP;
10442
10443 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10444 if (!msg)
10445 return -ENOMEM;
10446
15e47304 10447 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
7f6cf311 10448 NL80211_CMD_PROBE_CLIENT);
cb35fba3
DC		 10449 if (!hdr) {
10450 err = -ENOBUFS;
7f6cf311
JB		 10451 goto free_msg;
10452 }
10453
10454 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
10455
e35e4d28 10456 err = rdev_probe_client(rdev, dev, addr, &cookie);
7f6cf311
JB		 10457 if (err)
10458 goto free_msg;
10459
2dad624e
ND		 10460 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
10461 NL80211_ATTR_PAD))
9360ffd1 10462 goto nla_put_failure;
7f6cf311
JB		 10463
10464 genlmsg_end(msg, hdr);
10465
10466 return genlmsg_reply(msg, info);
10467
10468 nla_put_failure:
10469 err = -ENOBUFS;
10470 free_msg:
10471 nlmsg_free(msg);
10472 return err;
10473}
10474
5e760230
JB		 10475static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
10476{
10477 struct cfg80211_registered_device *rdev = info->user_ptr[0];
37c73b5f
BG		 10478 struct cfg80211_beacon_registration *reg, *nreg;
10479 int rv;
5e760230
JB		 10480
10481 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
10482 return -EOPNOTSUPP;
10483
37c73b5f
BG		 10484 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
10485 if (!nreg)
10486 return -ENOMEM;
10487
10488 /* First, check if already registered. */
10489 spin_lock_bh(&rdev->beacon_registrations_lock);
10490 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
10491 if (reg->nlportid == info->snd_portid) {
10492 rv = -EALREADY;
10493 goto out_err;
10494 }
10495 }
10496 /* Add it to the list */
10497 nreg->nlportid = info->snd_portid;
10498 list_add(&nreg->list, &rdev->beacon_registrations);
5e760230 10499
37c73b5f 10500 spin_unlock_bh(&rdev->beacon_registrations_lock);
5e760230
JB		 10501
10502 return 0;
37c73b5f
BG		 10503out_err:
10504 spin_unlock_bh(&rdev->beacon_registrations_lock);
10505 kfree(nreg);
10506 return rv;
5e760230
JB		 10507}
10508
98104fde
JB		 10509static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
10510{
10511 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10512 struct wireless_dev *wdev = info->user_ptr[1];
10513 int err;
10514
10515 if (!rdev->ops->start_p2p_device)
10516 return -EOPNOTSUPP;
10517
10518 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
10519 return -EOPNOTSUPP;
10520
10521 if (wdev->p2p_started)
10522 return 0;
10523
b6a55015
LC		 10524 if (rfkill_blocked(rdev->rfkill))
10525 return -ERFKILL;
98104fde 10526
eeb126e9 10527 err = rdev_start_p2p_device(rdev, wdev);
98104fde
JB		 10528 if (err)
10529 return err;
10530
10531 wdev->p2p_started = true;
98104fde 10532 rdev->opencount++;
98104fde
JB		 10533
10534 return 0;
10535}
10536
10537static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
10538{
10539 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10540 struct wireless_dev *wdev = info->user_ptr[1];
10541
10542 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
10543 return -EOPNOTSUPP;
10544
10545 if (!rdev->ops->stop_p2p_device)
10546 return -EOPNOTSUPP;
10547
f9f47529 10548 cfg80211_stop_p2p_device(rdev, wdev);
98104fde
JB		 10549
10550 return 0;
10551}
10552
cb3b7d87
AB		 10553static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
10554{
10555 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10556 struct wireless_dev *wdev = info->user_ptr[1];
10557 struct cfg80211_nan_conf conf = {};
10558 int err;
10559
10560 if (wdev->iftype != NL80211_IFTYPE_NAN)
10561 return -EOPNOTSUPP;
10562
10563 if (wdev->nan_started)
10564 return -EEXIST;
10565
10566 if (rfkill_blocked(rdev->rfkill))
10567 return -ERFKILL;
10568
10569 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
10570 return -EINVAL;
10571
10572 if (!info->attrs[NL80211_ATTR_NAN_DUAL])
10573 return -EINVAL;
10574
10575 conf.master_pref =
10576 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
10577 if (!conf.master_pref)
10578 return -EINVAL;
10579
10580 conf.dual = nla_get_u8(info->attrs[NL80211_ATTR_NAN_DUAL]);
10581
10582 err = rdev_start_nan(rdev, wdev, &conf);
10583 if (err)
10584 return err;
10585
10586 wdev->nan_started = true;
10587 rdev->opencount++;
10588
10589 return 0;
10590}
10591
10592static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
10593{
10594 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10595 struct wireless_dev *wdev = info->user_ptr[1];
10596
10597 if (wdev->iftype != NL80211_IFTYPE_NAN)
10598 return -EOPNOTSUPP;
10599
10600 cfg80211_stop_nan(rdev, wdev);
10601
10602 return 0;
10603}
10604
a442b761
AB		 10605static int validate_nan_filter(struct nlattr *filter_attr)
10606{
10607 struct nlattr *attr;
10608 int len = 0, n_entries = 0, rem;
10609
10610 nla_for_each_nested(attr, filter_attr, rem) {
10611 len += nla_len(attr);
10612 n_entries++;
10613 }
10614
10615 if (len >= U8_MAX)
10616 return -EINVAL;
10617
10618 return n_entries;
10619}
10620
10621static int handle_nan_filter(struct nlattr *attr_filter,
10622 struct cfg80211_nan_func *func,
10623 bool tx)
10624{
10625 struct nlattr *attr;
10626 int n_entries, rem, i;
10627 struct cfg80211_nan_func_filter *filter;
10628
10629 n_entries = validate_nan_filter(attr_filter);
10630 if (n_entries < 0)
10631 return n_entries;
10632
10633 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
10634
10635 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
10636 if (!filter)
10637 return -ENOMEM;
10638
10639 i = 0;
10640 nla_for_each_nested(attr, attr_filter, rem) {
10641 filter[i].filter = kmemdup(nla_data(attr), nla_len(attr),
10642 GFP_KERNEL);
10643 filter[i].len = nla_len(attr);
10644 i++;
10645 }
10646 if (tx) {
10647 func->num_tx_filters = n_entries;
10648 func->tx_filters = filter;
10649 } else {
10650 func->num_rx_filters = n_entries;
10651 func->rx_filters = filter;
10652 }
10653
10654 return 0;
10655}
10656
10657static int nl80211_nan_add_func(struct sk_buff *skb,
10658 struct genl_info *info)
10659{
10660 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10661 struct wireless_dev *wdev = info->user_ptr[1];
10662 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
10663 struct cfg80211_nan_func *func;
10664 struct sk_buff *msg = NULL;
10665 void *hdr = NULL;
10666 int err = 0;
10667
10668 if (wdev->iftype != NL80211_IFTYPE_NAN)
10669 return -EOPNOTSUPP;
10670
10671 if (!wdev->nan_started)
10672 return -ENOTCONN;
10673
10674 if (!info->attrs[NL80211_ATTR_NAN_FUNC])
10675 return -EINVAL;
10676
10677 if (wdev->owner_nlportid &&
10678 wdev->owner_nlportid != info->snd_portid)
10679 return -ENOTCONN;
10680
10681 err = nla_parse(tb, NL80211_NAN_FUNC_ATTR_MAX,
10682 nla_data(info->attrs[NL80211_ATTR_NAN_FUNC]),
10683 nla_len(info->attrs[NL80211_ATTR_NAN_FUNC]),
10684 nl80211_nan_func_policy);
10685 if (err)
10686 return err;
10687
10688 func = kzalloc(sizeof(*func), GFP_KERNEL);
10689 if (!func)
10690 return -ENOMEM;
10691
10692 func->cookie = wdev->wiphy->cookie_counter++;
10693
10694 if (!tb[NL80211_NAN_FUNC_TYPE] ||
10695 nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
10696 err = -EINVAL;
10697 goto out;
10698 }
10699
10700
10701 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
10702
10703 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
10704 err = -EINVAL;
10705 goto out;
10706 }
10707
10708 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
10709 sizeof(func->service_id));
10710
10711 func->close_range =
10712 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
10713
10714 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
10715 func->serv_spec_info_len =
10716 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
10717 func->serv_spec_info =
10718 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
10719 func->serv_spec_info_len,
10720 GFP_KERNEL);
10721 if (!func->serv_spec_info) {
10722 err = -ENOMEM;
10723 goto out;
10724 }
10725 }
10726
10727 if (tb[NL80211_NAN_FUNC_TTL])
10728 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
10729
10730 switch (func->type) {
10731 case NL80211_NAN_FUNC_PUBLISH:
10732 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
10733 err = -EINVAL;
10734 goto out;
10735 }
10736
10737 func->publish_type =
10738 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
10739 func->publish_bcast =
10740 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
10741
10742 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
10743 func->publish_bcast) {
10744 err = -EINVAL;
10745 goto out;
10746 }
10747 break;
10748 case NL80211_NAN_FUNC_SUBSCRIBE:
10749 func->subscribe_active =
10750 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
10751 break;
10752 case NL80211_NAN_FUNC_FOLLOW_UP:
10753 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
10754 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]) {
10755 err = -EINVAL;
10756 goto out;
10757 }
10758
10759 func->followup_id =
10760 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
10761 func->followup_reqid =
10762 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
10763 memcpy(func->followup_dest.addr,
10764 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
10765 sizeof(func->followup_dest.addr));
10766 if (func->ttl) {
10767 err = -EINVAL;
10768 goto out;
10769 }
10770 break;
10771 default:
10772 err = -EINVAL;
10773 goto out;
10774 }
10775
10776 if (tb[NL80211_NAN_FUNC_SRF]) {
10777 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
10778
10779 err = nla_parse(srf_tb, NL80211_NAN_SRF_ATTR_MAX,
10780 nla_data(tb[NL80211_NAN_FUNC_SRF]),
10781 nla_len(tb[NL80211_NAN_FUNC_SRF]), NULL);
10782 if (err)
10783 goto out;
10784
10785 func->srf_include =
10786 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
10787
10788 if (srf_tb[NL80211_NAN_SRF_BF]) {
10789 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
10790 !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
10791 err = -EINVAL;
10792 goto out;
10793 }
10794
10795 func->srf_bf_len =
10796 nla_len(srf_tb[NL80211_NAN_SRF_BF]);
10797 func->srf_bf =
10798 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
10799 func->srf_bf_len, GFP_KERNEL);
10800 if (!func->srf_bf) {
10801 err = -ENOMEM;
10802 goto out;
10803 }
10804
10805 func->srf_bf_idx =
10806 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
10807 } else {
10808 struct nlattr *attr, *mac_attr =
10809 srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
10810 int n_entries, rem, i = 0;
10811
10812 if (!mac_attr) {
10813 err = -EINVAL;
10814 goto out;
10815 }
10816
10817 n_entries = validate_acl_mac_addrs(mac_attr);
10818 if (n_entries <= 0) {
10819 err = -EINVAL;
10820 goto out;
10821 }
10822
10823 func->srf_num_macs = n_entries;
10824 func->srf_macs =
10825 kzalloc(sizeof(*func->srf_macs) * n_entries,
10826 GFP_KERNEL);
10827 if (!func->srf_macs) {
10828 err = -ENOMEM;
10829 goto out;
10830 }
10831
10832 nla_for_each_nested(attr, mac_attr, rem)
10833 memcpy(func->srf_macs[i++].addr, nla_data(attr),
10834 sizeof(*func->srf_macs));
10835 }
10836 }
10837
10838 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
10839 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
10840 func, true);
10841 if (err)
10842 goto out;
10843 }
10844
10845 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
10846 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
10847 func, false);
10848 if (err)
10849 goto out;
10850 }
10851
10852 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10853 if (!msg) {
10854 err = -ENOMEM;
10855 goto out;
10856 }
10857
10858 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10859 NL80211_CMD_ADD_NAN_FUNCTION);
10860 /* This can't really happen - we just allocated 4KB */
10861 if (WARN_ON(!hdr)) {
10862 err = -ENOMEM;
10863 goto out;
10864 }
10865
10866 err = rdev_add_nan_func(rdev, wdev, func);
10867out:
10868 if (err < 0) {
10869 cfg80211_free_nan_func(func);
10870 nlmsg_free(msg);
10871 return err;
10872 }
10873
10874 /* propagate the instance id and cookie to userspace */
10875 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
10876 NL80211_ATTR_PAD))
10877 goto nla_put_failure;
10878
10879 func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
10880 if (!func_attr)
10881 goto nla_put_failure;
10882
10883 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
10884 func->instance_id))
10885 goto nla_put_failure;
10886
10887 nla_nest_end(msg, func_attr);
10888
10889 genlmsg_end(msg, hdr);
10890 return genlmsg_reply(msg, info);
10891
10892nla_put_failure:
10893 nlmsg_free(msg);
10894 return -ENOBUFS;
10895}
10896
10897static int nl80211_nan_del_func(struct sk_buff *skb,
10898 struct genl_info *info)
10899{
10900 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10901 struct wireless_dev *wdev = info->user_ptr[1];
10902 u64 cookie;
10903
10904 if (wdev->iftype != NL80211_IFTYPE_NAN)
10905 return -EOPNOTSUPP;
10906
10907 if (!wdev->nan_started)
10908 return -ENOTCONN;
10909
10910 if (!info->attrs[NL80211_ATTR_COOKIE])
10911 return -EINVAL;
10912
10913 if (wdev->owner_nlportid &&
10914 wdev->owner_nlportid != info->snd_portid)
10915 return -ENOTCONN;
10916
10917 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
10918
10919 rdev_del_nan_func(rdev, wdev, cookie);
10920
10921 return 0;
10922}
10923
a5a9dcf2
AB		 10924static int nl80211_nan_change_config(struct sk_buff *skb,
10925 struct genl_info *info)
10926{
10927 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10928 struct wireless_dev *wdev = info->user_ptr[1];
10929 struct cfg80211_nan_conf conf = {};
10930 u32 changed = 0;
10931
10932 if (wdev->iftype != NL80211_IFTYPE_NAN)
10933 return -EOPNOTSUPP;
10934
10935 if (!wdev->nan_started)
10936 return -ENOTCONN;
10937
10938 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
10939 conf.master_pref =
10940 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
10941 if (conf.master_pref <= 1 || conf.master_pref == 255)
10942 return -EINVAL;
10943
10944 changed |= CFG80211_NAN_CONF_CHANGED_PREF;
10945 }
10946
10947 if (info->attrs[NL80211_ATTR_NAN_DUAL]) {
10948 conf.dual = nla_get_u8(info->attrs[NL80211_ATTR_NAN_DUAL]);
10949 changed |= CFG80211_NAN_CONF_CHANGED_DUAL;
10950 }
10951
10952 if (!changed)
10953 return -EINVAL;
10954
10955 return rdev_nan_change_conf(rdev, wdev, &conf, changed);
10956}
10957
50bcd31d
AB		 10958void cfg80211_nan_match(struct wireless_dev *wdev,
10959 struct cfg80211_nan_match_params *match, gfp_t gfp)
10960{
10961 struct wiphy *wiphy = wdev->wiphy;
10962 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
10963 struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
10964 struct sk_buff *msg;
10965 void *hdr;
10966
10967 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
10968 return;
10969
10970 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
10971 if (!msg)
10972 return;
10973
10974 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
10975 if (!hdr) {
10976 nlmsg_free(msg);
10977 return;
10978 }
10979
10980 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
10981 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
10982 wdev->netdev->ifindex)) ||
10983 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
10984 NL80211_ATTR_PAD))
10985 goto nla_put_failure;
10986
10987 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
10988 NL80211_ATTR_PAD) ||
10989 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
10990 goto nla_put_failure;
10991
10992 match_attr = nla_nest_start(msg, NL80211_ATTR_NAN_MATCH);
10993 if (!match_attr)
10994 goto nla_put_failure;
10995
10996 local_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_LOCAL);
10997 if (!local_func_attr)
10998 goto nla_put_failure;
10999
11000 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
11001 goto nla_put_failure;
11002
11003 nla_nest_end(msg, local_func_attr);
11004
11005 peer_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_PEER);
11006 if (!peer_func_attr)
11007 goto nla_put_failure;
11008
11009 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
11010 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
11011 goto nla_put_failure;
11012
11013 if (match->info && match->info_len &&
11014 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
11015 match->info))
11016 goto nla_put_failure;
11017
11018 nla_nest_end(msg, peer_func_attr);
11019 nla_nest_end(msg, match_attr);
11020 genlmsg_end(msg, hdr);
11021
11022 if (!wdev->owner_nlportid)
11023 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11024 msg, 0, NL80211_MCGRP_NAN, gfp);
11025 else
11026 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11027 wdev->owner_nlportid);
11028
11029 return;
11030
11031nla_put_failure:
11032 nlmsg_free(msg);
11033}
11034EXPORT_SYMBOL(cfg80211_nan_match);
11035
3713b4e3
JB		 11036static int nl80211_get_protocol_features(struct sk_buff *skb,
11037 struct genl_info *info)
11038{
11039 void *hdr;
11040 struct sk_buff *msg;
11041
11042 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11043 if (!msg)
11044 return -ENOMEM;
11045
11046 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11047 NL80211_CMD_GET_PROTOCOL_FEATURES);
11048 if (!hdr)
11049 goto nla_put_failure;
11050
11051 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
11052 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
11053 goto nla_put_failure;
11054
11055 genlmsg_end(msg, hdr);
11056 return genlmsg_reply(msg, info);
11057
11058 nla_put_failure:
11059 kfree_skb(msg);
11060 return -ENOBUFS;
11061}
11062
355199e0
JM		 11063static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
11064{
11065 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11066 struct cfg80211_update_ft_ies_params ft_params;
11067 struct net_device *dev = info->user_ptr[1];
11068
11069 if (!rdev->ops->update_ft_ies)
11070 return -EOPNOTSUPP;
11071
11072 if (!info->attrs[NL80211_ATTR_MDID] ||
11073 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
11074 return -EINVAL;
11075
11076 memset(&ft_params, 0, sizeof(ft_params));
11077 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
11078 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
11079 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
11080
11081 return rdev_update_ft_ies(rdev, dev, &ft_params);
11082}
11083
5de17984
AS		 11084static int nl80211_crit_protocol_start(struct sk_buff *skb,
11085 struct genl_info *info)
11086{
11087 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11088 struct wireless_dev *wdev = info->user_ptr[1];
11089 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
11090 u16 duration;
11091 int ret;
11092
11093 if (!rdev->ops->crit_proto_start)
11094 return -EOPNOTSUPP;
11095
11096 if (WARN_ON(!rdev->ops->crit_proto_stop))
11097 return -EINVAL;
11098
11099 if (rdev->crit_proto_nlportid)
11100 return -EBUSY;
11101
11102 /* determine protocol if provided */
11103 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
11104 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
11105
11106 if (proto >= NUM_NL80211_CRIT_PROTO)
11107 return -EINVAL;
11108
11109 /* timeout must be provided */
11110 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
11111 return -EINVAL;
11112
11113 duration =
11114 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
11115
11116 if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
11117 return -ERANGE;
11118
11119 ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
11120 if (!ret)
11121 rdev->crit_proto_nlportid = info->snd_portid;
11122
11123 return ret;
11124}
11125
11126static int nl80211_crit_protocol_stop(struct sk_buff *skb,
11127 struct genl_info *info)
11128{
11129 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11130 struct wireless_dev *wdev = info->user_ptr[1];
11131
11132 if (!rdev->ops->crit_proto_stop)
11133 return -EOPNOTSUPP;
11134
11135 if (rdev->crit_proto_nlportid) {
11136 rdev->crit_proto_nlportid = 0;
11137 rdev_crit_proto_stop(rdev, wdev);
11138 }
11139 return 0;
11140}
11141
ad7e718c
JB		 11142static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
11143{
11144 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11145 struct wireless_dev *wdev =
11146 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
11147 int i, err;
11148 u32 vid, subcmd;
11149
11150 if (!rdev->wiphy.vendor_commands)
11151 return -EOPNOTSUPP;
11152
11153 if (IS_ERR(wdev)) {
11154 err = PTR_ERR(wdev);
11155 if (err != -EINVAL)
11156 return err;
11157 wdev = NULL;
11158 } else if (wdev->wiphy != &rdev->wiphy) {
11159 return -EINVAL;
11160 }
11161
11162 if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
11163 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
11164 return -EINVAL;
11165
11166 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
11167 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
11168 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
11169 const struct wiphy_vendor_command *vcmd;
11170 void *data = NULL;
11171 int len = 0;
11172
11173 vcmd = &rdev->wiphy.vendor_commands[i];
11174
11175 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11176 continue;
11177
11178 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
11179 WIPHY_VENDOR_CMD_NEED_NETDEV)) {
11180 if (!wdev)
11181 return -EINVAL;
11182 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
11183 !wdev->netdev)
11184 return -EINVAL;
11185
11186 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
11187 if (wdev->netdev &&
11188 !netif_running(wdev->netdev))
11189 return -ENETDOWN;
11190 if (!wdev->netdev && !wdev->p2p_started)
11191 return -ENETDOWN;
11192 }
7bdbe400
JB		 11193
11194 if (!vcmd->doit)
11195 return -EOPNOTSUPP;
ad7e718c
JB		 11196 } else {
11197 wdev = NULL;
11198 }
11199
11200 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
11201 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11202 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11203 }
11204
11205 rdev->cur_cmd_info = info;
11206 err = rdev->wiphy.vendor_commands[i].doit(&rdev->wiphy, wdev,
11207 data, len);
11208 rdev->cur_cmd_info = NULL;
11209 return err;
11210 }
11211
11212 return -EOPNOTSUPP;
11213}
11214
7bdbe400
JB		 11215static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
11216 struct netlink_callback *cb,
11217 struct cfg80211_registered_device **rdev,
11218 struct wireless_dev **wdev)
11219{
11220 u32 vid, subcmd;
11221 unsigned int i;
11222 int vcmd_idx = -1;
11223 int err;
11224 void *data = NULL;
11225 unsigned int data_len = 0;
11226
11227 rtnl_lock();
11228
11229 if (cb->args[0]) {
11230 /* subtract the 1 again here */
11231 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
11232 struct wireless_dev *tmp;
11233
11234 if (!wiphy) {
11235 err = -ENODEV;
11236 goto out_unlock;
11237 }
11238 *rdev = wiphy_to_rdev(wiphy);
11239 *wdev = NULL;
11240
11241 if (cb->args[1]) {
53873f13 11242 list_for_each_entry(tmp, &wiphy->wdev_list, list) {
7bdbe400
JB		 11243 if (tmp->identifier == cb->args[1] - 1) {
11244 *wdev = tmp;
11245 break;
11246 }
11247 }
11248 }
11249
11250 /* keep rtnl locked in successful case */
11251 return 0;
11252 }
11253
11254 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
11255 nl80211_fam.attrbuf, nl80211_fam.maxattr,
11256 nl80211_policy);
11257 if (err)
11258 goto out_unlock;
11259
11260 if (!nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_ID] ||
11261 !nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) {
11262 err = -EINVAL;
11263 goto out_unlock;
11264 }
11265
11266 *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk),
11267 nl80211_fam.attrbuf);
11268 if (IS_ERR(*wdev))
11269 *wdev = NULL;
11270
11271 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk),
11272 nl80211_fam.attrbuf);
11273 if (IS_ERR(*rdev)) {
11274 err = PTR_ERR(*rdev);
11275 goto out_unlock;
11276 }
11277
11278 vid = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_ID]);
11279 subcmd = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
11280
11281 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
11282 const struct wiphy_vendor_command *vcmd;
11283
11284 vcmd = &(*rdev)->wiphy.vendor_commands[i];
11285
11286 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11287 continue;
11288
11289 if (!vcmd->dumpit) {
11290 err = -EOPNOTSUPP;
11291 goto out_unlock;
11292 }
11293
11294 vcmd_idx = i;
11295 break;
11296 }
11297
11298 if (vcmd_idx < 0) {
11299 err = -EOPNOTSUPP;
11300 goto out_unlock;
11301 }
11302
11303 if (nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_DATA]) {
11304 data = nla_data(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_DATA]);
11305 data_len = nla_len(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_DATA]);
11306 }
11307
11308 /* 0 is the first index - add 1 to parse only once */
11309 cb->args[0] = (*rdev)->wiphy_idx + 1;
11310 /* add 1 to know if it was NULL */
11311 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
11312 cb->args[2] = vcmd_idx;
11313 cb->args[3] = (unsigned long)data;
11314 cb->args[4] = data_len;
11315
11316 /* keep rtnl locked in successful case */
11317 return 0;
11318 out_unlock:
11319 rtnl_unlock();
11320 return err;
11321}
11322
11323static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
11324 struct netlink_callback *cb)
11325{
11326 struct cfg80211_registered_device *rdev;
11327 struct wireless_dev *wdev;
11328 unsigned int vcmd_idx;
11329 const struct wiphy_vendor_command *vcmd;
11330 void *data;
11331 int data_len;
11332 int err;
11333 struct nlattr *vendor_data;
11334
11335 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
11336 if (err)
11337 return err;
11338
11339 vcmd_idx = cb->args[2];
11340 data = (void *)cb->args[3];
11341 data_len = cb->args[4];
11342 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
11343
11344 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
11345 WIPHY_VENDOR_CMD_NEED_NETDEV)) {
11346 if (!wdev)
11347 return -EINVAL;
11348 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
11349 !wdev->netdev)
11350 return -EINVAL;
11351
11352 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
11353 if (wdev->netdev &&
11354 !netif_running(wdev->netdev))
11355 return -ENETDOWN;
11356 if (!wdev->netdev && !wdev->p2p_started)
11357 return -ENETDOWN;
11358 }
11359 }
11360
11361 while (1) {
11362 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
11363 cb->nlh->nlmsg_seq, NLM_F_MULTI,
11364 NL80211_CMD_VENDOR);
11365 if (!hdr)
11366 break;
11367
11368 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
2dad624e
ND		 11369 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
11370 wdev_id(wdev),
11371 NL80211_ATTR_PAD))) {
7bdbe400
JB		 11372 genlmsg_cancel(skb, hdr);
11373 break;
11374 }
11375
11376 vendor_data = nla_nest_start(skb, NL80211_ATTR_VENDOR_DATA);
11377 if (!vendor_data) {
11378 genlmsg_cancel(skb, hdr);
11379 break;
11380 }
11381
11382 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
11383 (unsigned long *)&cb->args[5]);
11384 nla_nest_end(skb, vendor_data);
11385
11386 if (err == -ENOBUFS || err == -ENOENT) {
11387 genlmsg_cancel(skb, hdr);
11388 break;
11389 } else if (err) {
11390 genlmsg_cancel(skb, hdr);
11391 goto out;
11392 }
11393
11394 genlmsg_end(skb, hdr);
11395 }
11396
11397 err = skb->len;
11398 out:
11399 rtnl_unlock();
11400 return err;
11401}
11402
ad7e718c
JB		 11403struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
11404 enum nl80211_commands cmd,
11405 enum nl80211_attrs attr,
11406 int approxlen)
11407{
f26cbf40 11408 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
ad7e718c
JB		 11409
11410 if (WARN_ON(!rdev->cur_cmd_info))
11411 return NULL;
11412
6c09e791 11413 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
ad7e718c
JB		 11414 rdev->cur_cmd_info->snd_portid,
11415 rdev->cur_cmd_info->snd_seq,
567ffc35 11416 cmd, attr, NULL, GFP_KERNEL);
ad7e718c
JB		 11417}
11418EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
11419
11420int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
11421{
11422 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
11423 void *hdr = ((void **)skb->cb)[1];
11424 struct nlattr *data = ((void **)skb->cb)[2];
11425
bd8c78e7
JB		 11426 /* clear CB data for netlink core to own from now on */
11427 memset(skb->cb, 0, sizeof(skb->cb));
11428
ad7e718c
JB		 11429 if (WARN_ON(!rdev->cur_cmd_info)) {
11430 kfree_skb(skb);
11431 return -EINVAL;
11432 }
11433
11434 nla_nest_end(skb, data);
11435 genlmsg_end(skb, hdr);
11436 return genlmsg_reply(skb, rdev->cur_cmd_info);
11437}
11438EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
11439
fa9ffc74
KP		 11440static int nl80211_set_qos_map(struct sk_buff *skb,
11441 struct genl_info *info)
11442{
11443 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11444 struct cfg80211_qos_map *qos_map = NULL;
11445 struct net_device *dev = info->user_ptr[1];
11446 u8 *pos, len, num_des, des_len, des;
11447 int ret;
11448
11449 if (!rdev->ops->set_qos_map)
11450 return -EOPNOTSUPP;
11451
11452 if (info->attrs[NL80211_ATTR_QOS_MAP]) {
11453 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
11454 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
11455
11456 if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
11457 len > IEEE80211_QOS_MAP_LEN_MAX)
11458 return -EINVAL;
11459
11460 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
11461 if (!qos_map)
11462 return -ENOMEM;
11463
11464 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
11465 if (num_des) {
11466 des_len = num_des *
11467 sizeof(struct cfg80211_dscp_exception);
11468 memcpy(qos_map->dscp_exception, pos, des_len);
11469 qos_map->num_des = num_des;
11470 for (des = 0; des < num_des; des++) {
11471 if (qos_map->dscp_exception[des].up > 7) {
11472 kfree(qos_map);
11473 return -EINVAL;
11474 }
11475 }
11476 pos += des_len;
11477 }
11478 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
11479 }
11480
11481 wdev_lock(dev->ieee80211_ptr);
11482 ret = nl80211_key_allowed(dev->ieee80211_ptr);
11483 if (!ret)
11484 ret = rdev_set_qos_map(rdev, dev, qos_map);
11485 wdev_unlock(dev->ieee80211_ptr);
11486
11487 kfree(qos_map);
11488 return ret;
11489}
11490
960d01ac
JB		 11491static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
11492{
11493 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11494 struct net_device *dev = info->user_ptr[1];
11495 struct wireless_dev *wdev = dev->ieee80211_ptr;
11496 const u8 *peer;
11497 u8 tsid, up;
11498 u16 admitted_time = 0;
11499 int err;
11500
723e73ac 11501 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
960d01ac
JB		 11502 return -EOPNOTSUPP;
11503
11504 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
11505 !info->attrs[NL80211_ATTR_USER_PRIO])
11506 return -EINVAL;
11507
11508 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
11509 if (tsid >= IEEE80211_NUM_TIDS)
11510 return -EINVAL;
11511
11512 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
11513 if (up >= IEEE80211_NUM_UPS)
11514 return -EINVAL;
11515
11516 /* WMM uses TIDs 0-7 even for TSPEC */
723e73ac 11517 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
960d01ac 11518 /* TODO: handle 802.11 TSPEC/admission control
723e73ac
JB		 11519 * need more attributes for that (e.g. BA session requirement);
11520 * change the WMM adminssion test above to allow both then
960d01ac
JB		 11521 */
11522 return -EINVAL;
11523 }
11524
11525 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
11526
11527 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
11528 admitted_time =
11529 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
11530 if (!admitted_time)
11531 return -EINVAL;
11532 }
11533
11534 wdev_lock(wdev);
11535 switch (wdev->iftype) {
11536 case NL80211_IFTYPE_STATION:
11537 case NL80211_IFTYPE_P2P_CLIENT:
11538 if (wdev->current_bss)
11539 break;
11540 err = -ENOTCONN;
11541 goto out;
11542 default:
11543 err = -EOPNOTSUPP;
11544 goto out;
11545 }
11546
11547 err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
11548
11549 out:
11550 wdev_unlock(wdev);
11551 return err;
11552}
11553
11554static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
11555{
11556 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11557 struct net_device *dev = info->user_ptr[1];
11558 struct wireless_dev *wdev = dev->ieee80211_ptr;
11559 const u8 *peer;
11560 u8 tsid;
11561 int err;
11562
11563 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
11564 return -EINVAL;
11565
11566 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
11567 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
11568
11569 wdev_lock(wdev);
11570 err = rdev_del_tx_ts(rdev, dev, tsid, peer);
11571 wdev_unlock(wdev);
11572
11573 return err;
11574}
11575
1057d35e
AN		 11576static int nl80211_tdls_channel_switch(struct sk_buff *skb,
11577 struct genl_info *info)
11578{
11579 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11580 struct net_device *dev = info->user_ptr[1];
11581 struct wireless_dev *wdev = dev->ieee80211_ptr;
11582 struct cfg80211_chan_def chandef = {};
11583 const u8 *addr;
11584 u8 oper_class;
11585 int err;
11586
11587 if (!rdev->ops->tdls_channel_switch ||
11588 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
11589 return -EOPNOTSUPP;
11590
11591 switch (dev->ieee80211_ptr->iftype) {
11592 case NL80211_IFTYPE_STATION:
11593 case NL80211_IFTYPE_P2P_CLIENT:
11594 break;
11595 default:
11596 return -EOPNOTSUPP;
11597 }
11598
11599 if (!info->attrs[NL80211_ATTR_MAC] ||
11600 !info->attrs[NL80211_ATTR_OPER_CLASS])
11601 return -EINVAL;
11602
11603 err = nl80211_parse_chandef(rdev, info, &chandef);
11604 if (err)
11605 return err;
11606
11607 /*
11608 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
11609 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
11610 * specification is not defined for them.
11611 */
57fbcce3 11612 if (chandef.chan->band == NL80211_BAND_2GHZ &&
1057d35e
AN		 11613 chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
11614 chandef.width != NL80211_CHAN_WIDTH_20)
11615 return -EINVAL;
11616
11617 /* we will be active on the TDLS link */
923b352f
AN		 11618 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
11619 wdev->iftype))
1057d35e
AN		 11620 return -EINVAL;
11621
11622 /* don't allow switching to DFS channels */
11623 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
11624 return -EINVAL;
11625
11626 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
11627 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
11628
11629 wdev_lock(wdev);
11630 err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
11631 wdev_unlock(wdev);
11632
11633 return err;
11634}
11635
11636static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
11637 struct genl_info *info)
11638{
11639 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11640 struct net_device *dev = info->user_ptr[1];
11641 struct wireless_dev *wdev = dev->ieee80211_ptr;
11642 const u8 *addr;
11643
11644 if (!rdev->ops->tdls_channel_switch ||
11645 !rdev->ops->tdls_cancel_channel_switch ||
11646 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
11647 return -EOPNOTSUPP;
11648
11649 switch (dev->ieee80211_ptr->iftype) {
11650 case NL80211_IFTYPE_STATION:
11651 case NL80211_IFTYPE_P2P_CLIENT:
11652 break;
11653 default:
11654 return -EOPNOTSUPP;
11655 }
11656
11657 if (!info->attrs[NL80211_ATTR_MAC])
11658 return -EINVAL;
11659
11660 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
11661
11662 wdev_lock(wdev);
11663 rdev_tdls_cancel_channel_switch(rdev, dev, addr);
11664 wdev_unlock(wdev);
11665
11666 return 0;
11667}
11668
4c476991
JB		 11669#define NL80211_FLAG_NEED_WIPHY 0x01
11670#define NL80211_FLAG_NEED_NETDEV 0x02
11671#define NL80211_FLAG_NEED_RTNL 0x04
41265714
JB		 11672#define NL80211_FLAG_CHECK_NETDEV_UP 0x08
11673#define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
11674 NL80211_FLAG_CHECK_NETDEV_UP)
1bf614ef 11675#define NL80211_FLAG_NEED_WDEV 0x10
98104fde 11676/* If a netdev is associated, it must be UP, P2P must be started */
1bf614ef
JB		 11677#define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
11678 NL80211_FLAG_CHECK_NETDEV_UP)
5393b917 11679#define NL80211_FLAG_CLEAR_SKB 0x20
4c476991 11680
f84f771d 11681static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
4c476991
JB		 11682 struct genl_info *info)
11683{
11684 struct cfg80211_registered_device *rdev;
89a54e48 11685 struct wireless_dev *wdev;
4c476991 11686 struct net_device *dev;
4c476991
JB		 11687 bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
11688
11689 if (rtnl)
11690 rtnl_lock();
11691
11692 if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
4f7eff10 11693 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
4c476991
JB		 11694 if (IS_ERR(rdev)) {
11695 if (rtnl)
11696 rtnl_unlock();
11697 return PTR_ERR(rdev);
11698 }
11699 info->user_ptr[0] = rdev;
1bf614ef
JB		 11700 } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
11701 ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
5fe231e8
JB		 11702 ASSERT_RTNL();
11703
89a54e48
JB		 11704 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
11705 info->attrs);
11706 if (IS_ERR(wdev)) {
4c476991
JB		 11707 if (rtnl)
11708 rtnl_unlock();
89a54e48 11709 return PTR_ERR(wdev);
4c476991 11710 }
89a54e48 11711
89a54e48 11712 dev = wdev->netdev;
f26cbf40 11713 rdev = wiphy_to_rdev(wdev->wiphy);
89a54e48 11714
1bf614ef
JB		 11715 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
11716 if (!dev) {
1bf614ef
JB		 11717 if (rtnl)
11718 rtnl_unlock();
11719 return -EINVAL;
11720 }
11721
11722 info->user_ptr[1] = dev;
11723 } else {
11724 info->user_ptr[1] = wdev;
41265714 11725 }
1bf614ef
JB		 11726
11727 if (dev) {
11728 if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
11729 !netif_running(dev)) {
1bf614ef
JB		 11730 if (rtnl)
11731 rtnl_unlock();
11732 return -ENETDOWN;
11733 }
11734
11735 dev_hold(dev);
98104fde 11736 } else if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP) {
cb3b7d87
AB		 11737 if (wdev->iftype == NL80211_IFTYPE_P2P_DEVICE &&
11738 !wdev->p2p_started) {
11739 if (rtnl)
11740 rtnl_unlock();
11741 return -ENETDOWN;
11742 }
11743 if (wdev->iftype == NL80211_IFTYPE_NAN &&
11744 !wdev->nan_started) {
98104fde
JB		 11745 if (rtnl)
11746 rtnl_unlock();
11747 return -ENETDOWN;
11748 }
41265714 11749 }
89a54e48 11750
4c476991 11751 info->user_ptr[0] = rdev;
4c476991
JB		 11752 }
11753
11754 return 0;
11755}
11756
f84f771d 11757static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
4c476991
JB		 11758 struct genl_info *info)
11759{
1bf614ef
JB		 11760 if (info->user_ptr[1]) {
11761 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
11762 struct wireless_dev *wdev = info->user_ptr[1];
11763
11764 if (wdev->netdev)
11765 dev_put(wdev->netdev);
11766 } else {
11767 dev_put(info->user_ptr[1]);
11768 }
11769 }
5393b917 11770
4c476991
JB		 11771 if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
11772 rtnl_unlock();
5393b917
JB		 11773
11774 /* If needed, clear the netlink message payload from the SKB
11775 * as it might contain key data that shouldn't stick around on
11776 * the heap after the SKB is freed. The netlink message header
11777 * is still needed for further processing, so leave it intact.
11778 */
11779 if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
11780 struct nlmsghdr *nlh = nlmsg_hdr(skb);
11781
11782 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
11783 }
4c476991
JB		 11784}
11785
4534de83 11786static const struct genl_ops nl80211_ops[] = {
55682965
JB		 11787 {
11788 .cmd = NL80211_CMD_GET_WIPHY,
11789 .doit = nl80211_get_wiphy,
11790 .dumpit = nl80211_dump_wiphy,
86e8cf98 11791 .done = nl80211_dump_wiphy_done,
55682965
JB		 11792 .policy = nl80211_policy,
11793 /* can be retrieved by unprivileged users */
5fe231e8
JB		 11794 .internal_flags = NL80211_FLAG_NEED_WIPHY |
11795 NL80211_FLAG_NEED_RTNL,
55682965
JB		 11796 },
11797 {
11798 .cmd = NL80211_CMD_SET_WIPHY,
11799 .doit = nl80211_set_wiphy,
11800 .policy = nl80211_policy,
5617c6cd 11801 .flags = GENL_UNS_ADMIN_PERM,
4c476991 11802 .internal_flags = NL80211_FLAG_NEED_RTNL,
55682965
JB		 11803 },
11804 {
11805 .cmd = NL80211_CMD_GET_INTERFACE,
11806 .doit = nl80211_get_interface,
11807 .dumpit = nl80211_dump_interface,
11808 .policy = nl80211_policy,
11809 /* can be retrieved by unprivileged users */
5fe231e8
JB		 11810 .internal_flags = NL80211_FLAG_NEED_WDEV |
11811 NL80211_FLAG_NEED_RTNL,
55682965
JB		 11812 },
11813 {
11814 .cmd = NL80211_CMD_SET_INTERFACE,
11815 .doit = nl80211_set_interface,
11816 .policy = nl80211_policy,
5617c6cd 11817 .flags = GENL_UNS_ADMIN_PERM,
4c476991
JB		 11818 .internal_flags = NL80211_FLAG_NEED_NETDEV |
11819 NL80211_FLAG_NEED_RTNL,
55682965
JB		 11820 },
11821 {
11822 .cmd = NL80211_CMD_NEW_INTERFACE,
11823 .doit = nl80211_new_interface,
11824 .policy = nl80211_policy,
5617c6cd 11825 .flags = GENL_UNS_ADMIN_PERM,
4c476991
JB		 11826 .internal_flags = NL80211_FLAG_NEED_WIPHY |
11827 NL80211_FLAG_NEED_RTNL,
55682965
JB		 11828 },
11829 {
11830 .cmd = NL80211_CMD_DEL_INTERFACE,
11831 .doit = nl80211_del_interface,
11832 .policy = nl80211_policy,
5617c6cd 11833 .flags = GENL_UNS_ADMIN_PERM,
84efbb84 11834 .internal_flags = NL80211_FLAG_NEED_WDEV |
4c476991 11835 NL80211_FLAG_NEED_RTNL,
41ade00f
JB		 11836 },
11837 {
11838 .cmd = NL80211_CMD_GET_KEY,
11839 .doit = nl80211_get_key,
11840 .policy = nl80211_policy,
5617c6cd 11841 .flags = GENL_UNS_ADMIN_PERM,
2b5f8b0b 11842 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11843 NL80211_FLAG_NEED_RTNL,
41ade00f
JB		 11844 },
11845 {
11846 .cmd = NL80211_CMD_SET_KEY,
11847 .doit = nl80211_set_key,
11848 .policy = nl80211_policy,
5617c6cd 11849 .flags = GENL_UNS_ADMIN_PERM,
41265714 11850 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
5393b917
JB		 11851 NL80211_FLAG_NEED_RTNL |
11852 NL80211_FLAG_CLEAR_SKB,
41ade00f
JB		 11853 },
11854 {
11855 .cmd = NL80211_CMD_NEW_KEY,
11856 .doit = nl80211_new_key,
11857 .policy = nl80211_policy,
5617c6cd 11858 .flags = GENL_UNS_ADMIN_PERM,
41265714 11859 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
5393b917
JB		 11860 NL80211_FLAG_NEED_RTNL |
11861 NL80211_FLAG_CLEAR_SKB,
41ade00f
JB		 11862 },
11863 {
11864 .cmd = NL80211_CMD_DEL_KEY,
11865 .doit = nl80211_del_key,
11866 .policy = nl80211_policy,
5617c6cd 11867 .flags = GENL_UNS_ADMIN_PERM,
41265714 11868 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11869 NL80211_FLAG_NEED_RTNL,
55682965 11870 },
ed1b6cc7
JB		 11871 {
11872 .cmd = NL80211_CMD_SET_BEACON,
11873 .policy = nl80211_policy,
5617c6cd 11874 .flags = GENL_UNS_ADMIN_PERM,
8860020e 11875 .doit = nl80211_set_beacon,
2b5f8b0b 11876 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11877 NL80211_FLAG_NEED_RTNL,
ed1b6cc7
JB		 11878 },
11879 {
8860020e 11880 .cmd = NL80211_CMD_START_AP,
ed1b6cc7 11881 .policy = nl80211_policy,
5617c6cd 11882 .flags = GENL_UNS_ADMIN_PERM,
8860020e 11883 .doit = nl80211_start_ap,
2b5f8b0b 11884 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11885 NL80211_FLAG_NEED_RTNL,
ed1b6cc7
JB		 11886 },
11887 {
8860020e 11888 .cmd = NL80211_CMD_STOP_AP,
ed1b6cc7 11889 .policy = nl80211_policy,
5617c6cd 11890 .flags = GENL_UNS_ADMIN_PERM,
8860020e 11891 .doit = nl80211_stop_ap,
2b5f8b0b 11892 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11893 NL80211_FLAG_NEED_RTNL,
ed1b6cc7 11894 },
5727ef1b
JB		 11895 {
11896 .cmd = NL80211_CMD_GET_STATION,
11897 .doit = nl80211_get_station,
2ec600d6 11898 .dumpit = nl80211_dump_station,
5727ef1b 11899 .policy = nl80211_policy,
4c476991
JB		 11900 .internal_flags = NL80211_FLAG_NEED_NETDEV |
11901 NL80211_FLAG_NEED_RTNL,
5727ef1b
JB		 11902 },
11903 {
11904 .cmd = NL80211_CMD_SET_STATION,
11905 .doit = nl80211_set_station,
11906 .policy = nl80211_policy,
5617c6cd 11907 .flags = GENL_UNS_ADMIN_PERM,
2b5f8b0b 11908 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11909 NL80211_FLAG_NEED_RTNL,
5727ef1b
JB		 11910 },
11911 {
11912 .cmd = NL80211_CMD_NEW_STATION,
11913 .doit = nl80211_new_station,
11914 .policy = nl80211_policy,
5617c6cd 11915 .flags = GENL_UNS_ADMIN_PERM,
41265714 11916 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11917 NL80211_FLAG_NEED_RTNL,
5727ef1b
JB		 11918 },
11919 {
11920 .cmd = NL80211_CMD_DEL_STATION,
11921 .doit = nl80211_del_station,
11922 .policy = nl80211_policy,
5617c6cd 11923 .flags = GENL_UNS_ADMIN_PERM,
2b5f8b0b 11924 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11925 NL80211_FLAG_NEED_RTNL,
2ec600d6
LCC		 11926 },
11927 {
11928 .cmd = NL80211_CMD_GET_MPATH,
11929 .doit = nl80211_get_mpath,
11930 .dumpit = nl80211_dump_mpath,
11931 .policy = nl80211_policy,
5617c6cd 11932 .flags = GENL_UNS_ADMIN_PERM,
41265714 11933 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11934 NL80211_FLAG_NEED_RTNL,
2ec600d6 11935 },
66be7d2b
HR		 11936 {
11937 .cmd = NL80211_CMD_GET_MPP,
11938 .doit = nl80211_get_mpp,
11939 .dumpit = nl80211_dump_mpp,
11940 .policy = nl80211_policy,
5617c6cd 11941 .flags = GENL_UNS_ADMIN_PERM,
66be7d2b
HR		 11942 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11943 NL80211_FLAG_NEED_RTNL,
11944 },
2ec600d6
LCC		 11945 {
11946 .cmd = NL80211_CMD_SET_MPATH,
11947 .doit = nl80211_set_mpath,
11948 .policy = nl80211_policy,
5617c6cd 11949 .flags = GENL_UNS_ADMIN_PERM,
41265714 11950 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11951 NL80211_FLAG_NEED_RTNL,
2ec600d6
LCC		 11952 },
11953 {
11954 .cmd = NL80211_CMD_NEW_MPATH,
11955 .doit = nl80211_new_mpath,
11956 .policy = nl80211_policy,
5617c6cd 11957 .flags = GENL_UNS_ADMIN_PERM,
41265714 11958 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11959 NL80211_FLAG_NEED_RTNL,
2ec600d6
LCC		 11960 },
11961 {
11962 .cmd = NL80211_CMD_DEL_MPATH,
11963 .doit = nl80211_del_mpath,
11964 .policy = nl80211_policy,
5617c6cd 11965 .flags = GENL_UNS_ADMIN_PERM,
2b5f8b0b 11966 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11967 NL80211_FLAG_NEED_RTNL,
9f1ba906
JM		 11968 },
11969 {
11970 .cmd = NL80211_CMD_SET_BSS,
11971 .doit = nl80211_set_bss,
11972 .policy = nl80211_policy,
5617c6cd 11973 .flags = GENL_UNS_ADMIN_PERM,
2b5f8b0b 11974 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 11975 NL80211_FLAG_NEED_RTNL,
b2e1b302 11976 },
f130347c
LR		 11977 {
11978 .cmd = NL80211_CMD_GET_REG,
ad30ca2c
AN		 11979 .doit = nl80211_get_reg_do,
11980 .dumpit = nl80211_get_reg_dump,
f130347c 11981 .policy = nl80211_policy,
5fe231e8 11982 .internal_flags = NL80211_FLAG_NEED_RTNL,
f130347c
LR		 11983 /* can be retrieved by unprivileged users */
11984 },
b6863036 11985#ifdef CONFIG_CFG80211_CRDA_SUPPORT
b2e1b302
LR		 11986 {
11987 .cmd = NL80211_CMD_SET_REG,
11988 .doit = nl80211_set_reg,
11989 .policy = nl80211_policy,
11990 .flags = GENL_ADMIN_PERM,
5fe231e8 11991 .internal_flags = NL80211_FLAG_NEED_RTNL,
b2e1b302 11992 },
b6863036 11993#endif
b2e1b302
LR		 11994 {
11995 .cmd = NL80211_CMD_REQ_SET_REG,
11996 .doit = nl80211_req_set_reg,
11997 .policy = nl80211_policy,
93da9cc1 11998 .flags = GENL_ADMIN_PERM,
11999 },
12000 {
24bdd9f4
JC		 12001 .cmd = NL80211_CMD_GET_MESH_CONFIG,
12002 .doit = nl80211_get_mesh_config,
93da9cc1 12003 .policy = nl80211_policy,
12004 /* can be retrieved by unprivileged users */
2b5f8b0b 12005 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12006 NL80211_FLAG_NEED_RTNL,
93da9cc1 12007 },
12008 {
24bdd9f4
JC		 12009 .cmd = NL80211_CMD_SET_MESH_CONFIG,
12010 .doit = nl80211_update_mesh_config,
93da9cc1 12011 .policy = nl80211_policy,
5617c6cd 12012 .flags = GENL_UNS_ADMIN_PERM,
29cbe68c 12013 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12014 NL80211_FLAG_NEED_RTNL,
9aed3cc1 12015 },
2a519311
JB		 12016 {
12017 .cmd = NL80211_CMD_TRIGGER_SCAN,
12018 .doit = nl80211_trigger_scan,
12019 .policy = nl80211_policy,
5617c6cd 12020 .flags = GENL_UNS_ADMIN_PERM,
fd014284 12021 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
4c476991 12022 NL80211_FLAG_NEED_RTNL,
2a519311 12023 },
91d3ab46
VK		 12024 {
12025 .cmd = NL80211_CMD_ABORT_SCAN,
12026 .doit = nl80211_abort_scan,
12027 .policy = nl80211_policy,
5617c6cd 12028 .flags = GENL_UNS_ADMIN_PERM,
91d3ab46
VK		 12029 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12030 NL80211_FLAG_NEED_RTNL,
12031 },
2a519311
JB		 12032 {
12033 .cmd = NL80211_CMD_GET_SCAN,
12034 .policy = nl80211_policy,
12035 .dumpit = nl80211_dump_scan,
12036 },
807f8a8c
LC		 12037 {
12038 .cmd = NL80211_CMD_START_SCHED_SCAN,
12039 .doit = nl80211_start_sched_scan,
12040 .policy = nl80211_policy,
5617c6cd 12041 .flags = GENL_UNS_ADMIN_PERM,
807f8a8c
LC		 12042 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12043 NL80211_FLAG_NEED_RTNL,
12044 },
12045 {
12046 .cmd = NL80211_CMD_STOP_SCHED_SCAN,
12047 .doit = nl80211_stop_sched_scan,
12048 .policy = nl80211_policy,
5617c6cd 12049 .flags = GENL_UNS_ADMIN_PERM,
807f8a8c
LC		 12050 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12051 NL80211_FLAG_NEED_RTNL,
12052 },
636a5d36
JM		 12053 {
12054 .cmd = NL80211_CMD_AUTHENTICATE,
12055 .doit = nl80211_authenticate,
12056 .policy = nl80211_policy,
5617c6cd 12057 .flags = GENL_UNS_ADMIN_PERM,
41265714 12058 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
5393b917
JB		 12059 NL80211_FLAG_NEED_RTNL |
12060 NL80211_FLAG_CLEAR_SKB,
636a5d36
JM		 12061 },
12062 {
12063 .cmd = NL80211_CMD_ASSOCIATE,
12064 .doit = nl80211_associate,
12065 .policy = nl80211_policy,
5617c6cd 12066 .flags = GENL_UNS_ADMIN_PERM,
41265714 12067 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12068 NL80211_FLAG_NEED_RTNL,
636a5d36
JM		 12069 },
12070 {
12071 .cmd = NL80211_CMD_DEAUTHENTICATE,
12072 .doit = nl80211_deauthenticate,
12073 .policy = nl80211_policy,
5617c6cd 12074 .flags = GENL_UNS_ADMIN_PERM,
41265714 12075 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12076 NL80211_FLAG_NEED_RTNL,
636a5d36
JM		 12077 },
12078 {
12079 .cmd = NL80211_CMD_DISASSOCIATE,
12080 .doit = nl80211_disassociate,
12081 .policy = nl80211_policy,
5617c6cd 12082 .flags = GENL_UNS_ADMIN_PERM,
41265714 12083 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12084 NL80211_FLAG_NEED_RTNL,
636a5d36 12085 },
04a773ad
JB		 12086 {
12087 .cmd = NL80211_CMD_JOIN_IBSS,
12088 .doit = nl80211_join_ibss,
12089 .policy = nl80211_policy,
5617c6cd 12090 .flags = GENL_UNS_ADMIN_PERM,
41265714 12091 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12092 NL80211_FLAG_NEED_RTNL,
04a773ad
JB		 12093 },
12094 {
12095 .cmd = NL80211_CMD_LEAVE_IBSS,
12096 .doit = nl80211_leave_ibss,
12097 .policy = nl80211_policy,
5617c6cd 12098 .flags = GENL_UNS_ADMIN_PERM,
41265714 12099 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12100 NL80211_FLAG_NEED_RTNL,
04a773ad 12101 },
aff89a9b
JB		 12102#ifdef CONFIG_NL80211_TESTMODE
12103 {
12104 .cmd = NL80211_CMD_TESTMODE,
12105 .doit = nl80211_testmode_do,
71063f0e 12106 .dumpit = nl80211_testmode_dump,
aff89a9b 12107 .policy = nl80211_policy,
5617c6cd 12108 .flags = GENL_UNS_ADMIN_PERM,
4c476991
JB		 12109 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12110 NL80211_FLAG_NEED_RTNL,
aff89a9b
JB		 12111 },
12112#endif
b23aa676
SO		 12113 {
12114 .cmd = NL80211_CMD_CONNECT,
12115 .doit = nl80211_connect,
12116 .policy = nl80211_policy,
5617c6cd 12117 .flags = GENL_UNS_ADMIN_PERM,
41265714 12118 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12119 NL80211_FLAG_NEED_RTNL,
b23aa676
SO		 12120 },
12121 {
12122 .cmd = NL80211_CMD_DISCONNECT,
12123 .doit = nl80211_disconnect,
12124 .policy = nl80211_policy,
5617c6cd 12125 .flags = GENL_UNS_ADMIN_PERM,
41265714 12126 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12127 NL80211_FLAG_NEED_RTNL,
b23aa676 12128 },
463d0183
JB		 12129 {
12130 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
12131 .doit = nl80211_wiphy_netns,
12132 .policy = nl80211_policy,
5617c6cd 12133 .flags = GENL_UNS_ADMIN_PERM,
4c476991
JB		 12134 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12135 NL80211_FLAG_NEED_RTNL,
463d0183 12136 },
61fa713c
HS		 12137 {
12138 .cmd = NL80211_CMD_GET_SURVEY,
12139 .policy = nl80211_policy,
12140 .dumpit = nl80211_dump_survey,
12141 },
67fbb16b
SO		 12142 {
12143 .cmd = NL80211_CMD_SET_PMKSA,
12144 .doit = nl80211_setdel_pmksa,
12145 .policy = nl80211_policy,
5617c6cd 12146 .flags = GENL_UNS_ADMIN_PERM,
2b5f8b0b 12147 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12148 NL80211_FLAG_NEED_RTNL,
67fbb16b
SO		 12149 },
12150 {
12151 .cmd = NL80211_CMD_DEL_PMKSA,
12152 .doit = nl80211_setdel_pmksa,
12153 .policy = nl80211_policy,
5617c6cd 12154 .flags = GENL_UNS_ADMIN_PERM,
2b5f8b0b 12155 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12156 NL80211_FLAG_NEED_RTNL,
67fbb16b
SO		 12157 },
12158 {
12159 .cmd = NL80211_CMD_FLUSH_PMKSA,
12160 .doit = nl80211_flush_pmksa,
12161 .policy = nl80211_policy,
5617c6cd 12162 .flags = GENL_UNS_ADMIN_PERM,
2b5f8b0b 12163 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 12164 NL80211_FLAG_NEED_RTNL,
67fbb16b 12165 },
9588bbd5
JM		 12166 {
12167 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
12168 .doit = nl80211_remain_on_channel,
12169 .policy = nl80211_policy,
5617c6cd 12170 .flags = GENL_UNS_ADMIN_PERM,
71bbc994 12171 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
4c476991 12172 NL80211_FLAG_NEED_RTNL,
9588bbd5
JM		 12173 },
12174 {
12175 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
12176 .doit = nl80211_cancel_remain_on_channel,
12177 .policy = nl80211_policy,
5617c6cd 12178 .flags = GENL_UNS_ADMIN_PERM,
71bbc994 12179 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
4c476991 12180 NL80211_FLAG_NEED_RTNL,
9588bbd5 12181 },
13ae75b1
JM		 12182 {
12183 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
12184 .doit = nl80211_set_tx_bitrate_mask,
12185 .policy = nl80211_policy,
5617c6cd 12186 .flags = GENL_UNS_ADMIN_PERM,
4c476991
JB		 12187 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12188 NL80211_FLAG_NEED_RTNL,
13ae75b1 12189 },
026331c4 12190 {
2e161f78
JB		 12191 .cmd = NL80211_CMD_REGISTER_FRAME,
12192 .doit = nl80211_register_mgmt,
026331c4 12193 .policy = nl80211_policy,
5617c6cd 12194 .flags = GENL_UNS_ADMIN_PERM,
71bbc994 12195 .internal_flags = NL80211_FLAG_NEED_WDEV |
4c476991 12196 NL80211_FLAG_NEED_RTNL,
026331c4
JM		 12197 },
12198 {
2e161f78
JB		 12199 .cmd = NL80211_CMD_FRAME,
12200 .doit = nl80211_tx_mgmt,
026331c4 12201 .policy = nl80211_policy,
5617c6cd 12202 .flags = GENL_UNS_ADMIN_PERM,
71bbc994 12203 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
f7ca38df
JB		 12204 NL80211_FLAG_NEED_RTNL,
12205 },
12206 {
12207 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
12208 .doit = nl80211_tx_mgmt_cancel_wait,
12209 .policy = nl80211_policy,
5617c6cd 12210 .flags = GENL_UNS_ADMIN_PERM,
71bbc994 12211 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
4c476991 12212 NL80211_FLAG_NEED_RTNL,
026331c4 12213 },
ffb9eb3d
KV		 12214 {
12215 .cmd = NL80211_CMD_SET_POWER_SAVE,
12216 .doit = nl80211_set_power_save,
12217 .policy = nl80211_policy,
5617c6cd 12218 .flags = GENL_UNS_ADMIN_PERM,
4c476991
JB		 12219 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12220 NL80211_FLAG_NEED_RTNL,
ffb9eb3d
KV		 12221 },
12222 {
12223 .cmd = NL80211_CMD_GET_POWER_SAVE,
12224 .doit = nl80211_get_power_save,
12225 .policy = nl80211_policy,
12226 /* can be retrieved by unprivileged users */
4c476991
JB		 12227 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12228 NL80211_FLAG_NEED_RTNL,
ffb9eb3d 12229 },
d6dc1a38
JO		 12230 {
12231 .cmd = NL80211_CMD_SET_CQM,
12232 .doit = nl80211_set_cqm,
12233 .policy = nl80211_policy,
5617c6cd 12234 .flags = GENL_UNS_ADMIN_PERM,
4c476991
JB		 12235 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12236 NL80211_FLAG_NEED_RTNL,
d6dc1a38 12237 },
f444de05
JB		 12238 {
12239 .cmd = NL80211_CMD_SET_CHANNEL,
12240 .doit = nl80211_set_channel,
12241 .policy = nl80211_policy,
5617c6cd 12242 .flags = GENL_UNS_ADMIN_PERM,
4c476991
JB		 12243 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12244 NL80211_FLAG_NEED_RTNL,
f444de05 12245 },
e8347eba
BJ		 12246 {
12247 .cmd = NL80211_CMD_SET_WDS_PEER,
12248 .doit = nl80211_set_wds_peer,
12249 .policy = nl80211_policy,
5617c6cd 12250 .flags = GENL_UNS_ADMIN_PERM,
43b19952
JB		 12251 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12252 NL80211_FLAG_NEED_RTNL,
e8347eba 12253 },
29cbe68c
JB		 12254 {
12255 .cmd = NL80211_CMD_JOIN_MESH,
12256 .doit = nl80211_join_mesh,
12257 .policy = nl80211_policy,
5617c6cd 12258 .flags = GENL_UNS_ADMIN_PERM,
29cbe68c
JB		 12259 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12260 NL80211_FLAG_NEED_RTNL,
12261 },
12262 {
12263 .cmd = NL80211_CMD_LEAVE_MESH,
12264 .doit = nl80211_leave_mesh,
12265 .policy = nl80211_policy,
5617c6cd 12266 .flags = GENL_UNS_ADMIN_PERM,
29cbe68c
JB		 12267 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12268 NL80211_FLAG_NEED_RTNL,
12269 },
6e0bd6c3
RL		 12270 {
12271 .cmd = NL80211_CMD_JOIN_OCB,
12272 .doit = nl80211_join_ocb,
12273 .policy = nl80211_policy,
5617c6cd 12274 .flags = GENL_UNS_ADMIN_PERM,
6e0bd6c3
RL		 12275 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12276 NL80211_FLAG_NEED_RTNL,
12277 },
12278 {
12279 .cmd = NL80211_CMD_LEAVE_OCB,
12280 .doit = nl80211_leave_ocb,
12281 .policy = nl80211_policy,
5617c6cd 12282 .flags = GENL_UNS_ADMIN_PERM,
6e0bd6c3
RL		 12283 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12284 NL80211_FLAG_NEED_RTNL,
12285 },
dfb89c56 12286#ifdef CONFIG_PM
ff1b6e69
JB		 12287 {
12288 .cmd = NL80211_CMD_GET_WOWLAN,
12289 .doit = nl80211_get_wowlan,
12290 .policy = nl80211_policy,
12291 /* can be retrieved by unprivileged users */
12292 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12293 NL80211_FLAG_NEED_RTNL,
12294 },
12295 {
12296 .cmd = NL80211_CMD_SET_WOWLAN,
12297 .doit = nl80211_set_wowlan,
12298 .policy = nl80211_policy,
5617c6cd 12299 .flags = GENL_UNS_ADMIN_PERM,
ff1b6e69
JB		 12300 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12301 NL80211_FLAG_NEED_RTNL,
12302 },
dfb89c56 12303#endif
e5497d76
JB		 12304 {
12305 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
12306 .doit = nl80211_set_rekey_data,
12307 .policy = nl80211_policy,
5617c6cd 12308 .flags = GENL_UNS_ADMIN_PERM,
e5497d76 12309 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
5393b917
JB		 12310 NL80211_FLAG_NEED_RTNL |
12311 NL80211_FLAG_CLEAR_SKB,
e5497d76 12312 },
109086ce
AN		 12313 {
12314 .cmd = NL80211_CMD_TDLS_MGMT,
12315 .doit = nl80211_tdls_mgmt,
12316 .policy = nl80211_policy,
5617c6cd 12317 .flags = GENL_UNS_ADMIN_PERM,
109086ce
AN		 12318 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12319 NL80211_FLAG_NEED_RTNL,
12320 },
12321 {
12322 .cmd = NL80211_CMD_TDLS_OPER,
12323 .doit = nl80211_tdls_oper,
12324 .policy = nl80211_policy,
5617c6cd 12325 .flags = GENL_UNS_ADMIN_PERM,
109086ce
AN		 12326 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12327 NL80211_FLAG_NEED_RTNL,
12328 },
28946da7
JB		 12329 {
12330 .cmd = NL80211_CMD_UNEXPECTED_FRAME,
12331 .doit = nl80211_register_unexpected_frame,
12332 .policy = nl80211_policy,
5617c6cd 12333 .flags = GENL_UNS_ADMIN_PERM,
28946da7
JB		 12334 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12335 NL80211_FLAG_NEED_RTNL,
12336 },
7f6cf311
JB		 12337 {
12338 .cmd = NL80211_CMD_PROBE_CLIENT,
12339 .doit = nl80211_probe_client,
12340 .policy = nl80211_policy,
5617c6cd 12341 .flags = GENL_UNS_ADMIN_PERM,
2b5f8b0b 12342 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7f6cf311
JB		 12343 NL80211_FLAG_NEED_RTNL,
12344 },
5e760230
JB		 12345 {
12346 .cmd = NL80211_CMD_REGISTER_BEACONS,
12347 .doit = nl80211_register_beacons,
12348 .policy = nl80211_policy,
5617c6cd 12349 .flags = GENL_UNS_ADMIN_PERM,
5e760230
JB		 12350 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12351 NL80211_FLAG_NEED_RTNL,
12352 },
1d9d9213
SW		 12353 {
12354 .cmd = NL80211_CMD_SET_NOACK_MAP,
12355 .doit = nl80211_set_noack_map,
12356 .policy = nl80211_policy,
5617c6cd 12357 .flags = GENL_UNS_ADMIN_PERM,
1d9d9213
SW		 12358 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12359 NL80211_FLAG_NEED_RTNL,
12360 },
98104fde
JB		 12361 {
12362 .cmd = NL80211_CMD_START_P2P_DEVICE,
12363 .doit = nl80211_start_p2p_device,
12364 .policy = nl80211_policy,
5617c6cd 12365 .flags = GENL_UNS_ADMIN_PERM,
98104fde
JB		 12366 .internal_flags = NL80211_FLAG_NEED_WDEV |
12367 NL80211_FLAG_NEED_RTNL,
12368 },
12369 {
12370 .cmd = NL80211_CMD_STOP_P2P_DEVICE,
12371 .doit = nl80211_stop_p2p_device,
12372 .policy = nl80211_policy,
5617c6cd 12373 .flags = GENL_UNS_ADMIN_PERM,
98104fde
JB		 12374 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12375 NL80211_FLAG_NEED_RTNL,
cb3b7d87
AB		 12376 },
12377 {
12378 .cmd = NL80211_CMD_START_NAN,
12379 .doit = nl80211_start_nan,
12380 .policy = nl80211_policy,
12381 .flags = GENL_ADMIN_PERM,
12382 .internal_flags = NL80211_FLAG_NEED_WDEV |
12383 NL80211_FLAG_NEED_RTNL,
12384 },
12385 {
12386 .cmd = NL80211_CMD_STOP_NAN,
12387 .doit = nl80211_stop_nan,
12388 .policy = nl80211_policy,
12389 .flags = GENL_ADMIN_PERM,
12390 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12391 NL80211_FLAG_NEED_RTNL,
a442b761
AB		 12392 },
12393 {
12394 .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
12395 .doit = nl80211_nan_add_func,
12396 .policy = nl80211_policy,
12397 .flags = GENL_ADMIN_PERM,
12398 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12399 NL80211_FLAG_NEED_RTNL,
12400 },
12401 {
12402 .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
12403 .doit = nl80211_nan_del_func,
12404 .policy = nl80211_policy,
12405 .flags = GENL_ADMIN_PERM,
12406 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12407 NL80211_FLAG_NEED_RTNL,
a5a9dcf2
AB		 12408 },
12409 {
12410 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
12411 .doit = nl80211_nan_change_config,
12412 .policy = nl80211_policy,
12413 .flags = GENL_ADMIN_PERM,
12414 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12415 NL80211_FLAG_NEED_RTNL,
98104fde 12416 },
f4e583c8
AQ		 12417 {
12418 .cmd = NL80211_CMD_SET_MCAST_RATE,
12419 .doit = nl80211_set_mcast_rate,
77765eaf 12420 .policy = nl80211_policy,
5617c6cd 12421 .flags = GENL_UNS_ADMIN_PERM,
77765eaf
VT		 12422 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12423 NL80211_FLAG_NEED_RTNL,
12424 },
12425 {
12426 .cmd = NL80211_CMD_SET_MAC_ACL,
12427 .doit = nl80211_set_mac_acl,
f4e583c8 12428 .policy = nl80211_policy,
5617c6cd 12429 .flags = GENL_UNS_ADMIN_PERM,
f4e583c8
AQ		 12430 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12431 NL80211_FLAG_NEED_RTNL,
12432 },
04f39047
SW		 12433 {
12434 .cmd = NL80211_CMD_RADAR_DETECT,
12435 .doit = nl80211_start_radar_detection,
12436 .policy = nl80211_policy,
5617c6cd 12437 .flags = GENL_UNS_ADMIN_PERM,
04f39047
SW		 12438 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12439 NL80211_FLAG_NEED_RTNL,
12440 },
3713b4e3
JB		 12441 {
12442 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
12443 .doit = nl80211_get_protocol_features,
12444 .policy = nl80211_policy,
12445 },
355199e0
JM		 12446 {
12447 .cmd = NL80211_CMD_UPDATE_FT_IES,
12448 .doit = nl80211_update_ft_ies,
12449 .policy = nl80211_policy,
5617c6cd 12450 .flags = GENL_UNS_ADMIN_PERM,
355199e0
JM		 12451 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12452 NL80211_FLAG_NEED_RTNL,
12453 },
5de17984
AS		 12454 {
12455 .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
12456 .doit = nl80211_crit_protocol_start,
12457 .policy = nl80211_policy,
5617c6cd 12458 .flags = GENL_UNS_ADMIN_PERM,
5de17984
AS		 12459 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12460 NL80211_FLAG_NEED_RTNL,
12461 },
12462 {
12463 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
12464 .doit = nl80211_crit_protocol_stop,
12465 .policy = nl80211_policy,
5617c6cd 12466 .flags = GENL_UNS_ADMIN_PERM,
5de17984
AS		 12467 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12468 NL80211_FLAG_NEED_RTNL,
be29b99a
AK		 12469 },
12470 {
12471 .cmd = NL80211_CMD_GET_COALESCE,
12472 .doit = nl80211_get_coalesce,
12473 .policy = nl80211_policy,
12474 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12475 NL80211_FLAG_NEED_RTNL,
12476 },
12477 {
12478 .cmd = NL80211_CMD_SET_COALESCE,
12479 .doit = nl80211_set_coalesce,
12480 .policy = nl80211_policy,
5617c6cd 12481 .flags = GENL_UNS_ADMIN_PERM,
be29b99a
AK		 12482 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12483 NL80211_FLAG_NEED_RTNL,
16ef1fe2
SW		 12484 },
12485 {
12486 .cmd = NL80211_CMD_CHANNEL_SWITCH,
12487 .doit = nl80211_channel_switch,
12488 .policy = nl80211_policy,
5617c6cd 12489 .flags = GENL_UNS_ADMIN_PERM,
16ef1fe2
SW		 12490 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12491 NL80211_FLAG_NEED_RTNL,
12492 },
ad7e718c
JB		 12493 {
12494 .cmd = NL80211_CMD_VENDOR,
12495 .doit = nl80211_vendor_cmd,
7bdbe400 12496 .dumpit = nl80211_vendor_cmd_dump,
ad7e718c 12497 .policy = nl80211_policy,
5617c6cd 12498 .flags = GENL_UNS_ADMIN_PERM,
ad7e718c
JB		 12499 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12500 NL80211_FLAG_NEED_RTNL,
12501 },
fa9ffc74
KP		 12502 {
12503 .cmd = NL80211_CMD_SET_QOS_MAP,
12504 .doit = nl80211_set_qos_map,
12505 .policy = nl80211_policy,
5617c6cd 12506 .flags = GENL_UNS_ADMIN_PERM,
fa9ffc74
KP		 12507 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12508 NL80211_FLAG_NEED_RTNL,
12509 },
960d01ac
JB		 12510 {
12511 .cmd = NL80211_CMD_ADD_TX_TS,
12512 .doit = nl80211_add_tx_ts,
12513 .policy = nl80211_policy,
5617c6cd 12514 .flags = GENL_UNS_ADMIN_PERM,
960d01ac
JB		 12515 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12516 NL80211_FLAG_NEED_RTNL,
12517 },
12518 {
12519 .cmd = NL80211_CMD_DEL_TX_TS,
12520 .doit = nl80211_del_tx_ts,
12521 .policy = nl80211_policy,
5617c6cd 12522 .flags = GENL_UNS_ADMIN_PERM,
960d01ac
JB		 12523 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12524 NL80211_FLAG_NEED_RTNL,
12525 },
1057d35e
AN		 12526 {
12527 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
12528 .doit = nl80211_tdls_channel_switch,
12529 .policy = nl80211_policy,
5617c6cd 12530 .flags = GENL_UNS_ADMIN_PERM,
1057d35e
AN		 12531 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12532 NL80211_FLAG_NEED_RTNL,
12533 },
12534 {
12535 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
12536 .doit = nl80211_tdls_cancel_channel_switch,
12537 .policy = nl80211_policy,
5617c6cd 12538 .flags = GENL_UNS_ADMIN_PERM,
1057d35e
AN		 12539 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12540 NL80211_FLAG_NEED_RTNL,
12541 },
55682965 12542};
9588bbd5 12543
55682965
JB		 12544/* notification functions */
12545
3bb20556
JB		 12546void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
12547 enum nl80211_commands cmd)
55682965
JB		 12548{
12549 struct sk_buff *msg;
86e8cf98 12550 struct nl80211_dump_wiphy_state state = {};
55682965 12551
3bb20556
JB		 12552 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
12553 cmd != NL80211_CMD_DEL_WIPHY);
12554
fd2120ca 12555 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
55682965
JB		 12556 if (!msg)
12557 return;
12558
3bb20556 12559 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
55682965
JB		 12560 nlmsg_free(msg);
12561 return;
12562 }
12563
68eb5503 12564 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 12565 NL80211_MCGRP_CONFIG, GFP_KERNEL);
55682965
JB		 12566}
12567
896ff063
DK		 12568void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
12569 struct wireless_dev *wdev,
12570 enum nl80211_commands cmd)
12571{
12572 struct sk_buff *msg;
12573
12574 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
12575 cmd != NL80211_CMD_DEL_INTERFACE);
12576
12577 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12578 if (!msg)
12579 return;
12580
12581 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev,
12582 cmd == NL80211_CMD_DEL_INTERFACE) < 0) {
12583 nlmsg_free(msg);
12584 return;
12585 }
12586
12587 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
12588 NL80211_MCGRP_CONFIG, GFP_KERNEL);
12589}
12590
362a415d
JB		 12591static int nl80211_add_scan_req(struct sk_buff *msg,
12592 struct cfg80211_registered_device *rdev)
12593{
12594 struct cfg80211_scan_request *req = rdev->scan_req;
12595 struct nlattr *nest;
12596 int i;
12597
12598 if (WARN_ON(!req))
12599 return 0;
12600
12601 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
12602 if (!nest)
12603 goto nla_put_failure;
9360ffd1
DM		 12604 for (i = 0; i < req->n_ssids; i++) {
12605 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
12606 goto nla_put_failure;
12607 }
362a415d
JB		 12608 nla_nest_end(msg, nest);
12609
12610 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
12611 if (!nest)
12612 goto nla_put_failure;
9360ffd1
DM		 12613 for (i = 0; i < req->n_channels; i++) {
12614 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
12615 goto nla_put_failure;
12616 }
362a415d
JB		 12617 nla_nest_end(msg, nest);
12618
9360ffd1
DM		 12619 if (req->ie &&
12620 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
12621 goto nla_put_failure;
362a415d 12622
ae917c9f
JB		 12623 if (req->flags &&
12624 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
12625 goto nla_put_failure;
ed473771 12626
1d76250b
AS		 12627 if (req->info.scan_start_tsf &&
12628 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
12629 req->info.scan_start_tsf, NL80211_BSS_PAD) ||
12630 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
12631 req->info.tsf_bssid)))
12632 goto nla_put_failure;
12633
362a415d
JB		 12634 return 0;
12635 nla_put_failure:
12636 return -ENOBUFS;
12637}
12638
a538e2d5
JB		 12639static int nl80211_send_scan_msg(struct sk_buff *msg,
12640 struct cfg80211_registered_device *rdev,
fd014284 12641 struct wireless_dev *wdev,
15e47304 12642 u32 portid, u32 seq, int flags,
a538e2d5 12643 u32 cmd)
2a519311
JB		 12644{
12645 void *hdr;
12646
15e47304 12647 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
2a519311
JB		 12648 if (!hdr)
12649 return -1;
12650
9360ffd1 12651 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
fd014284
JB		 12652 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
12653 wdev->netdev->ifindex)) ||
2dad624e
ND		 12654 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
12655 NL80211_ATTR_PAD))
9360ffd1 12656 goto nla_put_failure;
2a519311 12657
362a415d
JB		 12658 /* ignore errors and send incomplete event anyway */
12659 nl80211_add_scan_req(msg, rdev);
2a519311 12660
053c095a
JB		 12661 genlmsg_end(msg, hdr);
12662 return 0;
2a519311
JB		 12663
12664 nla_put_failure:
12665 genlmsg_cancel(msg, hdr);
12666 return -EMSGSIZE;
12667}
12668
807f8a8c
LC		 12669static int
12670nl80211_send_sched_scan_msg(struct sk_buff *msg,
12671 struct cfg80211_registered_device *rdev,
12672 struct net_device *netdev,
15e47304 12673 u32 portid, u32 seq, int flags, u32 cmd)
807f8a8c
LC		 12674{
12675 void *hdr;
12676
15e47304 12677 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
807f8a8c
LC		 12678 if (!hdr)
12679 return -1;
12680
9360ffd1
DM		 12681 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12682 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
12683 goto nla_put_failure;
807f8a8c 12684
053c095a
JB		 12685 genlmsg_end(msg, hdr);
12686 return 0;
807f8a8c
LC		 12687
12688 nla_put_failure:
12689 genlmsg_cancel(msg, hdr);
12690 return -EMSGSIZE;
12691}
12692
a538e2d5 12693void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
fd014284 12694 struct wireless_dev *wdev)
a538e2d5
JB		 12695{
12696 struct sk_buff *msg;
12697
58050fce 12698 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
a538e2d5
JB		 12699 if (!msg)
12700 return;
12701
fd014284 12702 if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
a538e2d5
JB		 12703 NL80211_CMD_TRIGGER_SCAN) < 0) {
12704 nlmsg_free(msg);
12705 return;
12706 }
12707
68eb5503 12708 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 12709 NL80211_MCGRP_SCAN, GFP_KERNEL);
a538e2d5
JB		 12710}
12711
f9d15d16
JB		 12712struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
12713 struct wireless_dev *wdev, bool aborted)
2a519311
JB		 12714{
12715 struct sk_buff *msg;
12716
fd2120ca 12717 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2a519311 12718 if (!msg)
f9d15d16 12719 return NULL;
2a519311 12720
fd014284 12721 if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
f9d15d16
JB		 12722 aborted ? NL80211_CMD_SCAN_ABORTED :
12723 NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
2a519311 12724 nlmsg_free(msg);
f9d15d16 12725 return NULL;
2a519311
JB		 12726 }
12727
f9d15d16 12728 return msg;
2a519311
JB		 12729}
12730
f9d15d16
JB		 12731void nl80211_send_scan_result(struct cfg80211_registered_device *rdev,
12732 struct sk_buff *msg)
2a519311 12733{
2a519311
JB		 12734 if (!msg)
12735 return;
12736
68eb5503 12737 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 12738 NL80211_MCGRP_SCAN, GFP_KERNEL);
2a519311
JB		 12739}
12740
807f8a8c
LC		 12741void nl80211_send_sched_scan_results(struct cfg80211_registered_device *rdev,
12742 struct net_device *netdev)
12743{
12744 struct sk_buff *msg;
12745
12746 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12747 if (!msg)
12748 return;
12749
12750 if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0,
12751 NL80211_CMD_SCHED_SCAN_RESULTS) < 0) {
12752 nlmsg_free(msg);
12753 return;
12754 }
12755
68eb5503 12756 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 12757 NL80211_MCGRP_SCAN, GFP_KERNEL);
807f8a8c
LC		 12758}
12759
12760void nl80211_send_sched_scan(struct cfg80211_registered_device *rdev,
12761 struct net_device *netdev, u32 cmd)
12762{
12763 struct sk_buff *msg;
12764
58050fce 12765 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
807f8a8c
LC		 12766 if (!msg)
12767 return;
12768
12769 if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0, cmd) < 0) {
12770 nlmsg_free(msg);
12771 return;
12772 }
12773
68eb5503 12774 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 12775 NL80211_MCGRP_SCAN, GFP_KERNEL);
807f8a8c
LC		 12776}
12777
b0d7aa59
JD		 12778static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
12779 struct regulatory_request *request)
73d54c9e 12780{
73d54c9e 12781 /* Userspace can always count this one always being set */
9360ffd1
DM		 12782 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
12783 goto nla_put_failure;
12784
12785 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
12786 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
12787 NL80211_REGDOM_TYPE_WORLD))
12788 goto nla_put_failure;
12789 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
12790 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
12791 NL80211_REGDOM_TYPE_CUSTOM_WORLD))
12792 goto nla_put_failure;
12793 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
12794 request->intersect) {
12795 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
12796 NL80211_REGDOM_TYPE_INTERSECTION))
12797 goto nla_put_failure;
12798 } else {
12799 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
12800 NL80211_REGDOM_TYPE_COUNTRY) ||
12801 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
12802 request->alpha2))
12803 goto nla_put_failure;
12804 }
12805
ad30ca2c
AN		 12806 if (request->wiphy_idx != WIPHY_IDX_INVALID) {
12807 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
12808
12809 if (wiphy &&
12810 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
12811 goto nla_put_failure;
1bdd716c
AN		 12812
12813 if (wiphy &&
12814 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
12815 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
12816 goto nla_put_failure;
ad30ca2c 12817 }
73d54c9e 12818
b0d7aa59
JD		 12819 return true;
12820
12821nla_put_failure:
12822 return false;
12823}
12824
12825/*
12826 * This can happen on global regulatory changes or device specific settings
12827 * based on custom regulatory domains.
12828 */
12829void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
12830 struct regulatory_request *request)
12831{
12832 struct sk_buff *msg;
12833 void *hdr;
12834
12835 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12836 if (!msg)
12837 return;
12838
12839 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
12840 if (!hdr) {
12841 nlmsg_free(msg);
12842 return;
12843 }
12844
12845 if (nl80211_reg_change_event_fill(msg, request) == false)
12846 goto nla_put_failure;
12847
3b7b72ee 12848 genlmsg_end(msg, hdr);
73d54c9e 12849
bc43b28c 12850 rcu_read_lock();
68eb5503 12851 genlmsg_multicast_allns(&nl80211_fam, msg, 0,
2a94fe48 12852 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
bc43b28c 12853 rcu_read_unlock();
73d54c9e
LR		 12854
12855 return;
12856
12857nla_put_failure:
12858 genlmsg_cancel(msg, hdr);
12859 nlmsg_free(msg);
12860}
12861
6039f6d2
JM		 12862static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
12863 struct net_device *netdev,
12864 const u8 *buf, size_t len,
b0b6aa2c
EP		 12865 enum nl80211_commands cmd, gfp_t gfp,
12866 int uapsd_queues)
6039f6d2
JM		 12867{
12868 struct sk_buff *msg;
12869 void *hdr;
12870
e6d6e342 12871 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
6039f6d2
JM		 12872 if (!msg)
12873 return;
12874
12875 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
12876 if (!hdr) {
12877 nlmsg_free(msg);
12878 return;
12879 }
12880
9360ffd1
DM		 12881 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12882 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
12883 nla_put(msg, NL80211_ATTR_FRAME, len, buf))
12884 goto nla_put_failure;
6039f6d2 12885
b0b6aa2c
EP		 12886 if (uapsd_queues >= 0) {
12887 struct nlattr *nla_wmm =
12888 nla_nest_start(msg, NL80211_ATTR_STA_WME);
12889 if (!nla_wmm)
12890 goto nla_put_failure;
12891
12892 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
12893 uapsd_queues))
12894 goto nla_put_failure;
12895
12896 nla_nest_end(msg, nla_wmm);
12897 }
12898
3b7b72ee 12899 genlmsg_end(msg, hdr);
6039f6d2 12900
68eb5503 12901 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 12902 NL80211_MCGRP_MLME, gfp);
6039f6d2
JM		 12903 return;
12904
12905 nla_put_failure:
12906 genlmsg_cancel(msg, hdr);
12907 nlmsg_free(msg);
12908}
12909
12910void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
e6d6e342
JB		 12911 struct net_device *netdev, const u8 *buf,
12912 size_t len, gfp_t gfp)
6039f6d2
JM		 12913{
12914 nl80211_send_mlme_event(rdev, netdev, buf, len,
b0b6aa2c 12915 NL80211_CMD_AUTHENTICATE, gfp, -1);
6039f6d2
JM		 12916}
12917
12918void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
12919 struct net_device *netdev, const u8 *buf,
b0b6aa2c 12920 size_t len, gfp_t gfp, int uapsd_queues)
6039f6d2 12921{
e6d6e342 12922 nl80211_send_mlme_event(rdev, netdev, buf, len,
b0b6aa2c 12923 NL80211_CMD_ASSOCIATE, gfp, uapsd_queues);
6039f6d2
JM		 12924}
12925
53b46b84 12926void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
e6d6e342
JB		 12927 struct net_device *netdev, const u8 *buf,
12928 size_t len, gfp_t gfp)
6039f6d2
JM		 12929{
12930 nl80211_send_mlme_event(rdev, netdev, buf, len,
b0b6aa2c 12931 NL80211_CMD_DEAUTHENTICATE, gfp, -1);
6039f6d2
JM		 12932}
12933
53b46b84
JM		 12934void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
12935 struct net_device *netdev, const u8 *buf,
e6d6e342 12936 size_t len, gfp_t gfp)
6039f6d2
JM		 12937{
12938 nl80211_send_mlme_event(rdev, netdev, buf, len,
b0b6aa2c 12939 NL80211_CMD_DISASSOCIATE, gfp, -1);
6039f6d2
JM		 12940}
12941
6ff57cf8
JB		 12942void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
12943 size_t len)
cf4e594e 12944{
947add36
JB		 12945 struct wireless_dev *wdev = dev->ieee80211_ptr;
12946 struct wiphy *wiphy = wdev->wiphy;
f26cbf40 12947 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
6ff57cf8
JB		 12948 const struct ieee80211_mgmt *mgmt = (void *)buf;
12949 u32 cmd;
947add36 12950
6ff57cf8
JB		 12951 if (WARN_ON(len < 2))
12952 return;
cf4e594e 12953
6ff57cf8
JB		 12954 if (ieee80211_is_deauth(mgmt->frame_control))
12955 cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
12956 else
12957 cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
947add36 12958
6ff57cf8 12959 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
b0b6aa2c 12960 nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1);
cf4e594e 12961}
6ff57cf8 12962EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
cf4e594e 12963
1b06bb40
LR		 12964static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
12965 struct net_device *netdev, int cmd,
e6d6e342 12966 const u8 *addr, gfp_t gfp)
1965c853
JM		 12967{
12968 struct sk_buff *msg;
12969 void *hdr;
12970
e6d6e342 12971 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
1965c853
JM		 12972 if (!msg)
12973 return;
12974
12975 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
12976 if (!hdr) {
12977 nlmsg_free(msg);
12978 return;
12979 }
12980
9360ffd1
DM		 12981 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12982 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
12983 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
12984 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
12985 goto nla_put_failure;
1965c853 12986
3b7b72ee 12987 genlmsg_end(msg, hdr);
1965c853 12988
68eb5503 12989 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 12990 NL80211_MCGRP_MLME, gfp);
1965c853
JM		 12991 return;
12992
12993 nla_put_failure:
12994 genlmsg_cancel(msg, hdr);
12995 nlmsg_free(msg);
12996}
12997
12998void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
e6d6e342
JB		 12999 struct net_device *netdev, const u8 *addr,
13000 gfp_t gfp)
1965c853
JM		 13001{
13002 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
e6d6e342 13003 addr, gfp);
1965c853
JM		 13004}
13005
13006void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
e6d6e342
JB		 13007 struct net_device *netdev, const u8 *addr,
13008 gfp_t gfp)
1965c853 13009{
e6d6e342
JB		 13010 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
13011 addr, gfp);
1965c853
JM		 13012}
13013
b23aa676
SO		 13014void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
13015 struct net_device *netdev, const u8 *bssid,
13016 const u8 *req_ie, size_t req_ie_len,
13017 const u8 *resp_ie, size_t resp_ie_len,
bf1ecd21 13018 int status, gfp_t gfp)
b23aa676
SO		 13019{
13020 struct sk_buff *msg;
13021 void *hdr;
13022
58050fce 13023 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
b23aa676
SO		 13024 if (!msg)
13025 return;
13026
13027 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
13028 if (!hdr) {
13029 nlmsg_free(msg);
13030 return;
13031 }
13032
9360ffd1
DM		 13033 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13034 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13035 (bssid && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) ||
bf1ecd21
JM		 13036 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
13037 status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
13038 status) ||
13039 (status < 0 && nla_put_flag(msg, NL80211_ATTR_TIMED_OUT)) ||
9360ffd1
DM		 13040 (req_ie &&
13041 nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
13042 (resp_ie &&
13043 nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
13044 goto nla_put_failure;
b23aa676 13045
3b7b72ee 13046 genlmsg_end(msg, hdr);
b23aa676 13047
68eb5503 13048 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13049 NL80211_MCGRP_MLME, gfp);
b23aa676
SO		 13050 return;
13051
13052 nla_put_failure:
13053 genlmsg_cancel(msg, hdr);
13054 nlmsg_free(msg);
b23aa676
SO		 13055}
13056
13057void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
13058 struct net_device *netdev, const u8 *bssid,
13059 const u8 *req_ie, size_t req_ie_len,
13060 const u8 *resp_ie, size_t resp_ie_len, gfp_t gfp)
13061{
13062 struct sk_buff *msg;
13063 void *hdr;
13064
58050fce 13065 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
b23aa676
SO		 13066 if (!msg)
13067 return;
13068
13069 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
13070 if (!hdr) {
13071 nlmsg_free(msg);
13072 return;
13073 }
13074
9360ffd1
DM		 13075 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13076 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13077 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
13078 (req_ie &&
13079 nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
13080 (resp_ie &&
13081 nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
13082 goto nla_put_failure;
b23aa676 13083
3b7b72ee 13084 genlmsg_end(msg, hdr);
b23aa676 13085
68eb5503 13086 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13087 NL80211_MCGRP_MLME, gfp);
b23aa676
SO		 13088 return;
13089
13090 nla_put_failure:
13091 genlmsg_cancel(msg, hdr);
13092 nlmsg_free(msg);
b23aa676
SO		 13093}
13094
13095void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
13096 struct net_device *netdev, u16 reason,
667503dd 13097 const u8 *ie, size_t ie_len, bool from_ap)
b23aa676
SO		 13098{
13099 struct sk_buff *msg;
13100 void *hdr;
13101
58050fce 13102 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
b23aa676
SO		 13103 if (!msg)
13104 return;
13105
13106 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
13107 if (!hdr) {
13108 nlmsg_free(msg);
13109 return;
13110 }
13111
9360ffd1
DM		 13112 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13113 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13114 (from_ap && reason &&
13115 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
13116 (from_ap &&
13117 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
13118 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
13119 goto nla_put_failure;
b23aa676 13120
3b7b72ee 13121 genlmsg_end(msg, hdr);
b23aa676 13122
68eb5503 13123 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13124 NL80211_MCGRP_MLME, GFP_KERNEL);
b23aa676
SO		 13125 return;
13126
13127 nla_put_failure:
13128 genlmsg_cancel(msg, hdr);
13129 nlmsg_free(msg);
b23aa676
SO		 13130}
13131
04a773ad
JB		 13132void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
13133 struct net_device *netdev, const u8 *bssid,
13134 gfp_t gfp)
13135{
13136 struct sk_buff *msg;
13137 void *hdr;
13138
fd2120ca 13139 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
04a773ad
JB		 13140 if (!msg)
13141 return;
13142
13143 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
13144 if (!hdr) {
13145 nlmsg_free(msg);
13146 return;
13147 }
13148
9360ffd1
DM		 13149 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13150 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13151 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
13152 goto nla_put_failure;
04a773ad 13153
3b7b72ee 13154 genlmsg_end(msg, hdr);
04a773ad 13155
68eb5503 13156 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13157 NL80211_MCGRP_MLME, gfp);
04a773ad
JB		 13158 return;
13159
13160 nla_put_failure:
13161 genlmsg_cancel(msg, hdr);
13162 nlmsg_free(msg);
13163}
13164
947add36
JB		 13165void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
13166 const u8* ie, u8 ie_len, gfp_t gfp)
c93b5e71 13167{
947add36 13168 struct wireless_dev *wdev = dev->ieee80211_ptr;
f26cbf40 13169 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
c93b5e71
JC		 13170 struct sk_buff *msg;
13171 void *hdr;
13172
947add36
JB		 13173 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
13174 return;
13175
13176 trace_cfg80211_notify_new_peer_candidate(dev, addr);
13177
c93b5e71
JC		 13178 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13179 if (!msg)
13180 return;
13181
13182 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
13183 if (!hdr) {
13184 nlmsg_free(msg);
13185 return;
13186 }
13187
9360ffd1 13188 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
947add36
JB		 13189 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
13190 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
9360ffd1
DM		 13191 (ie_len && ie &&
13192 nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
13193 goto nla_put_failure;
c93b5e71 13194
3b7b72ee 13195 genlmsg_end(msg, hdr);
c93b5e71 13196
68eb5503 13197 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13198 NL80211_MCGRP_MLME, gfp);
c93b5e71
JC		 13199 return;
13200
13201 nla_put_failure:
13202 genlmsg_cancel(msg, hdr);
13203 nlmsg_free(msg);
13204}
947add36 13205EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
c93b5e71 13206
a3b8b056
JM		 13207void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
13208 struct net_device *netdev, const u8 *addr,
13209 enum nl80211_key_type key_type, int key_id,
e6d6e342 13210 const u8 *tsc, gfp_t gfp)
a3b8b056
JM		 13211{
13212 struct sk_buff *msg;
13213 void *hdr;
13214
e6d6e342 13215 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
a3b8b056
JM		 13216 if (!msg)
13217 return;
13218
13219 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
13220 if (!hdr) {
13221 nlmsg_free(msg);
13222 return;
13223 }
13224
9360ffd1
DM		 13225 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13226 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13227 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
13228 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
13229 (key_id != -1 &&
13230 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
13231 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
13232 goto nla_put_failure;
a3b8b056 13233
3b7b72ee 13234 genlmsg_end(msg, hdr);
a3b8b056 13235
68eb5503 13236 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13237 NL80211_MCGRP_MLME, gfp);
a3b8b056
JM		 13238 return;
13239
13240 nla_put_failure:
13241 genlmsg_cancel(msg, hdr);
13242 nlmsg_free(msg);
13243}
13244
6bad8766
LR		 13245void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
13246 struct ieee80211_channel *channel_before,
13247 struct ieee80211_channel *channel_after)
13248{
13249 struct sk_buff *msg;
13250 void *hdr;
13251 struct nlattr *nl_freq;
13252
fd2120ca 13253 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
6bad8766
LR		 13254 if (!msg)
13255 return;
13256
13257 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
13258 if (!hdr) {
13259 nlmsg_free(msg);
13260 return;
13261 }
13262
13263 /*
13264 * Since we are applying the beacon hint to a wiphy we know its
13265 * wiphy_idx is valid
13266 */
9360ffd1
DM		 13267 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
13268 goto nla_put_failure;
6bad8766
LR		 13269
13270 /* Before */
13271 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
13272 if (!nl_freq)
13273 goto nla_put_failure;
cdc89b97 13274 if (nl80211_msg_put_channel(msg, channel_before, false))
6bad8766
LR		 13275 goto nla_put_failure;
13276 nla_nest_end(msg, nl_freq);
13277
13278 /* After */
13279 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
13280 if (!nl_freq)
13281 goto nla_put_failure;
cdc89b97 13282 if (nl80211_msg_put_channel(msg, channel_after, false))
6bad8766
LR		 13283 goto nla_put_failure;
13284 nla_nest_end(msg, nl_freq);
13285
3b7b72ee 13286 genlmsg_end(msg, hdr);
6bad8766 13287
463d0183 13288 rcu_read_lock();
68eb5503 13289 genlmsg_multicast_allns(&nl80211_fam, msg, 0,
2a94fe48 13290 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
463d0183 13291 rcu_read_unlock();
6bad8766
LR		 13292
13293 return;
13294
13295nla_put_failure:
13296 genlmsg_cancel(msg, hdr);
13297 nlmsg_free(msg);
13298}
13299
9588bbd5
JM		 13300static void nl80211_send_remain_on_chan_event(
13301 int cmd, struct cfg80211_registered_device *rdev,
71bbc994 13302 struct wireless_dev *wdev, u64 cookie,
9588bbd5 13303 struct ieee80211_channel *chan,
9588bbd5
JM		 13304 unsigned int duration, gfp_t gfp)
13305{
13306 struct sk_buff *msg;
13307 void *hdr;
13308
13309 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13310 if (!msg)
13311 return;
13312
13313 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13314 if (!hdr) {
13315 nlmsg_free(msg);
13316 return;
13317 }
13318
9360ffd1 13319 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
71bbc994
JB		 13320 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13321 wdev->netdev->ifindex)) ||
2dad624e
ND		 13322 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13323 NL80211_ATTR_PAD) ||
9360ffd1 13324 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
42d97a59
JB		 13325 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
13326 NL80211_CHAN_NO_HT) ||
2dad624e
ND		 13327 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
13328 NL80211_ATTR_PAD))
9360ffd1 13329 goto nla_put_failure;
9588bbd5 13330
9360ffd1
DM		 13331 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
13332 nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
13333 goto nla_put_failure;
9588bbd5 13334
3b7b72ee 13335 genlmsg_end(msg, hdr);
9588bbd5 13336
68eb5503 13337 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13338 NL80211_MCGRP_MLME, gfp);
9588bbd5
JM		 13339 return;
13340
13341 nla_put_failure:
13342 genlmsg_cancel(msg, hdr);
13343 nlmsg_free(msg);
13344}
13345
947add36
JB		 13346void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
13347 struct ieee80211_channel *chan,
13348 unsigned int duration, gfp_t gfp)
9588bbd5 13349{
947add36 13350 struct wiphy *wiphy = wdev->wiphy;
f26cbf40 13351 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
947add36
JB		 13352
13353 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
9588bbd5 13354 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
71bbc994 13355 rdev, wdev, cookie, chan,
42d97a59 13356 duration, gfp);
9588bbd5 13357}
947add36 13358EXPORT_SYMBOL(cfg80211_ready_on_channel);
9588bbd5 13359
947add36
JB		 13360void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
13361 struct ieee80211_channel *chan,
13362 gfp_t gfp)
9588bbd5 13363{
947add36 13364 struct wiphy *wiphy = wdev->wiphy;
f26cbf40 13365 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
947add36
JB		 13366
13367 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
9588bbd5 13368 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
42d97a59 13369 rdev, wdev, cookie, chan, 0, gfp);
9588bbd5 13370}
947add36 13371EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
9588bbd5 13372
947add36
JB		 13373void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
13374 struct station_info *sinfo, gfp_t gfp)
98b62183 13375{
947add36 13376 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
f26cbf40 13377 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
98b62183
JB		 13378 struct sk_buff *msg;
13379
947add36
JB		 13380 trace_cfg80211_new_sta(dev, mac_addr, sinfo);
13381
58050fce 13382 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
98b62183
JB		 13383 if (!msg)
13384 return;
13385
cf5ead82 13386 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
66266b3a 13387 rdev, dev, mac_addr, sinfo) < 0) {
98b62183
JB		 13388 nlmsg_free(msg);
13389 return;
13390 }
13391
68eb5503 13392 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13393 NL80211_MCGRP_MLME, gfp);
98b62183 13394}
947add36 13395EXPORT_SYMBOL(cfg80211_new_sta);
98b62183 13396
cf5ead82
JB		 13397void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
13398 struct station_info *sinfo, gfp_t gfp)
ec15e68b 13399{
947add36 13400 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
f26cbf40 13401 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
ec15e68b 13402 struct sk_buff *msg;
cf5ead82
JB		 13403 struct station_info empty_sinfo = {};
13404
13405 if (!sinfo)
13406 sinfo = &empty_sinfo;
ec15e68b 13407
947add36
JB		 13408 trace_cfg80211_del_sta(dev, mac_addr);
13409
58050fce 13410 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
ec15e68b
JM		 13411 if (!msg)
13412 return;
13413
cf5ead82 13414 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
57007121 13415 rdev, dev, mac_addr, sinfo) < 0) {
ec15e68b
JM		 13416 nlmsg_free(msg);
13417 return;
13418 }
13419
68eb5503 13420 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13421 NL80211_MCGRP_MLME, gfp);
ec15e68b 13422}
cf5ead82 13423EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
ec15e68b 13424
947add36
JB		 13425void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
13426 enum nl80211_connect_failed_reason reason,
13427 gfp_t gfp)
ed44a951 13428{
947add36 13429 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
f26cbf40 13430 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
ed44a951
PP		 13431 struct sk_buff *msg;
13432 void *hdr;
13433
13434 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
13435 if (!msg)
13436 return;
13437
13438 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
13439 if (!hdr) {
13440 nlmsg_free(msg);
13441 return;
13442 }
13443
13444 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
13445 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
13446 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
13447 goto nla_put_failure;
13448
13449 genlmsg_end(msg, hdr);
13450
68eb5503 13451 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13452 NL80211_MCGRP_MLME, gfp);
ed44a951
PP		 13453 return;
13454
13455 nla_put_failure:
13456 genlmsg_cancel(msg, hdr);
13457 nlmsg_free(msg);
13458}
947add36 13459EXPORT_SYMBOL(cfg80211_conn_failed);
ed44a951 13460
b92ab5d8
JB		 13461static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
13462 const u8 *addr, gfp_t gfp)
28946da7
JB		 13463{
13464 struct wireless_dev *wdev = dev->ieee80211_ptr;
f26cbf40 13465 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
28946da7
JB		 13466 struct sk_buff *msg;
13467 void *hdr;
15e47304 13468 u32 nlportid = ACCESS_ONCE(wdev->ap_unexpected_nlportid);
28946da7 13469
15e47304 13470 if (!nlportid)
28946da7
JB		 13471 return false;
13472
13473 msg = nlmsg_new(100, gfp);
13474 if (!msg)
13475 return true;
13476
b92ab5d8 13477 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
28946da7
JB		 13478 if (!hdr) {
13479 nlmsg_free(msg);
13480 return true;
13481 }
13482
9360ffd1
DM		 13483 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13484 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
13485 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
13486 goto nla_put_failure;
28946da7 13487
9c90a9f6 13488 genlmsg_end(msg, hdr);
15e47304 13489 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
28946da7
JB		 13490 return true;
13491
13492 nla_put_failure:
13493 genlmsg_cancel(msg, hdr);
13494 nlmsg_free(msg);
13495 return true;
13496}
13497
947add36
JB		 13498bool cfg80211_rx_spurious_frame(struct net_device *dev,
13499 const u8 *addr, gfp_t gfp)
b92ab5d8 13500{
947add36
JB		 13501 struct wireless_dev *wdev = dev->ieee80211_ptr;
13502 bool ret;
13503
13504 trace_cfg80211_rx_spurious_frame(dev, addr);
13505
13506 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
13507 wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
13508 trace_cfg80211_return_bool(false);
13509 return false;
13510 }
13511 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
13512 addr, gfp);
13513 trace_cfg80211_return_bool(ret);
13514 return ret;
b92ab5d8 13515}
947add36 13516EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
b92ab5d8 13517
947add36
JB		 13518bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
13519 const u8 *addr, gfp_t gfp)
b92ab5d8 13520{
947add36
JB		 13521 struct wireless_dev *wdev = dev->ieee80211_ptr;
13522 bool ret;
13523
13524 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
13525
13526 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
13527 wdev->iftype != NL80211_IFTYPE_P2P_GO &&
13528 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
13529 trace_cfg80211_return_bool(false);
13530 return false;
13531 }
13532 ret = __nl80211_unexpected_frame(dev,
13533 NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
13534 addr, gfp);
13535 trace_cfg80211_return_bool(ret);
13536 return ret;
b92ab5d8 13537}
947add36 13538EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
b92ab5d8 13539
2e161f78 13540int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
15e47304 13541 struct wireless_dev *wdev, u32 nlportid,
804483e9 13542 int freq, int sig_dbm,
19504cf5 13543 const u8 *buf, size_t len, u32 flags, gfp_t gfp)
026331c4 13544{
71bbc994 13545 struct net_device *netdev = wdev->netdev;
026331c4
JM		 13546 struct sk_buff *msg;
13547 void *hdr;
026331c4
JM		 13548
13549 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13550 if (!msg)
13551 return -ENOMEM;
13552
2e161f78 13553 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
026331c4
JM		 13554 if (!hdr) {
13555 nlmsg_free(msg);
13556 return -ENOMEM;
13557 }
13558
9360ffd1 13559 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
71bbc994
JB		 13560 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13561 netdev->ifindex)) ||
2dad624e
ND		 13562 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13563 NL80211_ATTR_PAD) ||
9360ffd1
DM		 13564 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
13565 (sig_dbm &&
13566 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
19504cf5
VK		 13567 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
13568 (flags &&
13569 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
9360ffd1 13570 goto nla_put_failure;
026331c4 13571
3b7b72ee 13572 genlmsg_end(msg, hdr);
026331c4 13573
15e47304 13574 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
026331c4
JM		 13575
13576 nla_put_failure:
13577 genlmsg_cancel(msg, hdr);
13578 nlmsg_free(msg);
13579 return -ENOBUFS;
13580}
13581
947add36
JB		 13582void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
13583 const u8 *buf, size_t len, bool ack, gfp_t gfp)
026331c4 13584{
947add36 13585 struct wiphy *wiphy = wdev->wiphy;
f26cbf40 13586 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
71bbc994 13587 struct net_device *netdev = wdev->netdev;
026331c4
JM		 13588 struct sk_buff *msg;
13589 void *hdr;
13590
947add36
JB		 13591 trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
13592
026331c4
JM		 13593 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13594 if (!msg)
13595 return;
13596
2e161f78 13597 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
026331c4
JM		 13598 if (!hdr) {
13599 nlmsg_free(msg);
13600 return;
13601 }
13602
9360ffd1 13603 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
71bbc994
JB		 13604 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13605 netdev->ifindex)) ||
2dad624e
ND		 13606 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13607 NL80211_ATTR_PAD) ||
9360ffd1 13608 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
2dad624e
ND		 13609 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
13610 NL80211_ATTR_PAD) ||
9360ffd1
DM		 13611 (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
13612 goto nla_put_failure;
026331c4 13613
3b7b72ee 13614 genlmsg_end(msg, hdr);
026331c4 13615
68eb5503 13616 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13617 NL80211_MCGRP_MLME, gfp);
026331c4
JM		 13618 return;
13619
13620 nla_put_failure:
13621 genlmsg_cancel(msg, hdr);
13622 nlmsg_free(msg);
13623}
947add36 13624EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
026331c4 13625
5b97f49d
JB		 13626static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
13627 const char *mac, gfp_t gfp)
d6dc1a38 13628{
947add36 13629 struct wireless_dev *wdev = dev->ieee80211_ptr;
5b97f49d
JB		 13630 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
13631 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13632 void **cb;
947add36 13633
d6dc1a38 13634 if (!msg)
5b97f49d 13635 return NULL;
d6dc1a38 13636
5b97f49d
JB		 13637 cb = (void **)msg->cb;
13638
13639 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
13640 if (!cb[0]) {
d6dc1a38 13641 nlmsg_free(msg);
5b97f49d 13642 return NULL;
d6dc1a38
JO		 13643 }
13644
9360ffd1 13645 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
947add36 13646 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
9360ffd1 13647 goto nla_put_failure;
d6dc1a38 13648
5b97f49d 13649 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
d6dc1a38
JO		 13650 goto nla_put_failure;
13651
5b97f49d
JB		 13652 cb[1] = nla_nest_start(msg, NL80211_ATTR_CQM);
13653 if (!cb[1])
9360ffd1 13654 goto nla_put_failure;
d6dc1a38 13655
5b97f49d 13656 cb[2] = rdev;
d6dc1a38 13657
5b97f49d
JB		 13658 return msg;
13659 nla_put_failure:
13660 nlmsg_free(msg);
13661 return NULL;
13662}
13663
13664static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
13665{
13666 void **cb = (void **)msg->cb;
13667 struct cfg80211_registered_device *rdev = cb[2];
13668
13669 nla_nest_end(msg, cb[1]);
13670 genlmsg_end(msg, cb[0]);
13671
13672 memset(msg->cb, 0, sizeof(msg->cb));
d6dc1a38 13673
68eb5503 13674 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13675 NL80211_MCGRP_MLME, gfp);
5b97f49d
JB		 13676}
13677
13678void cfg80211_cqm_rssi_notify(struct net_device *dev,
13679 enum nl80211_cqm_rssi_threshold_event rssi_event,
13680 gfp_t gfp)
13681{
13682 struct sk_buff *msg;
13683
13684 trace_cfg80211_cqm_rssi_notify(dev, rssi_event);
13685
98f03342
JB		 13686 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
13687 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
13688 return;
13689
5b97f49d
JB		 13690 msg = cfg80211_prepare_cqm(dev, NULL, gfp);
13691 if (!msg)
13692 return;
13693
13694 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
13695 rssi_event))
13696 goto nla_put_failure;
13697
13698 cfg80211_send_cqm(msg, gfp);
13699
d6dc1a38
JO		 13700 return;
13701
13702 nla_put_failure:
d6dc1a38
JO		 13703 nlmsg_free(msg);
13704}
947add36 13705EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
d6dc1a38 13706
5b97f49d
JB		 13707void cfg80211_cqm_txe_notify(struct net_device *dev,
13708 const u8 *peer, u32 num_packets,
13709 u32 rate, u32 intvl, gfp_t gfp)
13710{
13711 struct sk_buff *msg;
13712
13713 msg = cfg80211_prepare_cqm(dev, peer, gfp);
13714 if (!msg)
13715 return;
13716
13717 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
13718 goto nla_put_failure;
13719
13720 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
13721 goto nla_put_failure;
13722
13723 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
13724 goto nla_put_failure;
13725
13726 cfg80211_send_cqm(msg, gfp);
13727 return;
13728
13729 nla_put_failure:
13730 nlmsg_free(msg);
13731}
13732EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
13733
13734void cfg80211_cqm_pktloss_notify(struct net_device *dev,
13735 const u8 *peer, u32 num_packets, gfp_t gfp)
13736{
13737 struct sk_buff *msg;
13738
13739 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
13740
13741 msg = cfg80211_prepare_cqm(dev, peer, gfp);
13742 if (!msg)
13743 return;
13744
13745 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
13746 goto nla_put_failure;
13747
13748 cfg80211_send_cqm(msg, gfp);
13749 return;
13750
13751 nla_put_failure:
13752 nlmsg_free(msg);
13753}
13754EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
13755
98f03342
JB		 13756void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
13757{
13758 struct sk_buff *msg;
13759
13760 msg = cfg80211_prepare_cqm(dev, NULL, gfp);
13761 if (!msg)
13762 return;
13763
13764 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
13765 goto nla_put_failure;
13766
13767 cfg80211_send_cqm(msg, gfp);
13768 return;
13769
13770 nla_put_failure:
13771 nlmsg_free(msg);
13772}
13773EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
13774
947add36
JB		 13775static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
13776 struct net_device *netdev, const u8 *bssid,
13777 const u8 *replay_ctr, gfp_t gfp)
e5497d76
JB		 13778{
13779 struct sk_buff *msg;
13780 struct nlattr *rekey_attr;
13781 void *hdr;
13782
58050fce 13783 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
e5497d76
JB		 13784 if (!msg)
13785 return;
13786
13787 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
13788 if (!hdr) {
13789 nlmsg_free(msg);
13790 return;
13791 }
13792
9360ffd1
DM		 13793 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13794 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13795 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
13796 goto nla_put_failure;
e5497d76
JB		 13797
13798 rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
13799 if (!rekey_attr)
13800 goto nla_put_failure;
13801
9360ffd1
DM		 13802 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
13803 NL80211_REPLAY_CTR_LEN, replay_ctr))
13804 goto nla_put_failure;
e5497d76
JB		 13805
13806 nla_nest_end(msg, rekey_attr);
13807
3b7b72ee 13808 genlmsg_end(msg, hdr);
e5497d76 13809
68eb5503 13810 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13811 NL80211_MCGRP_MLME, gfp);
e5497d76
JB		 13812 return;
13813
13814 nla_put_failure:
13815 genlmsg_cancel(msg, hdr);
13816 nlmsg_free(msg);
13817}
13818
947add36
JB		 13819void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
13820 const u8 *replay_ctr, gfp_t gfp)
13821{
13822 struct wireless_dev *wdev = dev->ieee80211_ptr;
13823 struct wiphy *wiphy = wdev->wiphy;
f26cbf40 13824 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
947add36
JB		 13825
13826 trace_cfg80211_gtk_rekey_notify(dev, bssid);
13827 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
13828}
13829EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
13830
13831static void
13832nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
13833 struct net_device *netdev, int index,
13834 const u8 *bssid, bool preauth, gfp_t gfp)
c9df56b4
JM		 13835{
13836 struct sk_buff *msg;
13837 struct nlattr *attr;
13838 void *hdr;
13839
58050fce 13840 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
c9df56b4
JM		 13841 if (!msg)
13842 return;
13843
13844 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
13845 if (!hdr) {
13846 nlmsg_free(msg);
13847 return;
13848 }
13849
9360ffd1
DM		 13850 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13851 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
13852 goto nla_put_failure;
c9df56b4
JM		 13853
13854 attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
13855 if (!attr)
13856 goto nla_put_failure;
13857
9360ffd1
DM		 13858 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
13859 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
13860 (preauth &&
13861 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
13862 goto nla_put_failure;
c9df56b4
JM		 13863
13864 nla_nest_end(msg, attr);
13865
3b7b72ee 13866 genlmsg_end(msg, hdr);
c9df56b4 13867
68eb5503 13868 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13869 NL80211_MCGRP_MLME, gfp);
c9df56b4
JM		 13870 return;
13871
13872 nla_put_failure:
13873 genlmsg_cancel(msg, hdr);
13874 nlmsg_free(msg);
13875}
13876
947add36
JB		 13877void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
13878 const u8 *bssid, bool preauth, gfp_t gfp)
13879{
13880 struct wireless_dev *wdev = dev->ieee80211_ptr;
13881 struct wiphy *wiphy = wdev->wiphy;
f26cbf40 13882 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
947add36
JB		 13883
13884 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
13885 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
13886}
13887EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
13888
13889static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
13890 struct net_device *netdev,
13891 struct cfg80211_chan_def *chandef,
f8d7552e
LC		 13892 gfp_t gfp,
13893 enum nl80211_commands notif,
13894 u8 count)
5314526b
TP		 13895{
13896 struct sk_buff *msg;
13897 void *hdr;
13898
58050fce 13899 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
5314526b
TP		 13900 if (!msg)
13901 return;
13902
f8d7552e 13903 hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
5314526b
TP		 13904 if (!hdr) {
13905 nlmsg_free(msg);
13906 return;
13907 }
13908
683b6d3b
JB		 13909 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
13910 goto nla_put_failure;
13911
13912 if (nl80211_send_chandef(msg, chandef))
7eab0f64 13913 goto nla_put_failure;
5314526b 13914
f8d7552e
LC		 13915 if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
13916 (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
13917 goto nla_put_failure;
13918
5314526b
TP		 13919 genlmsg_end(msg, hdr);
13920
68eb5503 13921 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 13922 NL80211_MCGRP_MLME, gfp);
5314526b
TP		 13923 return;
13924
13925 nla_put_failure:
13926 genlmsg_cancel(msg, hdr);
13927 nlmsg_free(msg);
13928}
13929
947add36
JB		 13930void cfg80211_ch_switch_notify(struct net_device *dev,
13931 struct cfg80211_chan_def *chandef)
84f10708 13932{
947add36
JB		 13933 struct wireless_dev *wdev = dev->ieee80211_ptr;
13934 struct wiphy *wiphy = wdev->wiphy;
f26cbf40 13935 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
947add36 13936
e487eaeb 13937 ASSERT_WDEV_LOCK(wdev);
947add36 13938
e487eaeb 13939 trace_cfg80211_ch_switch_notify(dev, chandef);
947add36 13940
9e0e2961 13941 wdev->chandef = *chandef;
96f55f12 13942 wdev->preset_chandef = *chandef;
f8d7552e
LC		 13943 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
13944 NL80211_CMD_CH_SWITCH_NOTIFY, 0);
947add36
JB		 13945}
13946EXPORT_SYMBOL(cfg80211_ch_switch_notify);
13947
f8d7552e
LC		 13948void cfg80211_ch_switch_started_notify(struct net_device *dev,
13949 struct cfg80211_chan_def *chandef,
13950 u8 count)
13951{
13952 struct wireless_dev *wdev = dev->ieee80211_ptr;
13953 struct wiphy *wiphy = wdev->wiphy;
13954 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13955
13956 trace_cfg80211_ch_switch_started_notify(dev, chandef);
13957
13958 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
13959 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
13960}
13961EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
13962
04f39047
SW		 13963void
13964nl80211_radar_notify(struct cfg80211_registered_device *rdev,
d2859df5 13965 const struct cfg80211_chan_def *chandef,
04f39047
SW		 13966 enum nl80211_radar_event event,
13967 struct net_device *netdev, gfp_t gfp)
13968{
13969 struct sk_buff *msg;
13970 void *hdr;
13971
13972 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13973 if (!msg)
13974 return;
13975
13976 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
13977 if (!hdr) {
13978 nlmsg_free(msg);
13979 return;
13980 }
13981
13982 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
13983 goto nla_put_failure;
13984
13985 /* NOP and radar events don't need a netdev parameter */
13986 if (netdev) {
13987 struct wireless_dev *wdev = netdev->ieee80211_ptr;
13988
13989 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
2dad624e
ND		 13990 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13991 NL80211_ATTR_PAD))
04f39047
SW		 13992 goto nla_put_failure;
13993 }
13994
13995 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
13996 goto nla_put_failure;
13997
13998 if (nl80211_send_chandef(msg, chandef))
13999 goto nla_put_failure;
14000
9c90a9f6 14001 genlmsg_end(msg, hdr);
04f39047 14002
68eb5503 14003 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 14004 NL80211_MCGRP_MLME, gfp);
04f39047
SW		 14005 return;
14006
14007 nla_put_failure:
14008 genlmsg_cancel(msg, hdr);
14009 nlmsg_free(msg);
14010}
14011
7f6cf311
JB		 14012void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
14013 u64 cookie, bool acked, gfp_t gfp)
14014{
14015 struct wireless_dev *wdev = dev->ieee80211_ptr;
f26cbf40 14016 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
7f6cf311
JB		 14017 struct sk_buff *msg;
14018 void *hdr;
7f6cf311 14019
4ee3e063
BL		 14020 trace_cfg80211_probe_status(dev, addr, cookie, acked);
14021
58050fce 14022 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
4ee3e063 14023
7f6cf311
JB		 14024 if (!msg)
14025 return;
14026
14027 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
14028 if (!hdr) {
14029 nlmsg_free(msg);
14030 return;
14031 }
14032
9360ffd1
DM		 14033 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14034 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14035 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
2dad624e
ND		 14036 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14037 NL80211_ATTR_PAD) ||
9360ffd1
DM		 14038 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)))
14039 goto nla_put_failure;
7f6cf311 14040
9c90a9f6 14041 genlmsg_end(msg, hdr);
7f6cf311 14042
68eb5503 14043 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 14044 NL80211_MCGRP_MLME, gfp);
7f6cf311
JB		 14045 return;
14046
14047 nla_put_failure:
14048 genlmsg_cancel(msg, hdr);
14049 nlmsg_free(msg);
14050}
14051EXPORT_SYMBOL(cfg80211_probe_status);
14052
5e760230
JB		 14053void cfg80211_report_obss_beacon(struct wiphy *wiphy,
14054 const u8 *frame, size_t len,
37c73b5f 14055 int freq, int sig_dbm)
5e760230 14056{
f26cbf40 14057 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
5e760230
JB		 14058 struct sk_buff *msg;
14059 void *hdr;
37c73b5f 14060 struct cfg80211_beacon_registration *reg;
5e760230 14061
4ee3e063
BL		 14062 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
14063
37c73b5f
BG		 14064 spin_lock_bh(&rdev->beacon_registrations_lock);
14065 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
14066 msg = nlmsg_new(len + 100, GFP_ATOMIC);
14067 if (!msg) {
14068 spin_unlock_bh(&rdev->beacon_registrations_lock);
14069 return;
14070 }
5e760230 14071
37c73b5f
BG		 14072 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
14073 if (!hdr)
14074 goto nla_put_failure;
5e760230 14075
37c73b5f
BG		 14076 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14077 (freq &&
14078 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
14079 (sig_dbm &&
14080 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
14081 nla_put(msg, NL80211_ATTR_FRAME, len, frame))
14082 goto nla_put_failure;
5e760230 14083
37c73b5f 14084 genlmsg_end(msg, hdr);
5e760230 14085
37c73b5f
BG		 14086 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
14087 }
14088 spin_unlock_bh(&rdev->beacon_registrations_lock);
5e760230
JB		 14089 return;
14090
14091 nla_put_failure:
37c73b5f
BG		 14092 spin_unlock_bh(&rdev->beacon_registrations_lock);
14093 if (hdr)
14094 genlmsg_cancel(msg, hdr);
5e760230
JB		 14095 nlmsg_free(msg);
14096}
14097EXPORT_SYMBOL(cfg80211_report_obss_beacon);
14098
cd8f7cb4 14099#ifdef CONFIG_PM
8cd4d456
LC		 14100static int cfg80211_net_detect_results(struct sk_buff *msg,
14101 struct cfg80211_wowlan_wakeup *wakeup)
14102{
14103 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
14104 struct nlattr *nl_results, *nl_match, *nl_freqs;
14105 int i, j;
14106
14107 nl_results = nla_nest_start(
14108 msg, NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
14109 if (!nl_results)
14110 return -EMSGSIZE;
14111
14112 for (i = 0; i < nd->n_matches; i++) {
14113 struct cfg80211_wowlan_nd_match *match = nd->matches[i];
14114
14115 nl_match = nla_nest_start(msg, i);
14116 if (!nl_match)
14117 break;
14118
14119 /* The SSID attribute is optional in nl80211, but for
14120 * simplicity reasons it's always present in the
14121 * cfg80211 structure. If a driver can't pass the
14122 * SSID, that needs to be changed. A zero length SSID
14123 * is still a valid SSID (wildcard), so it cannot be
14124 * used for this purpose.
14125 */
14126 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
14127 match->ssid.ssid)) {
14128 nla_nest_cancel(msg, nl_match);
14129 goto out;
14130 }
14131
14132 if (match->n_channels) {
14133 nl_freqs = nla_nest_start(
14134 msg, NL80211_ATTR_SCAN_FREQUENCIES);
14135 if (!nl_freqs) {
14136 nla_nest_cancel(msg, nl_match);
14137 goto out;
14138 }
14139
14140 for (j = 0; j < match->n_channels; j++) {
5528fae8 14141 if (nla_put_u32(msg, j, match->channels[j])) {
8cd4d456
LC		 14142 nla_nest_cancel(msg, nl_freqs);
14143 nla_nest_cancel(msg, nl_match);
14144 goto out;
14145 }
14146 }
14147
14148 nla_nest_end(msg, nl_freqs);
14149 }
14150
14151 nla_nest_end(msg, nl_match);
14152 }
14153
14154out:
14155 nla_nest_end(msg, nl_results);
14156 return 0;
14157}
14158
cd8f7cb4
JB		 14159void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
14160 struct cfg80211_wowlan_wakeup *wakeup,
14161 gfp_t gfp)
14162{
f26cbf40 14163 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
cd8f7cb4
JB		 14164 struct sk_buff *msg;
14165 void *hdr;
9c90a9f6 14166 int size = 200;
cd8f7cb4
JB		 14167
14168 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
14169
14170 if (wakeup)
14171 size += wakeup->packet_present_len;
14172
14173 msg = nlmsg_new(size, gfp);
14174 if (!msg)
14175 return;
14176
14177 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
14178 if (!hdr)
14179 goto free_msg;
14180
14181 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
2dad624e
ND		 14182 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14183 NL80211_ATTR_PAD))
cd8f7cb4
JB		 14184 goto free_msg;
14185
14186 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14187 wdev->netdev->ifindex))
14188 goto free_msg;
14189
14190 if (wakeup) {
14191 struct nlattr *reasons;
14192
14193 reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
7fa322c8
JB		 14194 if (!reasons)
14195 goto free_msg;
cd8f7cb4
JB		 14196
14197 if (wakeup->disconnect &&
14198 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
14199 goto free_msg;
14200 if (wakeup->magic_pkt &&
14201 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
14202 goto free_msg;
14203 if (wakeup->gtk_rekey_failure &&
14204 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
14205 goto free_msg;
14206 if (wakeup->eap_identity_req &&
14207 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
14208 goto free_msg;
14209 if (wakeup->four_way_handshake &&
14210 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
14211 goto free_msg;
14212 if (wakeup->rfkill_release &&
14213 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
14214 goto free_msg;
14215
14216 if (wakeup->pattern_idx >= 0 &&
14217 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
14218 wakeup->pattern_idx))
14219 goto free_msg;
14220
ae917c9f
JB		 14221 if (wakeup->tcp_match &&
14222 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
14223 goto free_msg;
2a0e047e 14224
ae917c9f
JB		 14225 if (wakeup->tcp_connlost &&
14226 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
14227 goto free_msg;
2a0e047e 14228
ae917c9f
JB		 14229 if (wakeup->tcp_nomoretokens &&
14230 nla_put_flag(msg,
14231 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
14232 goto free_msg;
2a0e047e 14233
cd8f7cb4
JB		 14234 if (wakeup->packet) {
14235 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
14236 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
14237
14238 if (!wakeup->packet_80211) {
14239 pkt_attr =
14240 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
14241 len_attr =
14242 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
14243 }
14244
14245 if (wakeup->packet_len &&
14246 nla_put_u32(msg, len_attr, wakeup->packet_len))
14247 goto free_msg;
14248
14249 if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
14250 wakeup->packet))
14251 goto free_msg;
14252 }
14253
8cd4d456
LC		 14254 if (wakeup->net_detect &&
14255 cfg80211_net_detect_results(msg, wakeup))
14256 goto free_msg;
14257
cd8f7cb4
JB		 14258 nla_nest_end(msg, reasons);
14259 }
14260
9c90a9f6 14261 genlmsg_end(msg, hdr);
cd8f7cb4 14262
68eb5503 14263 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 14264 NL80211_MCGRP_MLME, gfp);
cd8f7cb4
JB		 14265 return;
14266
14267 free_msg:
14268 nlmsg_free(msg);
14269}
14270EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
14271#endif
14272
3475b094
JM		 14273void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
14274 enum nl80211_tdls_operation oper,
14275 u16 reason_code, gfp_t gfp)
14276{
14277 struct wireless_dev *wdev = dev->ieee80211_ptr;
f26cbf40 14278 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
3475b094
JM		 14279 struct sk_buff *msg;
14280 void *hdr;
3475b094
JM		 14281
14282 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
14283 reason_code);
14284
14285 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14286 if (!msg)
14287 return;
14288
14289 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
14290 if (!hdr) {
14291 nlmsg_free(msg);
14292 return;
14293 }
14294
14295 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14296 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14297 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
14298 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
14299 (reason_code > 0 &&
14300 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
14301 goto nla_put_failure;
14302
9c90a9f6 14303 genlmsg_end(msg, hdr);
3475b094 14304
68eb5503 14305 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 14306 NL80211_MCGRP_MLME, gfp);
3475b094
JM		 14307 return;
14308
14309 nla_put_failure:
14310 genlmsg_cancel(msg, hdr);
14311 nlmsg_free(msg);
14312}
14313EXPORT_SYMBOL(cfg80211_tdls_oper_request);
14314
026331c4
JM		 14315static int nl80211_netlink_notify(struct notifier_block * nb,
14316 unsigned long state,
14317 void *_notify)
14318{
14319 struct netlink_notify *notify = _notify;
14320 struct cfg80211_registered_device *rdev;
14321 struct wireless_dev *wdev;
37c73b5f 14322 struct cfg80211_beacon_registration *reg, *tmp;
026331c4 14323
8f815cdd 14324 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
026331c4
JM		 14325 return NOTIFY_DONE;
14326
14327 rcu_read_lock();
14328
5e760230 14329 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
78f22b6a 14330 bool schedule_destroy_work = false;
93a1e86c
JR		 14331 bool schedule_scan_stop = false;
14332 struct cfg80211_sched_scan_request *sched_scan_req =
14333 rcu_dereference(rdev->sched_scan_req);
14334
14335 if (sched_scan_req && notify->portid &&
14336 sched_scan_req->owner_nlportid == notify->portid)
14337 schedule_scan_stop = true;
78f22b6a 14338
53873f13 14339 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
15e47304 14340 cfg80211_mlme_unregister_socket(wdev, notify->portid);
37c73b5f 14341
78f22b6a
JB		 14342 if (wdev->owner_nlportid == notify->portid)
14343 schedule_destroy_work = true;
14344 }
14345
37c73b5f
BG		 14346 spin_lock_bh(&rdev->beacon_registrations_lock);
14347 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
14348 list) {
14349 if (reg->nlportid == notify->portid) {
14350 list_del(&reg->list);
14351 kfree(reg);
14352 break;
14353 }
14354 }
14355 spin_unlock_bh(&rdev->beacon_registrations_lock);
78f22b6a
JB		 14356
14357 if (schedule_destroy_work) {
14358 struct cfg80211_iface_destroy *destroy;
14359
14360 destroy = kzalloc(sizeof(*destroy), GFP_ATOMIC);
14361 if (destroy) {
14362 destroy->nlportid = notify->portid;
14363 spin_lock(&rdev->destroy_list_lock);
14364 list_add(&destroy->list, &rdev->destroy_list);
14365 spin_unlock(&rdev->destroy_list_lock);
14366 schedule_work(&rdev->destroy_work);
14367 }
93a1e86c
JR		 14368 } else if (schedule_scan_stop) {
14369 sched_scan_req->owner_nlportid = 0;
14370
14371 if (rdev->ops->sched_scan_stop &&
14372 rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN)
14373 schedule_work(&rdev->sched_scan_stop_wk);
78f22b6a 14374 }
5e760230 14375 }
026331c4
JM		 14376
14377 rcu_read_unlock();
14378
05050753
I		 14379 /*
14380 * It is possible that the user space process that is controlling the
14381 * indoor setting disappeared, so notify the regulatory core.
14382 */
14383 regulatory_netlink_notify(notify->portid);
6784c7db 14384 return NOTIFY_OK;
026331c4
JM		 14385}
14386
14387static struct notifier_block nl80211_netlink_notifier = {
14388 .notifier_call = nl80211_netlink_notify,
14389};
14390
355199e0
JM		 14391void cfg80211_ft_event(struct net_device *netdev,
14392 struct cfg80211_ft_event_params *ft_event)
14393{
14394 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
f26cbf40 14395 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
355199e0
JM		 14396 struct sk_buff *msg;
14397 void *hdr;
355199e0
JM		 14398
14399 trace_cfg80211_ft_event(wiphy, netdev, ft_event);
14400
14401 if (!ft_event->target_ap)
14402 return;
14403
14404 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14405 if (!msg)
14406 return;
14407
14408 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
ae917c9f
JB		 14409 if (!hdr)
14410 goto out;
355199e0 14411
ae917c9f
JB		 14412 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14413 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14414 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
14415 goto out;
355199e0 14416
ae917c9f
JB		 14417 if (ft_event->ies &&
14418 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
14419 goto out;
14420 if (ft_event->ric_ies &&
14421 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
14422 ft_event->ric_ies))
14423 goto out;
355199e0 14424
9c90a9f6 14425 genlmsg_end(msg, hdr);
355199e0 14426
68eb5503 14427 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
2a94fe48 14428 NL80211_MCGRP_MLME, GFP_KERNEL);
ae917c9f
JB		 14429 return;
14430 out:
14431 nlmsg_free(msg);
355199e0
JM		 14432}
14433EXPORT_SYMBOL(cfg80211_ft_event);
14434
5de17984
AS		 14435void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
14436{
14437 struct cfg80211_registered_device *rdev;
14438 struct sk_buff *msg;
14439 void *hdr;
14440 u32 nlportid;
14441
f26cbf40 14442 rdev = wiphy_to_rdev(wdev->wiphy);
5de17984
AS		 14443 if (!rdev->crit_proto_nlportid)
14444 return;
14445
14446 nlportid = rdev->crit_proto_nlportid;
14447 rdev->crit_proto_nlportid = 0;
14448
14449 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14450 if (!msg)
14451 return;
14452
14453 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
14454 if (!hdr)
14455 goto nla_put_failure;
14456
14457 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
2dad624e
ND		 14458 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14459 NL80211_ATTR_PAD))
5de17984
AS		 14460 goto nla_put_failure;
14461
14462 genlmsg_end(msg, hdr);
14463
14464 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
14465 return;
14466
14467 nla_put_failure:
14468 if (hdr)
14469 genlmsg_cancel(msg, hdr);
14470 nlmsg_free(msg);
5de17984
AS		 14471}
14472EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
14473
348baf0e
JB		 14474void nl80211_send_ap_stopped(struct wireless_dev *wdev)
14475{
14476 struct wiphy *wiphy = wdev->wiphy;
f26cbf40 14477 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
348baf0e
JB		 14478 struct sk_buff *msg;
14479 void *hdr;
14480
14481 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14482 if (!msg)
14483 return;
14484
14485 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
14486 if (!hdr)
14487 goto out;
14488
14489 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14490 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
2dad624e
ND		 14491 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14492 NL80211_ATTR_PAD))
348baf0e
JB		 14493 goto out;
14494
14495 genlmsg_end(msg, hdr);
14496
14497 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
14498 NL80211_MCGRP_MLME, GFP_KERNEL);
14499 return;
14500 out:
14501 nlmsg_free(msg);
14502}
14503
55682965
JB		 14504/* initialisation/exit functions */
14505
14506int nl80211_init(void)
14507{
0d63cbb5 14508 int err;
55682965 14509
2a94fe48
JB		 14510 err = genl_register_family_with_ops_groups(&nl80211_fam, nl80211_ops,
14511 nl80211_mcgrps);
55682965
JB		 14512 if (err)
14513 return err;
14514
026331c4
JM		 14515 err = netlink_register_notifier(&nl80211_netlink_notifier);
14516 if (err)
14517 goto err_out;
14518
55682965
JB		 14519 return 0;
14520 err_out:
14521 genl_unregister_family(&nl80211_fam);
14522 return err;
14523}
14524
14525void nl80211_exit(void)
14526{
026331c4 14527 netlink_unregister_notifier(&nl80211_netlink_notifier);
55682965
JB		 14528 genl_unregister_family(&nl80211_fam);
14529}
ubuntu-bionic-kernel mirror