projects / linux-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
mac80211/minstrel_ht: add support for using CCK rates
[linux-block.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>
55682965
JB		 5 */
6
7#include <linux/if.h>
8#include <linux/module.h>
9#include <linux/err.h>
5a0e3ad6 10#include <linux/slab.h>
55682965
JB		 11#include <linux/list.h>
12#include <linux/if_ether.h>
13#include <linux/ieee80211.h>
14#include <linux/nl80211.h>
15#include <linux/rtnetlink.h>
16#include <linux/netlink.h>
2a519311 17#include <linux/etherdevice.h>
463d0183 18#include <net/net_namespace.h>
55682965
JB		 19#include <net/genetlink.h>
20#include <net/cfg80211.h>
463d0183 21#include <net/sock.h>
55682965
JB		 22#include "core.h"
23#include "nl80211.h"
b2e1b302 24#include "reg.h"
e35e4d28 25#include "rdev-ops.h"
55682965 26
5fb628e9
JM		 27static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
28 struct genl_info *info,
29 struct cfg80211_crypto_settings *settings,
30 int cipher_limit);
31
4c476991
JB		 32static int nl80211_pre_doit(struct genl_ops *ops, struct sk_buff *skb,
33 struct genl_info *info);
34static void nl80211_post_doit(struct genl_ops *ops, struct sk_buff *skb,
35 struct genl_info *info);
36
55682965
JB		 37/* the netlink family */
38static struct genl_family nl80211_fam = {
39 .id = GENL_ID_GENERATE, /* don't bother with a hardcoded ID */
40 .name = "nl80211", /* have users key off the name instead */
41 .hdrsize = 0, /* no private header */
42 .version = 1, /* no particular meaning now */
43 .maxattr = NL80211_ATTR_MAX,
463d0183 44 .netnsok = true,
4c476991
JB		 45 .pre_doit = nl80211_pre_doit,
46 .post_doit = nl80211_post_doit,
55682965
JB		 47};
48
89a54e48
JB		 49/* returns ERR_PTR values */
50static struct wireless_dev *
51__cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
55682965 52{
89a54e48
JB		 53 struct cfg80211_registered_device *rdev;
54 struct wireless_dev *result = NULL;
55 bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
56 bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
57 u64 wdev_id;
58 int wiphy_idx = -1;
59 int ifidx = -1;
55682965 60
89a54e48 61 assert_cfg80211_lock();
55682965 62
89a54e48
JB		 63 if (!have_ifidx && !have_wdev_id)
64 return ERR_PTR(-EINVAL);
55682965 65
89a54e48
JB		 66 if (have_ifidx)
67 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
68 if (have_wdev_id) {
69 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
70 wiphy_idx = wdev_id >> 32;
55682965
JB		 71 }
72
89a54e48
JB		 73 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
74 struct wireless_dev *wdev;
75
76 if (wiphy_net(&rdev->wiphy) != netns)
77 continue;
78
79 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
80 continue;
81
82 mutex_lock(&rdev->devlist_mtx);
83 list_for_each_entry(wdev, &rdev->wdev_list, list) {
84 if (have_ifidx && wdev->netdev &&
85 wdev->netdev->ifindex == ifidx) {
86 result = wdev;
87 break;
88 }
89 if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
90 result = wdev;
91 break;
92 }
93 }
94 mutex_unlock(&rdev->devlist_mtx);
95
96 if (result)
97 break;
98 }
99
100 if (result)
101 return result;
102 return ERR_PTR(-ENODEV);
55682965
JB		 103}
104
a9455408 105static struct cfg80211_registered_device *
878d9ec7 106__cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
a9455408 107{
7fee4778
JB		 108 struct cfg80211_registered_device *rdev = NULL, *tmp;
109 struct net_device *netdev;
a9455408
JB		 110
111 assert_cfg80211_lock();
112
878d9ec7 113 if (!attrs[NL80211_ATTR_WIPHY] &&
89a54e48
JB		 114 !attrs[NL80211_ATTR_IFINDEX] &&
115 !attrs[NL80211_ATTR_WDEV])
7fee4778
JB		 116 return ERR_PTR(-EINVAL);
117
878d9ec7 118 if (attrs[NL80211_ATTR_WIPHY])
7fee4778 119 rdev = cfg80211_rdev_by_wiphy_idx(
878d9ec7 120 nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
a9455408 121
89a54e48
JB		 122 if (attrs[NL80211_ATTR_WDEV]) {
123 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
124 struct wireless_dev *wdev;
125 bool found = false;
126
127 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
128 if (tmp) {
129 /* make sure wdev exists */
130 mutex_lock(&tmp->devlist_mtx);
131 list_for_each_entry(wdev, &tmp->wdev_list, list) {
132 if (wdev->identifier != (u32)wdev_id)
133 continue;
134 found = true;
135 break;
136 }
137 mutex_unlock(&tmp->devlist_mtx);
138
139 if (!found)
140 tmp = NULL;
141
142 if (rdev && tmp != rdev)
143 return ERR_PTR(-EINVAL);
144 rdev = tmp;
145 }
146 }
147
878d9ec7
JB		 148 if (attrs[NL80211_ATTR_IFINDEX]) {
149 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
4f7eff10 150 netdev = dev_get_by_index(netns, ifindex);
7fee4778
JB		 151 if (netdev) {
152 if (netdev->ieee80211_ptr)
153 tmp = wiphy_to_dev(
154 netdev->ieee80211_ptr->wiphy);
155 else
156 tmp = NULL;
157
158 dev_put(netdev);
159
160 /* not wireless device -- return error */
161 if (!tmp)
162 return ERR_PTR(-EINVAL);
163
164 /* mismatch -- return error */
165 if (rdev && tmp != rdev)
166 return ERR_PTR(-EINVAL);
167
168 rdev = tmp;
a9455408 169 }
a9455408 170 }
a9455408 171
4f7eff10
JB		 172 if (!rdev)
173 return ERR_PTR(-ENODEV);
a9455408 174
4f7eff10
JB		 175 if (netns != wiphy_net(&rdev->wiphy))
176 return ERR_PTR(-ENODEV);
177
178 return rdev;
a9455408
JB		 179}
180
181/*
182 * This function returns a pointer to the driver
183 * that the genl_info item that is passed refers to.
184 * If successful, it returns non-NULL and also locks
185 * the driver's mutex!
186 *
187 * This means that you need to call cfg80211_unlock_rdev()
188 * before being allowed to acquire &cfg80211_mutex!
189 *
190 * This is necessary because we need to lock the global
191 * mutex to get an item off the list safely, and then
192 * we lock the rdev mutex so it doesn't go away under us.
193 *
194 * We don't want to keep cfg80211_mutex locked
195 * for all the time in order to allow requests on
196 * other interfaces to go through at the same time.
197 *
198 * The result of this can be a PTR_ERR and hence must
199 * be checked with IS_ERR() for errors.
200 */
201static struct cfg80211_registered_device *
4f7eff10 202cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
a9455408
JB		 203{
204 struct cfg80211_registered_device *rdev;
205
206 mutex_lock(&cfg80211_mutex);
878d9ec7 207 rdev = __cfg80211_rdev_from_attrs(netns, info->attrs);
a9455408
JB		 208
209 /* if it is not an error we grab the lock on
210 * it to assure it won't be going away while
211 * we operate on it */
212 if (!IS_ERR(rdev))
213 mutex_lock(&rdev->mtx);
214
215 mutex_unlock(&cfg80211_mutex);
216
217 return rdev;
218}
219
55682965 220/* policy for the attributes */
b54452b0 221static const struct nla_policy nl80211_policy[NL80211_ATTR_MAX+1] = {
55682965
JB		 222 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
223 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
079e24ed 224 .len = 20-1 },
31888487 225 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
3d9d1d66 226
72bdcf34 227 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
094d05dc 228 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
3d9d1d66
JB		 229 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
230 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
231 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
232
b9a5f8ca
JM		 233 [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
234 [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
235 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
236 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
81077e82 237 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
55682965
JB		 238
239 [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
240 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
241 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
41ade00f 242
e007b857
EP		 243 [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
244 [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
41ade00f 245
b9454e83 246 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
41ade00f
JB		 247 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
248 .len = WLAN_MAX_KEY_LEN },
249 [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
250 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
251 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
81962267 252 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
e31b8213 253 [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
ed1b6cc7
JB		 254
255 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
256 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
257 [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
258 .len = IEEE80211_MAX_DATA_LEN },
259 [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
260 .len = IEEE80211_MAX_DATA_LEN },
5727ef1b
JB		 261 [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
262 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
263 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
264 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
265 .len = NL80211_MAX_SUPP_RATES },
2ec600d6 266 [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
5727ef1b 267 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
0a9542ee 268 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
2ec600d6 269 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
a4f606ea 270 .len = IEEE80211_MAX_MESH_ID_LEN },
2ec600d6 271 [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
9f1ba906 272
b2e1b302
LR		 273 [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
274 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
275
9f1ba906
JM		 276 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
277 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
278 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
90c97a04
JM		 279 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
280 .len = NL80211_MAX_SUPP_RATES },
50b12f59 281 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
36aedc90 282
24bdd9f4 283 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
15d5dda6 284 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
93da9cc1 285
6c739419 286 [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
9aed3cc1
JM		 287
288 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
289 [NL80211_ATTR_IE] = { .type = NLA_BINARY,
290 .len = IEEE80211_MAX_DATA_LEN },
2a519311
JB		 291 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
292 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
636a5d36
JM		 293
294 [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
295 .len = IEEE80211_MAX_SSID_LEN },
296 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
297 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
04a773ad 298 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
1965c853 299 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
dc6382ce 300 [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
eccb8e8f
JB		 301 [NL80211_ATTR_STA_FLAGS2] = {
302 .len = sizeof(struct nl80211_sta_flag_update),
303 },
3f77316c 304 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
c0692b8f
JB		 305 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
306 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
b23aa676
SO		 307 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
308 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
309 [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
463d0183 310 [NL80211_ATTR_PID] = { .type = NLA_U32 },
8b787643 311 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
67fbb16b
SO		 312 [NL80211_ATTR_PMKID] = { .type = NLA_BINARY,
313 .len = WLAN_PMKID_LEN },
9588bbd5
JM		 314 [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
315 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
13ae75b1 316 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
026331c4
JM		 317 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
318 .len = IEEE80211_MAX_DATA_LEN },
319 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
ffb9eb3d 320 [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
d6dc1a38 321 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
d5cdfacb 322 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
fd8aaaf3 323 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
98d2ff8b
JO		 324 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
325 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
2e161f78 326 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
afe0cbf8
BR		 327 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
328 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
885a46d0 329 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
f7ca38df 330 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
dbd2fd65 331 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
ff1b6e69 332 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
9c3990aa 333 [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
bbe6ad6d 334 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
e5497d76 335 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
34850ab2 336 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
32e9de84 337 [NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
9946ecfb
JM		 338 [NL80211_ATTR_IE_PROBE_RESP] = { .type = NLA_BINARY,
339 .len = IEEE80211_MAX_DATA_LEN },
340 [NL80211_ATTR_IE_ASSOC_RESP] = { .type = NLA_BINARY,
341 .len = IEEE80211_MAX_DATA_LEN },
f4b34b55 342 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
a1f1c21c 343 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
e9f935e3 344 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
109086ce
AN		 345 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
346 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
347 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
348 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
349 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
e247bd90 350 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
00f740e1
AN		 351 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
352 .len = IEEE80211_MAX_DATA_LEN },
8b60b078 353 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
7e7c8926
BG		 354 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
355 [NL80211_ATTR_HT_CAPABILITY_MASK] = {
356 .len = NL80211_HT_CAPABILITY_LEN
357 },
1d9d9213 358 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
1b658f11 359 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
4486ea98 360 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
89a54e48 361 [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
57b5ce07 362 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
e39e5b5e 363 [NL80211_ATTR_SAE_DATA] = { .type = NLA_BINARY, },
f461be3e 364 [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
ed473771 365 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
53cabad7
JB		 366 [NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
367 [NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
77765eaf
VT		 368 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
369 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
55682965
JB		 370};
371
e31b8213 372/* policy for the key attributes */
b54452b0 373static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
fffd0934 374 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
b9454e83
JB		 375 [NL80211_KEY_IDX] = { .type = NLA_U8 },
376 [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
81962267 377 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
b9454e83
JB		 378 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
379 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
e31b8213 380 [NL80211_KEY_TYPE] = { .type = NLA_U32 },
dbd2fd65
JB		 381 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
382};
383
384/* policy for the key default flags */
385static const struct nla_policy
386nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
387 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
388 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
b9454e83
JB		 389};
390
ff1b6e69
JB		 391/* policy for WoWLAN attributes */
392static const struct nla_policy
393nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
394 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
395 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
396 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
397 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
77dbbb13
JB		 398 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
399 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
400 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
401 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
ff1b6e69
JB		 402};
403
e5497d76
JB		 404/* policy for GTK rekey offload attributes */
405static const struct nla_policy
406nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
407 [NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
408 [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
409 [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
410};
411
a1f1c21c
LC		 412static const struct nla_policy
413nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
4a4ab0d7 414 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
a1f1c21c 415 .len = IEEE80211_MAX_SSID_LEN },
88e920b4 416 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
a1f1c21c
LC		 417};
418
a043897a
HS		 419/* ifidx get helper */
420static int nl80211_get_ifidx(struct netlink_callback *cb)
421{
422 int res;
423
424 res = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
425 nl80211_fam.attrbuf, nl80211_fam.maxattr,
426 nl80211_policy);
427 if (res)
428 return res;
429
430 if (!nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX])
431 return -EINVAL;
432
433 res = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX]);
434 if (!res)
435 return -EINVAL;
436 return res;
437}
438
67748893
JB		 439static int nl80211_prepare_netdev_dump(struct sk_buff *skb,
440 struct netlink_callback *cb,
441 struct cfg80211_registered_device **rdev,
442 struct net_device **dev)
443{
444 int ifidx = cb->args[0];
445 int err;
446
447 if (!ifidx)
448 ifidx = nl80211_get_ifidx(cb);
449 if (ifidx < 0)
450 return ifidx;
451
452 cb->args[0] = ifidx;
453
454 rtnl_lock();
455
456 *dev = __dev_get_by_index(sock_net(skb->sk), ifidx);
457 if (!*dev) {
458 err = -ENODEV;
459 goto out_rtnl;
460 }
461
462 *rdev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
3cc25e51
FF		 463 if (IS_ERR(*rdev)) {
464 err = PTR_ERR(*rdev);
67748893
JB		 465 goto out_rtnl;
466 }
467
468 return 0;
469 out_rtnl:
470 rtnl_unlock();
471 return err;
472}
473
474static void nl80211_finish_netdev_dump(struct cfg80211_registered_device *rdev)
475{
476 cfg80211_unlock_rdev(rdev);
477 rtnl_unlock();
478}
479
f4a11bb0
JB		 480/* IE validation */
481static bool is_valid_ie_attr(const struct nlattr *attr)
482{
483 const u8 *pos;
484 int len;
485
486 if (!attr)
487 return true;
488
489 pos = nla_data(attr);
490 len = nla_len(attr);
491
492 while (len) {
493 u8 elemlen;
494
495 if (len < 2)
496 return false;
497 len -= 2;
498
499 elemlen = pos[1];
500 if (elemlen > len)
501 return false;
502
503 len -= elemlen;
504 pos += 2 + elemlen;
505 }
506
507 return true;
508}
509
55682965 510/* message building helper */
15e47304 511static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
55682965
JB		 512 int flags, u8 cmd)
513{
514 /* since there is no private header just add the generic one */
15e47304 515 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
55682965
JB		 516}
517
5dab3b8a
LR		 518static int nl80211_msg_put_channel(struct sk_buff *msg,
519 struct ieee80211_channel *chan)
520{
9360ffd1
DM		 521 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
522 chan->center_freq))
523 goto nla_put_failure;
5dab3b8a 524
9360ffd1
DM		 525 if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
526 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
527 goto nla_put_failure;
528 if ((chan->flags & IEEE80211_CHAN_PASSIVE_SCAN) &&
529 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_PASSIVE_SCAN))
530 goto nla_put_failure;
531 if ((chan->flags & IEEE80211_CHAN_NO_IBSS) &&
532 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IBSS))
533 goto nla_put_failure;
534 if ((chan->flags & IEEE80211_CHAN_RADAR) &&
535 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
536 goto nla_put_failure;
5dab3b8a 537
9360ffd1
DM		 538 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
539 DBM_TO_MBM(chan->max_power)))
540 goto nla_put_failure;
5dab3b8a
LR		 541
542 return 0;
543
544 nla_put_failure:
545 return -ENOBUFS;
546}
547
55682965
JB		 548/* netlink command implementations */
549
b9454e83
JB		 550struct key_parse {
551 struct key_params p;
552 int idx;
e31b8213 553 int type;
b9454e83 554 bool def, defmgmt;
dbd2fd65 555 bool def_uni, def_multi;
b9454e83
JB		 556};
557
558static int nl80211_parse_key_new(struct nlattr *key, struct key_parse *k)
559{
560 struct nlattr *tb[NL80211_KEY_MAX + 1];
561 int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
562 nl80211_key_policy);
563 if (err)
564 return err;
565
566 k->def = !!tb[NL80211_KEY_DEFAULT];
567 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
568
dbd2fd65
JB		 569 if (k->def) {
570 k->def_uni = true;
571 k->def_multi = true;
572 }
573 if (k->defmgmt)
574 k->def_multi = true;
575
b9454e83
JB		 576 if (tb[NL80211_KEY_IDX])
577 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
578
579 if (tb[NL80211_KEY_DATA]) {
580 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
581 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
582 }
583
584 if (tb[NL80211_KEY_SEQ]) {
585 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
586 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
587 }
588
589 if (tb[NL80211_KEY_CIPHER])
590 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
591
e31b8213
JB		 592 if (tb[NL80211_KEY_TYPE]) {
593 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
594 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
595 return -EINVAL;
596 }
597
dbd2fd65
JB		 598 if (tb[NL80211_KEY_DEFAULT_TYPES]) {
599 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
2da8f419
JB		 600 err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
601 tb[NL80211_KEY_DEFAULT_TYPES],
602 nl80211_key_default_policy);
dbd2fd65
JB		 603 if (err)
604 return err;
605
606 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
607 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
608 }
609
b9454e83
JB		 610 return 0;
611}
612
613static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
614{
615 if (info->attrs[NL80211_ATTR_KEY_DATA]) {
616 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
617 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
618 }
619
620 if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
621 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
622 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
623 }
624
625 if (info->attrs[NL80211_ATTR_KEY_IDX])
626 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
627
628 if (info->attrs[NL80211_ATTR_KEY_CIPHER])
629 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
630
631 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
632 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
633
dbd2fd65
JB		 634 if (k->def) {
635 k->def_uni = true;
636 k->def_multi = true;
637 }
638 if (k->defmgmt)
639 k->def_multi = true;
640
e31b8213
JB		 641 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
642 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
643 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
644 return -EINVAL;
645 }
646
dbd2fd65
JB		 647 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
648 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
649 int err = nla_parse_nested(
650 kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
651 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
652 nl80211_key_default_policy);
653 if (err)
654 return err;
655
656 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
657 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
658 }
659
b9454e83
JB		 660 return 0;
661}
662
663static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
664{
665 int err;
666
667 memset(k, 0, sizeof(*k));
668 k->idx = -1;
e31b8213 669 k->type = -1;
b9454e83
JB		 670
671 if (info->attrs[NL80211_ATTR_KEY])
672 err = nl80211_parse_key_new(info->attrs[NL80211_ATTR_KEY], k);
673 else
674 err = nl80211_parse_key_old(info, k);
675
676 if (err)
677 return err;
678
679 if (k->def && k->defmgmt)
680 return -EINVAL;
681
dbd2fd65
JB		 682 if (k->defmgmt) {
683 if (k->def_uni || !k->def_multi)
684 return -EINVAL;
685 }
686
b9454e83
JB		 687 if (k->idx != -1) {
688 if (k->defmgmt) {
689 if (k->idx < 4 || k->idx > 5)
690 return -EINVAL;
691 } else if (k->def) {
692 if (k->idx < 0 || k->idx > 3)
693 return -EINVAL;
694 } else {
695 if (k->idx < 0 || k->idx > 5)
696 return -EINVAL;
697 }
698 }
699
700 return 0;
701}
702
fffd0934
JB		 703static struct cfg80211_cached_keys *
704nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
de7044ee 705 struct nlattr *keys, bool *no_ht)
fffd0934
JB		 706{
707 struct key_parse parse;
708 struct nlattr *key;
709 struct cfg80211_cached_keys *result;
710 int rem, err, def = 0;
711
712 result = kzalloc(sizeof(*result), GFP_KERNEL);
713 if (!result)
714 return ERR_PTR(-ENOMEM);
715
716 result->def = -1;
717 result->defmgmt = -1;
718
719 nla_for_each_nested(key, keys, rem) {
720 memset(&parse, 0, sizeof(parse));
721 parse.idx = -1;
722
723 err = nl80211_parse_key_new(key, &parse);
724 if (err)
725 goto error;
726 err = -EINVAL;
727 if (!parse.p.key)
728 goto error;
729 if (parse.idx < 0 || parse.idx > 4)
730 goto error;
731 if (parse.def) {
732 if (def)
733 goto error;
734 def = 1;
735 result->def = parse.idx;
dbd2fd65
JB		 736 if (!parse.def_uni || !parse.def_multi)
737 goto error;
fffd0934
JB		 738 } else if (parse.defmgmt)
739 goto error;
740 err = cfg80211_validate_key_settings(rdev, &parse.p,
e31b8213 741 parse.idx, false, NULL);
fffd0934
JB		 742 if (err)
743 goto error;
744 result->params[parse.idx].cipher = parse.p.cipher;
745 result->params[parse.idx].key_len = parse.p.key_len;
746 result->params[parse.idx].key = result->data[parse.idx];
747 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
de7044ee
SM		 748
749 if (parse.p.cipher == WLAN_CIPHER_SUITE_WEP40 ||
750 parse.p.cipher == WLAN_CIPHER_SUITE_WEP104) {
751 if (no_ht)
752 *no_ht = true;
753 }
fffd0934
JB		 754 }
755
756 return result;
757 error:
758 kfree(result);
759 return ERR_PTR(err);
760}
761
762static int nl80211_key_allowed(struct wireless_dev *wdev)
763{
764 ASSERT_WDEV_LOCK(wdev);
765
fffd0934
JB		 766 switch (wdev->iftype) {
767 case NL80211_IFTYPE_AP:
768 case NL80211_IFTYPE_AP_VLAN:
074ac8df 769 case NL80211_IFTYPE_P2P_GO:
ff973af7 770 case NL80211_IFTYPE_MESH_POINT:
fffd0934
JB		 771 break;
772 case NL80211_IFTYPE_ADHOC:
773 if (!wdev->current_bss)
774 return -ENOLINK;
775 break;
776 case NL80211_IFTYPE_STATION:
074ac8df 777 case NL80211_IFTYPE_P2P_CLIENT:
fffd0934
JB		 778 if (wdev->sme_state != CFG80211_SME_CONNECTED)
779 return -ENOLINK;
780 break;
781 default:
782 return -EINVAL;
783 }
784
785 return 0;
786}
787
7527a782
JB		 788static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
789{
790 struct nlattr *nl_modes = nla_nest_start(msg, attr);
791 int i;
792
793 if (!nl_modes)
794 goto nla_put_failure;
795
796 i = 0;
797 while (ifmodes) {
9360ffd1
DM		 798 if ((ifmodes & 1) && nla_put_flag(msg, i))
799 goto nla_put_failure;
7527a782
JB		 800 ifmodes >>= 1;
801 i++;
802 }
803
804 nla_nest_end(msg, nl_modes);
805 return 0;
806
807nla_put_failure:
808 return -ENOBUFS;
809}
810
811static int nl80211_put_iface_combinations(struct wiphy *wiphy,
812 struct sk_buff *msg)
813{
814 struct nlattr *nl_combis;
815 int i, j;
816
817 nl_combis = nla_nest_start(msg,
818 NL80211_ATTR_INTERFACE_COMBINATIONS);
819 if (!nl_combis)
820 goto nla_put_failure;
821
822 for (i = 0; i < wiphy->n_iface_combinations; i++) {
823 const struct ieee80211_iface_combination *c;
824 struct nlattr *nl_combi, *nl_limits;
825
826 c = &wiphy->iface_combinations[i];
827
828 nl_combi = nla_nest_start(msg, i + 1);
829 if (!nl_combi)
830 goto nla_put_failure;
831
832 nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
833 if (!nl_limits)
834 goto nla_put_failure;
835
836 for (j = 0; j < c->n_limits; j++) {
837 struct nlattr *nl_limit;
838
839 nl_limit = nla_nest_start(msg, j + 1);
840 if (!nl_limit)
841 goto nla_put_failure;
9360ffd1
DM		 842 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
843 c->limits[j].max))
844 goto nla_put_failure;
7527a782
JB		 845 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
846 c->limits[j].types))
847 goto nla_put_failure;
848 nla_nest_end(msg, nl_limit);
849 }
850
851 nla_nest_end(msg, nl_limits);
852
9360ffd1
DM		 853 if (c->beacon_int_infra_match &&
854 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
855 goto nla_put_failure;
856 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
857 c->num_different_channels) ||
858 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
859 c->max_interfaces))
860 goto nla_put_failure;
11c4a075
SW		 861 if (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
862 c->radar_detect_widths))
863 goto nla_put_failure;
7527a782
JB		 864
865 nla_nest_end(msg, nl_combi);
866 }
867
868 nla_nest_end(msg, nl_combis);
869
870 return 0;
871nla_put_failure:
872 return -ENOBUFS;
873}
874
15e47304 875static int nl80211_send_wiphy(struct sk_buff *msg, u32 portid, u32 seq, int flags,
55682965
JB		 876 struct cfg80211_registered_device *dev)
877{
878 void *hdr;
ee688b00
JB		 879 struct nlattr *nl_bands, *nl_band;
880 struct nlattr *nl_freqs, *nl_freq;
881 struct nlattr *nl_rates, *nl_rate;
8fdc621d 882 struct nlattr *nl_cmds;
ee688b00
JB		 883 enum ieee80211_band band;
884 struct ieee80211_channel *chan;
885 struct ieee80211_rate *rate;
886 int i;
2e161f78
JB		 887 const struct ieee80211_txrx_stypes *mgmt_stypes =
888 dev->wiphy.mgmt_stypes;
55682965 889
15e47304 890 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_WIPHY);
55682965
JB		 891 if (!hdr)
892 return -1;
893
9360ffd1
DM		 894 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, dev->wiphy_idx) ||
895 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME, wiphy_name(&dev->wiphy)) ||
896 nla_put_u32(msg, NL80211_ATTR_GENERATION,
897 cfg80211_rdev_list_generation) ||
898 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
899 dev->wiphy.retry_short) ||
900 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
901 dev->wiphy.retry_long) ||
902 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
903 dev->wiphy.frag_threshold) ||
904 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
905 dev->wiphy.rts_threshold) ||
906 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
907 dev->wiphy.coverage_class) ||
908 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
909 dev->wiphy.max_scan_ssids) ||
910 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
911 dev->wiphy.max_sched_scan_ssids) ||
912 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
913 dev->wiphy.max_scan_ie_len) ||
914 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
915 dev->wiphy.max_sched_scan_ie_len) ||
916 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
917 dev->wiphy.max_match_sets))
918 goto nla_put_failure;
919
920 if ((dev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
921 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
922 goto nla_put_failure;
923 if ((dev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
924 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
925 goto nla_put_failure;
926 if ((dev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
927 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
928 goto nla_put_failure;
929 if ((dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
930 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
931 goto nla_put_failure;
932 if ((dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
933 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
934 goto nla_put_failure;
935 if ((dev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
936 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
937 goto nla_put_failure;
938
939 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
940 sizeof(u32) * dev->wiphy.n_cipher_suites,
941 dev->wiphy.cipher_suites))
942 goto nla_put_failure;
943
944 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
945 dev->wiphy.max_num_pmkids))
946 goto nla_put_failure;
947
948 if ((dev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
949 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
950 goto nla_put_failure;
951
952 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
953 dev->wiphy.available_antennas_tx) ||
954 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
955 dev->wiphy.available_antennas_rx))
956 goto nla_put_failure;
957
958 if ((dev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
959 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
960 dev->wiphy.probe_resp_offload))
961 goto nla_put_failure;
87bbbe22 962
7f531e03
BR		 963 if ((dev->wiphy.available_antennas_tx ||
964 dev->wiphy.available_antennas_rx) && dev->ops->get_antenna) {
afe0cbf8
BR		 965 u32 tx_ant = 0, rx_ant = 0;
966 int res;
e35e4d28 967 res = rdev_get_antenna(dev, &tx_ant, &rx_ant);
afe0cbf8 968 if (!res) {
9360ffd1
DM		 969 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_TX,
970 tx_ant) ||
971 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_RX,
972 rx_ant))
973 goto nla_put_failure;
afe0cbf8
BR		 974 }
975 }
976
7527a782
JB		 977 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
978 dev->wiphy.interface_modes))
f59ac048
LR		 979 goto nla_put_failure;
980
ee688b00
JB		 981 nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
982 if (!nl_bands)
983 goto nla_put_failure;
984
985 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
986 if (!dev->wiphy.bands[band])
987 continue;
988
989 nl_band = nla_nest_start(msg, band);
990 if (!nl_band)
991 goto nla_put_failure;
992
d51626df 993 /* add HT info */
9360ffd1
DM		 994 if (dev->wiphy.bands[band]->ht_cap.ht_supported &&
995 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
996 sizeof(dev->wiphy.bands[band]->ht_cap.mcs),
997 &dev->wiphy.bands[band]->ht_cap.mcs) ||
998 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
999 dev->wiphy.bands[band]->ht_cap.cap) ||
1000 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1001 dev->wiphy.bands[band]->ht_cap.ampdu_factor) ||
1002 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1003 dev->wiphy.bands[band]->ht_cap.ampdu_density)))
1004 goto nla_put_failure;
d51626df 1005
bf0c111e
MP		 1006 /* add VHT info */
1007 if (dev->wiphy.bands[band]->vht_cap.vht_supported &&
1008 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1009 sizeof(dev->wiphy.bands[band]->vht_cap.vht_mcs),
1010 &dev->wiphy.bands[band]->vht_cap.vht_mcs) ||
1011 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1012 dev->wiphy.bands[band]->vht_cap.cap)))
1013 goto nla_put_failure;
1014
ee688b00
JB		 1015 /* add frequencies */
1016 nl_freqs = nla_nest_start(msg, NL80211_BAND_ATTR_FREQS);
1017 if (!nl_freqs)
1018 goto nla_put_failure;
1019
1020 for (i = 0; i < dev->wiphy.bands[band]->n_channels; i++) {
1021 nl_freq = nla_nest_start(msg, i);
1022 if (!nl_freq)
1023 goto nla_put_failure;
1024
1025 chan = &dev->wiphy.bands[band]->channels[i];
5dab3b8a
LR		 1026
1027 if (nl80211_msg_put_channel(msg, chan))
1028 goto nla_put_failure;
e2f367f2 1029
ee688b00
JB		 1030 nla_nest_end(msg, nl_freq);
1031 }
1032
1033 nla_nest_end(msg, nl_freqs);
1034
1035 /* add bitrates */
1036 nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
1037 if (!nl_rates)
1038 goto nla_put_failure;
1039
1040 for (i = 0; i < dev->wiphy.bands[band]->n_bitrates; i++) {
1041 nl_rate = nla_nest_start(msg, i);
1042 if (!nl_rate)
1043 goto nla_put_failure;
1044
1045 rate = &dev->wiphy.bands[band]->bitrates[i];
9360ffd1
DM		 1046 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1047 rate->bitrate))
1048 goto nla_put_failure;
1049 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1050 nla_put_flag(msg,
1051 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1052 goto nla_put_failure;
ee688b00
JB		 1053
1054 nla_nest_end(msg, nl_rate);
1055 }
1056
1057 nla_nest_end(msg, nl_rates);
1058
1059 nla_nest_end(msg, nl_band);
1060 }
1061 nla_nest_end(msg, nl_bands);
1062
8fdc621d
JB		 1063 nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
1064 if (!nl_cmds)
1065 goto nla_put_failure;
1066
1067 i = 0;
1068#define CMD(op, n) \
1069 do { \
1070 if (dev->ops->op) { \
1071 i++; \
9360ffd1
DM		 1072 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
1073 goto nla_put_failure; \
8fdc621d
JB		 1074 } \
1075 } while (0)
1076
1077 CMD(add_virtual_intf, NEW_INTERFACE);
1078 CMD(change_virtual_intf, SET_INTERFACE);
1079 CMD(add_key, NEW_KEY);
8860020e 1080 CMD(start_ap, START_AP);
8fdc621d
JB		 1081 CMD(add_station, NEW_STATION);
1082 CMD(add_mpath, NEW_MPATH);
24bdd9f4 1083 CMD(update_mesh_config, SET_MESH_CONFIG);
8fdc621d 1084 CMD(change_bss, SET_BSS);
636a5d36
JM		 1085 CMD(auth, AUTHENTICATE);
1086 CMD(assoc, ASSOCIATE);
1087 CMD(deauth, DEAUTHENTICATE);
1088 CMD(disassoc, DISASSOCIATE);
04a773ad 1089 CMD(join_ibss, JOIN_IBSS);
29cbe68c 1090 CMD(join_mesh, JOIN_MESH);
67fbb16b
SO		 1091 CMD(set_pmksa, SET_PMKSA);
1092 CMD(del_pmksa, DEL_PMKSA);
1093 CMD(flush_pmksa, FLUSH_PMKSA);
7c4ef712
JB		 1094 if (dev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
1095 CMD(remain_on_channel, REMAIN_ON_CHANNEL);
13ae75b1 1096 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
2e161f78 1097 CMD(mgmt_tx, FRAME);
f7ca38df 1098 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
5be83de5 1099 if (dev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
463d0183 1100 i++;
9360ffd1
DM		 1101 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
1102 goto nla_put_failure;
463d0183 1103 }
e8c9bd5b 1104 if (dev->ops->set_monitor_channel || dev->ops->start_ap ||
cc1d2806 1105 dev->ops->join_mesh) {
aa430da4
JB		 1106 i++;
1107 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1108 goto nla_put_failure;
1109 }
e8347eba 1110 CMD(set_wds_peer, SET_WDS_PEER);
109086ce
AN		 1111 if (dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
1112 CMD(tdls_mgmt, TDLS_MGMT);
1113 CMD(tdls_oper, TDLS_OPER);
1114 }
807f8a8c
LC		 1115 if (dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN)
1116 CMD(sched_scan_start, START_SCHED_SCAN);
7f6cf311 1117 CMD(probe_client, PROBE_CLIENT);
1d9d9213 1118 CMD(set_noack_map, SET_NOACK_MAP);
5e760230
JB		 1119 if (dev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
1120 i++;
9360ffd1
DM		 1121 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1122 goto nla_put_failure;
5e760230 1123 }
98104fde 1124 CMD(start_p2p_device, START_P2P_DEVICE);
f4e583c8 1125 CMD(set_mcast_rate, SET_MCAST_RATE);
8fdc621d 1126
4745fc09
KV		 1127#ifdef CONFIG_NL80211_TESTMODE
1128 CMD(testmode_cmd, TESTMODE);
1129#endif
1130
8fdc621d 1131#undef CMD
b23aa676 1132
6829c878 1133 if (dev->ops->connect || dev->ops->auth) {
b23aa676 1134 i++;
9360ffd1
DM		 1135 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
1136 goto nla_put_failure;
b23aa676
SO		 1137 }
1138
6829c878 1139 if (dev->ops->disconnect || dev->ops->deauth) {
b23aa676 1140 i++;
9360ffd1
DM		 1141 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1142 goto nla_put_failure;
b23aa676
SO		 1143 }
1144
8fdc621d
JB		 1145 nla_nest_end(msg, nl_cmds);
1146
7c4ef712 1147 if (dev->ops->remain_on_channel &&
9360ffd1
DM		 1148 (dev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
1149 nla_put_u32(msg, NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
1150 dev->wiphy.max_remain_on_channel_duration))
1151 goto nla_put_failure;
a293911d 1152
9360ffd1
DM		 1153 if ((dev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
1154 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
1155 goto nla_put_failure;
f7ca38df 1156
2e161f78
JB		 1157 if (mgmt_stypes) {
1158 u16 stypes;
1159 struct nlattr *nl_ftypes, *nl_ifs;
1160 enum nl80211_iftype ift;
1161
1162 nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
1163 if (!nl_ifs)
1164 goto nla_put_failure;
1165
1166 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1167 nl_ftypes = nla_nest_start(msg, ift);
1168 if (!nl_ftypes)
1169 goto nla_put_failure;
1170 i = 0;
1171 stypes = mgmt_stypes[ift].tx;
1172 while (stypes) {
9360ffd1
DM		 1173 if ((stypes & 1) &&
1174 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1175 (i << 4) | IEEE80211_FTYPE_MGMT))
1176 goto nla_put_failure;
2e161f78
JB		 1177 stypes >>= 1;
1178 i++;
1179 }
1180 nla_nest_end(msg, nl_ftypes);
1181 }
1182
74b70a4e
JB		 1183 nla_nest_end(msg, nl_ifs);
1184
2e161f78
JB		 1185 nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
1186 if (!nl_ifs)
1187 goto nla_put_failure;
1188
1189 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1190 nl_ftypes = nla_nest_start(msg, ift);
1191 if (!nl_ftypes)
1192 goto nla_put_failure;
1193 i = 0;
1194 stypes = mgmt_stypes[ift].rx;
1195 while (stypes) {
9360ffd1
DM		 1196 if ((stypes & 1) &&
1197 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1198 (i << 4) | IEEE80211_FTYPE_MGMT))
1199 goto nla_put_failure;
2e161f78
JB		 1200 stypes >>= 1;
1201 i++;
1202 }
1203 nla_nest_end(msg, nl_ftypes);
1204 }
1205 nla_nest_end(msg, nl_ifs);
1206 }
1207
dfb89c56 1208#ifdef CONFIG_PM
ff1b6e69
JB		 1209 if (dev->wiphy.wowlan.flags || dev->wiphy.wowlan.n_patterns) {
1210 struct nlattr *nl_wowlan;
1211
1212 nl_wowlan = nla_nest_start(msg,
1213 NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1214 if (!nl_wowlan)
1215 goto nla_put_failure;
1216
9360ffd1
DM		 1217 if (((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_ANY) &&
1218 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1219 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_DISCONNECT) &&
1220 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1221 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_MAGIC_PKT) &&
1222 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1223 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
1224 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1225 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
1226 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1227 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
1228 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1229 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
1230 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1231 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
1232 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1233 goto nla_put_failure;
ff1b6e69
JB		 1234 if (dev->wiphy.wowlan.n_patterns) {
1235 struct nl80211_wowlan_pattern_support pat = {
1236 .max_patterns = dev->wiphy.wowlan.n_patterns,
1237 .min_pattern_len =
1238 dev->wiphy.wowlan.pattern_min_len,
1239 .max_pattern_len =
1240 dev->wiphy.wowlan.pattern_max_len,
bb92d199
AK		 1241 .max_pkt_offset =
1242 dev->wiphy.wowlan.max_pkt_offset,
ff1b6e69 1243 };
9360ffd1
DM		 1244 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1245 sizeof(pat), &pat))
1246 goto nla_put_failure;
ff1b6e69
JB		 1247 }
1248
1249 nla_nest_end(msg, nl_wowlan);
1250 }
dfb89c56 1251#endif
ff1b6e69 1252
7527a782
JB		 1253 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
1254 dev->wiphy.software_iftypes))
1255 goto nla_put_failure;
1256
1257 if (nl80211_put_iface_combinations(&dev->wiphy, msg))
1258 goto nla_put_failure;
1259
9360ffd1
DM		 1260 if ((dev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
1261 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
1262 dev->wiphy.ap_sme_capa))
1263 goto nla_put_failure;
562a7480 1264
9360ffd1
DM		 1265 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS,
1266 dev->wiphy.features))
1267 goto nla_put_failure;
1f074bd8 1268
9360ffd1
DM		 1269 if (dev->wiphy.ht_capa_mod_mask &&
1270 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
1271 sizeof(*dev->wiphy.ht_capa_mod_mask),
1272 dev->wiphy.ht_capa_mod_mask))
1273 goto nla_put_failure;
7e7c8926 1274
77765eaf
VT		 1275 if (dev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
1276 dev->wiphy.max_acl_mac_addrs &&
1277 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
1278 dev->wiphy.max_acl_mac_addrs))
1279 goto nla_put_failure;
1280
55682965
JB		 1281 return genlmsg_end(msg, hdr);
1282
1283 nla_put_failure:
bc3ed28c
TG		 1284 genlmsg_cancel(msg, hdr);
1285 return -EMSGSIZE;
55682965
JB		 1286}
1287
1288static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
1289{
1290 int idx = 0;
1291 int start = cb->args[0];
1292 struct cfg80211_registered_device *dev;
1293
a1794390 1294 mutex_lock(&cfg80211_mutex);
79c97e97 1295 list_for_each_entry(dev, &cfg80211_rdev_list, list) {
463d0183
JB		 1296 if (!net_eq(wiphy_net(&dev->wiphy), sock_net(skb->sk)))
1297 continue;
b4637271 1298 if (++idx <= start)
55682965 1299 continue;
15e47304 1300 if (nl80211_send_wiphy(skb, NETLINK_CB(cb->skb).portid,
55682965 1301 cb->nlh->nlmsg_seq, NLM_F_MULTI,
b4637271
JV		 1302 dev) < 0) {
1303 idx--;
55682965 1304 break;
b4637271 1305 }
55682965 1306 }
a1794390 1307 mutex_unlock(&cfg80211_mutex);
55682965
JB		 1308
1309 cb->args[0] = idx;
1310
1311 return skb->len;
1312}
1313
1314static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
1315{
1316 struct sk_buff *msg;
4c476991 1317 struct cfg80211_registered_device *dev = info->user_ptr[0];
55682965 1318
fd2120ca 1319 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
55682965 1320 if (!msg)
4c476991 1321 return -ENOMEM;
55682965 1322
15e47304 1323 if (nl80211_send_wiphy(msg, info->snd_portid, info->snd_seq, 0, dev) < 0) {
4c476991
JB		 1324 nlmsg_free(msg);
1325 return -ENOBUFS;
1326 }
55682965 1327
134e6375 1328 return genlmsg_reply(msg, info);
55682965
JB		 1329}
1330
31888487
JM		 1331static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
1332 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
1333 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
1334 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
1335 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
1336 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
1337};
1338
1339static int parse_txq_params(struct nlattr *tb[],
1340 struct ieee80211_txq_params *txq_params)
1341{
a3304b0a 1342 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
31888487
JM		 1343 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
1344 !tb[NL80211_TXQ_ATTR_AIFS])
1345 return -EINVAL;
1346
a3304b0a 1347 txq_params->ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
31888487
JM		 1348 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
1349 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
1350 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
1351 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
1352
a3304b0a
JB		 1353 if (txq_params->ac >= NL80211_NUM_ACS)
1354 return -EINVAL;
1355
31888487
JM		 1356 return 0;
1357}
1358
f444de05
JB		 1359static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
1360{
1361 /*
cc1d2806
JB		 1362 * You can only set the channel explicitly for WDS interfaces,
1363 * all others have their channel managed via their respective
1364 * "establish a connection" command (connect, join, ...)
1365 *
1366 * For AP/GO and mesh mode, the channel can be set with the
1367 * channel userspace API, but is only stored and passed to the
1368 * low-level driver when the AP starts or the mesh is joined.
1369 * This is for backward compatibility, userspace can also give
1370 * the channel in the start-ap or join-mesh commands instead.
f444de05
JB		 1371 *
1372 * Monitors are special as they are normally slaved to
e8c9bd5b
JB		 1373 * whatever else is going on, so they have their own special
1374 * operation to set the monitor channel if possible.
f444de05
JB		 1375 */
1376 return !wdev ||
1377 wdev->iftype == NL80211_IFTYPE_AP ||
f444de05 1378 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
074ac8df
JB		 1379 wdev->iftype == NL80211_IFTYPE_MONITOR ||
1380 wdev->iftype == NL80211_IFTYPE_P2P_GO;
f444de05
JB		 1381}
1382
683b6d3b
JB		 1383static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
1384 struct genl_info *info,
1385 struct cfg80211_chan_def *chandef)
1386{
dbeca2ea 1387 u32 control_freq;
683b6d3b
JB		 1388
1389 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
1390 return -EINVAL;
1391
1392 control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
1393
1394 chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
3d9d1d66
JB		 1395 chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
1396 chandef->center_freq1 = control_freq;
1397 chandef->center_freq2 = 0;
683b6d3b
JB		 1398
1399 /* Primary channel not allowed */
1400 if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
1401 return -EINVAL;
1402
3d9d1d66
JB		 1403 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
1404 enum nl80211_channel_type chantype;
1405
1406 chantype = nla_get_u32(
1407 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
1408
1409 switch (chantype) {
1410 case NL80211_CHAN_NO_HT:
1411 case NL80211_CHAN_HT20:
1412 case NL80211_CHAN_HT40PLUS:
1413 case NL80211_CHAN_HT40MINUS:
1414 cfg80211_chandef_create(chandef, chandef->chan,
1415 chantype);
1416 break;
1417 default:
1418 return -EINVAL;
1419 }
1420 } else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
1421 chandef->width =
1422 nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
1423 if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
1424 chandef->center_freq1 =
1425 nla_get_u32(
1426 info->attrs[NL80211_ATTR_CENTER_FREQ1]);
1427 if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
1428 chandef->center_freq2 =
1429 nla_get_u32(
1430 info->attrs[NL80211_ATTR_CENTER_FREQ2]);
1431 }
1432
9f5e8f6e 1433 if (!cfg80211_chandef_valid(chandef))
3d9d1d66
JB		 1434 return -EINVAL;
1435
9f5e8f6e
JB		 1436 if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
1437 IEEE80211_CHAN_DISABLED))
3d9d1d66
JB		 1438 return -EINVAL;
1439
683b6d3b
JB		 1440 return 0;
1441}
1442
f444de05
JB		 1443static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
1444 struct wireless_dev *wdev,
1445 struct genl_info *info)
1446{
683b6d3b 1447 struct cfg80211_chan_def chandef;
f444de05 1448 int result;
e8c9bd5b
JB		 1449 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
1450
1451 if (wdev)
1452 iftype = wdev->iftype;
f444de05 1453
f444de05
JB		 1454 if (!nl80211_can_set_dev_channel(wdev))
1455 return -EOPNOTSUPP;
1456
683b6d3b
JB		 1457 result = nl80211_parse_chandef(rdev, info, &chandef);
1458 if (result)
1459 return result;
f444de05
JB		 1460
1461 mutex_lock(&rdev->devlist_mtx);
e8c9bd5b 1462 switch (iftype) {
aa430da4
JB		 1463 case NL80211_IFTYPE_AP:
1464 case NL80211_IFTYPE_P2P_GO:
1465 if (wdev->beacon_interval) {
1466 result = -EBUSY;
1467 break;
1468 }
683b6d3b 1469 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &chandef)) {
aa430da4
JB		 1470 result = -EINVAL;
1471 break;
1472 }
683b6d3b 1473 wdev->preset_chandef = chandef;
aa430da4
JB		 1474 result = 0;
1475 break;
cc1d2806 1476 case NL80211_IFTYPE_MESH_POINT:
683b6d3b 1477 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
cc1d2806 1478 break;
e8c9bd5b 1479 case NL80211_IFTYPE_MONITOR:
683b6d3b 1480 result = cfg80211_set_monitor_channel(rdev, &chandef);
e8c9bd5b 1481 break;
aa430da4 1482 default:
e8c9bd5b 1483 result = -EINVAL;
f444de05
JB		 1484 }
1485 mutex_unlock(&rdev->devlist_mtx);
1486
1487 return result;
1488}
1489
1490static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
1491{
4c476991
JB		 1492 struct cfg80211_registered_device *rdev = info->user_ptr[0];
1493 struct net_device *netdev = info->user_ptr[1];
f444de05 1494
4c476991 1495 return __nl80211_set_channel(rdev, netdev->ieee80211_ptr, info);
f444de05
JB		 1496}
1497
e8347eba
BJ		 1498static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
1499{
43b19952
JB		 1500 struct cfg80211_registered_device *rdev = info->user_ptr[0];
1501 struct net_device *dev = info->user_ptr[1];
1502 struct wireless_dev *wdev = dev->ieee80211_ptr;
388ac775 1503 const u8 *bssid;
e8347eba
BJ		 1504
1505 if (!info->attrs[NL80211_ATTR_MAC])
1506 return -EINVAL;
1507
43b19952
JB		 1508 if (netif_running(dev))
1509 return -EBUSY;
e8347eba 1510
43b19952
JB		 1511 if (!rdev->ops->set_wds_peer)
1512 return -EOPNOTSUPP;
e8347eba 1513
43b19952
JB		 1514 if (wdev->iftype != NL80211_IFTYPE_WDS)
1515 return -EOPNOTSUPP;
e8347eba
BJ		 1516
1517 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
e35e4d28 1518 return rdev_set_wds_peer(rdev, dev, bssid);
e8347eba
BJ		 1519}
1520
1521
55682965
JB		 1522static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
1523{
1524 struct cfg80211_registered_device *rdev;
f444de05
JB		 1525 struct net_device *netdev = NULL;
1526 struct wireless_dev *wdev;
a1e567c8 1527 int result = 0, rem_txq_params = 0;
31888487 1528 struct nlattr *nl_txq_params;
b9a5f8ca
JM		 1529 u32 changed;
1530 u8 retry_short = 0, retry_long = 0;
1531 u32 frag_threshold = 0, rts_threshold = 0;
81077e82 1532 u8 coverage_class = 0;
55682965 1533
f444de05
JB		 1534 /*
1535 * Try to find the wiphy and netdev. Normally this
1536 * function shouldn't need the netdev, but this is
1537 * done for backward compatibility -- previously
1538 * setting the channel was done per wiphy, but now
1539 * it is per netdev. Previous userland like hostapd
1540 * also passed a netdev to set_wiphy, so that it is
1541 * possible to let that go to the right netdev!
1542 */
4bbf4d56
JB		 1543 mutex_lock(&cfg80211_mutex);
1544
f444de05
JB		 1545 if (info->attrs[NL80211_ATTR_IFINDEX]) {
1546 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
1547
1548 netdev = dev_get_by_index(genl_info_net(info), ifindex);
1549 if (netdev && netdev->ieee80211_ptr) {
1550 rdev = wiphy_to_dev(netdev->ieee80211_ptr->wiphy);
1551 mutex_lock(&rdev->mtx);
1552 } else
1553 netdev = NULL;
4bbf4d56
JB		 1554 }
1555
f444de05 1556 if (!netdev) {
878d9ec7
JB		 1557 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
1558 info->attrs);
f444de05
JB		 1559 if (IS_ERR(rdev)) {
1560 mutex_unlock(&cfg80211_mutex);
4c476991 1561 return PTR_ERR(rdev);
f444de05
JB		 1562 }
1563 wdev = NULL;
1564 netdev = NULL;
1565 result = 0;
1566
1567 mutex_lock(&rdev->mtx);
71fe96bf 1568 } else
f444de05 1569 wdev = netdev->ieee80211_ptr;
f444de05
JB		 1570
1571 /*
1572 * end workaround code, by now the rdev is available
1573 * and locked, and wdev may or may not be NULL.
1574 */
4bbf4d56
JB		 1575
1576 if (info->attrs[NL80211_ATTR_WIPHY_NAME])
31888487
JM		 1577 result = cfg80211_dev_rename(
1578 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
4bbf4d56
JB		 1579
1580 mutex_unlock(&cfg80211_mutex);
1581
1582 if (result)
1583 goto bad_res;
31888487
JM		 1584
1585 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
1586 struct ieee80211_txq_params txq_params;
1587 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
1588
1589 if (!rdev->ops->set_txq_params) {
1590 result = -EOPNOTSUPP;
1591 goto bad_res;
1592 }
1593
f70f01c2
EP		 1594 if (!netdev) {
1595 result = -EINVAL;
1596 goto bad_res;
1597 }
1598
133a3ff2
JB		 1599 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
1600 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
1601 result = -EINVAL;
1602 goto bad_res;
1603 }
1604
2b5f8b0b
JB		 1605 if (!netif_running(netdev)) {
1606 result = -ENETDOWN;
1607 goto bad_res;
1608 }
1609
31888487
JM		 1610 nla_for_each_nested(nl_txq_params,
1611 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
1612 rem_txq_params) {
1613 nla_parse(tb, NL80211_TXQ_ATTR_MAX,
1614 nla_data(nl_txq_params),
1615 nla_len(nl_txq_params),
1616 txq_params_policy);
1617 result = parse_txq_params(tb, &txq_params);
1618 if (result)
1619 goto bad_res;
1620
e35e4d28
HG		 1621 result = rdev_set_txq_params(rdev, netdev,
1622 &txq_params);
31888487
JM		 1623 if (result)
1624 goto bad_res;
1625 }
1626 }
55682965 1627
72bdcf34 1628 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
71fe96bf
JB		 1629 result = __nl80211_set_channel(rdev,
1630 nl80211_can_set_dev_channel(wdev) ? wdev : NULL,
1631 info);
72bdcf34
JM		 1632 if (result)
1633 goto bad_res;
1634 }
1635
98d2ff8b 1636 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
c8442118 1637 struct wireless_dev *txp_wdev = wdev;
98d2ff8b
JO		 1638 enum nl80211_tx_power_setting type;
1639 int idx, mbm = 0;
1640
c8442118
JB		 1641 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
1642 txp_wdev = NULL;
1643
98d2ff8b 1644 if (!rdev->ops->set_tx_power) {
60ea385f 1645 result = -EOPNOTSUPP;
98d2ff8b
JO		 1646 goto bad_res;
1647 }
1648
1649 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
1650 type = nla_get_u32(info->attrs[idx]);
1651
1652 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
1653 (type != NL80211_TX_POWER_AUTOMATIC)) {
1654 result = -EINVAL;
1655 goto bad_res;
1656 }
1657
1658 if (type != NL80211_TX_POWER_AUTOMATIC) {
1659 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
1660 mbm = nla_get_u32(info->attrs[idx]);
1661 }
1662
c8442118 1663 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
98d2ff8b
JO		 1664 if (result)
1665 goto bad_res;
1666 }
1667
afe0cbf8
BR		 1668 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
1669 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
1670 u32 tx_ant, rx_ant;
7f531e03
BR		 1671 if ((!rdev->wiphy.available_antennas_tx &&
1672 !rdev->wiphy.available_antennas_rx) ||
1673 !rdev->ops->set_antenna) {
afe0cbf8
BR		 1674 result = -EOPNOTSUPP;
1675 goto bad_res;
1676 }
1677
1678 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
1679 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
1680
a7ffac95 1681 /* reject antenna configurations which don't match the
7f531e03
BR		 1682 * available antenna masks, except for the "all" mask */
1683 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
1684 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) {
a7ffac95
BR		 1685 result = -EINVAL;
1686 goto bad_res;
1687 }
1688
7f531e03
BR		 1689 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
1690 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
a7ffac95 1691
e35e4d28 1692 result = rdev_set_antenna(rdev, tx_ant, rx_ant);
afe0cbf8
BR		 1693 if (result)
1694 goto bad_res;
1695 }
1696
b9a5f8ca
JM		 1697 changed = 0;
1698
1699 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
1700 retry_short = nla_get_u8(
1701 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
1702 if (retry_short == 0) {
1703 result = -EINVAL;
1704 goto bad_res;
1705 }
1706 changed |= WIPHY_PARAM_RETRY_SHORT;
1707 }
1708
1709 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
1710 retry_long = nla_get_u8(
1711 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
1712 if (retry_long == 0) {
1713 result = -EINVAL;
1714 goto bad_res;
1715 }
1716 changed |= WIPHY_PARAM_RETRY_LONG;
1717 }
1718
1719 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
1720 frag_threshold = nla_get_u32(
1721 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
1722 if (frag_threshold < 256) {
1723 result = -EINVAL;
1724 goto bad_res;
1725 }
1726 if (frag_threshold != (u32) -1) {
1727 /*
1728 * Fragments (apart from the last one) are required to
1729 * have even length. Make the fragmentation code
1730 * simpler by stripping LSB should someone try to use
1731 * odd threshold value.
1732 */
1733 frag_threshold &= ~0x1;
1734 }
1735 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
1736 }
1737
1738 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
1739 rts_threshold = nla_get_u32(
1740 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
1741 changed |= WIPHY_PARAM_RTS_THRESHOLD;
1742 }
1743
81077e82
LT		 1744 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
1745 coverage_class = nla_get_u8(
1746 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
1747 changed |= WIPHY_PARAM_COVERAGE_CLASS;
1748 }
1749
b9a5f8ca
JM		 1750 if (changed) {
1751 u8 old_retry_short, old_retry_long;
1752 u32 old_frag_threshold, old_rts_threshold;
81077e82 1753 u8 old_coverage_class;
b9a5f8ca
JM		 1754
1755 if (!rdev->ops->set_wiphy_params) {
1756 result = -EOPNOTSUPP;
1757 goto bad_res;
1758 }
1759
1760 old_retry_short = rdev->wiphy.retry_short;
1761 old_retry_long = rdev->wiphy.retry_long;
1762 old_frag_threshold = rdev->wiphy.frag_threshold;
1763 old_rts_threshold = rdev->wiphy.rts_threshold;
81077e82 1764 old_coverage_class = rdev->wiphy.coverage_class;
b9a5f8ca
JM		 1765
1766 if (changed & WIPHY_PARAM_RETRY_SHORT)
1767 rdev->wiphy.retry_short = retry_short;
1768 if (changed & WIPHY_PARAM_RETRY_LONG)
1769 rdev->wiphy.retry_long = retry_long;
1770 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
1771 rdev->wiphy.frag_threshold = frag_threshold;
1772 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
1773 rdev->wiphy.rts_threshold = rts_threshold;
81077e82
LT		 1774 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
1775 rdev->wiphy.coverage_class = coverage_class;
b9a5f8ca 1776
e35e4d28 1777 result = rdev_set_wiphy_params(rdev, changed);
b9a5f8ca
JM		 1778 if (result) {
1779 rdev->wiphy.retry_short = old_retry_short;
1780 rdev->wiphy.retry_long = old_retry_long;
1781 rdev->wiphy.frag_threshold = old_frag_threshold;
1782 rdev->wiphy.rts_threshold = old_rts_threshold;
81077e82 1783 rdev->wiphy.coverage_class = old_coverage_class;
b9a5f8ca
JM		 1784 }
1785 }
72bdcf34 1786
306d6112 1787 bad_res:
4bbf4d56 1788 mutex_unlock(&rdev->mtx);
f444de05
JB		 1789 if (netdev)
1790 dev_put(netdev);
55682965
JB		 1791 return result;
1792}
1793
71bbc994
JB		 1794static inline u64 wdev_id(struct wireless_dev *wdev)
1795{
1796 return (u64)wdev->identifier |
1797 ((u64)wiphy_to_dev(wdev->wiphy)->wiphy_idx << 32);
1798}
55682965 1799
683b6d3b
JB		 1800static int nl80211_send_chandef(struct sk_buff *msg,
1801 struct cfg80211_chan_def *chandef)
1802{
9f5e8f6e 1803 WARN_ON(!cfg80211_chandef_valid(chandef));
3d9d1d66 1804
683b6d3b
JB		 1805 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
1806 chandef->chan->center_freq))
1807 return -ENOBUFS;
3d9d1d66
JB		 1808 switch (chandef->width) {
1809 case NL80211_CHAN_WIDTH_20_NOHT:
1810 case NL80211_CHAN_WIDTH_20:
1811 case NL80211_CHAN_WIDTH_40:
1812 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
1813 cfg80211_get_chandef_type(chandef)))
1814 return -ENOBUFS;
1815 break;
1816 default:
1817 break;
1818 }
1819 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
1820 return -ENOBUFS;
1821 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
1822 return -ENOBUFS;
1823 if (chandef->center_freq2 &&
1824 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
683b6d3b
JB		 1825 return -ENOBUFS;
1826 return 0;
1827}
1828
15e47304 1829static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
d726405a 1830 struct cfg80211_registered_device *rdev,
72fb2abc 1831 struct wireless_dev *wdev)
55682965 1832{
72fb2abc 1833 struct net_device *dev = wdev->netdev;
55682965
JB		 1834 void *hdr;
1835
15e47304 1836 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_INTERFACE);
55682965
JB		 1837 if (!hdr)
1838 return -1;
1839
72fb2abc
JB		 1840 if (dev &&
1841 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
98104fde 1842 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
72fb2abc
JB		 1843 goto nla_put_failure;
1844
1845 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
1846 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
71bbc994 1847 nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)) ||
98104fde 1848 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
9360ffd1
DM		 1849 nla_put_u32(msg, NL80211_ATTR_GENERATION,
1850 rdev->devlist_generation ^
1851 (cfg80211_rdev_list_generation << 2)))
1852 goto nla_put_failure;
f5ea9120 1853
5b7ccaf3 1854 if (rdev->ops->get_channel) {
683b6d3b
JB		 1855 int ret;
1856 struct cfg80211_chan_def chandef;
1857
1858 ret = rdev_get_channel(rdev, wdev, &chandef);
1859 if (ret == 0) {
1860 if (nl80211_send_chandef(msg, &chandef))
1861 goto nla_put_failure;
1862 }
d91df0e3
PF		 1863 }
1864
b84e7a05
AQ		 1865 if (wdev->ssid_len) {
1866 if (nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
1867 goto nla_put_failure;
1868 }
1869
55682965
JB		 1870 return genlmsg_end(msg, hdr);
1871
1872 nla_put_failure:
bc3ed28c
TG		 1873 genlmsg_cancel(msg, hdr);
1874 return -EMSGSIZE;
55682965
JB		 1875}
1876
1877static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
1878{
1879 int wp_idx = 0;
1880 int if_idx = 0;
1881 int wp_start = cb->args[0];
1882 int if_start = cb->args[1];
f5ea9120 1883 struct cfg80211_registered_device *rdev;
55682965
JB		 1884 struct wireless_dev *wdev;
1885
a1794390 1886 mutex_lock(&cfg80211_mutex);
f5ea9120
JB		 1887 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1888 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
463d0183 1889 continue;
bba95fef
JB		 1890 if (wp_idx < wp_start) {
1891 wp_idx++;
55682965 1892 continue;
bba95fef 1893 }
55682965
JB		 1894 if_idx = 0;
1895
f5ea9120 1896 mutex_lock(&rdev->devlist_mtx);
89a54e48 1897 list_for_each_entry(wdev, &rdev->wdev_list, list) {
bba95fef
JB		 1898 if (if_idx < if_start) {
1899 if_idx++;
55682965 1900 continue;
bba95fef 1901 }
15e47304 1902 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
55682965 1903 cb->nlh->nlmsg_seq, NLM_F_MULTI,
72fb2abc 1904 rdev, wdev) < 0) {
f5ea9120 1905 mutex_unlock(&rdev->devlist_mtx);
bba95fef
JB		 1906 goto out;
1907 }
1908 if_idx++;
55682965 1909 }
f5ea9120 1910 mutex_unlock(&rdev->devlist_mtx);
bba95fef
JB		 1911
1912 wp_idx++;
55682965 1913 }
bba95fef 1914 out:
a1794390 1915 mutex_unlock(&cfg80211_mutex);
55682965
JB		 1916
1917 cb->args[0] = wp_idx;
1918 cb->args[1] = if_idx;
1919
1920 return skb->len;
1921}
1922
1923static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
1924{
1925 struct sk_buff *msg;
4c476991 1926 struct cfg80211_registered_device *dev = info->user_ptr[0];
72fb2abc 1927 struct wireless_dev *wdev = info->user_ptr[1];
55682965 1928
fd2120ca 1929 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
55682965 1930 if (!msg)
4c476991 1931 return -ENOMEM;
55682965 1932
15e47304 1933 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
72fb2abc 1934 dev, wdev) < 0) {
4c476991
JB		 1935 nlmsg_free(msg);
1936 return -ENOBUFS;
1937 }
55682965 1938
134e6375 1939 return genlmsg_reply(msg, info);
55682965
JB		 1940}
1941
66f7ac50
MW		 1942static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
1943 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
1944 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
1945 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
1946 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
1947 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
1948};
1949
1950static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
1951{
1952 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
1953 int flag;
1954
1955 *mntrflags = 0;
1956
1957 if (!nla)
1958 return -EINVAL;
1959
1960 if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX,
1961 nla, mntr_flags_policy))
1962 return -EINVAL;
1963
1964 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
1965 if (flags[flag])
1966 *mntrflags |= (1<<flag);
1967
1968 return 0;
1969}
1970
9bc383de 1971static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
ad4bb6f8
JB		 1972 struct net_device *netdev, u8 use_4addr,
1973 enum nl80211_iftype iftype)
9bc383de 1974{
ad4bb6f8 1975 if (!use_4addr) {
f350a0a8 1976 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
ad4bb6f8 1977 return -EBUSY;
9bc383de 1978 return 0;
ad4bb6f8 1979 }
9bc383de
JB		 1980
1981 switch (iftype) {
1982 case NL80211_IFTYPE_AP_VLAN:
1983 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
1984 return 0;
1985 break;
1986 case NL80211_IFTYPE_STATION:
1987 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
1988 return 0;
1989 break;
1990 default:
1991 break;
1992 }
1993
1994 return -EOPNOTSUPP;
1995}
1996
55682965
JB		 1997static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
1998{
4c476991 1999 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2ec600d6 2000 struct vif_params params;
e36d56b6 2001 int err;
04a773ad 2002 enum nl80211_iftype otype, ntype;
4c476991 2003 struct net_device *dev = info->user_ptr[1];
92ffe055 2004 u32 _flags, *flags = NULL;
ac7f9cfa 2005 bool change = false;
55682965 2006
2ec600d6
LCC		 2007 memset(&params, 0, sizeof(params));
2008
04a773ad 2009 otype = ntype = dev->ieee80211_ptr->iftype;
55682965 2010
723b038d 2011 if (info->attrs[NL80211_ATTR_IFTYPE]) {
ac7f9cfa 2012 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
04a773ad 2013 if (otype != ntype)
ac7f9cfa 2014 change = true;
4c476991
JB		 2015 if (ntype > NL80211_IFTYPE_MAX)
2016 return -EINVAL;
723b038d
JB		 2017 }
2018
92ffe055 2019 if (info->attrs[NL80211_ATTR_MESH_ID]) {
29cbe68c
JB		 2020 struct wireless_dev *wdev = dev->ieee80211_ptr;
2021
4c476991
JB		 2022 if (ntype != NL80211_IFTYPE_MESH_POINT)
2023 return -EINVAL;
29cbe68c
JB		 2024 if (netif_running(dev))
2025 return -EBUSY;
2026
2027 wdev_lock(wdev);
2028 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2029 IEEE80211_MAX_MESH_ID_LEN);
2030 wdev->mesh_id_up_len =
2031 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2032 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2033 wdev->mesh_id_up_len);
2034 wdev_unlock(wdev);
2ec600d6
LCC		 2035 }
2036
8b787643
FF		 2037 if (info->attrs[NL80211_ATTR_4ADDR]) {
2038 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2039 change = true;
ad4bb6f8 2040 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
9bc383de 2041 if (err)
4c476991 2042 return err;
8b787643
FF		 2043 } else {
2044 params.use_4addr = -1;
2045 }
2046
92ffe055 2047 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
4c476991
JB		 2048 if (ntype != NL80211_IFTYPE_MONITOR)
2049 return -EINVAL;
92ffe055
JB		 2050 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
2051 &_flags);
ac7f9cfa 2052 if (err)
4c476991 2053 return err;
ac7f9cfa
JB		 2054
2055 flags = &_flags;
2056 change = true;
92ffe055 2057 }
3b85875a 2058
ac7f9cfa 2059 if (change)
3d54d255 2060 err = cfg80211_change_iface(rdev, dev, ntype, flags, &params);
ac7f9cfa
JB		 2061 else
2062 err = 0;
60719ffd 2063
9bc383de
JB		 2064 if (!err && params.use_4addr != -1)
2065 dev->ieee80211_ptr->use_4addr = params.use_4addr;
2066
55682965
JB		 2067 return err;
2068}
2069
2070static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
2071{
4c476991 2072 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2ec600d6 2073 struct vif_params params;
84efbb84 2074 struct wireless_dev *wdev;
1c90f9d4 2075 struct sk_buff *msg;
55682965
JB		 2076 int err;
2077 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
66f7ac50 2078 u32 flags;
55682965 2079
2ec600d6
LCC		 2080 memset(&params, 0, sizeof(params));
2081
55682965
JB		 2082 if (!info->attrs[NL80211_ATTR_IFNAME])
2083 return -EINVAL;
2084
2085 if (info->attrs[NL80211_ATTR_IFTYPE]) {
2086 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2087 if (type > NL80211_IFTYPE_MAX)
2088 return -EINVAL;
2089 }
2090
79c97e97 2091 if (!rdev->ops->add_virtual_intf ||
4c476991
JB		 2092 !(rdev->wiphy.interface_modes & (1 << type)))
2093 return -EOPNOTSUPP;
55682965 2094
1c18f145
AS		 2095 if (type == NL80211_IFTYPE_P2P_DEVICE && info->attrs[NL80211_ATTR_MAC]) {
2096 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
2097 ETH_ALEN);
2098 if (!is_valid_ether_addr(params.macaddr))
2099 return -EADDRNOTAVAIL;
2100 }
2101
9bc383de 2102 if (info->attrs[NL80211_ATTR_4ADDR]) {
8b787643 2103 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
ad4bb6f8 2104 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
9bc383de 2105 if (err)
4c476991 2106 return err;
9bc383de 2107 }
8b787643 2108
1c90f9d4
JB		 2109 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2110 if (!msg)
2111 return -ENOMEM;
2112
66f7ac50
MW		 2113 err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
2114 info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
2115 &flags);
e35e4d28
HG		 2116 wdev = rdev_add_virtual_intf(rdev,
2117 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
2118 type, err ? NULL : &flags, &params);
1c90f9d4
JB		 2119 if (IS_ERR(wdev)) {
2120 nlmsg_free(msg);
84efbb84 2121 return PTR_ERR(wdev);
1c90f9d4 2122 }
2ec600d6 2123
98104fde
JB		 2124 switch (type) {
2125 case NL80211_IFTYPE_MESH_POINT:
2126 if (!info->attrs[NL80211_ATTR_MESH_ID])
2127 break;
29cbe68c
JB		 2128 wdev_lock(wdev);
2129 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2130 IEEE80211_MAX_MESH_ID_LEN);
2131 wdev->mesh_id_up_len =
2132 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2133 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2134 wdev->mesh_id_up_len);
2135 wdev_unlock(wdev);
98104fde
JB		 2136 break;
2137 case NL80211_IFTYPE_P2P_DEVICE:
2138 /*
2139 * P2P Device doesn't have a netdev, so doesn't go
2140 * through the netdev notifier and must be added here
2141 */
2142 mutex_init(&wdev->mtx);
2143 INIT_LIST_HEAD(&wdev->event_list);
2144 spin_lock_init(&wdev->event_lock);
2145 INIT_LIST_HEAD(&wdev->mgmt_registrations);
2146 spin_lock_init(&wdev->mgmt_registrations_lock);
2147
2148 mutex_lock(&rdev->devlist_mtx);
2149 wdev->identifier = ++rdev->wdev_id;
2150 list_add_rcu(&wdev->list, &rdev->wdev_list);
2151 rdev->devlist_generation++;
2152 mutex_unlock(&rdev->devlist_mtx);
2153 break;
2154 default:
2155 break;
29cbe68c
JB		 2156 }
2157
15e47304 2158 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
1c90f9d4
JB		 2159 rdev, wdev) < 0) {
2160 nlmsg_free(msg);
2161 return -ENOBUFS;
2162 }
2163
2164 return genlmsg_reply(msg, info);
55682965
JB		 2165}
2166
2167static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
2168{
4c476991 2169 struct cfg80211_registered_device *rdev = info->user_ptr[0];
84efbb84 2170 struct wireless_dev *wdev = info->user_ptr[1];
55682965 2171
4c476991
JB		 2172 if (!rdev->ops->del_virtual_intf)
2173 return -EOPNOTSUPP;
55682965 2174
84efbb84
JB		 2175 /*
2176 * If we remove a wireless device without a netdev then clear
2177 * user_ptr[1] so that nl80211_post_doit won't dereference it
2178 * to check if it needs to do dev_put(). Otherwise it crashes
2179 * since the wdev has been freed, unlike with a netdev where
2180 * we need the dev_put() for the netdev to really be freed.
2181 */
2182 if (!wdev->netdev)
2183 info->user_ptr[1] = NULL;
2184
e35e4d28 2185 return rdev_del_virtual_intf(rdev, wdev);
55682965
JB		 2186}
2187
1d9d9213
SW		 2188static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
2189{
2190 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2191 struct net_device *dev = info->user_ptr[1];
2192 u16 noack_map;
2193
2194 if (!info->attrs[NL80211_ATTR_NOACK_MAP])
2195 return -EINVAL;
2196
2197 if (!rdev->ops->set_noack_map)
2198 return -EOPNOTSUPP;
2199
2200 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
2201
e35e4d28 2202 return rdev_set_noack_map(rdev, dev, noack_map);
1d9d9213
SW		 2203}
2204
41ade00f
JB		 2205struct get_key_cookie {
2206 struct sk_buff *msg;
2207 int error;
b9454e83 2208 int idx;
41ade00f
JB		 2209};
2210
2211static void get_key_callback(void *c, struct key_params *params)
2212{
b9454e83 2213 struct nlattr *key;
41ade00f
JB		 2214 struct get_key_cookie *cookie = c;
2215
9360ffd1
DM		 2216 if ((params->key &&
2217 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
2218 params->key_len, params->key)) ||
2219 (params->seq &&
2220 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
2221 params->seq_len, params->seq)) ||
2222 (params->cipher &&
2223 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
2224 params->cipher)))
2225 goto nla_put_failure;
41ade00f 2226
b9454e83
JB		 2227 key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
2228 if (!key)
2229 goto nla_put_failure;
2230
9360ffd1
DM		 2231 if ((params->key &&
2232 nla_put(cookie->msg, NL80211_KEY_DATA,
2233 params->key_len, params->key)) ||
2234 (params->seq &&
2235 nla_put(cookie->msg, NL80211_KEY_SEQ,
2236 params->seq_len, params->seq)) ||
2237 (params->cipher &&
2238 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
2239 params->cipher)))
2240 goto nla_put_failure;
b9454e83 2241
9360ffd1
DM		 2242 if (nla_put_u8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx))
2243 goto nla_put_failure;
b9454e83
JB		 2244
2245 nla_nest_end(cookie->msg, key);
2246
41ade00f
JB		 2247 return;
2248 nla_put_failure:
2249 cookie->error = 1;
2250}
2251
2252static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
2253{
4c476991 2254 struct cfg80211_registered_device *rdev = info->user_ptr[0];
41ade00f 2255 int err;
4c476991 2256 struct net_device *dev = info->user_ptr[1];
41ade00f 2257 u8 key_idx = 0;
e31b8213
JB		 2258 const u8 *mac_addr = NULL;
2259 bool pairwise;
41ade00f
JB		 2260 struct get_key_cookie cookie = {
2261 .error = 0,
2262 };
2263 void *hdr;
2264 struct sk_buff *msg;
2265
2266 if (info->attrs[NL80211_ATTR_KEY_IDX])
2267 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
2268
3cfcf6ac 2269 if (key_idx > 5)
41ade00f
JB		 2270 return -EINVAL;
2271
2272 if (info->attrs[NL80211_ATTR_MAC])
2273 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2274
e31b8213
JB		 2275 pairwise = !!mac_addr;
2276 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
2277 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
2278 if (kt >= NUM_NL80211_KEYTYPES)
2279 return -EINVAL;
2280 if (kt != NL80211_KEYTYPE_GROUP &&
2281 kt != NL80211_KEYTYPE_PAIRWISE)
2282 return -EINVAL;
2283 pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
2284 }
2285
4c476991
JB		 2286 if (!rdev->ops->get_key)
2287 return -EOPNOTSUPP;
41ade00f 2288
fd2120ca 2289 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4c476991
JB		 2290 if (!msg)
2291 return -ENOMEM;
41ade00f 2292
15e47304 2293 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
41ade00f 2294 NL80211_CMD_NEW_KEY);
4c476991
JB		 2295 if (IS_ERR(hdr))
2296 return PTR_ERR(hdr);
41ade00f
JB		 2297
2298 cookie.msg = msg;
b9454e83 2299 cookie.idx = key_idx;
41ade00f 2300
9360ffd1
DM		 2301 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
2302 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
2303 goto nla_put_failure;
2304 if (mac_addr &&
2305 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
2306 goto nla_put_failure;
41ade00f 2307
e31b8213
JB		 2308 if (pairwise && mac_addr &&
2309 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
2310 return -ENOENT;
2311
e35e4d28
HG		 2312 err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
2313 get_key_callback);
41ade00f
JB		 2314
2315 if (err)
6c95e2a2 2316 goto free_msg;
41ade00f
JB		 2317
2318 if (cookie.error)
2319 goto nla_put_failure;
2320
2321 genlmsg_end(msg, hdr);
4c476991 2322 return genlmsg_reply(msg, info);
41ade00f
JB		 2323
2324 nla_put_failure:
2325 err = -ENOBUFS;
6c95e2a2 2326 free_msg:
41ade00f 2327 nlmsg_free(msg);
41ade00f
JB		 2328 return err;
2329}
2330
2331static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
2332{
4c476991 2333 struct cfg80211_registered_device *rdev = info->user_ptr[0];
b9454e83 2334 struct key_parse key;
41ade00f 2335 int err;
4c476991 2336 struct net_device *dev = info->user_ptr[1];
41ade00f 2337
b9454e83
JB		 2338 err = nl80211_parse_key(info, &key);
2339 if (err)
2340 return err;
41ade00f 2341
b9454e83 2342 if (key.idx < 0)
41ade00f
JB		 2343 return -EINVAL;
2344
b9454e83
JB		 2345 /* only support setting default key */
2346 if (!key.def && !key.defmgmt)
41ade00f
JB		 2347 return -EINVAL;
2348
dbd2fd65 2349 wdev_lock(dev->ieee80211_ptr);
3cfcf6ac 2350
dbd2fd65
JB		 2351 if (key.def) {
2352 if (!rdev->ops->set_default_key) {
2353 err = -EOPNOTSUPP;
2354 goto out;
2355 }
41ade00f 2356
dbd2fd65
JB		 2357 err = nl80211_key_allowed(dev->ieee80211_ptr);
2358 if (err)
2359 goto out;
2360
e35e4d28 2361 err = rdev_set_default_key(rdev, dev, key.idx,
dbd2fd65
JB		 2362 key.def_uni, key.def_multi);
2363
2364 if (err)
2365 goto out;
fffd0934 2366
3d23e349 2367#ifdef CONFIG_CFG80211_WEXT
dbd2fd65
JB		 2368 dev->ieee80211_ptr->wext.default_key = key.idx;
2369#endif
2370 } else {
2371 if (key.def_uni || !key.def_multi) {
2372 err = -EINVAL;
2373 goto out;
2374 }
2375
2376 if (!rdev->ops->set_default_mgmt_key) {
2377 err = -EOPNOTSUPP;
2378 goto out;
2379 }
2380
2381 err = nl80211_key_allowed(dev->ieee80211_ptr);
2382 if (err)
2383 goto out;
2384
e35e4d28 2385 err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
dbd2fd65
JB		 2386 if (err)
2387 goto out;
2388
2389#ifdef CONFIG_CFG80211_WEXT
2390 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
08645126 2391#endif
dbd2fd65
JB		 2392 }
2393
2394 out:
fffd0934 2395 wdev_unlock(dev->ieee80211_ptr);
41ade00f 2396
41ade00f
JB		 2397 return err;
2398}
2399
2400static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
2401{
4c476991 2402 struct cfg80211_registered_device *rdev = info->user_ptr[0];
fffd0934 2403 int err;
4c476991 2404 struct net_device *dev = info->user_ptr[1];
b9454e83 2405 struct key_parse key;
e31b8213 2406 const u8 *mac_addr = NULL;
41ade00f 2407
b9454e83
JB		 2408 err = nl80211_parse_key(info, &key);
2409 if (err)
2410 return err;
41ade00f 2411
b9454e83 2412 if (!key.p.key)
41ade00f
JB		 2413 return -EINVAL;
2414
41ade00f
JB		 2415 if (info->attrs[NL80211_ATTR_MAC])
2416 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2417
e31b8213
JB		 2418 if (key.type == -1) {
2419 if (mac_addr)
2420 key.type = NL80211_KEYTYPE_PAIRWISE;
2421 else
2422 key.type = NL80211_KEYTYPE_GROUP;
2423 }
2424
2425 /* for now */
2426 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
2427 key.type != NL80211_KEYTYPE_GROUP)
2428 return -EINVAL;
2429
4c476991
JB		 2430 if (!rdev->ops->add_key)
2431 return -EOPNOTSUPP;
25e47c18 2432
e31b8213
JB		 2433 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
2434 key.type == NL80211_KEYTYPE_PAIRWISE,
2435 mac_addr))
4c476991 2436 return -EINVAL;
41ade00f 2437
fffd0934
JB		 2438 wdev_lock(dev->ieee80211_ptr);
2439 err = nl80211_key_allowed(dev->ieee80211_ptr);
2440 if (!err)
e35e4d28
HG		 2441 err = rdev_add_key(rdev, dev, key.idx,
2442 key.type == NL80211_KEYTYPE_PAIRWISE,
2443 mac_addr, &key.p);
fffd0934 2444 wdev_unlock(dev->ieee80211_ptr);
41ade00f 2445
41ade00f
JB		 2446 return err;
2447}
2448
2449static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
2450{
4c476991 2451 struct cfg80211_registered_device *rdev = info->user_ptr[0];
41ade00f 2452 int err;
4c476991 2453 struct net_device *dev = info->user_ptr[1];
41ade00f 2454 u8 *mac_addr = NULL;
b9454e83 2455 struct key_parse key;
41ade00f 2456
b9454e83
JB		 2457 err = nl80211_parse_key(info, &key);
2458 if (err)
2459 return err;
41ade00f
JB		 2460
2461 if (info->attrs[NL80211_ATTR_MAC])
2462 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2463
e31b8213
JB		 2464 if (key.type == -1) {
2465 if (mac_addr)
2466 key.type = NL80211_KEYTYPE_PAIRWISE;
2467 else
2468 key.type = NL80211_KEYTYPE_GROUP;
2469 }
2470
2471 /* for now */
2472 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
2473 key.type != NL80211_KEYTYPE_GROUP)
2474 return -EINVAL;
2475
4c476991
JB		 2476 if (!rdev->ops->del_key)
2477 return -EOPNOTSUPP;
41ade00f 2478
fffd0934
JB		 2479 wdev_lock(dev->ieee80211_ptr);
2480 err = nl80211_key_allowed(dev->ieee80211_ptr);
e31b8213
JB		 2481
2482 if (key.type == NL80211_KEYTYPE_PAIRWISE && mac_addr &&
2483 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
2484 err = -ENOENT;
2485
fffd0934 2486 if (!err)
e35e4d28
HG		 2487 err = rdev_del_key(rdev, dev, key.idx,
2488 key.type == NL80211_KEYTYPE_PAIRWISE,
2489 mac_addr);
41ade00f 2490
3d23e349 2491#ifdef CONFIG_CFG80211_WEXT
08645126 2492 if (!err) {
b9454e83 2493 if (key.idx == dev->ieee80211_ptr->wext.default_key)
08645126 2494 dev->ieee80211_ptr->wext.default_key = -1;
b9454e83 2495 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
08645126
JB		 2496 dev->ieee80211_ptr->wext.default_mgmt_key = -1;
2497 }
2498#endif
fffd0934 2499 wdev_unlock(dev->ieee80211_ptr);
08645126 2500
41ade00f
JB		 2501 return err;
2502}
2503
77765eaf
VT		 2504/* This function returns an error or the number of nested attributes */
2505static int validate_acl_mac_addrs(struct nlattr *nl_attr)
2506{
2507 struct nlattr *attr;
2508 int n_entries = 0, tmp;
2509
2510 nla_for_each_nested(attr, nl_attr, tmp) {
2511 if (nla_len(attr) != ETH_ALEN)
2512 return -EINVAL;
2513
2514 n_entries++;
2515 }
2516
2517 return n_entries;
2518}
2519
2520/*
2521 * This function parses ACL information and allocates memory for ACL data.
2522 * On successful return, the calling function is responsible to free the
2523 * ACL buffer returned by this function.
2524 */
2525static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
2526 struct genl_info *info)
2527{
2528 enum nl80211_acl_policy acl_policy;
2529 struct nlattr *attr;
2530 struct cfg80211_acl_data *acl;
2531 int i = 0, n_entries, tmp;
2532
2533 if (!wiphy->max_acl_mac_addrs)
2534 return ERR_PTR(-EOPNOTSUPP);
2535
2536 if (!info->attrs[NL80211_ATTR_ACL_POLICY])
2537 return ERR_PTR(-EINVAL);
2538
2539 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
2540 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
2541 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
2542 return ERR_PTR(-EINVAL);
2543
2544 if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
2545 return ERR_PTR(-EINVAL);
2546
2547 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
2548 if (n_entries < 0)
2549 return ERR_PTR(n_entries);
2550
2551 if (n_entries > wiphy->max_acl_mac_addrs)
2552 return ERR_PTR(-ENOTSUPP);
2553
2554 acl = kzalloc(sizeof(*acl) + (sizeof(struct mac_address) * n_entries),
2555 GFP_KERNEL);
2556 if (!acl)
2557 return ERR_PTR(-ENOMEM);
2558
2559 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
2560 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
2561 i++;
2562 }
2563
2564 acl->n_acl_entries = n_entries;
2565 acl->acl_policy = acl_policy;
2566
2567 return acl;
2568}
2569
2570static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
2571{
2572 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2573 struct net_device *dev = info->user_ptr[1];
2574 struct cfg80211_acl_data *acl;
2575 int err;
2576
2577 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2578 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2579 return -EOPNOTSUPP;
2580
2581 if (!dev->ieee80211_ptr->beacon_interval)
2582 return -EINVAL;
2583
2584 acl = parse_acl_data(&rdev->wiphy, info);
2585 if (IS_ERR(acl))
2586 return PTR_ERR(acl);
2587
2588 err = rdev_set_mac_acl(rdev, dev, acl);
2589
2590 kfree(acl);
2591
2592 return err;
2593}
2594
8860020e
JB		 2595static int nl80211_parse_beacon(struct genl_info *info,
2596 struct cfg80211_beacon_data *bcn)
ed1b6cc7 2597{
8860020e 2598 bool haveinfo = false;
ed1b6cc7 2599
9946ecfb
JM		 2600 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_BEACON_TAIL]) ||
2601 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]) ||
2602 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
2603 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE_ASSOC_RESP]))
f4a11bb0
JB		 2604 return -EINVAL;
2605
8860020e 2606 memset(bcn, 0, sizeof(*bcn));
ed1b6cc7 2607
ed1b6cc7 2608 if (info->attrs[NL80211_ATTR_BEACON_HEAD]) {
8860020e
JB		 2609 bcn->head = nla_data(info->attrs[NL80211_ATTR_BEACON_HEAD]);
2610 bcn->head_len = nla_len(info->attrs[NL80211_ATTR_BEACON_HEAD]);
2611 if (!bcn->head_len)
2612 return -EINVAL;
2613 haveinfo = true;
ed1b6cc7
JB		 2614 }
2615
2616 if (info->attrs[NL80211_ATTR_BEACON_TAIL]) {
8860020e
JB		 2617 bcn->tail = nla_data(info->attrs[NL80211_ATTR_BEACON_TAIL]);
2618 bcn->tail_len =
ed1b6cc7 2619 nla_len(info->attrs[NL80211_ATTR_BEACON_TAIL]);
8860020e 2620 haveinfo = true;
ed1b6cc7
JB		 2621 }
2622
4c476991
JB		 2623 if (!haveinfo)
2624 return -EINVAL;
3b85875a 2625
9946ecfb 2626 if (info->attrs[NL80211_ATTR_IE]) {
8860020e
JB		 2627 bcn->beacon_ies = nla_data(info->attrs[NL80211_ATTR_IE]);
2628 bcn->beacon_ies_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9946ecfb
JM		 2629 }
2630
2631 if (info->attrs[NL80211_ATTR_IE_PROBE_RESP]) {
8860020e 2632 bcn->proberesp_ies =
9946ecfb 2633 nla_data(info->attrs[NL80211_ATTR_IE_PROBE_RESP]);
8860020e 2634 bcn->proberesp_ies_len =
9946ecfb
JM		 2635 nla_len(info->attrs[NL80211_ATTR_IE_PROBE_RESP]);
2636 }
2637
2638 if (info->attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
8860020e 2639 bcn->assocresp_ies =
9946ecfb 2640 nla_data(info->attrs[NL80211_ATTR_IE_ASSOC_RESP]);
8860020e 2641 bcn->assocresp_ies_len =
9946ecfb
JM		 2642 nla_len(info->attrs[NL80211_ATTR_IE_ASSOC_RESP]);
2643 }
2644
00f740e1 2645 if (info->attrs[NL80211_ATTR_PROBE_RESP]) {
8860020e 2646 bcn->probe_resp =
00f740e1 2647 nla_data(info->attrs[NL80211_ATTR_PROBE_RESP]);
8860020e 2648 bcn->probe_resp_len =
00f740e1
AN		 2649 nla_len(info->attrs[NL80211_ATTR_PROBE_RESP]);
2650 }
2651
8860020e
JB		 2652 return 0;
2653}
2654
46c1dd0c
FF		 2655static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
2656 struct cfg80211_ap_settings *params)
2657{
2658 struct wireless_dev *wdev;
2659 bool ret = false;
2660
2661 mutex_lock(&rdev->devlist_mtx);
2662
89a54e48 2663 list_for_each_entry(wdev, &rdev->wdev_list, list) {
46c1dd0c
FF		 2664 if (wdev->iftype != NL80211_IFTYPE_AP &&
2665 wdev->iftype != NL80211_IFTYPE_P2P_GO)
2666 continue;
2667
683b6d3b 2668 if (!wdev->preset_chandef.chan)
46c1dd0c
FF		 2669 continue;
2670
683b6d3b 2671 params->chandef = wdev->preset_chandef;
46c1dd0c
FF		 2672 ret = true;
2673 break;
2674 }
2675
2676 mutex_unlock(&rdev->devlist_mtx);
2677
2678 return ret;
2679}
2680
e39e5b5e
JM		 2681static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
2682 enum nl80211_auth_type auth_type,
2683 enum nl80211_commands cmd)
2684{
2685 if (auth_type > NL80211_AUTHTYPE_MAX)
2686 return false;
2687
2688 switch (cmd) {
2689 case NL80211_CMD_AUTHENTICATE:
2690 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
2691 auth_type == NL80211_AUTHTYPE_SAE)
2692 return false;
2693 return true;
2694 case NL80211_CMD_CONNECT:
2695 case NL80211_CMD_START_AP:
2696 /* SAE not supported yet */
2697 if (auth_type == NL80211_AUTHTYPE_SAE)
2698 return false;
2699 return true;
2700 default:
2701 return false;
2702 }
2703}
2704
8860020e
JB		 2705static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
2706{
2707 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2708 struct net_device *dev = info->user_ptr[1];
2709 struct wireless_dev *wdev = dev->ieee80211_ptr;
2710 struct cfg80211_ap_settings params;
2711 int err;
2712
2713 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2714 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2715 return -EOPNOTSUPP;
2716
2717 if (!rdev->ops->start_ap)
2718 return -EOPNOTSUPP;
2719
2720 if (wdev->beacon_interval)
2721 return -EALREADY;
2722
2723 memset(&params, 0, sizeof(params));
2724
2725 /* these are required for START_AP */
2726 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
2727 !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
2728 !info->attrs[NL80211_ATTR_BEACON_HEAD])
2729 return -EINVAL;
2730
2731 err = nl80211_parse_beacon(info, &params.beacon);
2732 if (err)
2733 return err;
2734
2735 params.beacon_interval =
2736 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
2737 params.dtim_period =
2738 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
2739
2740 err = cfg80211_validate_beacon_int(rdev, params.beacon_interval);
2741 if (err)
2742 return err;
2743
2744 /*
2745 * In theory, some of these attributes should be required here
2746 * but since they were not used when the command was originally
2747 * added, keep them optional for old user space programs to let
2748 * them continue to work with drivers that do not need the
2749 * additional information -- drivers must check!
2750 */
2751 if (info->attrs[NL80211_ATTR_SSID]) {
2752 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
2753 params.ssid_len =
2754 nla_len(info->attrs[NL80211_ATTR_SSID]);
2755 if (params.ssid_len == 0 ||
2756 params.ssid_len > IEEE80211_MAX_SSID_LEN)
2757 return -EINVAL;
2758 }
2759
2760 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
2761 params.hidden_ssid = nla_get_u32(
2762 info->attrs[NL80211_ATTR_HIDDEN_SSID]);
2763 if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
2764 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
2765 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
2766 return -EINVAL;
2767 }
2768
2769 params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
2770
2771 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
2772 params.auth_type = nla_get_u32(
2773 info->attrs[NL80211_ATTR_AUTH_TYPE]);
e39e5b5e
JM		 2774 if (!nl80211_valid_auth_type(rdev, params.auth_type,
2775 NL80211_CMD_START_AP))
8860020e
JB		 2776 return -EINVAL;
2777 } else
2778 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
2779
2780 err = nl80211_crypto_settings(rdev, info, &params.crypto,
2781 NL80211_MAX_NR_CIPHER_SUITES);
2782 if (err)
2783 return err;
2784
1b658f11
VT		 2785 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
2786 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
2787 return -EOPNOTSUPP;
2788 params.inactivity_timeout = nla_get_u16(
2789 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
2790 }
2791
53cabad7
JB		 2792 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
2793 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2794 return -EINVAL;
2795 params.p2p_ctwindow =
2796 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
2797 if (params.p2p_ctwindow > 127)
2798 return -EINVAL;
2799 if (params.p2p_ctwindow != 0 &&
2800 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
2801 return -EINVAL;
2802 }
2803
2804 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
2805 u8 tmp;
2806
2807 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2808 return -EINVAL;
2809 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
2810 if (tmp > 1)
2811 return -EINVAL;
2812 params.p2p_opp_ps = tmp;
2813 if (params.p2p_opp_ps != 0 &&
2814 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
2815 return -EINVAL;
2816 }
2817
aa430da4 2818 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
683b6d3b
JB		 2819 err = nl80211_parse_chandef(rdev, info, &params.chandef);
2820 if (err)
2821 return err;
2822 } else if (wdev->preset_chandef.chan) {
2823 params.chandef = wdev->preset_chandef;
46c1dd0c 2824 } else if (!nl80211_get_ap_channel(rdev, &params))
aa430da4
JB		 2825 return -EINVAL;
2826
683b6d3b 2827 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &params.chandef))
aa430da4
JB		 2828 return -EINVAL;
2829
e4e32459 2830 mutex_lock(&rdev->devlist_mtx);
683b6d3b 2831 err = cfg80211_can_use_chan(rdev, wdev, params.chandef.chan,
e4e32459
MK		 2832 CHAN_MODE_SHARED);
2833 mutex_unlock(&rdev->devlist_mtx);
2834
2835 if (err)
2836 return err;
2837
77765eaf
VT		 2838 if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
2839 params.acl = parse_acl_data(&rdev->wiphy, info);
2840 if (IS_ERR(params.acl))
2841 return PTR_ERR(params.acl);
2842 }
2843
e35e4d28 2844 err = rdev_start_ap(rdev, dev, &params);
46c1dd0c 2845 if (!err) {
683b6d3b 2846 wdev->preset_chandef = params.chandef;
8860020e 2847 wdev->beacon_interval = params.beacon_interval;
683b6d3b 2848 wdev->channel = params.chandef.chan;
06e191e2
AQ		 2849 wdev->ssid_len = params.ssid_len;
2850 memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
46c1dd0c 2851 }
77765eaf
VT		 2852
2853 kfree(params.acl);
2854
56d1893d 2855 return err;
ed1b6cc7
JB		 2856}
2857
8860020e
JB		 2858static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
2859{
2860 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2861 struct net_device *dev = info->user_ptr[1];
2862 struct wireless_dev *wdev = dev->ieee80211_ptr;
2863 struct cfg80211_beacon_data params;
2864 int err;
2865
2866 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2867 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2868 return -EOPNOTSUPP;
2869
2870 if (!rdev->ops->change_beacon)
2871 return -EOPNOTSUPP;
2872
2873 if (!wdev->beacon_interval)
2874 return -EINVAL;
2875
2876 err = nl80211_parse_beacon(info, &params);
2877 if (err)
2878 return err;
2879
e35e4d28 2880 return rdev_change_beacon(rdev, dev, &params);
8860020e
JB		 2881}
2882
2883static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
ed1b6cc7 2884{
4c476991
JB		 2885 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2886 struct net_device *dev = info->user_ptr[1];
ed1b6cc7 2887
60771780 2888 return cfg80211_stop_ap(rdev, dev);
ed1b6cc7
JB		 2889}
2890
5727ef1b
JB		 2891static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
2892 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
2893 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
2894 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
0e46724a 2895 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
b39c48fa 2896 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
d83023da 2897 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
5727ef1b
JB		 2898};
2899
eccb8e8f 2900static int parse_station_flags(struct genl_info *info,
bdd3ae3d 2901 enum nl80211_iftype iftype,
eccb8e8f 2902 struct station_parameters *params)
5727ef1b
JB		 2903{
2904 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
eccb8e8f 2905 struct nlattr *nla;
5727ef1b
JB		 2906 int flag;
2907
eccb8e8f
JB		 2908 /*
2909 * Try parsing the new attribute first so userspace
2910 * can specify both for older kernels.
2911 */
2912 nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
2913 if (nla) {
2914 struct nl80211_sta_flag_update *sta_flags;
2915
2916 sta_flags = nla_data(nla);
2917 params->sta_flags_mask = sta_flags->mask;
2918 params->sta_flags_set = sta_flags->set;
2919 if ((params->sta_flags_mask |
2920 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
2921 return -EINVAL;
2922 return 0;
2923 }
2924
2925 /* if present, parse the old attribute */
5727ef1b 2926
eccb8e8f 2927 nla = info->attrs[NL80211_ATTR_STA_FLAGS];
5727ef1b
JB		 2928 if (!nla)
2929 return 0;
2930
2931 if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX,
2932 nla, sta_flags_policy))
2933 return -EINVAL;
2934
bdd3ae3d
JB		 2935 /*
2936 * Only allow certain flags for interface types so that
2937 * other attributes are silently ignored. Remember that
2938 * this is backward compatibility code with old userspace
2939 * and shouldn't be hit in other cases anyway.
2940 */
2941 switch (iftype) {
2942 case NL80211_IFTYPE_AP:
2943 case NL80211_IFTYPE_AP_VLAN:
2944 case NL80211_IFTYPE_P2P_GO:
2945 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
2946 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
2947 BIT(NL80211_STA_FLAG_WME) |
2948 BIT(NL80211_STA_FLAG_MFP);
2949 break;
2950 case NL80211_IFTYPE_P2P_CLIENT:
2951 case NL80211_IFTYPE_STATION:
2952 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
2953 BIT(NL80211_STA_FLAG_TDLS_PEER);
2954 break;
2955 case NL80211_IFTYPE_MESH_POINT:
2956 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
2957 BIT(NL80211_STA_FLAG_MFP) |
2958 BIT(NL80211_STA_FLAG_AUTHORIZED);
2959 default:
2960 return -EINVAL;
2961 }
5727ef1b 2962
3383b5a6
JB		 2963 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
2964 if (flags[flag]) {
eccb8e8f 2965 params->sta_flags_set |= (1<<flag);
5727ef1b 2966
3383b5a6
JB		 2967 /* no longer support new API additions in old API */
2968 if (flag > NL80211_STA_FLAG_MAX_OLD_API)
2969 return -EINVAL;
2970 }
2971 }
2972
5727ef1b
JB		 2973 return 0;
2974}
2975
c8dcfd8a
FF		 2976static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
2977 int attr)
2978{
2979 struct nlattr *rate;
8eb41c8d
VK		 2980 u32 bitrate;
2981 u16 bitrate_compat;
c8dcfd8a
FF		 2982
2983 rate = nla_nest_start(msg, attr);
2984 if (!rate)
db9c64cf 2985 return false;
c8dcfd8a
FF		 2986
2987 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
2988 bitrate = cfg80211_calculate_bitrate(info);
8eb41c8d
VK		 2989 /* report 16-bit bitrate only if we can */
2990 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
db9c64cf
JB		 2991 if (bitrate > 0 &&
2992 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
2993 return false;
2994 if (bitrate_compat > 0 &&
2995 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
2996 return false;
2997
2998 if (info->flags & RATE_INFO_FLAGS_MCS) {
2999 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
3000 return false;
3001 if (info->flags & RATE_INFO_FLAGS_40_MHZ_WIDTH &&
3002 nla_put_flag(msg, NL80211_RATE_INFO_40_MHZ_WIDTH))
3003 return false;
3004 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
3005 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
3006 return false;
3007 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
3008 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
3009 return false;
3010 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
3011 return false;
3012 if (info->flags & RATE_INFO_FLAGS_40_MHZ_WIDTH &&
3013 nla_put_flag(msg, NL80211_RATE_INFO_40_MHZ_WIDTH))
3014 return false;
3015 if (info->flags & RATE_INFO_FLAGS_80_MHZ_WIDTH &&
3016 nla_put_flag(msg, NL80211_RATE_INFO_80_MHZ_WIDTH))
3017 return false;
3018 if (info->flags & RATE_INFO_FLAGS_80P80_MHZ_WIDTH &&
3019 nla_put_flag(msg, NL80211_RATE_INFO_80P80_MHZ_WIDTH))
3020 return false;
3021 if (info->flags & RATE_INFO_FLAGS_160_MHZ_WIDTH &&
3022 nla_put_flag(msg, NL80211_RATE_INFO_160_MHZ_WIDTH))
3023 return false;
3024 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
3025 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
3026 return false;
3027 }
c8dcfd8a
FF		 3028
3029 nla_nest_end(msg, rate);
3030 return true;
c8dcfd8a
FF		 3031}
3032
15e47304 3033static int nl80211_send_station(struct sk_buff *msg, u32 portid, u32 seq,
66266b3a
JL		 3034 int flags,
3035 struct cfg80211_registered_device *rdev,
3036 struct net_device *dev,
98b62183 3037 const u8 *mac_addr, struct station_info *sinfo)
fd5b74dc
JB		 3038{
3039 void *hdr;
f4263c98 3040 struct nlattr *sinfoattr, *bss_param;
fd5b74dc 3041
15e47304 3042 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_STATION);
fd5b74dc
JB		 3043 if (!hdr)
3044 return -1;
3045
9360ffd1
DM		 3046 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3047 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
3048 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
3049 goto nla_put_failure;
f5ea9120 3050
2ec600d6
LCC		 3051 sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
3052 if (!sinfoattr)
fd5b74dc 3053 goto nla_put_failure;
9360ffd1
DM		 3054 if ((sinfo->filled & STATION_INFO_CONNECTED_TIME) &&
3055 nla_put_u32(msg, NL80211_STA_INFO_CONNECTED_TIME,
3056 sinfo->connected_time))
3057 goto nla_put_failure;
3058 if ((sinfo->filled & STATION_INFO_INACTIVE_TIME) &&
3059 nla_put_u32(msg, NL80211_STA_INFO_INACTIVE_TIME,
3060 sinfo->inactive_time))
3061 goto nla_put_failure;
42745e03
VK		 3062 if ((sinfo->filled & (STATION_INFO_RX_BYTES |
3063 STATION_INFO_RX_BYTES64)) &&
9360ffd1 3064 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
42745e03 3065 (u32)sinfo->rx_bytes))
9360ffd1 3066 goto nla_put_failure;
42745e03
VK		 3067 if ((sinfo->filled & (STATION_INFO_TX_BYTES |
3068 NL80211_STA_INFO_TX_BYTES64)) &&
9360ffd1 3069 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
42745e03
VK		 3070 (u32)sinfo->tx_bytes))
3071 goto nla_put_failure;
3072 if ((sinfo->filled & STATION_INFO_RX_BYTES64) &&
3073 nla_put_u64(msg, NL80211_STA_INFO_RX_BYTES64,
3074 sinfo->rx_bytes))
3075 goto nla_put_failure;
3076 if ((sinfo->filled & STATION_INFO_TX_BYTES64) &&
3077 nla_put_u64(msg, NL80211_STA_INFO_TX_BYTES64,
9360ffd1
DM		 3078 sinfo->tx_bytes))
3079 goto nla_put_failure;
3080 if ((sinfo->filled & STATION_INFO_LLID) &&
3081 nla_put_u16(msg, NL80211_STA_INFO_LLID, sinfo->llid))
3082 goto nla_put_failure;
3083 if ((sinfo->filled & STATION_INFO_PLID) &&
3084 nla_put_u16(msg, NL80211_STA_INFO_PLID, sinfo->plid))
3085 goto nla_put_failure;
3086 if ((sinfo->filled & STATION_INFO_PLINK_STATE) &&
3087 nla_put_u8(msg, NL80211_STA_INFO_PLINK_STATE,
3088 sinfo->plink_state))
3089 goto nla_put_failure;
66266b3a
JL		 3090 switch (rdev->wiphy.signal_type) {
3091 case CFG80211_SIGNAL_TYPE_MBM:
9360ffd1
DM		 3092 if ((sinfo->filled & STATION_INFO_SIGNAL) &&
3093 nla_put_u8(msg, NL80211_STA_INFO_SIGNAL,
3094 sinfo->signal))
3095 goto nla_put_failure;
3096 if ((sinfo->filled & STATION_INFO_SIGNAL_AVG) &&
3097 nla_put_u8(msg, NL80211_STA_INFO_SIGNAL_AVG,
3098 sinfo->signal_avg))
3099 goto nla_put_failure;
66266b3a
JL		 3100 break;
3101 default:
3102 break;
3103 }
420e7fab 3104 if (sinfo->filled & STATION_INFO_TX_BITRATE) {
c8dcfd8a
FF		 3105 if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
3106 NL80211_STA_INFO_TX_BITRATE))
3107 goto nla_put_failure;
3108 }
3109 if (sinfo->filled & STATION_INFO_RX_BITRATE) {
3110 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
3111 NL80211_STA_INFO_RX_BITRATE))
420e7fab 3112 goto nla_put_failure;
420e7fab 3113 }
9360ffd1
DM		 3114 if ((sinfo->filled & STATION_INFO_RX_PACKETS) &&
3115 nla_put_u32(msg, NL80211_STA_INFO_RX_PACKETS,
3116 sinfo->rx_packets))
3117 goto nla_put_failure;
3118 if ((sinfo->filled & STATION_INFO_TX_PACKETS) &&
3119 nla_put_u32(msg, NL80211_STA_INFO_TX_PACKETS,
3120 sinfo->tx_packets))
3121 goto nla_put_failure;
3122 if ((sinfo->filled & STATION_INFO_TX_RETRIES) &&
3123 nla_put_u32(msg, NL80211_STA_INFO_TX_RETRIES,
3124 sinfo->tx_retries))
3125 goto nla_put_failure;
3126 if ((sinfo->filled & STATION_INFO_TX_FAILED) &&
3127 nla_put_u32(msg, NL80211_STA_INFO_TX_FAILED,
3128 sinfo->tx_failed))
3129 goto nla_put_failure;
3130 if ((sinfo->filled & STATION_INFO_BEACON_LOSS_COUNT) &&
3131 nla_put_u32(msg, NL80211_STA_INFO_BEACON_LOSS,
3132 sinfo->beacon_loss_count))
3133 goto nla_put_failure;
3b1c5a53
MP		 3134 if ((sinfo->filled & STATION_INFO_LOCAL_PM) &&
3135 nla_put_u32(msg, NL80211_STA_INFO_LOCAL_PM,
3136 sinfo->local_pm))
3137 goto nla_put_failure;
3138 if ((sinfo->filled & STATION_INFO_PEER_PM) &&
3139 nla_put_u32(msg, NL80211_STA_INFO_PEER_PM,
3140 sinfo->peer_pm))
3141 goto nla_put_failure;
3142 if ((sinfo->filled & STATION_INFO_NONPEER_PM) &&
3143 nla_put_u32(msg, NL80211_STA_INFO_NONPEER_PM,
3144 sinfo->nonpeer_pm))
3145 goto nla_put_failure;
f4263c98
PS		 3146 if (sinfo->filled & STATION_INFO_BSS_PARAM) {
3147 bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
3148 if (!bss_param)
3149 goto nla_put_failure;
3150
9360ffd1
DM		 3151 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
3152 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
3153 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
3154 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
3155 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
3156 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
3157 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
3158 sinfo->bss_param.dtim_period) ||
3159 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
3160 sinfo->bss_param.beacon_interval))
3161 goto nla_put_failure;
f4263c98
PS		 3162
3163 nla_nest_end(msg, bss_param);
3164 }
9360ffd1
DM		 3165 if ((sinfo->filled & STATION_INFO_STA_FLAGS) &&
3166 nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
3167 sizeof(struct nl80211_sta_flag_update),
3168 &sinfo->sta_flags))
3169 goto nla_put_failure;
7eab0f64
JL		 3170 if ((sinfo->filled & STATION_INFO_T_OFFSET) &&
3171 nla_put_u64(msg, NL80211_STA_INFO_T_OFFSET,
3172 sinfo->t_offset))
3173 goto nla_put_failure;
2ec600d6 3174 nla_nest_end(msg, sinfoattr);
fd5b74dc 3175
9360ffd1
DM		 3176 if ((sinfo->filled & STATION_INFO_ASSOC_REQ_IES) &&
3177 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
3178 sinfo->assoc_req_ies))
3179 goto nla_put_failure;
50d3dfb7 3180
fd5b74dc
JB		 3181 return genlmsg_end(msg, hdr);
3182
3183 nla_put_failure:
bc3ed28c
TG		 3184 genlmsg_cancel(msg, hdr);
3185 return -EMSGSIZE;
fd5b74dc
JB		 3186}
3187
2ec600d6 3188static int nl80211_dump_station(struct sk_buff *skb,
bba95fef 3189 struct netlink_callback *cb)
2ec600d6 3190{
2ec600d6
LCC		 3191 struct station_info sinfo;
3192 struct cfg80211_registered_device *dev;
bba95fef 3193 struct net_device *netdev;
2ec600d6 3194 u8 mac_addr[ETH_ALEN];
bba95fef 3195 int sta_idx = cb->args[1];
2ec600d6 3196 int err;
2ec600d6 3197
67748893
JB		 3198 err = nl80211_prepare_netdev_dump(skb, cb, &dev, &netdev);
3199 if (err)
3200 return err;
bba95fef
JB		 3201
3202 if (!dev->ops->dump_station) {
eec60b03 3203 err = -EOPNOTSUPP;
bba95fef
JB		 3204 goto out_err;
3205 }
3206
bba95fef 3207 while (1) {
f612cedf 3208 memset(&sinfo, 0, sizeof(sinfo));
e35e4d28
HG		 3209 err = rdev_dump_station(dev, netdev, sta_idx,
3210 mac_addr, &sinfo);
bba95fef
JB		 3211 if (err == -ENOENT)
3212 break;
3213 if (err)
3b85875a 3214 goto out_err;
bba95fef
JB		 3215
3216 if (nl80211_send_station(skb,
15e47304 3217 NETLINK_CB(cb->skb).portid,
bba95fef 3218 cb->nlh->nlmsg_seq, NLM_F_MULTI,
66266b3a 3219 dev, netdev, mac_addr,
bba95fef
JB		 3220 &sinfo) < 0)
3221 goto out;
3222
3223 sta_idx++;
3224 }
3225
3226
3227 out:
3228 cb->args[1] = sta_idx;
3229 err = skb->len;
bba95fef 3230 out_err:
67748893 3231 nl80211_finish_netdev_dump(dev);
bba95fef
JB		 3232
3233 return err;
2ec600d6 3234}
fd5b74dc 3235
5727ef1b
JB		 3236static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
3237{
4c476991
JB		 3238 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3239 struct net_device *dev = info->user_ptr[1];
2ec600d6 3240 struct station_info sinfo;
fd5b74dc
JB		 3241 struct sk_buff *msg;
3242 u8 *mac_addr = NULL;
4c476991 3243 int err;
fd5b74dc 3244
2ec600d6 3245 memset(&sinfo, 0, sizeof(sinfo));
fd5b74dc
JB		 3246
3247 if (!info->attrs[NL80211_ATTR_MAC])
3248 return -EINVAL;
3249
3250 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3251
4c476991
JB		 3252 if (!rdev->ops->get_station)
3253 return -EOPNOTSUPP;
3b85875a 3254
e35e4d28 3255 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
fd5b74dc 3256 if (err)
4c476991 3257 return err;
2ec600d6 3258
fd2120ca 3259 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
fd5b74dc 3260 if (!msg)
4c476991 3261 return -ENOMEM;
fd5b74dc 3262
15e47304 3263 if (nl80211_send_station(msg, info->snd_portid, info->snd_seq, 0,
66266b3a 3264 rdev, dev, mac_addr, &sinfo) < 0) {
4c476991
JB		 3265 nlmsg_free(msg);
3266 return -ENOBUFS;
3267 }
3b85875a 3268
4c476991 3269 return genlmsg_reply(msg, info);
5727ef1b
JB		 3270}
3271
3272/*
c258d2de 3273 * Get vlan interface making sure it is running and on the right wiphy.
5727ef1b 3274 */
80b99899
JB		 3275static struct net_device *get_vlan(struct genl_info *info,
3276 struct cfg80211_registered_device *rdev)
5727ef1b 3277{
463d0183 3278 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
80b99899
JB		 3279 struct net_device *v;
3280 int ret;
3281
3282 if (!vlanattr)
3283 return NULL;
3284
3285 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
3286 if (!v)
3287 return ERR_PTR(-ENODEV);
3288
3289 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
3290 ret = -EINVAL;
3291 goto error;
5727ef1b 3292 }
80b99899
JB		 3293
3294 if (!netif_running(v)) {
3295 ret = -ENETDOWN;
3296 goto error;
3297 }
3298
3299 return v;
3300 error:
3301 dev_put(v);
3302 return ERR_PTR(ret);
5727ef1b
JB		 3303}
3304
3305static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
3306{
4c476991 3307 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5727ef1b 3308 int err;
4c476991 3309 struct net_device *dev = info->user_ptr[1];
5727ef1b
JB		 3310 struct station_parameters params;
3311 u8 *mac_addr = NULL;
3312
3313 memset(&params, 0, sizeof(params));
3314
3315 params.listen_interval = -1;
57cf8043 3316 params.plink_state = -1;
5727ef1b
JB		 3317
3318 if (info->attrs[NL80211_ATTR_STA_AID])
3319 return -EINVAL;
3320
3321 if (!info->attrs[NL80211_ATTR_MAC])
3322 return -EINVAL;
3323
3324 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3325
3326 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
3327 params.supported_rates =
3328 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
3329 params.supported_rates_len =
3330 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
3331 }
3332
ba23d206
JB		 3333 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL] ||
3334 info->attrs[NL80211_ATTR_HT_CAPABILITY])
3335 return -EINVAL;
36aedc90 3336
bdd90d5e
JB		 3337 if (!rdev->ops->change_station)
3338 return -EOPNOTSUPP;
3339
bdd3ae3d 3340 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5727ef1b
JB		 3341 return -EINVAL;
3342
2ec600d6
LCC		 3343 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
3344 params.plink_action =
3345 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
3346
9c3990aa
JC		 3347 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE])
3348 params.plink_state =
3349 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
3350
3b1c5a53
MP		 3351 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) {
3352 enum nl80211_mesh_power_mode pm = nla_get_u32(
3353 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
3354
3355 if (pm <= NL80211_MESH_POWER_UNKNOWN ||
3356 pm > NL80211_MESH_POWER_MAX)
3357 return -EINVAL;
3358
3359 params.local_pm = pm;
3360 }
3361
a97f4424
JB		 3362 switch (dev->ieee80211_ptr->iftype) {
3363 case NL80211_IFTYPE_AP:
3364 case NL80211_IFTYPE_AP_VLAN:
074ac8df 3365 case NL80211_IFTYPE_P2P_GO:
a97f4424
JB		 3366 /* disallow mesh-specific things */
3367 if (params.plink_action)
bdd90d5e 3368 return -EINVAL;
3b1c5a53
MP		 3369 if (params.local_pm)
3370 return -EINVAL;
bdd90d5e
JB		 3371
3372 /* TDLS can't be set, ... */
3373 if (params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
3374 return -EINVAL;
3375 /*
3376 * ... but don't bother the driver with it. This works around
3377 * a hostapd/wpa_supplicant issue -- it always includes the
3378 * TLDS_PEER flag in the mask even for AP mode.
3379 */
3380 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
3381
3382 /* accept only the listed bits */
3383 if (params.sta_flags_mask &
3384 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
d582cffb
JB		 3385 BIT(NL80211_STA_FLAG_AUTHENTICATED) |
3386 BIT(NL80211_STA_FLAG_ASSOCIATED) |
bdd90d5e
JB		 3387 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
3388 BIT(NL80211_STA_FLAG_WME) |
3389 BIT(NL80211_STA_FLAG_MFP)))
3390 return -EINVAL;
3391
d582cffb
JB		 3392 /* but authenticated/associated only if driver handles it */
3393 if (!(rdev->wiphy.features &
3394 NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
3395 params.sta_flags_mask &
3396 (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
3397 BIT(NL80211_STA_FLAG_ASSOCIATED)))
3398 return -EINVAL;
3399
ba23d206
JB		 3400 /* reject other things that can't change */
3401 if (params.supported_rates)
3402 return -EINVAL;
3403
bdd90d5e
JB		 3404 /* must be last in here for error handling */
3405 params.vlan = get_vlan(info, rdev);
3406 if (IS_ERR(params.vlan))
3407 return PTR_ERR(params.vlan);
a97f4424 3408 break;
074ac8df 3409 case NL80211_IFTYPE_P2P_CLIENT:
a97f4424 3410 case NL80211_IFTYPE_STATION:
bdd90d5e
JB		 3411 /*
3412 * Don't allow userspace to change the TDLS_PEER flag,
3413 * but silently ignore attempts to change it since we
3414 * don't have state here to verify that it doesn't try
3415 * to change the flag.
3416 */
3417 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
267335d6
AQ		 3418 /* fall through */
3419 case NL80211_IFTYPE_ADHOC:
3420 /* disallow things sta doesn't support */
3421 if (params.plink_action)
3422 return -EINVAL;
3b1c5a53
MP		 3423 if (params.local_pm)
3424 return -EINVAL;
bdd90d5e
JB		 3425 /* reject any changes other than AUTHORIZED */
3426 if (params.sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
3427 return -EINVAL;
a97f4424
JB		 3428 break;
3429 case NL80211_IFTYPE_MESH_POINT:
3430 /* disallow things mesh doesn't support */
3431 if (params.vlan)
bdd90d5e 3432 return -EINVAL;
ba23d206 3433 if (params.supported_rates)
bdd90d5e
JB		 3434 return -EINVAL;
3435 /*
3436 * No special handling for TDLS here -- the userspace
3437 * mesh code doesn't have this bug.
3438 */
b39c48fa
JC		 3439 if (params.sta_flags_mask &
3440 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
8429828e 3441 BIT(NL80211_STA_FLAG_MFP) |
b39c48fa 3442 BIT(NL80211_STA_FLAG_AUTHORIZED)))
bdd90d5e 3443 return -EINVAL;
a97f4424
JB		 3444 break;
3445 default:
bdd90d5e 3446 return -EOPNOTSUPP;
034d655e
JB		 3447 }
3448
bdd90d5e 3449 /* be aware of params.vlan when changing code here */
5727ef1b 3450
e35e4d28 3451 err = rdev_change_station(rdev, dev, mac_addr, &params);
5727ef1b 3452
5727ef1b
JB		 3453 if (params.vlan)
3454 dev_put(params.vlan);
3b85875a 3455
5727ef1b
JB		 3456 return err;
3457}
3458
c75786c9
EP		 3459static struct nla_policy
3460nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] __read_mostly = {
3461 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
3462 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
3463};
3464
5727ef1b
JB		 3465static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
3466{
4c476991 3467 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5727ef1b 3468 int err;
4c476991 3469 struct net_device *dev = info->user_ptr[1];
5727ef1b
JB		 3470 struct station_parameters params;
3471 u8 *mac_addr = NULL;
3472
3473 memset(&params, 0, sizeof(params));
3474
3475 if (!info->attrs[NL80211_ATTR_MAC])
3476 return -EINVAL;
3477
5727ef1b
JB		 3478 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
3479 return -EINVAL;
3480
3481 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
3482 return -EINVAL;
3483
0e956c13
TLSC		 3484 if (!info->attrs[NL80211_ATTR_STA_AID])
3485 return -EINVAL;
3486
5727ef1b
JB		 3487 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3488 params.supported_rates =
3489 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
3490 params.supported_rates_len =
3491 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
3492 params.listen_interval =
3493 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
51b50fbe 3494
0e956c13
TLSC		 3495 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
3496 if (!params.aid || params.aid > IEEE80211_MAX_AID)
3497 return -EINVAL;
51b50fbe 3498
36aedc90
JM		 3499 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
3500 params.ht_capa =
3501 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5727ef1b 3502
f461be3e
MP		 3503 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
3504 params.vht_capa =
3505 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
3506
96b78dff
JC		 3507 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
3508 params.plink_action =
3509 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
3510
bdd90d5e
JB		 3511 if (!rdev->ops->add_station)
3512 return -EOPNOTSUPP;
3513
bdd3ae3d 3514 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5727ef1b
JB		 3515 return -EINVAL;
3516
bdd90d5e
JB		 3517 switch (dev->ieee80211_ptr->iftype) {
3518 case NL80211_IFTYPE_AP:
3519 case NL80211_IFTYPE_AP_VLAN:
3520 case NL80211_IFTYPE_P2P_GO:
3521 /* parse WME attributes if sta is WME capable */
3522 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
3523 (params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)) &&
3524 info->attrs[NL80211_ATTR_STA_WME]) {
3525 struct nlattr *tb[NL80211_STA_WME_MAX + 1];
3526 struct nlattr *nla;
3527
3528 nla = info->attrs[NL80211_ATTR_STA_WME];
3529 err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
3530 nl80211_sta_wme_policy);
3531 if (err)
3532 return err;
3533
3534 if (tb[NL80211_STA_WME_UAPSD_QUEUES])
3535 params.uapsd_queues =
3536 nla_get_u8(tb[NL80211_STA_WME_UAPSD_QUEUES]);
3537 if (params.uapsd_queues &
3538 ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
3539 return -EINVAL;
c75786c9 3540
bdd90d5e
JB		 3541 if (tb[NL80211_STA_WME_MAX_SP])
3542 params.max_sp =
3543 nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
c75786c9 3544
bdd90d5e
JB		 3545 if (params.max_sp &
3546 ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
3547 return -EINVAL;
4319e193 3548
bdd90d5e
JB		 3549 params.sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
3550 }
3551 /* TDLS peers cannot be added */
3552 if (params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
4319e193 3553 return -EINVAL;
bdd90d5e
JB		 3554 /* but don't bother the driver with it */
3555 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
3b9ce80c 3556
d582cffb
JB		 3557 /* allow authenticated/associated only if driver handles it */
3558 if (!(rdev->wiphy.features &
3559 NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
3560 params.sta_flags_mask &
3561 (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
3562 BIT(NL80211_STA_FLAG_ASSOCIATED)))
3563 return -EINVAL;
3564
bdd90d5e
JB		 3565 /* must be last in here for error handling */
3566 params.vlan = get_vlan(info, rdev);
3567 if (IS_ERR(params.vlan))
3568 return PTR_ERR(params.vlan);
3569 break;
3570 case NL80211_IFTYPE_MESH_POINT:
d582cffb
JB		 3571 /* associated is disallowed */
3572 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
3573 return -EINVAL;
bdd90d5e
JB		 3574 /* TDLS peers cannot be added */
3575 if (params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
3576 return -EINVAL;
3577 break;
3578 case NL80211_IFTYPE_STATION:
d582cffb
JB		 3579 /* associated is disallowed */
3580 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
3581 return -EINVAL;
bdd90d5e
JB		 3582 /* Only TDLS peers can be added */
3583 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
3584 return -EINVAL;
3585 /* Can only add if TDLS ... */
3586 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
3587 return -EOPNOTSUPP;
3588 /* ... with external setup is supported */
3589 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
3590 return -EOPNOTSUPP;
3591 break;
3592 default:
3593 return -EOPNOTSUPP;
c75786c9
EP		 3594 }
3595
bdd90d5e 3596 /* be aware of params.vlan when changing code here */
5727ef1b 3597
e35e4d28 3598 err = rdev_add_station(rdev, dev, mac_addr, &params);
5727ef1b 3599
5727ef1b
JB		 3600 if (params.vlan)
3601 dev_put(params.vlan);
5727ef1b
JB		 3602 return err;
3603}
3604
3605static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
3606{
4c476991
JB		 3607 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3608 struct net_device *dev = info->user_ptr[1];
5727ef1b
JB		 3609 u8 *mac_addr = NULL;
3610
3611 if (info->attrs[NL80211_ATTR_MAC])
3612 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3613
e80cf853 3614 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
d5d9de02 3615 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
074ac8df 3616 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
4c476991
JB		 3617 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3618 return -EINVAL;
5727ef1b 3619
4c476991
JB		 3620 if (!rdev->ops->del_station)
3621 return -EOPNOTSUPP;
3b85875a 3622
e35e4d28 3623 return rdev_del_station(rdev, dev, mac_addr);
5727ef1b
JB		 3624}
3625
15e47304 3626static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
2ec600d6
LCC		 3627 int flags, struct net_device *dev,
3628 u8 *dst, u8 *next_hop,
3629 struct mpath_info *pinfo)
3630{
3631 void *hdr;
3632 struct nlattr *pinfoattr;
3633
15e47304 3634 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_STATION);
2ec600d6
LCC		 3635 if (!hdr)
3636 return -1;
3637
9360ffd1
DM		 3638 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3639 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
3640 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
3641 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
3642 goto nla_put_failure;
f5ea9120 3643
2ec600d6
LCC		 3644 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
3645 if (!pinfoattr)
3646 goto nla_put_failure;
9360ffd1
DM		 3647 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
3648 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
3649 pinfo->frame_qlen))
3650 goto nla_put_failure;
3651 if (((pinfo->filled & MPATH_INFO_SN) &&
3652 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
3653 ((pinfo->filled & MPATH_INFO_METRIC) &&
3654 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
3655 pinfo->metric)) ||
3656 ((pinfo->filled & MPATH_INFO_EXPTIME) &&
3657 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
3658 pinfo->exptime)) ||
3659 ((pinfo->filled & MPATH_INFO_FLAGS) &&
3660 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
3661 pinfo->flags)) ||
3662 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
3663 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
3664 pinfo->discovery_timeout)) ||
3665 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
3666 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
3667 pinfo->discovery_retries)))
3668 goto nla_put_failure;
2ec600d6
LCC		 3669
3670 nla_nest_end(msg, pinfoattr);
3671
3672 return genlmsg_end(msg, hdr);
3673
3674 nla_put_failure:
bc3ed28c
TG		 3675 genlmsg_cancel(msg, hdr);
3676 return -EMSGSIZE;
2ec600d6
LCC		 3677}
3678
3679static int nl80211_dump_mpath(struct sk_buff *skb,
bba95fef 3680 struct netlink_callback *cb)
2ec600d6 3681{
2ec600d6
LCC		 3682 struct mpath_info pinfo;
3683 struct cfg80211_registered_device *dev;
bba95fef 3684 struct net_device *netdev;
2ec600d6
LCC		 3685 u8 dst[ETH_ALEN];
3686 u8 next_hop[ETH_ALEN];
bba95fef 3687 int path_idx = cb->args[1];
2ec600d6 3688 int err;
2ec600d6 3689
67748893
JB		 3690 err = nl80211_prepare_netdev_dump(skb, cb, &dev, &netdev);
3691 if (err)
3692 return err;
bba95fef
JB		 3693
3694 if (!dev->ops->dump_mpath) {
eec60b03 3695 err = -EOPNOTSUPP;
bba95fef
JB		 3696 goto out_err;
3697 }
3698
eec60b03
JM		 3699 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
3700 err = -EOPNOTSUPP;
0448b5fc 3701 goto out_err;
eec60b03
JM		 3702 }
3703
bba95fef 3704 while (1) {
e35e4d28
HG		 3705 err = rdev_dump_mpath(dev, netdev, path_idx, dst, next_hop,
3706 &pinfo);
bba95fef 3707 if (err == -ENOENT)
2ec600d6 3708 break;
bba95fef 3709 if (err)
3b85875a 3710 goto out_err;
2ec600d6 3711
15e47304 3712 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
bba95fef
JB		 3713 cb->nlh->nlmsg_seq, NLM_F_MULTI,
3714 netdev, dst, next_hop,
3715 &pinfo) < 0)
3716 goto out;
2ec600d6 3717
bba95fef 3718 path_idx++;
2ec600d6 3719 }
2ec600d6 3720
2ec600d6 3721
bba95fef
JB		 3722 out:
3723 cb->args[1] = path_idx;
3724 err = skb->len;
bba95fef 3725 out_err:
67748893 3726 nl80211_finish_netdev_dump(dev);
bba95fef 3727 return err;
2ec600d6
LCC		 3728}
3729
3730static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
3731{
4c476991 3732 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2ec600d6 3733 int err;
4c476991 3734 struct net_device *dev = info->user_ptr[1];
2ec600d6
LCC		 3735 struct mpath_info pinfo;
3736 struct sk_buff *msg;
3737 u8 *dst = NULL;
3738 u8 next_hop[ETH_ALEN];
3739
3740 memset(&pinfo, 0, sizeof(pinfo));
3741
3742 if (!info->attrs[NL80211_ATTR_MAC])
3743 return -EINVAL;
3744
3745 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
3746
4c476991
JB		 3747 if (!rdev->ops->get_mpath)
3748 return -EOPNOTSUPP;
2ec600d6 3749
4c476991
JB		 3750 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
3751 return -EOPNOTSUPP;
eec60b03 3752
e35e4d28 3753 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
2ec600d6 3754 if (err)
4c476991 3755 return err;
2ec600d6 3756
fd2120ca 3757 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2ec600d6 3758 if (!msg)
4c476991 3759 return -ENOMEM;
2ec600d6 3760
15e47304 3761 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
4c476991
JB		 3762 dev, dst, next_hop, &pinfo) < 0) {
3763 nlmsg_free(msg);
3764 return -ENOBUFS;
3765 }
3b85875a 3766
4c476991 3767 return genlmsg_reply(msg, info);
2ec600d6
LCC		 3768}
3769
3770static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
3771{
4c476991
JB		 3772 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3773 struct net_device *dev = info->user_ptr[1];
2ec600d6
LCC		 3774 u8 *dst = NULL;
3775 u8 *next_hop = NULL;
3776
3777 if (!info->attrs[NL80211_ATTR_MAC])
3778 return -EINVAL;
3779
3780 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
3781 return -EINVAL;
3782
3783 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
3784 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
3785
4c476991
JB		 3786 if (!rdev->ops->change_mpath)
3787 return -EOPNOTSUPP;
35a8efe1 3788
4c476991
JB		 3789 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
3790 return -EOPNOTSUPP;
2ec600d6 3791
e35e4d28 3792 return rdev_change_mpath(rdev, dev, dst, next_hop);
2ec600d6 3793}
4c476991 3794
2ec600d6
LCC		 3795static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
3796{
4c476991
JB		 3797 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3798 struct net_device *dev = info->user_ptr[1];
2ec600d6
LCC		 3799 u8 *dst = NULL;
3800 u8 *next_hop = NULL;
3801
3802 if (!info->attrs[NL80211_ATTR_MAC])
3803 return -EINVAL;
3804
3805 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
3806 return -EINVAL;
3807
3808 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
3809 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
3810
4c476991
JB		 3811 if (!rdev->ops->add_mpath)
3812 return -EOPNOTSUPP;
35a8efe1 3813
4c476991
JB		 3814 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
3815 return -EOPNOTSUPP;
2ec600d6 3816
e35e4d28 3817 return rdev_add_mpath(rdev, dev, dst, next_hop);
2ec600d6
LCC		 3818}
3819
3820static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
3821{
4c476991
JB		 3822 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3823 struct net_device *dev = info->user_ptr[1];
2ec600d6
LCC		 3824 u8 *dst = NULL;
3825
3826 if (info->attrs[NL80211_ATTR_MAC])
3827 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
3828
4c476991
JB		 3829 if (!rdev->ops->del_mpath)
3830 return -EOPNOTSUPP;
3b85875a 3831
e35e4d28 3832 return rdev_del_mpath(rdev, dev, dst);
2ec600d6
LCC		 3833}
3834
9f1ba906
JM		 3835static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
3836{
4c476991
JB		 3837 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3838 struct net_device *dev = info->user_ptr[1];
9f1ba906
JM		 3839 struct bss_parameters params;
3840
3841 memset(&params, 0, sizeof(params));
3842 /* default to not changing parameters */
3843 params.use_cts_prot = -1;
3844 params.use_short_preamble = -1;
3845 params.use_short_slot_time = -1;
fd8aaaf3 3846 params.ap_isolate = -1;
50b12f59 3847 params.ht_opmode = -1;
53cabad7
JB		 3848 params.p2p_ctwindow = -1;
3849 params.p2p_opp_ps = -1;
9f1ba906
JM		 3850
3851 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
3852 params.use_cts_prot =
3853 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
3854 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
3855 params.use_short_preamble =
3856 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
3857 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
3858 params.use_short_slot_time =
3859 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
90c97a04
JM		 3860 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
3861 params.basic_rates =
3862 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
3863 params.basic_rates_len =
3864 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
3865 }
fd8aaaf3
FF		 3866 if (info->attrs[NL80211_ATTR_AP_ISOLATE])
3867 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
50b12f59
HS		 3868 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
3869 params.ht_opmode =
3870 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
9f1ba906 3871
53cabad7
JB		 3872 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
3873 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3874 return -EINVAL;
3875 params.p2p_ctwindow =
3876 nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
3877 if (params.p2p_ctwindow < 0)
3878 return -EINVAL;
3879 if (params.p2p_ctwindow != 0 &&
3880 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
3881 return -EINVAL;
3882 }
3883
3884 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
3885 u8 tmp;
3886
3887 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3888 return -EINVAL;
3889 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
3890 if (tmp > 1)
3891 return -EINVAL;
3892 params.p2p_opp_ps = tmp;
3893 if (params.p2p_opp_ps &&
3894 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
3895 return -EINVAL;
3896 }
3897
4c476991
JB		 3898 if (!rdev->ops->change_bss)
3899 return -EOPNOTSUPP;
9f1ba906 3900
074ac8df 3901 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4c476991
JB		 3902 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3903 return -EOPNOTSUPP;
3b85875a 3904
e35e4d28 3905 return rdev_change_bss(rdev, dev, &params);
9f1ba906
JM		 3906}
3907
b54452b0 3908static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
b2e1b302
LR		 3909 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
3910 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
3911 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
3912 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
3913 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
3914 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
3915};
3916
3917static int parse_reg_rule(struct nlattr *tb[],
3918 struct ieee80211_reg_rule *reg_rule)
3919{
3920 struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
3921 struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
3922
3923 if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
3924 return -EINVAL;
3925 if (!tb[NL80211_ATTR_FREQ_RANGE_START])
3926 return -EINVAL;
3927 if (!tb[NL80211_ATTR_FREQ_RANGE_END])
3928 return -EINVAL;
3929 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
3930 return -EINVAL;
3931 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
3932 return -EINVAL;
3933
3934 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
3935
3936 freq_range->start_freq_khz =
3937 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
3938 freq_range->end_freq_khz =
3939 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
3940 freq_range->max_bandwidth_khz =
3941 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
3942
3943 power_rule->max_eirp =
3944 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
3945
3946 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
3947 power_rule->max_antenna_gain =
3948 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
3949
3950 return 0;
3951}
3952
3953static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
3954{
3955 int r;
3956 char *data = NULL;
57b5ce07 3957 enum nl80211_user_reg_hint_type user_reg_hint_type;
b2e1b302 3958
80778f18
LR		 3959 /*
3960 * You should only get this when cfg80211 hasn't yet initialized
3961 * completely when built-in to the kernel right between the time
3962 * window between nl80211_init() and regulatory_init(), if that is
3963 * even possible.
3964 */
458f4f9e 3965 if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
fe33eb39 3966 return -EINPROGRESS;
80778f18 3967
fe33eb39
LR		 3968 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
3969 return -EINVAL;
b2e1b302
LR		 3970
3971 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
3972
57b5ce07
LR		 3973 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
3974 user_reg_hint_type =
3975 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
3976 else
3977 user_reg_hint_type = NL80211_USER_REG_HINT_USER;
3978
3979 switch (user_reg_hint_type) {
3980 case NL80211_USER_REG_HINT_USER:
3981 case NL80211_USER_REG_HINT_CELL_BASE:
3982 break;
3983 default:
3984 return -EINVAL;
3985 }
3986
3987 r = regulatory_hint_user(data, user_reg_hint_type);
fe33eb39 3988
b2e1b302
LR		 3989 return r;
3990}
3991
24bdd9f4 3992static int nl80211_get_mesh_config(struct sk_buff *skb,
29cbe68c 3993 struct genl_info *info)
93da9cc1 3994{
4c476991 3995 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4c476991 3996 struct net_device *dev = info->user_ptr[1];
29cbe68c
JB		 3997 struct wireless_dev *wdev = dev->ieee80211_ptr;
3998 struct mesh_config cur_params;
3999 int err = 0;
93da9cc1 4000 void *hdr;
4001 struct nlattr *pinfoattr;
4002 struct sk_buff *msg;
4003
29cbe68c
JB		 4004 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
4005 return -EOPNOTSUPP;
4006
24bdd9f4 4007 if (!rdev->ops->get_mesh_config)
4c476991 4008 return -EOPNOTSUPP;
f3f92586 4009
29cbe68c
JB		 4010 wdev_lock(wdev);
4011 /* If not connected, get default parameters */
4012 if (!wdev->mesh_id_len)
4013 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
4014 else
e35e4d28 4015 err = rdev_get_mesh_config(rdev, dev, &cur_params);
29cbe68c
JB		 4016 wdev_unlock(wdev);
4017
93da9cc1 4018 if (err)
4c476991 4019 return err;
93da9cc1 4020
4021 /* Draw up a netlink message to send back */
fd2120ca 4022 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4c476991
JB		 4023 if (!msg)
4024 return -ENOMEM;
15e47304 4025 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
24bdd9f4 4026 NL80211_CMD_GET_MESH_CONFIG);
93da9cc1 4027 if (!hdr)
efe1cf0c 4028 goto out;
24bdd9f4 4029 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
93da9cc1 4030 if (!pinfoattr)
4031 goto nla_put_failure;
9360ffd1
DM		 4032 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
4033 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
4034 cur_params.dot11MeshRetryTimeout) ||
4035 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
4036 cur_params.dot11MeshConfirmTimeout) ||
4037 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
4038 cur_params.dot11MeshHoldingTimeout) ||
4039 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
4040 cur_params.dot11MeshMaxPeerLinks) ||
4041 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
4042 cur_params.dot11MeshMaxRetries) ||
4043 nla_put_u8(msg, NL80211_MESHCONF_TTL,
4044 cur_params.dot11MeshTTL) ||
4045 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
4046 cur_params.element_ttl) ||
4047 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
4048 cur_params.auto_open_plinks) ||
7eab0f64
JL		 4049 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
4050 cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
9360ffd1
DM		 4051 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
4052 cur_params.dot11MeshHWMPmaxPREQretries) ||
4053 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
4054 cur_params.path_refresh_time) ||
4055 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
4056 cur_params.min_discovery_timeout) ||
4057 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
4058 cur_params.dot11MeshHWMPactivePathTimeout) ||
4059 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
4060 cur_params.dot11MeshHWMPpreqMinInterval) ||
4061 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
4062 cur_params.dot11MeshHWMPperrMinInterval) ||
4063 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
4064 cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
4065 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
4066 cur_params.dot11MeshHWMPRootMode) ||
4067 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
4068 cur_params.dot11MeshHWMPRannInterval) ||
4069 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
4070 cur_params.dot11MeshGateAnnouncementProtocol) ||
4071 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
4072 cur_params.dot11MeshForwarding) ||
4073 nla_put_u32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
70c33eaa
AN		 4074 cur_params.rssi_threshold) ||
4075 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
ac1073a6
CYY		 4076 cur_params.ht_opmode) ||
4077 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
4078 cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
4079 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
728b19e5
CYY		 4080 cur_params.dot11MeshHWMProotInterval) ||
4081 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
3b1c5a53
MP		 4082 cur_params.dot11MeshHWMPconfirmationInterval) ||
4083 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
4084 cur_params.power_mode) ||
4085 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
4086 cur_params.dot11MeshAwakeWindowDuration))
9360ffd1 4087 goto nla_put_failure;
93da9cc1 4088 nla_nest_end(msg, pinfoattr);
4089 genlmsg_end(msg, hdr);
4c476991 4090 return genlmsg_reply(msg, info);
93da9cc1 4091
3b85875a 4092 nla_put_failure:
93da9cc1 4093 genlmsg_cancel(msg, hdr);
efe1cf0c 4094 out:
d080e275 4095 nlmsg_free(msg);
4c476991 4096 return -ENOBUFS;
93da9cc1 4097}
4098
b54452b0 4099static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
93da9cc1 4100 [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
4101 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
4102 [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
4103 [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
4104 [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
4105 [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
45904f21 4106 [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
93da9cc1 4107 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
d299a1f2 4108 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
93da9cc1 4109 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
4110 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
4111 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
4112 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
4113 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
dca7e943 4114 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
93da9cc1 4115 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
699403db 4116 [NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
0507e159 4117 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
16dd7267 4118 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
94f90656 4119 [NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
a4f606ea
CYY		 4120 [NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
4121 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
ac1073a6
CYY		 4122 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
4123 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
728b19e5 4124 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
3b1c5a53
MP		 4125 [NL80211_MESHCONF_POWER_MODE] = { .type = NLA_U32 },
4126 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
93da9cc1 4127};
4128
c80d545d
JC		 4129static const struct nla_policy
4130 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
d299a1f2 4131 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
c80d545d
JC		 4132 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
4133 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
15d5dda6 4134 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
581a8b0f 4135 [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
a4f606ea 4136 .len = IEEE80211_MAX_DATA_LEN },
b130e5ce 4137 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
c80d545d
JC		 4138};
4139
24bdd9f4 4140static int nl80211_parse_mesh_config(struct genl_info *info,
bd90fdcc
JB		 4141 struct mesh_config *cfg,
4142 u32 *mask_out)
93da9cc1 4143{
93da9cc1 4144 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
bd90fdcc 4145 u32 mask = 0;
93da9cc1 4146
ea54fba2
MP		 4147#define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, min, max, mask, attr, fn) \
4148do { \
4149 if (tb[attr]) { \
4150 if (fn(tb[attr]) < min || fn(tb[attr]) > max) \
4151 return -EINVAL; \
4152 cfg->param = fn(tb[attr]); \
4153 mask |= (1 << (attr - 1)); \
4154 } \
4155} while (0)
bd90fdcc
JB		 4156
4157
24bdd9f4 4158 if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
93da9cc1 4159 return -EINVAL;
4160 if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
24bdd9f4 4161 info->attrs[NL80211_ATTR_MESH_CONFIG],
bd90fdcc 4162 nl80211_meshconf_params_policy))
93da9cc1 4163 return -EINVAL;
4164
93da9cc1 4165 /* This makes sure that there aren't more than 32 mesh config
4166 * parameters (otherwise our bitfield scheme would not work.) */
4167 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
4168
4169 /* Fill in the params struct */
ea54fba2 4170 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, 1, 255,
a4f606ea
CYY		 4171 mask, NL80211_MESHCONF_RETRY_TIMEOUT,
4172 nla_get_u16);
ea54fba2 4173 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, 1, 255,
a4f606ea
CYY		 4174 mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
4175 nla_get_u16);
ea54fba2 4176 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, 1, 255,
a4f606ea
CYY		 4177 mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
4178 nla_get_u16);
ea54fba2 4179 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, 0, 255,
a4f606ea
CYY		 4180 mask, NL80211_MESHCONF_MAX_PEER_LINKS,
4181 nla_get_u16);
ea54fba2 4182 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, 0, 16,
a4f606ea
CYY		 4183 mask, NL80211_MESHCONF_MAX_RETRIES,
4184 nla_get_u8);
ea54fba2 4185 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, 1, 255,
a4f606ea 4186 mask, NL80211_MESHCONF_TTL, nla_get_u8);
ea54fba2 4187 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, 1, 255,
a4f606ea
CYY		 4188 mask, NL80211_MESHCONF_ELEMENT_TTL,
4189 nla_get_u8);
ea54fba2 4190 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, 0, 1,
a4f606ea
CYY		 4191 mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
4192 nla_get_u8);
ea54fba2
MP		 4193 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
4194 1, 255, mask,
a4f606ea
CYY		 4195 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
4196 nla_get_u32);
ea54fba2 4197 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, 0, 255,
a4f606ea
CYY		 4198 mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
4199 nla_get_u8);
ea54fba2 4200 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, 1, 65535,
a4f606ea
CYY		 4201 mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
4202 nla_get_u32);
ea54fba2 4203 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, 1, 65535,
a4f606ea
CYY		 4204 mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
4205 nla_get_u16);
ea54fba2
MP		 4206 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
4207 1, 65535, mask,
a4f606ea
CYY		 4208 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
4209 nla_get_u32);
93da9cc1 4210 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
ea54fba2
MP		 4211 1, 65535, mask,
4212 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
a4f606ea 4213 nla_get_u16);
dca7e943 4214 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
ea54fba2
MP		 4215 1, 65535, mask,
4216 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
a4f606ea 4217 nla_get_u16);
93da9cc1 4218 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
ea54fba2
MP		 4219 dot11MeshHWMPnetDiameterTraversalTime,
4220 1, 65535, mask,
a4f606ea
CYY		 4221 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
4222 nla_get_u16);
ea54fba2
MP		 4223 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, 0, 4,
4224 mask, NL80211_MESHCONF_HWMP_ROOTMODE,
4225 nla_get_u8);
4226 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, 1, 65535,
4227 mask, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
a4f606ea 4228 nla_get_u16);
63c5723b 4229 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
ea54fba2
MP		 4230 dot11MeshGateAnnouncementProtocol, 0, 1,
4231 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
a4f606ea 4232 nla_get_u8);
ea54fba2 4233 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, 0, 1,
a4f606ea
CYY		 4234 mask, NL80211_MESHCONF_FORWARDING,
4235 nla_get_u8);
ea54fba2 4236 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, 1, 255,
a4f606ea
CYY		 4237 mask, NL80211_MESHCONF_RSSI_THRESHOLD,
4238 nla_get_u32);
ea54fba2 4239 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, ht_opmode, 0, 16,
a4f606ea 4240 mask, NL80211_MESHCONF_HT_OPMODE,
ac1073a6
CYY		 4241 nla_get_u16);
4242 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
ea54fba2 4243 1, 65535, mask,
ac1073a6
CYY		 4244 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
4245 nla_get_u32);
ea54fba2 4246 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, 1, 65535,
ac1073a6 4247 mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
728b19e5
CYY		 4248 nla_get_u16);
4249 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
ea54fba2
MP		 4250 dot11MeshHWMPconfirmationInterval,
4251 1, 65535, mask,
728b19e5 4252 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
a4f606ea 4253 nla_get_u16);
3b1c5a53
MP		 4254 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode,
4255 NL80211_MESH_POWER_ACTIVE,
4256 NL80211_MESH_POWER_MAX,
4257 mask, NL80211_MESHCONF_POWER_MODE,
4258 nla_get_u32);
4259 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration,
4260 0, 65535, mask,
4261 NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16);
bd90fdcc
JB		 4262 if (mask_out)
4263 *mask_out = mask;
c80d545d 4264
bd90fdcc
JB		 4265 return 0;
4266
4267#undef FILL_IN_MESH_PARAM_IF_SET
4268}
4269
c80d545d
JC		 4270static int nl80211_parse_mesh_setup(struct genl_info *info,
4271 struct mesh_setup *setup)
4272{
4273 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
4274
4275 if (!info->attrs[NL80211_ATTR_MESH_SETUP])
4276 return -EINVAL;
4277 if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
4278 info->attrs[NL80211_ATTR_MESH_SETUP],
4279 nl80211_mesh_setup_params_policy))
4280 return -EINVAL;
4281
d299a1f2
JC		 4282 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
4283 setup->sync_method =
4284 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
4285 IEEE80211_SYNC_METHOD_VENDOR :
4286 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
4287
c80d545d
JC		 4288 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
4289 setup->path_sel_proto =
4290 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
4291 IEEE80211_PATH_PROTOCOL_VENDOR :
4292 IEEE80211_PATH_PROTOCOL_HWMP;
4293
4294 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
4295 setup->path_metric =
4296 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
4297 IEEE80211_PATH_METRIC_VENDOR :
4298 IEEE80211_PATH_METRIC_AIRTIME;
4299
581a8b0f
JC		 4300
4301 if (tb[NL80211_MESH_SETUP_IE]) {
c80d545d 4302 struct nlattr *ieattr =
581a8b0f 4303 tb[NL80211_MESH_SETUP_IE];
c80d545d
JC		 4304 if (!is_valid_ie_attr(ieattr))
4305 return -EINVAL;
581a8b0f
JC		 4306 setup->ie = nla_data(ieattr);
4307 setup->ie_len = nla_len(ieattr);
c80d545d 4308 }
b130e5ce
JC		 4309 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
4310 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
c80d545d
JC		 4311
4312 return 0;
4313}
4314
24bdd9f4 4315static int nl80211_update_mesh_config(struct sk_buff *skb,
29cbe68c 4316 struct genl_info *info)
bd90fdcc
JB		 4317{
4318 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4319 struct net_device *dev = info->user_ptr[1];
29cbe68c 4320 struct wireless_dev *wdev = dev->ieee80211_ptr;
bd90fdcc
JB		 4321 struct mesh_config cfg;
4322 u32 mask;
4323 int err;
4324
29cbe68c
JB		 4325 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
4326 return -EOPNOTSUPP;
4327
24bdd9f4 4328 if (!rdev->ops->update_mesh_config)
bd90fdcc
JB		 4329 return -EOPNOTSUPP;
4330
24bdd9f4 4331 err = nl80211_parse_mesh_config(info, &cfg, &mask);
bd90fdcc
JB		 4332 if (err)
4333 return err;
4334
29cbe68c
JB		 4335 wdev_lock(wdev);
4336 if (!wdev->mesh_id_len)
4337 err = -ENOLINK;
4338
4339 if (!err)
e35e4d28 4340 err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
29cbe68c
JB		 4341
4342 wdev_unlock(wdev);
4343
4344 return err;
93da9cc1 4345}
4346
f130347c
LR		 4347static int nl80211_get_reg(struct sk_buff *skb, struct genl_info *info)
4348{
458f4f9e 4349 const struct ieee80211_regdomain *regdom;
f130347c
LR		 4350 struct sk_buff *msg;
4351 void *hdr = NULL;
4352 struct nlattr *nl_reg_rules;
4353 unsigned int i;
4354 int err = -EINVAL;
4355
a1794390 4356 mutex_lock(&cfg80211_mutex);
f130347c
LR		 4357
4358 if (!cfg80211_regdomain)
4359 goto out;
4360
fd2120ca 4361 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
f130347c
LR		 4362 if (!msg) {
4363 err = -ENOBUFS;
4364 goto out;
4365 }
4366
15e47304 4367 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
f130347c
LR		 4368 NL80211_CMD_GET_REG);
4369 if (!hdr)
efe1cf0c 4370 goto put_failure;
f130347c 4371
57b5ce07
LR		 4372 if (reg_last_request_cell_base() &&
4373 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
4374 NL80211_USER_REG_HINT_CELL_BASE))
4375 goto nla_put_failure;
4376
458f4f9e
JB		 4377 rcu_read_lock();
4378 regdom = rcu_dereference(cfg80211_regdomain);
4379
4380 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
4381 (regdom->dfs_region &&
4382 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
4383 goto nla_put_failure_rcu;
4384
f130347c
LR		 4385 nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
4386 if (!nl_reg_rules)
458f4f9e 4387 goto nla_put_failure_rcu;
f130347c 4388
458f4f9e 4389 for (i = 0; i < regdom->n_reg_rules; i++) {
f130347c
LR		 4390 struct nlattr *nl_reg_rule;
4391 const struct ieee80211_reg_rule *reg_rule;
4392 const struct ieee80211_freq_range *freq_range;
4393 const struct ieee80211_power_rule *power_rule;
4394
458f4f9e 4395 reg_rule = &regdom->reg_rules[i];
f130347c
LR		 4396 freq_range = &reg_rule->freq_range;
4397 power_rule = &reg_rule->power_rule;
4398
4399 nl_reg_rule = nla_nest_start(msg, i);
4400 if (!nl_reg_rule)
458f4f9e 4401 goto nla_put_failure_rcu;
f130347c 4402
9360ffd1
DM		 4403 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
4404 reg_rule->flags) ||
4405 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
4406 freq_range->start_freq_khz) ||
4407 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
4408 freq_range->end_freq_khz) ||
4409 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
4410 freq_range->max_bandwidth_khz) ||
4411 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
4412 power_rule->max_antenna_gain) ||
4413 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
4414 power_rule->max_eirp))
458f4f9e 4415 goto nla_put_failure_rcu;
f130347c
LR		 4416
4417 nla_nest_end(msg, nl_reg_rule);
4418 }
458f4f9e 4419 rcu_read_unlock();
f130347c
LR		 4420
4421 nla_nest_end(msg, nl_reg_rules);
4422
4423 genlmsg_end(msg, hdr);
134e6375 4424 err = genlmsg_reply(msg, info);
f130347c
LR		 4425 goto out;
4426
458f4f9e
JB		 4427nla_put_failure_rcu:
4428 rcu_read_unlock();
f130347c
LR		 4429nla_put_failure:
4430 genlmsg_cancel(msg, hdr);
efe1cf0c 4431put_failure:
d080e275 4432 nlmsg_free(msg);
f130347c
LR		 4433 err = -EMSGSIZE;
4434out:
a1794390 4435 mutex_unlock(&cfg80211_mutex);
f130347c
LR		 4436 return err;
4437}
4438
b2e1b302
LR		 4439static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
4440{
4441 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
4442 struct nlattr *nl_reg_rule;
4443 char *alpha2 = NULL;
4444 int rem_reg_rules = 0, r = 0;
4445 u32 num_rules = 0, rule_idx = 0, size_of_regd;
8b60b078 4446 u8 dfs_region = 0;
b2e1b302
LR		 4447 struct ieee80211_regdomain *rd = NULL;
4448
4449 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
4450 return -EINVAL;
4451
4452 if (!info->attrs[NL80211_ATTR_REG_RULES])
4453 return -EINVAL;
4454
4455 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
4456
8b60b078
LR		 4457 if (info->attrs[NL80211_ATTR_DFS_REGION])
4458 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
4459
b2e1b302 4460 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
1a919318 4461 rem_reg_rules) {
b2e1b302
LR		 4462 num_rules++;
4463 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
4776c6e7 4464 return -EINVAL;
b2e1b302
LR		 4465 }
4466
b2e1b302 4467 size_of_regd = sizeof(struct ieee80211_regdomain) +
1a919318 4468 num_rules * sizeof(struct ieee80211_reg_rule);
b2e1b302
LR		 4469
4470 rd = kzalloc(size_of_regd, GFP_KERNEL);
6913b49a
JB		 4471 if (!rd)
4472 return -ENOMEM;
b2e1b302
LR		 4473
4474 rd->n_reg_rules = num_rules;
4475 rd->alpha2[0] = alpha2[0];
4476 rd->alpha2[1] = alpha2[1];
4477
8b60b078
LR		 4478 /*
4479 * Disable DFS master mode if the DFS region was
4480 * not supported or known on this kernel.
4481 */
4482 if (reg_supported_dfs_region(dfs_region))
4483 rd->dfs_region = dfs_region;
4484
b2e1b302 4485 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
1a919318 4486 rem_reg_rules) {
b2e1b302 4487 nla_parse(tb, NL80211_REG_RULE_ATTR_MAX,
1a919318
JB		 4488 nla_data(nl_reg_rule), nla_len(nl_reg_rule),
4489 reg_rule_policy);
b2e1b302
LR		 4490 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
4491 if (r)
4492 goto bad_reg;
4493
4494 rule_idx++;
4495
d0e18f83
LR		 4496 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
4497 r = -EINVAL;
b2e1b302 4498 goto bad_reg;
d0e18f83 4499 }
b2e1b302
LR		 4500 }
4501
6913b49a
JB		 4502 mutex_lock(&cfg80211_mutex);
4503
b2e1b302 4504 r = set_regdom(rd);
6913b49a 4505 /* set_regdom took ownership */
1a919318 4506 rd = NULL;
6913b49a 4507 mutex_unlock(&cfg80211_mutex);
b2e1b302 4508
d2372b31 4509 bad_reg:
b2e1b302 4510 kfree(rd);
d0e18f83 4511 return r;
b2e1b302
LR		 4512}
4513
83f5e2cf
JB		 4514static int validate_scan_freqs(struct nlattr *freqs)
4515{
4516 struct nlattr *attr1, *attr2;
4517 int n_channels = 0, tmp1, tmp2;
4518
4519 nla_for_each_nested(attr1, freqs, tmp1) {
4520 n_channels++;
4521 /*
4522 * Some hardware has a limited channel list for
4523 * scanning, and it is pretty much nonsensical
4524 * to scan for a channel twice, so disallow that
4525 * and don't require drivers to check that the
4526 * channel list they get isn't longer than what
4527 * they can scan, as long as they can scan all
4528 * the channels they registered at once.
4529 */
4530 nla_for_each_nested(attr2, freqs, tmp2)
4531 if (attr1 != attr2 &&
4532 nla_get_u32(attr1) == nla_get_u32(attr2))
4533 return 0;
4534 }
4535
4536 return n_channels;
4537}
4538
2a519311
JB		 4539static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
4540{
4c476991 4541 struct cfg80211_registered_device *rdev = info->user_ptr[0];
fd014284 4542 struct wireless_dev *wdev = info->user_ptr[1];
2a519311 4543 struct cfg80211_scan_request *request;
2a519311
JB		 4544 struct nlattr *attr;
4545 struct wiphy *wiphy;
83f5e2cf 4546 int err, tmp, n_ssids = 0, n_channels, i;
70692ad2 4547 size_t ie_len;
2a519311 4548
f4a11bb0
JB		 4549 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
4550 return -EINVAL;
4551
79c97e97 4552 wiphy = &rdev->wiphy;
2a519311 4553
4c476991
JB		 4554 if (!rdev->ops->scan)
4555 return -EOPNOTSUPP;
2a519311 4556
4c476991
JB		 4557 if (rdev->scan_req)
4558 return -EBUSY;
2a519311
JB		 4559
4560 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
83f5e2cf
JB		 4561 n_channels = validate_scan_freqs(
4562 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
4c476991
JB		 4563 if (!n_channels)
4564 return -EINVAL;
2a519311 4565 } else {
34850ab2 4566 enum ieee80211_band band;
83f5e2cf
JB		 4567 n_channels = 0;
4568
2a519311
JB		 4569 for (band = 0; band < IEEE80211_NUM_BANDS; band++)
4570 if (wiphy->bands[band])
4571 n_channels += wiphy->bands[band]->n_channels;
4572 }
4573
4574 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
4575 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
4576 n_ssids++;
4577
4c476991
JB		 4578 if (n_ssids > wiphy->max_scan_ssids)
4579 return -EINVAL;
2a519311 4580
70692ad2
JM		 4581 if (info->attrs[NL80211_ATTR_IE])
4582 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4583 else
4584 ie_len = 0;
4585
4c476991
JB		 4586 if (ie_len > wiphy->max_scan_ie_len)
4587 return -EINVAL;
18a83659 4588
2a519311 4589 request = kzalloc(sizeof(*request)
a2cd43c5
LC		 4590 + sizeof(*request->ssids) * n_ssids
4591 + sizeof(*request->channels) * n_channels
70692ad2 4592 + ie_len, GFP_KERNEL);
4c476991
JB		 4593 if (!request)
4594 return -ENOMEM;
2a519311 4595
2a519311 4596 if (n_ssids)
5ba63533 4597 request->ssids = (void *)&request->channels[n_channels];
2a519311 4598 request->n_ssids = n_ssids;
70692ad2
JM		 4599 if (ie_len) {
4600 if (request->ssids)
4601 request->ie = (void *)(request->ssids + n_ssids);
4602 else
4603 request->ie = (void *)(request->channels + n_channels);
4604 }
2a519311 4605
584991dc 4606 i = 0;
2a519311
JB		 4607 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
4608 /* user specified, bail out if channel not found */
2a519311 4609 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
584991dc
JB		 4610 struct ieee80211_channel *chan;
4611
4612 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
4613
4614 if (!chan) {
2a519311
JB		 4615 err = -EINVAL;
4616 goto out_free;
4617 }
584991dc
JB		 4618
4619 /* ignore disabled channels */
4620 if (chan->flags & IEEE80211_CHAN_DISABLED)
4621 continue;
4622
4623 request->channels[i] = chan;
2a519311
JB		 4624 i++;
4625 }
4626 } else {
34850ab2
JB		 4627 enum ieee80211_band band;
4628
2a519311 4629 /* all channels */
2a519311
JB		 4630 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
4631 int j;
4632 if (!wiphy->bands[band])
4633 continue;
4634 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
584991dc
JB		 4635 struct ieee80211_channel *chan;
4636
4637 chan = &wiphy->bands[band]->channels[j];
4638
4639 if (chan->flags & IEEE80211_CHAN_DISABLED)
4640 continue;
4641
4642 request->channels[i] = chan;
2a519311
JB		 4643 i++;
4644 }
4645 }
4646 }
4647
584991dc
JB		 4648 if (!i) {
4649 err = -EINVAL;
4650 goto out_free;
4651 }
4652
4653 request->n_channels = i;
4654
2a519311
JB		 4655 i = 0;
4656 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) {
4657 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
57a27e1d 4658 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
2a519311
JB		 4659 err = -EINVAL;
4660 goto out_free;
4661 }
57a27e1d 4662 request->ssids[i].ssid_len = nla_len(attr);
2a519311 4663 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
2a519311
JB		 4664 i++;
4665 }
4666 }
4667
70692ad2
JM		 4668 if (info->attrs[NL80211_ATTR_IE]) {
4669 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
de95a54b
JB		 4670 memcpy((void *)request->ie,
4671 nla_data(info->attrs[NL80211_ATTR_IE]),
70692ad2
JM		 4672 request->ie_len);
4673 }
4674
34850ab2 4675 for (i = 0; i < IEEE80211_NUM_BANDS; i++)
a401d2bb
JB		 4676 if (wiphy->bands[i])
4677 request->rates[i] =
4678 (1 << wiphy->bands[i]->n_bitrates) - 1;
34850ab2
JB		 4679
4680 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
4681 nla_for_each_nested(attr,
4682 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
4683 tmp) {
4684 enum ieee80211_band band = nla_type(attr);
4685
84404623 4686 if (band < 0 || band >= IEEE80211_NUM_BANDS) {
34850ab2
JB		 4687 err = -EINVAL;
4688 goto out_free;
4689 }
4690 err = ieee80211_get_ratemask(wiphy->bands[band],
4691 nla_data(attr),
4692 nla_len(attr),
4693 &request->rates[band]);
4694 if (err)
4695 goto out_free;
4696 }
4697 }
4698
46856bbf 4699 if (info->attrs[NL80211_ATTR_SCAN_FLAGS]) {
ed473771
SL		 4700 request->flags = nla_get_u32(
4701 info->attrs[NL80211_ATTR_SCAN_FLAGS]);
15d6030b
SL		 4702 if (((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
4703 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
4704 ((request->flags & NL80211_SCAN_FLAG_FLUSH) &&
4705 !(wiphy->features & NL80211_FEATURE_SCAN_FLUSH))) {
46856bbf
SL		 4706 err = -EOPNOTSUPP;
4707 goto out_free;
4708 }
4709 }
ed473771 4710
e9f935e3
RM		 4711 request->no_cck =
4712 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
4713
fd014284 4714 request->wdev = wdev;
79c97e97 4715 request->wiphy = &rdev->wiphy;
15d6030b 4716 request->scan_start = jiffies;
2a519311 4717
79c97e97 4718 rdev->scan_req = request;
e35e4d28 4719 err = rdev_scan(rdev, request);
2a519311 4720
463d0183 4721 if (!err) {
fd014284
JB		 4722 nl80211_send_scan_start(rdev, wdev);
4723 if (wdev->netdev)
4724 dev_hold(wdev->netdev);
4c476991 4725 } else {
2a519311 4726 out_free:
79c97e97 4727 rdev->scan_req = NULL;
2a519311
JB		 4728 kfree(request);
4729 }
3b85875a 4730
2a519311
JB		 4731 return err;
4732}
4733
807f8a8c
LC		 4734static int nl80211_start_sched_scan(struct sk_buff *skb,
4735 struct genl_info *info)
4736{
4737 struct cfg80211_sched_scan_request *request;
4738 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4739 struct net_device *dev = info->user_ptr[1];
807f8a8c
LC		 4740 struct nlattr *attr;
4741 struct wiphy *wiphy;
a1f1c21c 4742 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i;
bbe6ad6d 4743 u32 interval;
807f8a8c
LC		 4744 enum ieee80211_band band;
4745 size_t ie_len;
a1f1c21c 4746 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
807f8a8c
LC		 4747
4748 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
4749 !rdev->ops->sched_scan_start)
4750 return -EOPNOTSUPP;
4751
4752 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
4753 return -EINVAL;
4754
bbe6ad6d
LC		 4755 if (!info->attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
4756 return -EINVAL;
4757
4758 interval = nla_get_u32(info->attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
4759 if (interval == 0)
4760 return -EINVAL;
4761
807f8a8c
LC		 4762 wiphy = &rdev->wiphy;
4763
4764 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
4765 n_channels = validate_scan_freqs(
4766 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
4767 if (!n_channels)
4768 return -EINVAL;
4769 } else {
4770 n_channels = 0;
4771
4772 for (band = 0; band < IEEE80211_NUM_BANDS; band++)
4773 if (wiphy->bands[band])
4774 n_channels += wiphy->bands[band]->n_channels;
4775 }
4776
4777 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
4778 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS],
4779 tmp)
4780 n_ssids++;
4781
93b6aa69 4782 if (n_ssids > wiphy->max_sched_scan_ssids)
807f8a8c
LC		 4783 return -EINVAL;
4784
a1f1c21c
LC		 4785 if (info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH])
4786 nla_for_each_nested(attr,
4787 info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
4788 tmp)
4789 n_match_sets++;
4790
4791 if (n_match_sets > wiphy->max_match_sets)
4792 return -EINVAL;
4793
807f8a8c
LC		 4794 if (info->attrs[NL80211_ATTR_IE])
4795 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4796 else
4797 ie_len = 0;
4798
5a865bad 4799 if (ie_len > wiphy->max_sched_scan_ie_len)
807f8a8c
LC		 4800 return -EINVAL;
4801
c10841ca
LC		 4802 mutex_lock(&rdev->sched_scan_mtx);
4803
4804 if (rdev->sched_scan_req) {
4805 err = -EINPROGRESS;
4806 goto out;
4807 }
4808
807f8a8c 4809 request = kzalloc(sizeof(*request)
a2cd43c5 4810 + sizeof(*request->ssids) * n_ssids
a1f1c21c 4811 + sizeof(*request->match_sets) * n_match_sets
a2cd43c5 4812 + sizeof(*request->channels) * n_channels
807f8a8c 4813 + ie_len, GFP_KERNEL);
c10841ca
LC		 4814 if (!request) {
4815 err = -ENOMEM;
4816 goto out;
4817 }
807f8a8c
LC		 4818
4819 if (n_ssids)
4820 request->ssids = (void *)&request->channels[n_channels];
4821 request->n_ssids = n_ssids;
4822 if (ie_len) {
4823 if (request->ssids)
4824 request->ie = (void *)(request->ssids + n_ssids);
4825 else
4826 request->ie = (void *)(request->channels + n_channels);
4827 }
4828
a1f1c21c
LC		 4829 if (n_match_sets) {
4830 if (request->ie)
4831 request->match_sets = (void *)(request->ie + ie_len);
4832 else if (request->ssids)
4833 request->match_sets =
4834 (void *)(request->ssids + n_ssids);
4835 else
4836 request->match_sets =
4837 (void *)(request->channels + n_channels);
4838 }
4839 request->n_match_sets = n_match_sets;
4840
807f8a8c
LC		 4841 i = 0;
4842 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
4843 /* user specified, bail out if channel not found */
4844 nla_for_each_nested(attr,
4845 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES],
4846 tmp) {
4847 struct ieee80211_channel *chan;
4848
4849 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
4850
4851 if (!chan) {
4852 err = -EINVAL;
4853 goto out_free;
4854 }
4855
4856 /* ignore disabled channels */
4857 if (chan->flags & IEEE80211_CHAN_DISABLED)
4858 continue;
4859
4860 request->channels[i] = chan;
4861 i++;
4862 }
4863 } else {
4864 /* all channels */
4865 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
4866 int j;
4867 if (!wiphy->bands[band])
4868 continue;
4869 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
4870 struct ieee80211_channel *chan;
4871
4872 chan = &wiphy->bands[band]->channels[j];
4873
4874 if (chan->flags & IEEE80211_CHAN_DISABLED)
4875 continue;
4876
4877 request->channels[i] = chan;
4878 i++;
4879 }
4880 }
4881 }
4882
4883 if (!i) {
4884 err = -EINVAL;
4885 goto out_free;
4886 }
4887
4888 request->n_channels = i;
4889
4890 i = 0;
4891 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) {
4892 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS],
4893 tmp) {
57a27e1d 4894 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
807f8a8c
LC		 4895 err = -EINVAL;
4896 goto out_free;
4897 }
57a27e1d 4898 request->ssids[i].ssid_len = nla_len(attr);
807f8a8c
LC		 4899 memcpy(request->ssids[i].ssid, nla_data(attr),
4900 nla_len(attr));
807f8a8c
LC		 4901 i++;
4902 }
4903 }
4904
a1f1c21c
LC		 4905 i = 0;
4906 if (info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
4907 nla_for_each_nested(attr,
4908 info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
4909 tmp) {
88e920b4 4910 struct nlattr *ssid, *rssi;
a1f1c21c
LC		 4911
4912 nla_parse(tb, NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
4913 nla_data(attr), nla_len(attr),
4914 nl80211_match_policy);
4a4ab0d7 4915 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
a1f1c21c
LC		 4916 if (ssid) {
4917 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
4918 err = -EINVAL;
4919 goto out_free;
4920 }
4921 memcpy(request->match_sets[i].ssid.ssid,
4922 nla_data(ssid), nla_len(ssid));
4923 request->match_sets[i].ssid.ssid_len =
4924 nla_len(ssid);
4925 }
88e920b4
TP		 4926 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
4927 if (rssi)
4928 request->rssi_thold = nla_get_u32(rssi);
4929 else
4930 request->rssi_thold =
4931 NL80211_SCAN_RSSI_THOLD_OFF;
a1f1c21c
LC		 4932 i++;
4933 }
4934 }
4935
807f8a8c
LC		 4936 if (info->attrs[NL80211_ATTR_IE]) {
4937 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4938 memcpy((void *)request->ie,
4939 nla_data(info->attrs[NL80211_ATTR_IE]),
4940 request->ie_len);
4941 }
4942
46856bbf 4943 if (info->attrs[NL80211_ATTR_SCAN_FLAGS]) {
ed473771
SL		 4944 request->flags = nla_get_u32(
4945 info->attrs[NL80211_ATTR_SCAN_FLAGS]);
15d6030b
SL		 4946 if (((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
4947 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
4948 ((request->flags & NL80211_SCAN_FLAG_FLUSH) &&
4949 !(wiphy->features & NL80211_FEATURE_SCAN_FLUSH))) {
46856bbf
SL		 4950 err = -EOPNOTSUPP;
4951 goto out_free;
4952 }
4953 }
ed473771 4954
807f8a8c
LC		 4955 request->dev = dev;
4956 request->wiphy = &rdev->wiphy;
bbe6ad6d 4957 request->interval = interval;
15d6030b 4958 request->scan_start = jiffies;
807f8a8c 4959
e35e4d28 4960 err = rdev_sched_scan_start(rdev, dev, request);
807f8a8c
LC		 4961 if (!err) {
4962 rdev->sched_scan_req = request;
4963 nl80211_send_sched_scan(rdev, dev,
4964 NL80211_CMD_START_SCHED_SCAN);
4965 goto out;
4966 }
4967
4968out_free:
4969 kfree(request);
4970out:
c10841ca 4971 mutex_unlock(&rdev->sched_scan_mtx);
807f8a8c
LC		 4972 return err;
4973}
4974
4975static int nl80211_stop_sched_scan(struct sk_buff *skb,
4976 struct genl_info *info)
4977{
4978 struct cfg80211_registered_device *rdev = info->user_ptr[0];
c10841ca 4979 int err;
807f8a8c
LC		 4980
4981 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
4982 !rdev->ops->sched_scan_stop)
4983 return -EOPNOTSUPP;
4984
c10841ca
LC		 4985 mutex_lock(&rdev->sched_scan_mtx);
4986 err = __cfg80211_stop_sched_scan(rdev, false);
4987 mutex_unlock(&rdev->sched_scan_mtx);
4988
4989 return err;
807f8a8c
LC		 4990}
4991
9720bb3a
JB		 4992static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
4993 u32 seq, int flags,
2a519311 4994 struct cfg80211_registered_device *rdev,
48ab905d
JB		 4995 struct wireless_dev *wdev,
4996 struct cfg80211_internal_bss *intbss)
2a519311 4997{
48ab905d 4998 struct cfg80211_bss *res = &intbss->pub;
9caf0364 4999 const struct cfg80211_bss_ies *ies;
2a519311
JB		 5000 void *hdr;
5001 struct nlattr *bss;
8cef2c9d 5002 bool tsf = false;
48ab905d
JB		 5003
5004 ASSERT_WDEV_LOCK(wdev);
2a519311 5005
15e47304 5006 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
2a519311
JB		 5007 NL80211_CMD_NEW_SCAN_RESULTS);
5008 if (!hdr)
5009 return -1;
5010
9720bb3a
JB		 5011 genl_dump_check_consistent(cb, hdr, &nl80211_fam);
5012
9360ffd1
DM		 5013 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation) ||
5014 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
5015 goto nla_put_failure;
2a519311
JB		 5016
5017 bss = nla_nest_start(msg, NL80211_ATTR_BSS);
5018 if (!bss)
5019 goto nla_put_failure;
9360ffd1 5020 if ((!is_zero_ether_addr(res->bssid) &&
9caf0364 5021 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
9360ffd1 5022 goto nla_put_failure;
9caf0364
JB		 5023
5024 rcu_read_lock();
5025 ies = rcu_dereference(res->ies);
8cef2c9d
JB		 5026 if (ies) {
5027 if (nla_put_u64(msg, NL80211_BSS_TSF, ies->tsf))
5028 goto fail_unlock_rcu;
5029 tsf = true;
5030 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
5031 ies->len, ies->data))
5032 goto fail_unlock_rcu;
9caf0364
JB		 5033 }
5034 ies = rcu_dereference(res->beacon_ies);
8cef2c9d
JB		 5035 if (ies) {
5036 if (!tsf && nla_put_u64(msg, NL80211_BSS_TSF, ies->tsf))
5037 goto fail_unlock_rcu;
5038 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
5039 ies->len, ies->data))
5040 goto fail_unlock_rcu;
9caf0364
JB		 5041 }
5042 rcu_read_unlock();
5043
9360ffd1
DM		 5044 if (res->beacon_interval &&
5045 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
5046 goto nla_put_failure;
5047 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
5048 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
5049 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
5050 jiffies_to_msecs(jiffies - intbss->ts)))
5051 goto nla_put_failure;
2a519311 5052
77965c97 5053 switch (rdev->wiphy.signal_type) {
2a519311 5054 case CFG80211_SIGNAL_TYPE_MBM:
9360ffd1
DM		 5055 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
5056 goto nla_put_failure;
2a519311
JB		 5057 break;
5058 case CFG80211_SIGNAL_TYPE_UNSPEC:
9360ffd1
DM		 5059 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
5060 goto nla_put_failure;
2a519311
JB		 5061 break;
5062 default:
5063 break;
5064 }
5065
48ab905d 5066 switch (wdev->iftype) {
074ac8df 5067 case NL80211_IFTYPE_P2P_CLIENT:
48ab905d 5068 case NL80211_IFTYPE_STATION:
9360ffd1
DM		 5069 if (intbss == wdev->current_bss &&
5070 nla_put_u32(msg, NL80211_BSS_STATUS,
5071 NL80211_BSS_STATUS_ASSOCIATED))
5072 goto nla_put_failure;
48ab905d
JB		 5073 break;
5074 case NL80211_IFTYPE_ADHOC:
9360ffd1
DM		 5075 if (intbss == wdev->current_bss &&
5076 nla_put_u32(msg, NL80211_BSS_STATUS,
5077 NL80211_BSS_STATUS_IBSS_JOINED))
5078 goto nla_put_failure;
48ab905d
JB		 5079 break;
5080 default:
5081 break;
5082 }
5083
2a519311
JB		 5084 nla_nest_end(msg, bss);
5085
5086 return genlmsg_end(msg, hdr);
5087
8cef2c9d
JB		 5088 fail_unlock_rcu:
5089 rcu_read_unlock();
2a519311
JB		 5090 nla_put_failure:
5091 genlmsg_cancel(msg, hdr);
5092 return -EMSGSIZE;
5093}
5094
5095static int nl80211_dump_scan(struct sk_buff *skb,
5096 struct netlink_callback *cb)
5097{
48ab905d
JB		 5098 struct cfg80211_registered_device *rdev;
5099 struct net_device *dev;
2a519311 5100 struct cfg80211_internal_bss *scan;
48ab905d 5101 struct wireless_dev *wdev;
2a519311
JB		 5102 int start = cb->args[1], idx = 0;
5103 int err;
5104
67748893
JB		 5105 err = nl80211_prepare_netdev_dump(skb, cb, &rdev, &dev);
5106 if (err)
5107 return err;
2a519311 5108
48ab905d 5109 wdev = dev->ieee80211_ptr;
2a519311 5110
48ab905d
JB		 5111 wdev_lock(wdev);
5112 spin_lock_bh(&rdev->bss_lock);
5113 cfg80211_bss_expire(rdev);
5114
9720bb3a
JB		 5115 cb->seq = rdev->bss_generation;
5116
48ab905d 5117 list_for_each_entry(scan, &rdev->bss_list, list) {
2a519311
JB		 5118 if (++idx <= start)
5119 continue;
9720bb3a 5120 if (nl80211_send_bss(skb, cb,
2a519311 5121 cb->nlh->nlmsg_seq, NLM_F_MULTI,
48ab905d 5122 rdev, wdev, scan) < 0) {
2a519311 5123 idx--;
67748893 5124 break;
2a519311
JB		 5125 }
5126 }
5127
48ab905d
JB		 5128 spin_unlock_bh(&rdev->bss_lock);
5129 wdev_unlock(wdev);
2a519311
JB		 5130
5131 cb->args[1] = idx;
67748893 5132 nl80211_finish_netdev_dump(rdev);
2a519311 5133
67748893 5134 return skb->len;
2a519311
JB		 5135}
5136
15e47304 5137static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
61fa713c
HS		 5138 int flags, struct net_device *dev,
5139 struct survey_info *survey)
5140{
5141 void *hdr;
5142 struct nlattr *infoattr;
5143
15e47304 5144 hdr = nl80211hdr_put(msg, portid, seq, flags,
61fa713c
HS		 5145 NL80211_CMD_NEW_SURVEY_RESULTS);
5146 if (!hdr)
5147 return -ENOMEM;
5148
9360ffd1
DM		 5149 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
5150 goto nla_put_failure;
61fa713c
HS		 5151
5152 infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
5153 if (!infoattr)
5154 goto nla_put_failure;
5155
9360ffd1
DM		 5156 if (nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
5157 survey->channel->center_freq))
5158 goto nla_put_failure;
5159
5160 if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
5161 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
5162 goto nla_put_failure;
5163 if ((survey->filled & SURVEY_INFO_IN_USE) &&
5164 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
5165 goto nla_put_failure;
5166 if ((survey->filled & SURVEY_INFO_CHANNEL_TIME) &&
5167 nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME,
5168 survey->channel_time))
5169 goto nla_put_failure;
5170 if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_BUSY) &&
5171 nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_BUSY,
5172 survey->channel_time_busy))
5173 goto nla_put_failure;
5174 if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_EXT_BUSY) &&
5175 nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_EXT_BUSY,
5176 survey->channel_time_ext_busy))
5177 goto nla_put_failure;
5178 if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_RX) &&
5179 nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_RX,
5180 survey->channel_time_rx))
5181 goto nla_put_failure;
5182 if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_TX) &&
5183 nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_TX,
5184 survey->channel_time_tx))
5185 goto nla_put_failure;
61fa713c
HS		 5186
5187 nla_nest_end(msg, infoattr);
5188
5189 return genlmsg_end(msg, hdr);
5190
5191 nla_put_failure:
5192 genlmsg_cancel(msg, hdr);
5193 return -EMSGSIZE;
5194}
5195
5196static int nl80211_dump_survey(struct sk_buff *skb,
5197 struct netlink_callback *cb)
5198{
5199 struct survey_info survey;
5200 struct cfg80211_registered_device *dev;
5201 struct net_device *netdev;
61fa713c
HS		 5202 int survey_idx = cb->args[1];
5203 int res;
5204
67748893
JB		 5205 res = nl80211_prepare_netdev_dump(skb, cb, &dev, &netdev);
5206 if (res)
5207 return res;
61fa713c
HS		 5208
5209 if (!dev->ops->dump_survey) {
5210 res = -EOPNOTSUPP;
5211 goto out_err;
5212 }
5213
5214 while (1) {
180cdc79
LR		 5215 struct ieee80211_channel *chan;
5216
e35e4d28 5217 res = rdev_dump_survey(dev, netdev, survey_idx, &survey);
61fa713c
HS		 5218 if (res == -ENOENT)
5219 break;
5220 if (res)
5221 goto out_err;
5222
180cdc79
LR		 5223 /* Survey without a channel doesn't make sense */
5224 if (!survey.channel) {
5225 res = -EINVAL;
5226 goto out;
5227 }
5228
5229 chan = ieee80211_get_channel(&dev->wiphy,
5230 survey.channel->center_freq);
5231 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED) {
5232 survey_idx++;
5233 continue;
5234 }
5235
61fa713c 5236 if (nl80211_send_survey(skb,
15e47304 5237 NETLINK_CB(cb->skb).portid,
61fa713c
HS		 5238 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5239 netdev,
5240 &survey) < 0)
5241 goto out;
5242 survey_idx++;
5243 }
5244
5245 out:
5246 cb->args[1] = survey_idx;
5247 res = skb->len;
5248 out_err:
67748893 5249 nl80211_finish_netdev_dump(dev);
61fa713c
HS		 5250 return res;
5251}
5252
b23aa676
SO		 5253static bool nl80211_valid_wpa_versions(u32 wpa_versions)
5254{
5255 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
5256 NL80211_WPA_VERSION_2));
5257}
5258
636a5d36
JM		 5259static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
5260{
4c476991
JB		 5261 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5262 struct net_device *dev = info->user_ptr[1];
19957bb3 5263 struct ieee80211_channel *chan;
e39e5b5e
JM		 5264 const u8 *bssid, *ssid, *ie = NULL, *sae_data = NULL;
5265 int err, ssid_len, ie_len = 0, sae_data_len = 0;
19957bb3 5266 enum nl80211_auth_type auth_type;
fffd0934 5267 struct key_parse key;
d5cdfacb 5268 bool local_state_change;
636a5d36 5269
f4a11bb0
JB		 5270 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5271 return -EINVAL;
5272
5273 if (!info->attrs[NL80211_ATTR_MAC])
5274 return -EINVAL;
5275
1778092e
JM		 5276 if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
5277 return -EINVAL;
5278
19957bb3
JB		 5279 if (!info->attrs[NL80211_ATTR_SSID])
5280 return -EINVAL;
5281
5282 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
5283 return -EINVAL;
5284
fffd0934
JB		 5285 err = nl80211_parse_key(info, &key);
5286 if (err)
5287 return err;
5288
5289 if (key.idx >= 0) {
e31b8213
JB		 5290 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
5291 return -EINVAL;
fffd0934
JB		 5292 if (!key.p.key || !key.p.key_len)
5293 return -EINVAL;
5294 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
5295 key.p.key_len != WLAN_KEY_LEN_WEP40) &&
5296 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
5297 key.p.key_len != WLAN_KEY_LEN_WEP104))
5298 return -EINVAL;
5299 if (key.idx > 4)
5300 return -EINVAL;
5301 } else {
5302 key.p.key_len = 0;
5303 key.p.key = NULL;
5304 }
5305
afea0b7a
JB		 5306 if (key.idx >= 0) {
5307 int i;
5308 bool ok = false;
5309 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
5310 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
5311 ok = true;
5312 break;
5313 }
5314 }
4c476991
JB		 5315 if (!ok)
5316 return -EINVAL;
afea0b7a
JB		 5317 }
5318
4c476991
JB		 5319 if (!rdev->ops->auth)
5320 return -EOPNOTSUPP;
636a5d36 5321
074ac8df 5322 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 5323 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5324 return -EOPNOTSUPP;
eec60b03 5325
19957bb3 5326 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
79c97e97 5327 chan = ieee80211_get_channel(&rdev->wiphy,
19957bb3 5328 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
4c476991
JB		 5329 if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED))
5330 return -EINVAL;
636a5d36 5331
19957bb3
JB		 5332 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
5333 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
636a5d36
JM		 5334
5335 if (info->attrs[NL80211_ATTR_IE]) {
19957bb3
JB		 5336 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5337 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
636a5d36
JM		 5338 }
5339
19957bb3 5340 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
e39e5b5e 5341 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
4c476991 5342 return -EINVAL;
636a5d36 5343
e39e5b5e
JM		 5344 if (auth_type == NL80211_AUTHTYPE_SAE &&
5345 !info->attrs[NL80211_ATTR_SAE_DATA])
5346 return -EINVAL;
5347
5348 if (info->attrs[NL80211_ATTR_SAE_DATA]) {
5349 if (auth_type != NL80211_AUTHTYPE_SAE)
5350 return -EINVAL;
5351 sae_data = nla_data(info->attrs[NL80211_ATTR_SAE_DATA]);
5352 sae_data_len = nla_len(info->attrs[NL80211_ATTR_SAE_DATA]);
5353 /* need to include at least Auth Transaction and Status Code */
5354 if (sae_data_len < 4)
5355 return -EINVAL;
5356 }
5357
d5cdfacb
JM		 5358 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
5359
95de817b
JB		 5360 /*
5361 * Since we no longer track auth state, ignore
5362 * requests to only change local state.
5363 */
5364 if (local_state_change)
5365 return 0;
5366
4c476991
JB		 5367 return cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
5368 ssid, ssid_len, ie, ie_len,
e39e5b5e
JM		 5369 key.p.key, key.p.key_len, key.idx,
5370 sae_data, sae_data_len);
636a5d36
JM		 5371}
5372
c0692b8f
JB		 5373static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
5374 struct genl_info *info,
3dc27d25
JB		 5375 struct cfg80211_crypto_settings *settings,
5376 int cipher_limit)
b23aa676 5377{
c0b2bbd8
JB		 5378 memset(settings, 0, sizeof(*settings));
5379
b23aa676
SO		 5380 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
5381
c0692b8f
JB		 5382 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
5383 u16 proto;
5384 proto = nla_get_u16(
5385 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
5386 settings->control_port_ethertype = cpu_to_be16(proto);
5387 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
5388 proto != ETH_P_PAE)
5389 return -EINVAL;
5390 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
5391 settings->control_port_no_encrypt = true;
5392 } else
5393 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
5394
b23aa676
SO		 5395 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
5396 void *data;
5397 int len, i;
5398
5399 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
5400 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
5401 settings->n_ciphers_pairwise = len / sizeof(u32);
5402
5403 if (len % sizeof(u32))
5404 return -EINVAL;
5405
3dc27d25 5406 if (settings->n_ciphers_pairwise > cipher_limit)
b23aa676
SO		 5407 return -EINVAL;
5408
5409 memcpy(settings->ciphers_pairwise, data, len);
5410
5411 for (i = 0; i < settings->n_ciphers_pairwise; i++)
38ba3c57
JM		 5412 if (!cfg80211_supported_cipher_suite(
5413 &rdev->wiphy,
b23aa676
SO		 5414 settings->ciphers_pairwise[i]))
5415 return -EINVAL;
5416 }
5417
5418 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
5419 settings->cipher_group =
5420 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
38ba3c57
JM		 5421 if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
5422 settings->cipher_group))
b23aa676
SO		 5423 return -EINVAL;
5424 }
5425
5426 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
5427 settings->wpa_versions =
5428 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
5429 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
5430 return -EINVAL;
5431 }
5432
5433 if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
5434 void *data;
6d30240e 5435 int len;
b23aa676
SO		 5436
5437 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
5438 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
5439 settings->n_akm_suites = len / sizeof(u32);
5440
5441 if (len % sizeof(u32))
5442 return -EINVAL;
5443
1b9ca027
JM		 5444 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
5445 return -EINVAL;
5446
b23aa676 5447 memcpy(settings->akm_suites, data, len);
b23aa676
SO		 5448 }
5449
5450 return 0;
5451}
5452
636a5d36
JM		 5453static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
5454{
4c476991
JB		 5455 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5456 struct net_device *dev = info->user_ptr[1];
19957bb3 5457 struct cfg80211_crypto_settings crypto;
f444de05 5458 struct ieee80211_channel *chan;
3e5d7649 5459 const u8 *bssid, *ssid, *ie = NULL, *prev_bssid = NULL;
19957bb3
JB		 5460 int err, ssid_len, ie_len = 0;
5461 bool use_mfp = false;
7e7c8926
BG		 5462 u32 flags = 0;
5463 struct ieee80211_ht_cap *ht_capa = NULL;
5464 struct ieee80211_ht_cap *ht_capa_mask = NULL;
636a5d36 5465
f4a11bb0
JB		 5466 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5467 return -EINVAL;
5468
5469 if (!info->attrs[NL80211_ATTR_MAC] ||
19957bb3
JB		 5470 !info->attrs[NL80211_ATTR_SSID] ||
5471 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
f4a11bb0
JB		 5472 return -EINVAL;
5473
4c476991
JB		 5474 if (!rdev->ops->assoc)
5475 return -EOPNOTSUPP;
636a5d36 5476
074ac8df 5477 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 5478 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5479 return -EOPNOTSUPP;
eec60b03 5480
19957bb3 5481 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
636a5d36 5482
19957bb3
JB		 5483 chan = ieee80211_get_channel(&rdev->wiphy,
5484 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
4c476991
JB		 5485 if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED))
5486 return -EINVAL;
636a5d36 5487
19957bb3
JB		 5488 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
5489 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
636a5d36
JM		 5490
5491 if (info->attrs[NL80211_ATTR_IE]) {
19957bb3
JB		 5492 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5493 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
636a5d36
JM		 5494 }
5495
dc6382ce 5496 if (info->attrs[NL80211_ATTR_USE_MFP]) {
4f5dadce 5497 enum nl80211_mfp mfp =
dc6382ce 5498 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
4f5dadce 5499 if (mfp == NL80211_MFP_REQUIRED)
19957bb3 5500 use_mfp = true;
4c476991
JB		 5501 else if (mfp != NL80211_MFP_NO)
5502 return -EINVAL;
dc6382ce
JM		 5503 }
5504
3e5d7649
JB		 5505 if (info->attrs[NL80211_ATTR_PREV_BSSID])
5506 prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
5507
7e7c8926
BG		 5508 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
5509 flags |= ASSOC_REQ_DISABLE_HT;
5510
5511 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
5512 ht_capa_mask =
5513 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]);
5514
5515 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
5516 if (!ht_capa_mask)
5517 return -EINVAL;
5518 ht_capa = nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5519 }
5520
c0692b8f 5521 err = nl80211_crypto_settings(rdev, info, &crypto, 1);
b23aa676 5522 if (!err)
3e5d7649
JB		 5523 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid, prev_bssid,
5524 ssid, ssid_len, ie, ie_len, use_mfp,
7e7c8926
BG		 5525 &crypto, flags, ht_capa,
5526 ht_capa_mask);
636a5d36 5527
636a5d36
JM		 5528 return err;
5529}
5530
5531static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
5532{
4c476991
JB		 5533 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5534 struct net_device *dev = info->user_ptr[1];
19957bb3 5535 const u8 *ie = NULL, *bssid;
4c476991 5536 int ie_len = 0;
19957bb3 5537 u16 reason_code;
d5cdfacb 5538 bool local_state_change;
636a5d36 5539
f4a11bb0
JB		 5540 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5541 return -EINVAL;
5542
5543 if (!info->attrs[NL80211_ATTR_MAC])
5544 return -EINVAL;
5545
5546 if (!info->attrs[NL80211_ATTR_REASON_CODE])
5547 return -EINVAL;
5548
4c476991
JB		 5549 if (!rdev->ops->deauth)
5550 return -EOPNOTSUPP;
636a5d36 5551
074ac8df 5552 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 5553 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5554 return -EOPNOTSUPP;
eec60b03 5555
19957bb3 5556 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
636a5d36 5557
19957bb3
JB		 5558 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5559 if (reason_code == 0) {
f4a11bb0 5560 /* Reason Code 0 is reserved */
4c476991 5561 return -EINVAL;
255e737e 5562 }
636a5d36
JM		 5563
5564 if (info->attrs[NL80211_ATTR_IE]) {
19957bb3
JB		 5565 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5566 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
636a5d36
JM		 5567 }
5568
d5cdfacb
JM		 5569 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
5570
4c476991
JB		 5571 return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
5572 local_state_change);
636a5d36
JM		 5573}
5574
5575static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
5576{
4c476991
JB		 5577 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5578 struct net_device *dev = info->user_ptr[1];
19957bb3 5579 const u8 *ie = NULL, *bssid;
4c476991 5580 int ie_len = 0;
19957bb3 5581 u16 reason_code;
d5cdfacb 5582 bool local_state_change;
636a5d36 5583
f4a11bb0
JB		 5584 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5585 return -EINVAL;
5586
5587 if (!info->attrs[NL80211_ATTR_MAC])
5588 return -EINVAL;
5589
5590 if (!info->attrs[NL80211_ATTR_REASON_CODE])
5591 return -EINVAL;
5592
4c476991
JB		 5593 if (!rdev->ops->disassoc)
5594 return -EOPNOTSUPP;
636a5d36 5595
074ac8df 5596 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 5597 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5598 return -EOPNOTSUPP;
eec60b03 5599
19957bb3 5600 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
636a5d36 5601
19957bb3
JB		 5602 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5603 if (reason_code == 0) {
f4a11bb0 5604 /* Reason Code 0 is reserved */
4c476991 5605 return -EINVAL;
255e737e 5606 }
636a5d36
JM		 5607
5608 if (info->attrs[NL80211_ATTR_IE]) {
19957bb3
JB		 5609 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5610 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
636a5d36
JM		 5611 }
5612
d5cdfacb
JM		 5613 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
5614
4c476991
JB		 5615 return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
5616 local_state_change);
636a5d36
JM		 5617}
5618
dd5b4cc7
FF		 5619static bool
5620nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
5621 int mcast_rate[IEEE80211_NUM_BANDS],
5622 int rateval)
5623{
5624 struct wiphy *wiphy = &rdev->wiphy;
5625 bool found = false;
5626 int band, i;
5627
5628 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
5629 struct ieee80211_supported_band *sband;
5630
5631 sband = wiphy->bands[band];
5632 if (!sband)
5633 continue;
5634
5635 for (i = 0; i < sband->n_bitrates; i++) {
5636 if (sband->bitrates[i].bitrate == rateval) {
5637 mcast_rate[band] = i + 1;
5638 found = true;
5639 break;
5640 }
5641 }
5642 }
5643
5644 return found;
5645}
5646
04a773ad
JB		 5647static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
5648{
4c476991
JB		 5649 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5650 struct net_device *dev = info->user_ptr[1];
04a773ad
JB		 5651 struct cfg80211_ibss_params ibss;
5652 struct wiphy *wiphy;
fffd0934 5653 struct cfg80211_cached_keys *connkeys = NULL;
04a773ad
JB		 5654 int err;
5655
8e30bc55
JB		 5656 memset(&ibss, 0, sizeof(ibss));
5657
04a773ad
JB		 5658 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5659 return -EINVAL;
5660
683b6d3b 5661 if (!info->attrs[NL80211_ATTR_SSID] ||
04a773ad
JB		 5662 !nla_len(info->attrs[NL80211_ATTR_SSID]))
5663 return -EINVAL;
5664
8e30bc55
JB		 5665 ibss.beacon_interval = 100;
5666
5667 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
5668 ibss.beacon_interval =
5669 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
5670 if (ibss.beacon_interval < 1 || ibss.beacon_interval > 10000)
5671 return -EINVAL;
5672 }
5673
4c476991
JB		 5674 if (!rdev->ops->join_ibss)
5675 return -EOPNOTSUPP;
04a773ad 5676
4c476991
JB		 5677 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
5678 return -EOPNOTSUPP;
04a773ad 5679
79c97e97 5680 wiphy = &rdev->wiphy;
04a773ad 5681
39193498 5682 if (info->attrs[NL80211_ATTR_MAC]) {
04a773ad 5683 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
39193498
JB		 5684
5685 if (!is_valid_ether_addr(ibss.bssid))
5686 return -EINVAL;
5687 }
04a773ad
JB		 5688 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
5689 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
5690
5691 if (info->attrs[NL80211_ATTR_IE]) {
5692 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5693 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
5694 }
5695
683b6d3b
JB		 5696 err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
5697 if (err)
5698 return err;
04a773ad 5699
683b6d3b 5700 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef))
54858ee5
AS		 5701 return -EINVAL;
5702
db9c64cf
JB		 5703 if (ibss.chandef.width > NL80211_CHAN_WIDTH_40)
5704 return -EINVAL;
5705 if (ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
5706 !(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
c04d6150 5707 return -EINVAL;
db9c64cf 5708
04a773ad 5709 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
fffd0934
JB		 5710 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
5711
fbd2c8dc
TP		 5712 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
5713 u8 *rates =
5714 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5715 int n_rates =
5716 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5717 struct ieee80211_supported_band *sband =
683b6d3b 5718 wiphy->bands[ibss.chandef.chan->band];
fbd2c8dc 5719
34850ab2
JB		 5720 err = ieee80211_get_ratemask(sband, rates, n_rates,
5721 &ibss.basic_rates);
5722 if (err)
5723 return err;
fbd2c8dc 5724 }
dd5b4cc7
FF		 5725
5726 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
5727 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
5728 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
5729 return -EINVAL;
fbd2c8dc 5730
4c476991 5731 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
de7044ee
SM		 5732 bool no_ht = false;
5733
4c476991 5734 connkeys = nl80211_parse_connkeys(rdev,
de7044ee
SM		 5735 info->attrs[NL80211_ATTR_KEYS],
5736 &no_ht);
4c476991
JB		 5737 if (IS_ERR(connkeys))
5738 return PTR_ERR(connkeys);
de7044ee 5739
3d9d1d66
JB		 5740 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
5741 no_ht) {
de7044ee
SM		 5742 kfree(connkeys);
5743 return -EINVAL;
5744 }
4c476991 5745 }
04a773ad 5746
267335d6
AQ		 5747 ibss.control_port =
5748 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
5749
4c476991 5750 err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
fffd0934
JB		 5751 if (err)
5752 kfree(connkeys);
04a773ad
JB		 5753 return err;
5754}
5755
5756static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
5757{
4c476991
JB		 5758 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5759 struct net_device *dev = info->user_ptr[1];
04a773ad 5760
4c476991
JB		 5761 if (!rdev->ops->leave_ibss)
5762 return -EOPNOTSUPP;
04a773ad 5763
4c476991
JB		 5764 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
5765 return -EOPNOTSUPP;
04a773ad 5766
4c476991 5767 return cfg80211_leave_ibss(rdev, dev, false);
04a773ad
JB		 5768}
5769
f4e583c8
AQ		 5770static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
5771{
5772 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5773 struct net_device *dev = info->user_ptr[1];
5774 int mcast_rate[IEEE80211_NUM_BANDS];
5775 u32 nla_rate;
5776 int err;
5777
5778 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
5779 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5780 return -EOPNOTSUPP;
5781
5782 if (!rdev->ops->set_mcast_rate)
5783 return -EOPNOTSUPP;
5784
5785 memset(mcast_rate, 0, sizeof(mcast_rate));
5786
5787 if (!info->attrs[NL80211_ATTR_MCAST_RATE])
5788 return -EINVAL;
5789
5790 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
5791 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
5792 return -EINVAL;
5793
5794 err = rdev->ops->set_mcast_rate(&rdev->wiphy, dev, mcast_rate);
5795
5796 return err;
5797}
5798
5799
aff89a9b
JB		 5800#ifdef CONFIG_NL80211_TESTMODE
5801static struct genl_multicast_group nl80211_testmode_mcgrp = {
5802 .name = "testmode",
5803};
5804
5805static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
5806{
4c476991 5807 struct cfg80211_registered_device *rdev = info->user_ptr[0];
aff89a9b
JB		 5808 int err;
5809
5810 if (!info->attrs[NL80211_ATTR_TESTDATA])
5811 return -EINVAL;
5812
aff89a9b
JB		 5813 err = -EOPNOTSUPP;
5814 if (rdev->ops->testmode_cmd) {
5815 rdev->testmode_info = info;
e35e4d28 5816 err = rdev_testmode_cmd(rdev,
aff89a9b
JB		 5817 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
5818 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
5819 rdev->testmode_info = NULL;
5820 }
5821
aff89a9b
JB		 5822 return err;
5823}
5824
71063f0e
WYG		 5825static int nl80211_testmode_dump(struct sk_buff *skb,
5826 struct netlink_callback *cb)
5827{
00918d33 5828 struct cfg80211_registered_device *rdev;
71063f0e
WYG		 5829 int err;
5830 long phy_idx;
5831 void *data = NULL;
5832 int data_len = 0;
5833
5834 if (cb->args[0]) {
5835 /*
5836 * 0 is a valid index, but not valid for args[0],
5837 * so we need to offset by 1.
5838 */
5839 phy_idx = cb->args[0] - 1;
5840 } else {
5841 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
5842 nl80211_fam.attrbuf, nl80211_fam.maxattr,
5843 nl80211_policy);
5844 if (err)
5845 return err;
00918d33 5846
2bd7e35d
JB		 5847 mutex_lock(&cfg80211_mutex);
5848 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk),
5849 nl80211_fam.attrbuf);
5850 if (IS_ERR(rdev)) {
5851 mutex_unlock(&cfg80211_mutex);
5852 return PTR_ERR(rdev);
00918d33 5853 }
2bd7e35d
JB		 5854 phy_idx = rdev->wiphy_idx;
5855 rdev = NULL;
5856 mutex_unlock(&cfg80211_mutex);
5857
71063f0e
WYG		 5858 if (nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA])
5859 cb->args[1] =
5860 (long)nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA];
5861 }
5862
5863 if (cb->args[1]) {
5864 data = nla_data((void *)cb->args[1]);
5865 data_len = nla_len((void *)cb->args[1]);
5866 }
5867
5868 mutex_lock(&cfg80211_mutex);
00918d33
JB		 5869 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
5870 if (!rdev) {
71063f0e
WYG		 5871 mutex_unlock(&cfg80211_mutex);
5872 return -ENOENT;
5873 }
00918d33 5874 cfg80211_lock_rdev(rdev);
71063f0e
WYG		 5875 mutex_unlock(&cfg80211_mutex);
5876
00918d33 5877 if (!rdev->ops->testmode_dump) {
71063f0e
WYG		 5878 err = -EOPNOTSUPP;
5879 goto out_err;
5880 }
5881
5882 while (1) {
15e47304 5883 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
71063f0e
WYG		 5884 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5885 NL80211_CMD_TESTMODE);
5886 struct nlattr *tmdata;
5887
9360ffd1 5888 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
71063f0e
WYG		 5889 genlmsg_cancel(skb, hdr);
5890 break;
5891 }
5892
5893 tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
5894 if (!tmdata) {
5895 genlmsg_cancel(skb, hdr);
5896 break;
5897 }
e35e4d28 5898 err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
71063f0e
WYG		 5899 nla_nest_end(skb, tmdata);
5900
5901 if (err == -ENOBUFS || err == -ENOENT) {
5902 genlmsg_cancel(skb, hdr);
5903 break;
5904 } else if (err) {
5905 genlmsg_cancel(skb, hdr);
5906 goto out_err;
5907 }
5908
5909 genlmsg_end(skb, hdr);
5910 }
5911
5912 err = skb->len;
5913 /* see above */
5914 cb->args[0] = phy_idx + 1;
5915 out_err:
00918d33 5916 cfg80211_unlock_rdev(rdev);
71063f0e
WYG		 5917 return err;
5918}
5919
aff89a9b
JB		 5920static struct sk_buff *
5921__cfg80211_testmode_alloc_skb(struct cfg80211_registered_device *rdev,
15e47304 5922 int approxlen, u32 portid, u32 seq, gfp_t gfp)
aff89a9b
JB		 5923{
5924 struct sk_buff *skb;
5925 void *hdr;
5926 struct nlattr *data;
5927
5928 skb = nlmsg_new(approxlen + 100, gfp);
5929 if (!skb)
5930 return NULL;
5931
15e47304 5932 hdr = nl80211hdr_put(skb, portid, seq, 0, NL80211_CMD_TESTMODE);
aff89a9b
JB		 5933 if (!hdr) {
5934 kfree_skb(skb);
5935 return NULL;
5936 }
5937
9360ffd1
DM		 5938 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
5939 goto nla_put_failure;
aff89a9b
JB		 5940 data = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
5941
5942 ((void **)skb->cb)[0] = rdev;
5943 ((void **)skb->cb)[1] = hdr;
5944 ((void **)skb->cb)[2] = data;
5945
5946 return skb;
5947
5948 nla_put_failure:
5949 kfree_skb(skb);
5950 return NULL;
5951}
5952
5953struct sk_buff *cfg80211_testmode_alloc_reply_skb(struct wiphy *wiphy,
5954 int approxlen)
5955{
5956 struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
5957
5958 if (WARN_ON(!rdev->testmode_info))
5959 return NULL;
5960
5961 return __cfg80211_testmode_alloc_skb(rdev, approxlen,
15e47304 5962 rdev->testmode_info->snd_portid,
aff89a9b
JB		 5963 rdev->testmode_info->snd_seq,
5964 GFP_KERNEL);
5965}
5966EXPORT_SYMBOL(cfg80211_testmode_alloc_reply_skb);
5967
5968int cfg80211_testmode_reply(struct sk_buff *skb)
5969{
5970 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
5971 void *hdr = ((void **)skb->cb)[1];
5972 struct nlattr *data = ((void **)skb->cb)[2];
5973
5974 if (WARN_ON(!rdev->testmode_info)) {
5975 kfree_skb(skb);
5976 return -EINVAL;
5977 }
5978
5979 nla_nest_end(skb, data);
5980 genlmsg_end(skb, hdr);
5981 return genlmsg_reply(skb, rdev->testmode_info);
5982}
5983EXPORT_SYMBOL(cfg80211_testmode_reply);
5984
5985struct sk_buff *cfg80211_testmode_alloc_event_skb(struct wiphy *wiphy,
5986 int approxlen, gfp_t gfp)
5987{
5988 struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
5989
5990 return __cfg80211_testmode_alloc_skb(rdev, approxlen, 0, 0, gfp);
5991}
5992EXPORT_SYMBOL(cfg80211_testmode_alloc_event_skb);
5993
5994void cfg80211_testmode_event(struct sk_buff *skb, gfp_t gfp)
5995{
5996 void *hdr = ((void **)skb->cb)[1];
5997 struct nlattr *data = ((void **)skb->cb)[2];
5998
5999 nla_nest_end(skb, data);
6000 genlmsg_end(skb, hdr);
6001 genlmsg_multicast(skb, 0, nl80211_testmode_mcgrp.id, gfp);
6002}
6003EXPORT_SYMBOL(cfg80211_testmode_event);
6004#endif
6005
b23aa676
SO		 6006static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
6007{
4c476991
JB		 6008 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6009 struct net_device *dev = info->user_ptr[1];
b23aa676
SO		 6010 struct cfg80211_connect_params connect;
6011 struct wiphy *wiphy;
fffd0934 6012 struct cfg80211_cached_keys *connkeys = NULL;
b23aa676
SO		 6013 int err;
6014
6015 memset(&connect, 0, sizeof(connect));
6016
6017 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
6018 return -EINVAL;
6019
6020 if (!info->attrs[NL80211_ATTR_SSID] ||
6021 !nla_len(info->attrs[NL80211_ATTR_SSID]))
6022 return -EINVAL;
6023
6024 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
6025 connect.auth_type =
6026 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
e39e5b5e
JM		 6027 if (!nl80211_valid_auth_type(rdev, connect.auth_type,
6028 NL80211_CMD_CONNECT))
b23aa676
SO		 6029 return -EINVAL;
6030 } else
6031 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
6032
6033 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
6034
c0692b8f 6035 err = nl80211_crypto_settings(rdev, info, &connect.crypto,
3dc27d25 6036 NL80211_MAX_NR_CIPHER_SUITES);
b23aa676
SO		 6037 if (err)
6038 return err;
b23aa676 6039
074ac8df 6040 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 6041 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
6042 return -EOPNOTSUPP;
b23aa676 6043
79c97e97 6044 wiphy = &rdev->wiphy;
b23aa676 6045
4486ea98
BS		 6046 connect.bg_scan_period = -1;
6047 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
6048 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
6049 connect.bg_scan_period =
6050 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
6051 }
6052
b23aa676
SO		 6053 if (info->attrs[NL80211_ATTR_MAC])
6054 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
6055 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
6056 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
6057
6058 if (info->attrs[NL80211_ATTR_IE]) {
6059 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
6060 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
6061 }
6062
cee00a95
JM		 6063 if (info->attrs[NL80211_ATTR_USE_MFP]) {
6064 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
6065 if (connect.mfp != NL80211_MFP_REQUIRED &&
6066 connect.mfp != NL80211_MFP_NO)
6067 return -EINVAL;
6068 } else {
6069 connect.mfp = NL80211_MFP_NO;
6070 }
6071
b23aa676
SO		 6072 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
6073 connect.channel =
6074 ieee80211_get_channel(wiphy,
6075 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
6076 if (!connect.channel ||
4c476991
JB		 6077 connect.channel->flags & IEEE80211_CHAN_DISABLED)
6078 return -EINVAL;
b23aa676
SO		 6079 }
6080
fffd0934
JB		 6081 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
6082 connkeys = nl80211_parse_connkeys(rdev,
de7044ee 6083 info->attrs[NL80211_ATTR_KEYS], NULL);
4c476991
JB		 6084 if (IS_ERR(connkeys))
6085 return PTR_ERR(connkeys);
fffd0934
JB		 6086 }
6087
7e7c8926
BG		 6088 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
6089 connect.flags |= ASSOC_REQ_DISABLE_HT;
6090
6091 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
6092 memcpy(&connect.ht_capa_mask,
6093 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
6094 sizeof(connect.ht_capa_mask));
6095
6096 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
b4e4f47e
WY		 6097 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
6098 kfree(connkeys);
7e7c8926 6099 return -EINVAL;
b4e4f47e 6100 }
7e7c8926
BG		 6101 memcpy(&connect.ht_capa,
6102 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
6103 sizeof(connect.ht_capa));
6104 }
6105
fffd0934 6106 err = cfg80211_connect(rdev, dev, &connect, connkeys);
fffd0934
JB		 6107 if (err)
6108 kfree(connkeys);
b23aa676
SO		 6109 return err;
6110}
6111
6112static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
6113{
4c476991
JB		 6114 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6115 struct net_device *dev = info->user_ptr[1];
b23aa676
SO		 6116 u16 reason;
6117
6118 if (!info->attrs[NL80211_ATTR_REASON_CODE])
6119 reason = WLAN_REASON_DEAUTH_LEAVING;
6120 else
6121 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
6122
6123 if (reason == 0)
6124 return -EINVAL;
6125
074ac8df 6126 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 6127 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
6128 return -EOPNOTSUPP;
b23aa676 6129
4c476991 6130 return cfg80211_disconnect(rdev, dev, reason, true);
b23aa676
SO		 6131}
6132
463d0183
JB		 6133static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
6134{
4c476991 6135 struct cfg80211_registered_device *rdev = info->user_ptr[0];
463d0183
JB		 6136 struct net *net;
6137 int err;
6138 u32 pid;
6139
6140 if (!info->attrs[NL80211_ATTR_PID])
6141 return -EINVAL;
6142
6143 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
6144
463d0183 6145 net = get_net_ns_by_pid(pid);
4c476991
JB		 6146 if (IS_ERR(net))
6147 return PTR_ERR(net);
463d0183
JB		 6148
6149 err = 0;
6150
6151 /* check if anything to do */
4c476991
JB		 6152 if (!net_eq(wiphy_net(&rdev->wiphy), net))
6153 err = cfg80211_switch_netns(rdev, net);
463d0183 6154
463d0183 6155 put_net(net);
463d0183
JB		 6156 return err;
6157}
6158
67fbb16b
SO		 6159static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
6160{
4c476991 6161 struct cfg80211_registered_device *rdev = info->user_ptr[0];
67fbb16b
SO		 6162 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
6163 struct cfg80211_pmksa *pmksa) = NULL;
4c476991 6164 struct net_device *dev = info->user_ptr[1];
67fbb16b
SO		 6165 struct cfg80211_pmksa pmksa;
6166
6167 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
6168
6169 if (!info->attrs[NL80211_ATTR_MAC])
6170 return -EINVAL;
6171
6172 if (!info->attrs[NL80211_ATTR_PMKID])
6173 return -EINVAL;
6174
67fbb16b
SO		 6175 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
6176 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
6177
074ac8df 6178 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 6179 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
6180 return -EOPNOTSUPP;
67fbb16b
SO		 6181
6182 switch (info->genlhdr->cmd) {
6183 case NL80211_CMD_SET_PMKSA:
6184 rdev_ops = rdev->ops->set_pmksa;
6185 break;
6186 case NL80211_CMD_DEL_PMKSA:
6187 rdev_ops = rdev->ops->del_pmksa;
6188 break;
6189 default:
6190 WARN_ON(1);
6191 break;
6192 }
6193
4c476991
JB		 6194 if (!rdev_ops)
6195 return -EOPNOTSUPP;
67fbb16b 6196
4c476991 6197 return rdev_ops(&rdev->wiphy, dev, &pmksa);
67fbb16b
SO		 6198}
6199
6200static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
6201{
4c476991
JB		 6202 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6203 struct net_device *dev = info->user_ptr[1];
67fbb16b 6204
074ac8df 6205 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 6206 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
6207 return -EOPNOTSUPP;
67fbb16b 6208
4c476991
JB		 6209 if (!rdev->ops->flush_pmksa)
6210 return -EOPNOTSUPP;
67fbb16b 6211
e35e4d28 6212 return rdev_flush_pmksa(rdev, dev);
67fbb16b
SO		 6213}
6214
109086ce
AN		 6215static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
6216{
6217 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6218 struct net_device *dev = info->user_ptr[1];
6219 u8 action_code, dialog_token;
6220 u16 status_code;
6221 u8 *peer;
6222
6223 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
6224 !rdev->ops->tdls_mgmt)
6225 return -EOPNOTSUPP;
6226
6227 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
6228 !info->attrs[NL80211_ATTR_STATUS_CODE] ||
6229 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
6230 !info->attrs[NL80211_ATTR_IE] ||
6231 !info->attrs[NL80211_ATTR_MAC])
6232 return -EINVAL;
6233
6234 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
6235 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
6236 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
6237 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
6238
e35e4d28
HG		 6239 return rdev_tdls_mgmt(rdev, dev, peer, action_code,
6240 dialog_token, status_code,
6241 nla_data(info->attrs[NL80211_ATTR_IE]),
6242 nla_len(info->attrs[NL80211_ATTR_IE]));
109086ce
AN		 6243}
6244
6245static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
6246{
6247 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6248 struct net_device *dev = info->user_ptr[1];
6249 enum nl80211_tdls_operation operation;
6250 u8 *peer;
6251
6252 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
6253 !rdev->ops->tdls_oper)
6254 return -EOPNOTSUPP;
6255
6256 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
6257 !info->attrs[NL80211_ATTR_MAC])
6258 return -EINVAL;
6259
6260 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
6261 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
6262
e35e4d28 6263 return rdev_tdls_oper(rdev, dev, peer, operation);
109086ce
AN		 6264}
6265
9588bbd5
JM		 6266static int nl80211_remain_on_channel(struct sk_buff *skb,
6267 struct genl_info *info)
6268{
4c476991 6269 struct cfg80211_registered_device *rdev = info->user_ptr[0];
71bbc994 6270 struct wireless_dev *wdev = info->user_ptr[1];
683b6d3b 6271 struct cfg80211_chan_def chandef;
9588bbd5
JM		 6272 struct sk_buff *msg;
6273 void *hdr;
6274 u64 cookie;
683b6d3b 6275 u32 duration;
9588bbd5
JM		 6276 int err;
6277
6278 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
6279 !info->attrs[NL80211_ATTR_DURATION])
6280 return -EINVAL;
6281
6282 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
6283
ebf348fc
JB		 6284 if (!rdev->ops->remain_on_channel ||
6285 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
6286 return -EOPNOTSUPP;
6287
9588bbd5 6288 /*
ebf348fc
JB		 6289 * We should be on that channel for at least a minimum amount of
6290 * time (10ms) but no longer than the driver supports.
9588bbd5 6291 */
ebf348fc 6292 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
a293911d 6293 duration > rdev->wiphy.max_remain_on_channel_duration)
9588bbd5
JM		 6294 return -EINVAL;
6295
683b6d3b
JB		 6296 err = nl80211_parse_chandef(rdev, info, &chandef);
6297 if (err)
6298 return err;
9588bbd5
JM		 6299
6300 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4c476991
JB		 6301 if (!msg)
6302 return -ENOMEM;
9588bbd5 6303
15e47304 6304 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9588bbd5
JM		 6305 NL80211_CMD_REMAIN_ON_CHANNEL);
6306
6307 if (IS_ERR(hdr)) {
6308 err = PTR_ERR(hdr);
6309 goto free_msg;
6310 }
6311
683b6d3b
JB		 6312 err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
6313 duration, &cookie);
9588bbd5
JM		 6314
6315 if (err)
6316 goto free_msg;
6317
9360ffd1
DM		 6318 if (nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
6319 goto nla_put_failure;
9588bbd5
JM		 6320
6321 genlmsg_end(msg, hdr);
4c476991
JB		 6322
6323 return genlmsg_reply(msg, info);
9588bbd5
JM		 6324
6325 nla_put_failure:
6326 err = -ENOBUFS;
6327 free_msg:
6328 nlmsg_free(msg);
9588bbd5
JM		 6329 return err;
6330}
6331
6332static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
6333 struct genl_info *info)
6334{
4c476991 6335 struct cfg80211_registered_device *rdev = info->user_ptr[0];
71bbc994 6336 struct wireless_dev *wdev = info->user_ptr[1];
9588bbd5 6337 u64 cookie;
9588bbd5
JM		 6338
6339 if (!info->attrs[NL80211_ATTR_COOKIE])
6340 return -EINVAL;
6341
4c476991
JB		 6342 if (!rdev->ops->cancel_remain_on_channel)
6343 return -EOPNOTSUPP;
9588bbd5 6344
9588bbd5
JM		 6345 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
6346
e35e4d28 6347 return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
9588bbd5
JM		 6348}
6349
13ae75b1
JM		 6350static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
6351 u8 *rates, u8 rates_len)
6352{
6353 u8 i;
6354 u32 mask = 0;
6355
6356 for (i = 0; i < rates_len; i++) {
6357 int rate = (rates[i] & 0x7f) * 5;
6358 int ridx;
6359 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
6360 struct ieee80211_rate *srate =
6361 &sband->bitrates[ridx];
6362 if (rate == srate->bitrate) {
6363 mask |= 1 << ridx;
6364 break;
6365 }
6366 }
6367 if (ridx == sband->n_bitrates)
6368 return 0; /* rate not found */
6369 }
6370
6371 return mask;
6372}
6373
24db78c0
SW		 6374static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
6375 u8 *rates, u8 rates_len,
6376 u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
6377{
6378 u8 i;
6379
6380 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
6381
6382 for (i = 0; i < rates_len; i++) {
6383 int ridx, rbit;
6384
6385 ridx = rates[i] / 8;
6386 rbit = BIT(rates[i] % 8);
6387
6388 /* check validity */
910570b5 6389 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
24db78c0
SW		 6390 return false;
6391
6392 /* check availability */
6393 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
6394 mcs[ridx] |= rbit;
6395 else
6396 return false;
6397 }
6398
6399 return true;
6400}
6401
b54452b0 6402static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
13ae75b1
JM		 6403 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
6404 .len = NL80211_MAX_SUPP_RATES },
24db78c0
SW		 6405 [NL80211_TXRATE_MCS] = { .type = NLA_BINARY,
6406 .len = NL80211_MAX_SUPP_HT_RATES },
13ae75b1
JM		 6407};
6408
6409static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
6410 struct genl_info *info)
6411{
6412 struct nlattr *tb[NL80211_TXRATE_MAX + 1];
4c476991 6413 struct cfg80211_registered_device *rdev = info->user_ptr[0];
13ae75b1 6414 struct cfg80211_bitrate_mask mask;
4c476991
JB		 6415 int rem, i;
6416 struct net_device *dev = info->user_ptr[1];
13ae75b1
JM		 6417 struct nlattr *tx_rates;
6418 struct ieee80211_supported_band *sband;
6419
6420 if (info->attrs[NL80211_ATTR_TX_RATES] == NULL)
6421 return -EINVAL;
6422
4c476991
JB		 6423 if (!rdev->ops->set_bitrate_mask)
6424 return -EOPNOTSUPP;
13ae75b1
JM		 6425
6426 memset(&mask, 0, sizeof(mask));
6427 /* Default to all rates enabled */
6428 for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
6429 sband = rdev->wiphy.bands[i];
6430 mask.control[i].legacy =
6431 sband ? (1 << sband->n_bitrates) - 1 : 0;
24db78c0
SW		 6432 if (sband)
6433 memcpy(mask.control[i].mcs,
6434 sband->ht_cap.mcs.rx_mask,
6435 sizeof(mask.control[i].mcs));
6436 else
6437 memset(mask.control[i].mcs, 0,
6438 sizeof(mask.control[i].mcs));
13ae75b1
JM		 6439 }
6440
6441 /*
6442 * The nested attribute uses enum nl80211_band as the index. This maps
6443 * directly to the enum ieee80211_band values used in cfg80211.
6444 */
24db78c0 6445 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
13ae75b1
JM		 6446 nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem)
6447 {
6448 enum ieee80211_band band = nla_type(tx_rates);
4c476991
JB		 6449 if (band < 0 || band >= IEEE80211_NUM_BANDS)
6450 return -EINVAL;
13ae75b1 6451 sband = rdev->wiphy.bands[band];
4c476991
JB		 6452 if (sband == NULL)
6453 return -EINVAL;
13ae75b1
JM		 6454 nla_parse(tb, NL80211_TXRATE_MAX, nla_data(tx_rates),
6455 nla_len(tx_rates), nl80211_txattr_policy);
6456 if (tb[NL80211_TXRATE_LEGACY]) {
6457 mask.control[band].legacy = rateset_to_mask(
6458 sband,
6459 nla_data(tb[NL80211_TXRATE_LEGACY]),
6460 nla_len(tb[NL80211_TXRATE_LEGACY]));
218d2e26
BS		 6461 if ((mask.control[band].legacy == 0) &&
6462 nla_len(tb[NL80211_TXRATE_LEGACY]))
6463 return -EINVAL;
24db78c0
SW		 6464 }
6465 if (tb[NL80211_TXRATE_MCS]) {
6466 if (!ht_rateset_to_mask(
6467 sband,
6468 nla_data(tb[NL80211_TXRATE_MCS]),
6469 nla_len(tb[NL80211_TXRATE_MCS]),
6470 mask.control[band].mcs))
6471 return -EINVAL;
6472 }
6473
6474 if (mask.control[band].legacy == 0) {
6475 /* don't allow empty legacy rates if HT
6476 * is not even supported. */
6477 if (!rdev->wiphy.bands[band]->ht_cap.ht_supported)
6478 return -EINVAL;
6479
6480 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
6481 if (mask.control[band].mcs[i])
6482 break;
6483
6484 /* legacy and mcs rates may not be both empty */
6485 if (i == IEEE80211_HT_MCS_MASK_LEN)
4c476991 6486 return -EINVAL;
13ae75b1
JM		 6487 }
6488 }
6489
e35e4d28 6490 return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
13ae75b1
JM		 6491}
6492
2e161f78 6493static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
026331c4 6494{
4c476991 6495 struct cfg80211_registered_device *rdev = info->user_ptr[0];
71bbc994 6496 struct wireless_dev *wdev = info->user_ptr[1];
2e161f78 6497 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
026331c4
JM		 6498
6499 if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
6500 return -EINVAL;
6501
2e161f78
JB		 6502 if (info->attrs[NL80211_ATTR_FRAME_TYPE])
6503 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
026331c4 6504
71bbc994
JB		 6505 switch (wdev->iftype) {
6506 case NL80211_IFTYPE_STATION:
6507 case NL80211_IFTYPE_ADHOC:
6508 case NL80211_IFTYPE_P2P_CLIENT:
6509 case NL80211_IFTYPE_AP:
6510 case NL80211_IFTYPE_AP_VLAN:
6511 case NL80211_IFTYPE_MESH_POINT:
6512 case NL80211_IFTYPE_P2P_GO:
98104fde 6513 case NL80211_IFTYPE_P2P_DEVICE:
71bbc994
JB		 6514 break;
6515 default:
4c476991 6516 return -EOPNOTSUPP;
71bbc994 6517 }
026331c4
JM		 6518
6519 /* not much point in registering if we can't reply */
4c476991
JB		 6520 if (!rdev->ops->mgmt_tx)
6521 return -EOPNOTSUPP;
026331c4 6522
15e47304 6523 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
026331c4
JM		 6524 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
6525 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
026331c4
JM		 6526}
6527
2e161f78 6528static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
026331c4 6529{
4c476991 6530 struct cfg80211_registered_device *rdev = info->user_ptr[0];
71bbc994 6531 struct wireless_dev *wdev = info->user_ptr[1];
683b6d3b 6532 struct cfg80211_chan_def chandef;
026331c4 6533 int err;
d64d373f 6534 void *hdr = NULL;
026331c4 6535 u64 cookie;
e247bd90 6536 struct sk_buff *msg = NULL;
f7ca38df 6537 unsigned int wait = 0;
e247bd90
JB		 6538 bool offchan, no_cck, dont_wait_for_ack;
6539
6540 dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK];
026331c4 6541
683b6d3b 6542 if (!info->attrs[NL80211_ATTR_FRAME])
026331c4
JM		 6543 return -EINVAL;
6544
4c476991
JB		 6545 if (!rdev->ops->mgmt_tx)
6546 return -EOPNOTSUPP;
026331c4 6547
71bbc994
JB		 6548 switch (wdev->iftype) {
6549 case NL80211_IFTYPE_STATION:
6550 case NL80211_IFTYPE_ADHOC:
6551 case NL80211_IFTYPE_P2P_CLIENT:
6552 case NL80211_IFTYPE_AP:
6553 case NL80211_IFTYPE_AP_VLAN:
6554 case NL80211_IFTYPE_MESH_POINT:
6555 case NL80211_IFTYPE_P2P_GO:
98104fde 6556 case NL80211_IFTYPE_P2P_DEVICE:
71bbc994
JB		 6557 break;
6558 default:
4c476991 6559 return -EOPNOTSUPP;
71bbc994 6560 }
026331c4 6561
f7ca38df 6562 if (info->attrs[NL80211_ATTR_DURATION]) {
7c4ef712 6563 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
f7ca38df
JB		 6564 return -EINVAL;
6565 wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
ebf348fc
JB		 6566
6567 /*
6568 * We should wait on the channel for at least a minimum amount
6569 * of time (10ms) but no longer than the driver supports.
6570 */
6571 if (wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
6572 wait > rdev->wiphy.max_remain_on_channel_duration)
6573 return -EINVAL;
6574
f7ca38df
JB		 6575 }
6576
f7ca38df
JB		 6577 offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
6578
7c4ef712
JB		 6579 if (offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
6580 return -EINVAL;
6581
e9f935e3
RM		 6582 no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
6583
683b6d3b
JB		 6584 err = nl80211_parse_chandef(rdev, info, &chandef);
6585 if (err)
6586 return err;
026331c4 6587
e247bd90
JB		 6588 if (!dont_wait_for_ack) {
6589 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6590 if (!msg)
6591 return -ENOMEM;
026331c4 6592
15e47304 6593 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
e247bd90 6594 NL80211_CMD_FRAME);
026331c4 6595
e247bd90
JB		 6596 if (IS_ERR(hdr)) {
6597 err = PTR_ERR(hdr);
6598 goto free_msg;
6599 }
026331c4 6600 }
e247bd90 6601
683b6d3b 6602 err = cfg80211_mlme_mgmt_tx(rdev, wdev, chandef.chan, offchan, wait,
2e161f78
JB		 6603 nla_data(info->attrs[NL80211_ATTR_FRAME]),
6604 nla_len(info->attrs[NL80211_ATTR_FRAME]),
e247bd90 6605 no_cck, dont_wait_for_ack, &cookie);
026331c4
JM		 6606 if (err)
6607 goto free_msg;
6608
e247bd90 6609 if (msg) {
9360ffd1
DM		 6610 if (nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
6611 goto nla_put_failure;
026331c4 6612
e247bd90
JB		 6613 genlmsg_end(msg, hdr);
6614 return genlmsg_reply(msg, info);
6615 }
6616
6617 return 0;
026331c4
JM		 6618
6619 nla_put_failure:
6620 err = -ENOBUFS;
6621 free_msg:
6622 nlmsg_free(msg);
026331c4
JM		 6623 return err;
6624}
6625
f7ca38df
JB		 6626static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
6627{
6628 struct cfg80211_registered_device *rdev = info->user_ptr[0];
71bbc994 6629 struct wireless_dev *wdev = info->user_ptr[1];
f7ca38df
JB		 6630 u64 cookie;
6631
6632 if (!info->attrs[NL80211_ATTR_COOKIE])
6633 return -EINVAL;
6634
6635 if (!rdev->ops->mgmt_tx_cancel_wait)
6636 return -EOPNOTSUPP;
6637
71bbc994
JB		 6638 switch (wdev->iftype) {
6639 case NL80211_IFTYPE_STATION:
6640 case NL80211_IFTYPE_ADHOC:
6641 case NL80211_IFTYPE_P2P_CLIENT:
6642 case NL80211_IFTYPE_AP:
6643 case NL80211_IFTYPE_AP_VLAN:
6644 case NL80211_IFTYPE_P2P_GO:
98104fde 6645 case NL80211_IFTYPE_P2P_DEVICE:
71bbc994
JB		 6646 break;
6647 default:
f7ca38df 6648 return -EOPNOTSUPP;
71bbc994 6649 }
f7ca38df
JB		 6650
6651 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
6652
e35e4d28 6653 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
f7ca38df
JB		 6654}
6655
ffb9eb3d
KV		 6656static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
6657{
4c476991 6658 struct cfg80211_registered_device *rdev = info->user_ptr[0];
ffb9eb3d 6659 struct wireless_dev *wdev;
4c476991 6660 struct net_device *dev = info->user_ptr[1];
ffb9eb3d
KV		 6661 u8 ps_state;
6662 bool state;
6663 int err;
6664
4c476991
JB		 6665 if (!info->attrs[NL80211_ATTR_PS_STATE])
6666 return -EINVAL;
ffb9eb3d
KV		 6667
6668 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
6669
4c476991
JB		 6670 if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
6671 return -EINVAL;
ffb9eb3d
KV		 6672
6673 wdev = dev->ieee80211_ptr;
6674
4c476991
JB		 6675 if (!rdev->ops->set_power_mgmt)
6676 return -EOPNOTSUPP;
ffb9eb3d
KV		 6677
6678 state = (ps_state == NL80211_PS_ENABLED) ? true : false;
6679
6680 if (state == wdev->ps)
4c476991 6681 return 0;
ffb9eb3d 6682
e35e4d28 6683 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
4c476991
JB		 6684 if (!err)
6685 wdev->ps = state;
ffb9eb3d
KV		 6686 return err;
6687}
6688
6689static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
6690{
4c476991 6691 struct cfg80211_registered_device *rdev = info->user_ptr[0];
ffb9eb3d
KV		 6692 enum nl80211_ps_state ps_state;
6693 struct wireless_dev *wdev;
4c476991 6694 struct net_device *dev = info->user_ptr[1];
ffb9eb3d
KV		 6695 struct sk_buff *msg;
6696 void *hdr;
6697 int err;
6698
ffb9eb3d
KV		 6699 wdev = dev->ieee80211_ptr;
6700
4c476991
JB		 6701 if (!rdev->ops->set_power_mgmt)
6702 return -EOPNOTSUPP;
ffb9eb3d
KV		 6703
6704 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4c476991
JB		 6705 if (!msg)
6706 return -ENOMEM;
ffb9eb3d 6707
15e47304 6708 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
ffb9eb3d
KV		 6709 NL80211_CMD_GET_POWER_SAVE);
6710 if (!hdr) {
4c476991 6711 err = -ENOBUFS;
ffb9eb3d
KV		 6712 goto free_msg;
6713 }
6714
6715 if (wdev->ps)
6716 ps_state = NL80211_PS_ENABLED;
6717 else
6718 ps_state = NL80211_PS_DISABLED;
6719
9360ffd1
DM		 6720 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
6721 goto nla_put_failure;
ffb9eb3d
KV		 6722
6723 genlmsg_end(msg, hdr);
4c476991 6724 return genlmsg_reply(msg, info);
ffb9eb3d 6725
4c476991 6726 nla_put_failure:
ffb9eb3d 6727 err = -ENOBUFS;
4c476991 6728 free_msg:
ffb9eb3d 6729 nlmsg_free(msg);
ffb9eb3d
KV		 6730 return err;
6731}
6732
d6dc1a38
JO		 6733static struct nla_policy
6734nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] __read_mostly = {
6735 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
6736 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
6737 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
84f10708
TP		 6738 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
6739 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
6740 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
d6dc1a38
JO		 6741};
6742
84f10708 6743static int nl80211_set_cqm_txe(struct genl_info *info,
d9d8b019 6744 u32 rate, u32 pkts, u32 intvl)
84f10708
TP		 6745{
6746 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6747 struct wireless_dev *wdev;
6748 struct net_device *dev = info->user_ptr[1];
6749
d9d8b019 6750 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
84f10708
TP		 6751 return -EINVAL;
6752
6753 wdev = dev->ieee80211_ptr;
6754
6755 if (!rdev->ops->set_cqm_txe_config)
6756 return -EOPNOTSUPP;
6757
6758 if (wdev->iftype != NL80211_IFTYPE_STATION &&
6759 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
6760 return -EOPNOTSUPP;
6761
e35e4d28 6762 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
84f10708
TP		 6763}
6764
d6dc1a38
JO		 6765static int nl80211_set_cqm_rssi(struct genl_info *info,
6766 s32 threshold, u32 hysteresis)
6767{
4c476991 6768 struct cfg80211_registered_device *rdev = info->user_ptr[0];
d6dc1a38 6769 struct wireless_dev *wdev;
4c476991 6770 struct net_device *dev = info->user_ptr[1];
d6dc1a38
JO		 6771
6772 if (threshold > 0)
6773 return -EINVAL;
6774
d6dc1a38
JO		 6775 wdev = dev->ieee80211_ptr;
6776
4c476991
JB		 6777 if (!rdev->ops->set_cqm_rssi_config)
6778 return -EOPNOTSUPP;
d6dc1a38 6779
074ac8df 6780 if (wdev->iftype != NL80211_IFTYPE_STATION &&
4c476991
JB		 6781 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
6782 return -EOPNOTSUPP;
d6dc1a38 6783
e35e4d28 6784 return rdev_set_cqm_rssi_config(rdev, dev, threshold, hysteresis);
d6dc1a38
JO		 6785}
6786
6787static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
6788{
6789 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
6790 struct nlattr *cqm;
6791 int err;
6792
6793 cqm = info->attrs[NL80211_ATTR_CQM];
6794 if (!cqm) {
6795 err = -EINVAL;
6796 goto out;
6797 }
6798
6799 err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
6800 nl80211_attr_cqm_policy);
6801 if (err)
6802 goto out;
6803
6804 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
6805 attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
6806 s32 threshold;
6807 u32 hysteresis;
6808 threshold = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
6809 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
6810 err = nl80211_set_cqm_rssi(info, threshold, hysteresis);
84f10708
TP		 6811 } else if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
6812 attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
6813 attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
6814 u32 rate, pkts, intvl;
6815 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
6816 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
6817 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
6818 err = nl80211_set_cqm_txe(info, rate, pkts, intvl);
d6dc1a38
JO		 6819 } else
6820 err = -EINVAL;
6821
6822out:
6823 return err;
6824}
6825
29cbe68c
JB		 6826static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
6827{
6828 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6829 struct net_device *dev = info->user_ptr[1];
6830 struct mesh_config cfg;
c80d545d 6831 struct mesh_setup setup;
29cbe68c
JB		 6832 int err;
6833
6834 /* start with default */
6835 memcpy(&cfg, &default_mesh_config, sizeof(cfg));
c80d545d 6836 memcpy(&setup, &default_mesh_setup, sizeof(setup));
29cbe68c 6837
24bdd9f4 6838 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
29cbe68c 6839 /* and parse parameters if given */
24bdd9f4 6840 err = nl80211_parse_mesh_config(info, &cfg, NULL);
29cbe68c
JB		 6841 if (err)
6842 return err;
6843 }
6844
6845 if (!info->attrs[NL80211_ATTR_MESH_ID] ||
6846 !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
6847 return -EINVAL;
6848
c80d545d
JC		 6849 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
6850 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
6851
4bb62344
CYY		 6852 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
6853 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
6854 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
6855 return -EINVAL;
6856
9bdbf04d
MP		 6857 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
6858 setup.beacon_interval =
6859 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
6860 if (setup.beacon_interval < 10 ||
6861 setup.beacon_interval > 10000)
6862 return -EINVAL;
6863 }
6864
6865 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
6866 setup.dtim_period =
6867 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
6868 if (setup.dtim_period < 1 || setup.dtim_period > 100)
6869 return -EINVAL;
6870 }
6871
c80d545d
JC		 6872 if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
6873 /* parse additional setup parameters if given */
6874 err = nl80211_parse_mesh_setup(info, &setup);
6875 if (err)
6876 return err;
6877 }
6878
cc1d2806 6879 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
683b6d3b
JB		 6880 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
6881 if (err)
6882 return err;
cc1d2806
JB		 6883 } else {
6884 /* cfg80211_join_mesh() will sort it out */
683b6d3b 6885 setup.chandef.chan = NULL;
cc1d2806
JB		 6886 }
6887
c80d545d 6888 return cfg80211_join_mesh(rdev, dev, &setup, &cfg);
29cbe68c
JB		 6889}
6890
6891static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
6892{
6893 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6894 struct net_device *dev = info->user_ptr[1];
6895
6896 return cfg80211_leave_mesh(rdev, dev);
6897}
6898
dfb89c56 6899#ifdef CONFIG_PM
bb92d199
AK		 6900static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
6901 struct cfg80211_registered_device *rdev)
6902{
6903 struct nlattr *nl_pats, *nl_pat;
6904 int i, pat_len;
6905
6906 if (!rdev->wowlan->n_patterns)
6907 return 0;
6908
6909 nl_pats = nla_nest_start(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
6910 if (!nl_pats)
6911 return -ENOBUFS;
6912
6913 for (i = 0; i < rdev->wowlan->n_patterns; i++) {
6914 nl_pat = nla_nest_start(msg, i + 1);
6915 if (!nl_pat)
6916 return -ENOBUFS;
6917 pat_len = rdev->wowlan->patterns[i].pattern_len;
6918 if (nla_put(msg, NL80211_WOWLAN_PKTPAT_MASK,
6919 DIV_ROUND_UP(pat_len, 8),
6920 rdev->wowlan->patterns[i].mask) ||
6921 nla_put(msg, NL80211_WOWLAN_PKTPAT_PATTERN,
6922 pat_len, rdev->wowlan->patterns[i].pattern) ||
6923 nla_put_u32(msg, NL80211_WOWLAN_PKTPAT_OFFSET,
6924 rdev->wowlan->patterns[i].pkt_offset))
6925 return -ENOBUFS;
6926 nla_nest_end(msg, nl_pat);
6927 }
6928 nla_nest_end(msg, nl_pats);
6929
6930 return 0;
6931}
6932
ff1b6e69
JB		 6933static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
6934{
6935 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6936 struct sk_buff *msg;
6937 void *hdr;
6938
6939 if (!rdev->wiphy.wowlan.flags && !rdev->wiphy.wowlan.n_patterns)
6940 return -EOPNOTSUPP;
6941
6942 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6943 if (!msg)
6944 return -ENOMEM;
6945
15e47304 6946 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
ff1b6e69
JB		 6947 NL80211_CMD_GET_WOWLAN);
6948 if (!hdr)
6949 goto nla_put_failure;
6950
6951 if (rdev->wowlan) {
6952 struct nlattr *nl_wowlan;
6953
6954 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
6955 if (!nl_wowlan)
6956 goto nla_put_failure;
6957
9360ffd1
DM		 6958 if ((rdev->wowlan->any &&
6959 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
6960 (rdev->wowlan->disconnect &&
6961 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
6962 (rdev->wowlan->magic_pkt &&
6963 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
6964 (rdev->wowlan->gtk_rekey_failure &&
6965 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
6966 (rdev->wowlan->eap_identity_req &&
6967 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
6968 (rdev->wowlan->four_way_handshake &&
6969 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
6970 (rdev->wowlan->rfkill_release &&
6971 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
6972 goto nla_put_failure;
bb92d199
AK		 6973 if (nl80211_send_wowlan_patterns(msg, rdev))
6974 goto nla_put_failure;
ff1b6e69
JB		 6975 nla_nest_end(msg, nl_wowlan);
6976 }
6977
6978 genlmsg_end(msg, hdr);
6979 return genlmsg_reply(msg, info);
6980
6981nla_put_failure:
6982 nlmsg_free(msg);
6983 return -ENOBUFS;
6984}
6985
6986static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
6987{
6988 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6989 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
ff1b6e69 6990 struct cfg80211_wowlan new_triggers = {};
ae33bd81 6991 struct cfg80211_wowlan *ntrig;
ff1b6e69
JB		 6992 struct wiphy_wowlan_support *wowlan = &rdev->wiphy.wowlan;
6993 int err, i;
6d52563f 6994 bool prev_enabled = rdev->wowlan;
ff1b6e69
JB		 6995
6996 if (!rdev->wiphy.wowlan.flags && !rdev->wiphy.wowlan.n_patterns)
6997 return -EOPNOTSUPP;
6998
ae33bd81
JB		 6999 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
7000 cfg80211_rdev_free_wowlan(rdev);
7001 rdev->wowlan = NULL;
7002 goto set_wakeup;
7003 }
ff1b6e69
JB		 7004
7005 err = nla_parse(tb, MAX_NL80211_WOWLAN_TRIG,
7006 nla_data(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
7007 nla_len(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
7008 nl80211_wowlan_policy);
7009 if (err)
7010 return err;
7011
7012 if (tb[NL80211_WOWLAN_TRIG_ANY]) {
7013 if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
7014 return -EINVAL;
7015 new_triggers.any = true;
7016 }
7017
7018 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
7019 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
7020 return -EINVAL;
7021 new_triggers.disconnect = true;
7022 }
7023
7024 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
7025 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
7026 return -EINVAL;
7027 new_triggers.magic_pkt = true;
7028 }
7029
77dbbb13
JB		 7030 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
7031 return -EINVAL;
7032
7033 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
7034 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
7035 return -EINVAL;
7036 new_triggers.gtk_rekey_failure = true;
7037 }
7038
7039 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
7040 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
7041 return -EINVAL;
7042 new_triggers.eap_identity_req = true;
7043 }
7044
7045 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
7046 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
7047 return -EINVAL;
7048 new_triggers.four_way_handshake = true;
7049 }
7050
7051 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
7052 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
7053 return -EINVAL;
7054 new_triggers.rfkill_release = true;
7055 }
7056
ff1b6e69
JB		 7057 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
7058 struct nlattr *pat;
7059 int n_patterns = 0;
bb92d199 7060 int rem, pat_len, mask_len, pkt_offset;
ff1b6e69
JB		 7061 struct nlattr *pat_tb[NUM_NL80211_WOWLAN_PKTPAT];
7062
7063 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
7064 rem)
7065 n_patterns++;
7066 if (n_patterns > wowlan->n_patterns)
7067 return -EINVAL;
7068
7069 new_triggers.patterns = kcalloc(n_patterns,
7070 sizeof(new_triggers.patterns[0]),
7071 GFP_KERNEL);
7072 if (!new_triggers.patterns)
7073 return -ENOMEM;
7074
7075 new_triggers.n_patterns = n_patterns;
7076 i = 0;
7077
7078 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
7079 rem) {
7080 nla_parse(pat_tb, MAX_NL80211_WOWLAN_PKTPAT,
7081 nla_data(pat), nla_len(pat), NULL);
7082 err = -EINVAL;
7083 if (!pat_tb[NL80211_WOWLAN_PKTPAT_MASK] ||
7084 !pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN])
7085 goto error;
7086 pat_len = nla_len(pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN]);
7087 mask_len = DIV_ROUND_UP(pat_len, 8);
7088 if (nla_len(pat_tb[NL80211_WOWLAN_PKTPAT_MASK]) !=
7089 mask_len)
7090 goto error;
7091 if (pat_len > wowlan->pattern_max_len ||
7092 pat_len < wowlan->pattern_min_len)
7093 goto error;
7094
bb92d199
AK		 7095 if (!pat_tb[NL80211_WOWLAN_PKTPAT_OFFSET])
7096 pkt_offset = 0;
7097 else
7098 pkt_offset = nla_get_u32(
7099 pat_tb[NL80211_WOWLAN_PKTPAT_OFFSET]);
7100 if (pkt_offset > wowlan->max_pkt_offset)
7101 goto error;
7102 new_triggers.patterns[i].pkt_offset = pkt_offset;
7103
ff1b6e69
JB		 7104 new_triggers.patterns[i].mask =
7105 kmalloc(mask_len + pat_len, GFP_KERNEL);
7106 if (!new_triggers.patterns[i].mask) {
7107 err = -ENOMEM;
7108 goto error;
7109 }
7110 new_triggers.patterns[i].pattern =
7111 new_triggers.patterns[i].mask + mask_len;
7112 memcpy(new_triggers.patterns[i].mask,
7113 nla_data(pat_tb[NL80211_WOWLAN_PKTPAT_MASK]),
7114 mask_len);
7115 new_triggers.patterns[i].pattern_len = pat_len;
7116 memcpy(new_triggers.patterns[i].pattern,
7117 nla_data(pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN]),
7118 pat_len);
7119 i++;
7120 }
7121 }
7122
ae33bd81
JB		 7123 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
7124 if (!ntrig) {
7125 err = -ENOMEM;
7126 goto error;
ff1b6e69 7127 }
ae33bd81
JB		 7128 cfg80211_rdev_free_wowlan(rdev);
7129 rdev->wowlan = ntrig;
ff1b6e69 7130
ae33bd81 7131 set_wakeup:
6d52563f 7132 if (rdev->ops->set_wakeup && prev_enabled != !!rdev->wowlan)
e35e4d28 7133 rdev_set_wakeup(rdev, rdev->wowlan);
6d52563f 7134
ff1b6e69
JB		 7135 return 0;
7136 error:
7137 for (i = 0; i < new_triggers.n_patterns; i++)
7138 kfree(new_triggers.patterns[i].mask);
7139 kfree(new_triggers.patterns);
7140 return err;
7141}
dfb89c56 7142#endif
ff1b6e69 7143
e5497d76
JB		 7144static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
7145{
7146 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7147 struct net_device *dev = info->user_ptr[1];
7148 struct wireless_dev *wdev = dev->ieee80211_ptr;
7149 struct nlattr *tb[NUM_NL80211_REKEY_DATA];
7150 struct cfg80211_gtk_rekey_data rekey_data;
7151 int err;
7152
7153 if (!info->attrs[NL80211_ATTR_REKEY_DATA])
7154 return -EINVAL;
7155
7156 err = nla_parse(tb, MAX_NL80211_REKEY_DATA,
7157 nla_data(info->attrs[NL80211_ATTR_REKEY_DATA]),
7158 nla_len(info->attrs[NL80211_ATTR_REKEY_DATA]),
7159 nl80211_rekey_policy);
7160 if (err)
7161 return err;
7162
7163 if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
7164 return -ERANGE;
7165 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
7166 return -ERANGE;
7167 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
7168 return -ERANGE;
7169
7170 memcpy(rekey_data.kek, nla_data(tb[NL80211_REKEY_DATA_KEK]),
7171 NL80211_KEK_LEN);
7172 memcpy(rekey_data.kck, nla_data(tb[NL80211_REKEY_DATA_KCK]),
7173 NL80211_KCK_LEN);
7174 memcpy(rekey_data.replay_ctr,
7175 nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]),
7176 NL80211_REPLAY_CTR_LEN);
7177
7178 wdev_lock(wdev);
7179 if (!wdev->current_bss) {
7180 err = -ENOTCONN;
7181 goto out;
7182 }
7183
7184 if (!rdev->ops->set_rekey_data) {
7185 err = -EOPNOTSUPP;
7186 goto out;
7187 }
7188
e35e4d28 7189 err = rdev_set_rekey_data(rdev, dev, &rekey_data);
e5497d76
JB		 7190 out:
7191 wdev_unlock(wdev);
7192 return err;
7193}
7194
28946da7
JB		 7195static int nl80211_register_unexpected_frame(struct sk_buff *skb,
7196 struct genl_info *info)
7197{
7198 struct net_device *dev = info->user_ptr[1];
7199 struct wireless_dev *wdev = dev->ieee80211_ptr;
7200
7201 if (wdev->iftype != NL80211_IFTYPE_AP &&
7202 wdev->iftype != NL80211_IFTYPE_P2P_GO)
7203 return -EINVAL;
7204
15e47304 7205 if (wdev->ap_unexpected_nlportid)
28946da7
JB		 7206 return -EBUSY;
7207
15e47304 7208 wdev->ap_unexpected_nlportid = info->snd_portid;
28946da7
JB		 7209 return 0;
7210}
7211
7f6cf311
JB		 7212static int nl80211_probe_client(struct sk_buff *skb,
7213 struct genl_info *info)
7214{
7215 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7216 struct net_device *dev = info->user_ptr[1];
7217 struct wireless_dev *wdev = dev->ieee80211_ptr;
7218 struct sk_buff *msg;
7219 void *hdr;
7220 const u8 *addr;
7221 u64 cookie;
7222 int err;
7223
7224 if (wdev->iftype != NL80211_IFTYPE_AP &&
7225 wdev->iftype != NL80211_IFTYPE_P2P_GO)
7226 return -EOPNOTSUPP;
7227
7228 if (!info->attrs[NL80211_ATTR_MAC])
7229 return -EINVAL;
7230
7231 if (!rdev->ops->probe_client)
7232 return -EOPNOTSUPP;
7233
7234 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
7235 if (!msg)
7236 return -ENOMEM;
7237
15e47304 7238 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
7f6cf311
JB		 7239 NL80211_CMD_PROBE_CLIENT);
7240
7241 if (IS_ERR(hdr)) {
7242 err = PTR_ERR(hdr);
7243 goto free_msg;
7244 }
7245
7246 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
7247
e35e4d28 7248 err = rdev_probe_client(rdev, dev, addr, &cookie);
7f6cf311
JB		 7249 if (err)
7250 goto free_msg;
7251
9360ffd1
DM		 7252 if (nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
7253 goto nla_put_failure;
7f6cf311
JB		 7254
7255 genlmsg_end(msg, hdr);
7256
7257 return genlmsg_reply(msg, info);
7258
7259 nla_put_failure:
7260 err = -ENOBUFS;
7261 free_msg:
7262 nlmsg_free(msg);
7263 return err;
7264}
7265
5e760230
JB		 7266static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
7267{
7268 struct cfg80211_registered_device *rdev = info->user_ptr[0];
37c73b5f
BG		 7269 struct cfg80211_beacon_registration *reg, *nreg;
7270 int rv;
5e760230
JB		 7271
7272 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
7273 return -EOPNOTSUPP;
7274
37c73b5f
BG		 7275 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
7276 if (!nreg)
7277 return -ENOMEM;
7278
7279 /* First, check if already registered. */
7280 spin_lock_bh(&rdev->beacon_registrations_lock);
7281 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
7282 if (reg->nlportid == info->snd_portid) {
7283 rv = -EALREADY;
7284 goto out_err;
7285 }
7286 }
7287 /* Add it to the list */
7288 nreg->nlportid = info->snd_portid;
7289 list_add(&nreg->list, &rdev->beacon_registrations);
5e760230 7290
37c73b5f 7291 spin_unlock_bh(&rdev->beacon_registrations_lock);
5e760230
JB		 7292
7293 return 0;
37c73b5f
BG		 7294out_err:
7295 spin_unlock_bh(&rdev->beacon_registrations_lock);
7296 kfree(nreg);
7297 return rv;
5e760230
JB		 7298}
7299
98104fde
JB		 7300static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
7301{
7302 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7303 struct wireless_dev *wdev = info->user_ptr[1];
7304 int err;
7305
7306 if (!rdev->ops->start_p2p_device)
7307 return -EOPNOTSUPP;
7308
7309 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
7310 return -EOPNOTSUPP;
7311
7312 if (wdev->p2p_started)
7313 return 0;
7314
7315 mutex_lock(&rdev->devlist_mtx);
7316 err = cfg80211_can_add_interface(rdev, wdev->iftype);
7317 mutex_unlock(&rdev->devlist_mtx);
7318 if (err)
7319 return err;
7320
eeb126e9 7321 err = rdev_start_p2p_device(rdev, wdev);
98104fde
JB		 7322 if (err)
7323 return err;
7324
7325 wdev->p2p_started = true;
7326 mutex_lock(&rdev->devlist_mtx);
7327 rdev->opencount++;
7328 mutex_unlock(&rdev->devlist_mtx);
7329
7330 return 0;
7331}
7332
7333static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
7334{
7335 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7336 struct wireless_dev *wdev = info->user_ptr[1];
7337
7338 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
7339 return -EOPNOTSUPP;
7340
7341 if (!rdev->ops->stop_p2p_device)
7342 return -EOPNOTSUPP;
7343
7344 if (!wdev->p2p_started)
7345 return 0;
7346
eeb126e9 7347 rdev_stop_p2p_device(rdev, wdev);
98104fde
JB		 7348 wdev->p2p_started = false;
7349
7350 mutex_lock(&rdev->devlist_mtx);
7351 rdev->opencount--;
7352 mutex_unlock(&rdev->devlist_mtx);
7353
7354 if (WARN_ON(rdev->scan_req && rdev->scan_req->wdev == wdev)) {
7355 rdev->scan_req->aborted = true;
7356 ___cfg80211_scan_done(rdev, true);
7357 }
7358
7359 return 0;
7360}
7361
4c476991
JB		 7362#define NL80211_FLAG_NEED_WIPHY 0x01
7363#define NL80211_FLAG_NEED_NETDEV 0x02
7364#define NL80211_FLAG_NEED_RTNL 0x04
41265714
JB		 7365#define NL80211_FLAG_CHECK_NETDEV_UP 0x08
7366#define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
7367 NL80211_FLAG_CHECK_NETDEV_UP)
1bf614ef 7368#define NL80211_FLAG_NEED_WDEV 0x10
98104fde 7369/* If a netdev is associated, it must be UP, P2P must be started */
1bf614ef
JB		 7370#define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
7371 NL80211_FLAG_CHECK_NETDEV_UP)
4c476991
JB		 7372
7373static int nl80211_pre_doit(struct genl_ops *ops, struct sk_buff *skb,
7374 struct genl_info *info)
7375{
7376 struct cfg80211_registered_device *rdev;
89a54e48 7377 struct wireless_dev *wdev;
4c476991 7378 struct net_device *dev;
4c476991
JB		 7379 bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
7380
7381 if (rtnl)
7382 rtnl_lock();
7383
7384 if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
4f7eff10 7385 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
4c476991
JB		 7386 if (IS_ERR(rdev)) {
7387 if (rtnl)
7388 rtnl_unlock();
7389 return PTR_ERR(rdev);
7390 }
7391 info->user_ptr[0] = rdev;
1bf614ef
JB		 7392 } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
7393 ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
89a54e48
JB		 7394 mutex_lock(&cfg80211_mutex);
7395 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
7396 info->attrs);
7397 if (IS_ERR(wdev)) {
7398 mutex_unlock(&cfg80211_mutex);
4c476991
JB		 7399 if (rtnl)
7400 rtnl_unlock();
89a54e48 7401 return PTR_ERR(wdev);
4c476991 7402 }
89a54e48 7403
89a54e48
JB		 7404 dev = wdev->netdev;
7405 rdev = wiphy_to_dev(wdev->wiphy);
7406
1bf614ef
JB		 7407 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
7408 if (!dev) {
7409 mutex_unlock(&cfg80211_mutex);
7410 if (rtnl)
7411 rtnl_unlock();
7412 return -EINVAL;
7413 }
7414
7415 info->user_ptr[1] = dev;
7416 } else {
7417 info->user_ptr[1] = wdev;
41265714 7418 }
1bf614ef
JB		 7419
7420 if (dev) {
7421 if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
7422 !netif_running(dev)) {
7423 mutex_unlock(&cfg80211_mutex);
7424 if (rtnl)
7425 rtnl_unlock();
7426 return -ENETDOWN;
7427 }
7428
7429 dev_hold(dev);
98104fde
JB		 7430 } else if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP) {
7431 if (!wdev->p2p_started) {
7432 mutex_unlock(&cfg80211_mutex);
7433 if (rtnl)
7434 rtnl_unlock();
7435 return -ENETDOWN;
7436 }
41265714 7437 }
89a54e48 7438
89a54e48
JB		 7439 cfg80211_lock_rdev(rdev);
7440
7441 mutex_unlock(&cfg80211_mutex);
7442
4c476991 7443 info->user_ptr[0] = rdev;
4c476991
JB		 7444 }
7445
7446 return 0;
7447}
7448
7449static void nl80211_post_doit(struct genl_ops *ops, struct sk_buff *skb,
7450 struct genl_info *info)
7451{
7452 if (info->user_ptr[0])
7453 cfg80211_unlock_rdev(info->user_ptr[0]);
1bf614ef
JB		 7454 if (info->user_ptr[1]) {
7455 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
7456 struct wireless_dev *wdev = info->user_ptr[1];
7457
7458 if (wdev->netdev)
7459 dev_put(wdev->netdev);
7460 } else {
7461 dev_put(info->user_ptr[1]);
7462 }
7463 }
4c476991
JB		 7464 if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
7465 rtnl_unlock();
7466}
7467
55682965
JB		 7468static struct genl_ops nl80211_ops[] = {
7469 {
7470 .cmd = NL80211_CMD_GET_WIPHY,
7471 .doit = nl80211_get_wiphy,
7472 .dumpit = nl80211_dump_wiphy,
7473 .policy = nl80211_policy,
7474 /* can be retrieved by unprivileged users */
4c476991 7475 .internal_flags = NL80211_FLAG_NEED_WIPHY,
55682965
JB		 7476 },
7477 {
7478 .cmd = NL80211_CMD_SET_WIPHY,
7479 .doit = nl80211_set_wiphy,
7480 .policy = nl80211_policy,
7481 .flags = GENL_ADMIN_PERM,
4c476991 7482 .internal_flags = NL80211_FLAG_NEED_RTNL,
55682965
JB		 7483 },
7484 {
7485 .cmd = NL80211_CMD_GET_INTERFACE,
7486 .doit = nl80211_get_interface,
7487 .dumpit = nl80211_dump_interface,
7488 .policy = nl80211_policy,
7489 /* can be retrieved by unprivileged users */
72fb2abc 7490 .internal_flags = NL80211_FLAG_NEED_WDEV,
55682965
JB		 7491 },
7492 {
7493 .cmd = NL80211_CMD_SET_INTERFACE,
7494 .doit = nl80211_set_interface,
7495 .policy = nl80211_policy,
7496 .flags = GENL_ADMIN_PERM,
4c476991
JB		 7497 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7498 NL80211_FLAG_NEED_RTNL,
55682965
JB		 7499 },
7500 {
7501 .cmd = NL80211_CMD_NEW_INTERFACE,
7502 .doit = nl80211_new_interface,
7503 .policy = nl80211_policy,
7504 .flags = GENL_ADMIN_PERM,
4c476991
JB		 7505 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7506 NL80211_FLAG_NEED_RTNL,
55682965
JB		 7507 },
7508 {
7509 .cmd = NL80211_CMD_DEL_INTERFACE,
7510 .doit = nl80211_del_interface,
7511 .policy = nl80211_policy,
41ade00f 7512 .flags = GENL_ADMIN_PERM,
84efbb84 7513 .internal_flags = NL80211_FLAG_NEED_WDEV |
4c476991 7514 NL80211_FLAG_NEED_RTNL,
41ade00f
JB		 7515 },
7516 {
7517 .cmd = NL80211_CMD_GET_KEY,
7518 .doit = nl80211_get_key,
7519 .policy = nl80211_policy,
7520 .flags = GENL_ADMIN_PERM,
2b5f8b0b 7521 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7522 NL80211_FLAG_NEED_RTNL,
41ade00f
JB		 7523 },
7524 {
7525 .cmd = NL80211_CMD_SET_KEY,
7526 .doit = nl80211_set_key,
7527 .policy = nl80211_policy,
7528 .flags = GENL_ADMIN_PERM,
41265714 7529 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7530 NL80211_FLAG_NEED_RTNL,
41ade00f
JB		 7531 },
7532 {
7533 .cmd = NL80211_CMD_NEW_KEY,
7534 .doit = nl80211_new_key,
7535 .policy = nl80211_policy,
7536 .flags = GENL_ADMIN_PERM,
41265714 7537 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7538 NL80211_FLAG_NEED_RTNL,
41ade00f
JB		 7539 },
7540 {
7541 .cmd = NL80211_CMD_DEL_KEY,
7542 .doit = nl80211_del_key,
7543 .policy = nl80211_policy,
55682965 7544 .flags = GENL_ADMIN_PERM,
41265714 7545 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7546 NL80211_FLAG_NEED_RTNL,
55682965 7547 },
ed1b6cc7
JB		 7548 {
7549 .cmd = NL80211_CMD_SET_BEACON,
7550 .policy = nl80211_policy,
7551 .flags = GENL_ADMIN_PERM,
8860020e 7552 .doit = nl80211_set_beacon,
2b5f8b0b 7553 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7554 NL80211_FLAG_NEED_RTNL,
ed1b6cc7
JB		 7555 },
7556 {
8860020e 7557 .cmd = NL80211_CMD_START_AP,
ed1b6cc7
JB		 7558 .policy = nl80211_policy,
7559 .flags = GENL_ADMIN_PERM,
8860020e 7560 .doit = nl80211_start_ap,
2b5f8b0b 7561 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7562 NL80211_FLAG_NEED_RTNL,
ed1b6cc7
JB		 7563 },
7564 {
8860020e 7565 .cmd = NL80211_CMD_STOP_AP,
ed1b6cc7
JB		 7566 .policy = nl80211_policy,
7567 .flags = GENL_ADMIN_PERM,
8860020e 7568 .doit = nl80211_stop_ap,
2b5f8b0b 7569 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7570 NL80211_FLAG_NEED_RTNL,
ed1b6cc7 7571 },
5727ef1b
JB		 7572 {
7573 .cmd = NL80211_CMD_GET_STATION,
7574 .doit = nl80211_get_station,
2ec600d6 7575 .dumpit = nl80211_dump_station,
5727ef1b 7576 .policy = nl80211_policy,
4c476991
JB		 7577 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7578 NL80211_FLAG_NEED_RTNL,
5727ef1b
JB		 7579 },
7580 {
7581 .cmd = NL80211_CMD_SET_STATION,
7582 .doit = nl80211_set_station,
7583 .policy = nl80211_policy,
7584 .flags = GENL_ADMIN_PERM,
2b5f8b0b 7585 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7586 NL80211_FLAG_NEED_RTNL,
5727ef1b
JB		 7587 },
7588 {
7589 .cmd = NL80211_CMD_NEW_STATION,
7590 .doit = nl80211_new_station,
7591 .policy = nl80211_policy,
7592 .flags = GENL_ADMIN_PERM,
41265714 7593 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7594 NL80211_FLAG_NEED_RTNL,
5727ef1b
JB		 7595 },
7596 {
7597 .cmd = NL80211_CMD_DEL_STATION,
7598 .doit = nl80211_del_station,
7599 .policy = nl80211_policy,
2ec600d6 7600 .flags = GENL_ADMIN_PERM,
2b5f8b0b 7601 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7602 NL80211_FLAG_NEED_RTNL,
2ec600d6
LCC		 7603 },
7604 {
7605 .cmd = NL80211_CMD_GET_MPATH,
7606 .doit = nl80211_get_mpath,
7607 .dumpit = nl80211_dump_mpath,
7608 .policy = nl80211_policy,
7609 .flags = GENL_ADMIN_PERM,
41265714 7610 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7611 NL80211_FLAG_NEED_RTNL,
2ec600d6
LCC		 7612 },
7613 {
7614 .cmd = NL80211_CMD_SET_MPATH,
7615 .doit = nl80211_set_mpath,
7616 .policy = nl80211_policy,
7617 .flags = GENL_ADMIN_PERM,
41265714 7618 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7619 NL80211_FLAG_NEED_RTNL,
2ec600d6
LCC		 7620 },
7621 {
7622 .cmd = NL80211_CMD_NEW_MPATH,
7623 .doit = nl80211_new_mpath,
7624 .policy = nl80211_policy,
7625 .flags = GENL_ADMIN_PERM,
41265714 7626 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7627 NL80211_FLAG_NEED_RTNL,
2ec600d6
LCC		 7628 },
7629 {
7630 .cmd = NL80211_CMD_DEL_MPATH,
7631 .doit = nl80211_del_mpath,
7632 .policy = nl80211_policy,
9f1ba906 7633 .flags = GENL_ADMIN_PERM,
2b5f8b0b 7634 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7635 NL80211_FLAG_NEED_RTNL,
9f1ba906
JM		 7636 },
7637 {
7638 .cmd = NL80211_CMD_SET_BSS,
7639 .doit = nl80211_set_bss,
7640 .policy = nl80211_policy,
b2e1b302 7641 .flags = GENL_ADMIN_PERM,
2b5f8b0b 7642 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7643 NL80211_FLAG_NEED_RTNL,
b2e1b302 7644 },
f130347c
LR		 7645 {
7646 .cmd = NL80211_CMD_GET_REG,
7647 .doit = nl80211_get_reg,
7648 .policy = nl80211_policy,
7649 /* can be retrieved by unprivileged users */
7650 },
b2e1b302
LR		 7651 {
7652 .cmd = NL80211_CMD_SET_REG,
7653 .doit = nl80211_set_reg,
7654 .policy = nl80211_policy,
7655 .flags = GENL_ADMIN_PERM,
7656 },
7657 {
7658 .cmd = NL80211_CMD_REQ_SET_REG,
7659 .doit = nl80211_req_set_reg,
7660 .policy = nl80211_policy,
93da9cc1 7661 .flags = GENL_ADMIN_PERM,
7662 },
7663 {
24bdd9f4
JC		 7664 .cmd = NL80211_CMD_GET_MESH_CONFIG,
7665 .doit = nl80211_get_mesh_config,
93da9cc1 7666 .policy = nl80211_policy,
7667 /* can be retrieved by unprivileged users */
2b5f8b0b 7668 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7669 NL80211_FLAG_NEED_RTNL,
93da9cc1 7670 },
7671 {
24bdd9f4
JC		 7672 .cmd = NL80211_CMD_SET_MESH_CONFIG,
7673 .doit = nl80211_update_mesh_config,
93da9cc1 7674 .policy = nl80211_policy,
9aed3cc1 7675 .flags = GENL_ADMIN_PERM,
29cbe68c 7676 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7677 NL80211_FLAG_NEED_RTNL,
9aed3cc1 7678 },
2a519311
JB		 7679 {
7680 .cmd = NL80211_CMD_TRIGGER_SCAN,
7681 .doit = nl80211_trigger_scan,
7682 .policy = nl80211_policy,
7683 .flags = GENL_ADMIN_PERM,
fd014284 7684 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
4c476991 7685 NL80211_FLAG_NEED_RTNL,
2a519311
JB		 7686 },
7687 {
7688 .cmd = NL80211_CMD_GET_SCAN,
7689 .policy = nl80211_policy,
7690 .dumpit = nl80211_dump_scan,
7691 },
807f8a8c
LC		 7692 {
7693 .cmd = NL80211_CMD_START_SCHED_SCAN,
7694 .doit = nl80211_start_sched_scan,
7695 .policy = nl80211_policy,
7696 .flags = GENL_ADMIN_PERM,
7697 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7698 NL80211_FLAG_NEED_RTNL,
7699 },
7700 {
7701 .cmd = NL80211_CMD_STOP_SCHED_SCAN,
7702 .doit = nl80211_stop_sched_scan,
7703 .policy = nl80211_policy,
7704 .flags = GENL_ADMIN_PERM,
7705 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7706 NL80211_FLAG_NEED_RTNL,
7707 },
636a5d36
JM		 7708 {
7709 .cmd = NL80211_CMD_AUTHENTICATE,
7710 .doit = nl80211_authenticate,
7711 .policy = nl80211_policy,
7712 .flags = GENL_ADMIN_PERM,
41265714 7713 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7714 NL80211_FLAG_NEED_RTNL,
636a5d36
JM		 7715 },
7716 {
7717 .cmd = NL80211_CMD_ASSOCIATE,
7718 .doit = nl80211_associate,
7719 .policy = nl80211_policy,
7720 .flags = GENL_ADMIN_PERM,
41265714 7721 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7722 NL80211_FLAG_NEED_RTNL,
636a5d36
JM		 7723 },
7724 {
7725 .cmd = NL80211_CMD_DEAUTHENTICATE,
7726 .doit = nl80211_deauthenticate,
7727 .policy = nl80211_policy,
7728 .flags = GENL_ADMIN_PERM,
41265714 7729 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7730 NL80211_FLAG_NEED_RTNL,
636a5d36
JM		 7731 },
7732 {
7733 .cmd = NL80211_CMD_DISASSOCIATE,
7734 .doit = nl80211_disassociate,
7735 .policy = nl80211_policy,
7736 .flags = GENL_ADMIN_PERM,
41265714 7737 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7738 NL80211_FLAG_NEED_RTNL,
636a5d36 7739 },
04a773ad
JB		 7740 {
7741 .cmd = NL80211_CMD_JOIN_IBSS,
7742 .doit = nl80211_join_ibss,
7743 .policy = nl80211_policy,
7744 .flags = GENL_ADMIN_PERM,
41265714 7745 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7746 NL80211_FLAG_NEED_RTNL,
04a773ad
JB		 7747 },
7748 {
7749 .cmd = NL80211_CMD_LEAVE_IBSS,
7750 .doit = nl80211_leave_ibss,
7751 .policy = nl80211_policy,
7752 .flags = GENL_ADMIN_PERM,
41265714 7753 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7754 NL80211_FLAG_NEED_RTNL,
04a773ad 7755 },
aff89a9b
JB		 7756#ifdef CONFIG_NL80211_TESTMODE
7757 {
7758 .cmd = NL80211_CMD_TESTMODE,
7759 .doit = nl80211_testmode_do,
71063f0e 7760 .dumpit = nl80211_testmode_dump,
aff89a9b
JB		 7761 .policy = nl80211_policy,
7762 .flags = GENL_ADMIN_PERM,
4c476991
JB		 7763 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7764 NL80211_FLAG_NEED_RTNL,
aff89a9b
JB		 7765 },
7766#endif
b23aa676
SO		 7767 {
7768 .cmd = NL80211_CMD_CONNECT,
7769 .doit = nl80211_connect,
7770 .policy = nl80211_policy,
7771 .flags = GENL_ADMIN_PERM,
41265714 7772 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7773 NL80211_FLAG_NEED_RTNL,
b23aa676
SO		 7774 },
7775 {
7776 .cmd = NL80211_CMD_DISCONNECT,
7777 .doit = nl80211_disconnect,
7778 .policy = nl80211_policy,
7779 .flags = GENL_ADMIN_PERM,
41265714 7780 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7781 NL80211_FLAG_NEED_RTNL,
b23aa676 7782 },
463d0183
JB		 7783 {
7784 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
7785 .doit = nl80211_wiphy_netns,
7786 .policy = nl80211_policy,
7787 .flags = GENL_ADMIN_PERM,
4c476991
JB		 7788 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7789 NL80211_FLAG_NEED_RTNL,
463d0183 7790 },
61fa713c
HS		 7791 {
7792 .cmd = NL80211_CMD_GET_SURVEY,
7793 .policy = nl80211_policy,
7794 .dumpit = nl80211_dump_survey,
7795 },
67fbb16b
SO		 7796 {
7797 .cmd = NL80211_CMD_SET_PMKSA,
7798 .doit = nl80211_setdel_pmksa,
7799 .policy = nl80211_policy,
7800 .flags = GENL_ADMIN_PERM,
2b5f8b0b 7801 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7802 NL80211_FLAG_NEED_RTNL,
67fbb16b
SO		 7803 },
7804 {
7805 .cmd = NL80211_CMD_DEL_PMKSA,
7806 .doit = nl80211_setdel_pmksa,
7807 .policy = nl80211_policy,
7808 .flags = GENL_ADMIN_PERM,
2b5f8b0b 7809 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7810 NL80211_FLAG_NEED_RTNL,
67fbb16b
SO		 7811 },
7812 {
7813 .cmd = NL80211_CMD_FLUSH_PMKSA,
7814 .doit = nl80211_flush_pmksa,
7815 .policy = nl80211_policy,
7816 .flags = GENL_ADMIN_PERM,
2b5f8b0b 7817 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
4c476991 7818 NL80211_FLAG_NEED_RTNL,
67fbb16b 7819 },
9588bbd5
JM		 7820 {
7821 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
7822 .doit = nl80211_remain_on_channel,
7823 .policy = nl80211_policy,
7824 .flags = GENL_ADMIN_PERM,
71bbc994 7825 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
4c476991 7826 NL80211_FLAG_NEED_RTNL,
9588bbd5
JM		 7827 },
7828 {
7829 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
7830 .doit = nl80211_cancel_remain_on_channel,
7831 .policy = nl80211_policy,
7832 .flags = GENL_ADMIN_PERM,
71bbc994 7833 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
4c476991 7834 NL80211_FLAG_NEED_RTNL,
9588bbd5 7835 },
13ae75b1
JM		 7836 {
7837 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
7838 .doit = nl80211_set_tx_bitrate_mask,
7839 .policy = nl80211_policy,
7840 .flags = GENL_ADMIN_PERM,
4c476991
JB		 7841 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7842 NL80211_FLAG_NEED_RTNL,
13ae75b1 7843 },
026331c4 7844 {
2e161f78
JB		 7845 .cmd = NL80211_CMD_REGISTER_FRAME,
7846 .doit = nl80211_register_mgmt,
026331c4
JM		 7847 .policy = nl80211_policy,
7848 .flags = GENL_ADMIN_PERM,
71bbc994 7849 .internal_flags = NL80211_FLAG_NEED_WDEV |
4c476991 7850 NL80211_FLAG_NEED_RTNL,
026331c4
JM		 7851 },
7852 {
2e161f78
JB		 7853 .cmd = NL80211_CMD_FRAME,
7854 .doit = nl80211_tx_mgmt,
026331c4 7855 .policy = nl80211_policy,
f7ca38df 7856 .flags = GENL_ADMIN_PERM,
71bbc994 7857 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
f7ca38df
JB		 7858 NL80211_FLAG_NEED_RTNL,
7859 },
7860 {
7861 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
7862 .doit = nl80211_tx_mgmt_cancel_wait,
7863 .policy = nl80211_policy,
026331c4 7864 .flags = GENL_ADMIN_PERM,
71bbc994 7865 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
4c476991 7866 NL80211_FLAG_NEED_RTNL,
026331c4 7867 },
ffb9eb3d
KV		 7868 {
7869 .cmd = NL80211_CMD_SET_POWER_SAVE,
7870 .doit = nl80211_set_power_save,
7871 .policy = nl80211_policy,
7872 .flags = GENL_ADMIN_PERM,
4c476991
JB		 7873 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7874 NL80211_FLAG_NEED_RTNL,
ffb9eb3d
KV		 7875 },
7876 {
7877 .cmd = NL80211_CMD_GET_POWER_SAVE,
7878 .doit = nl80211_get_power_save,
7879 .policy = nl80211_policy,
7880 /* can be retrieved by unprivileged users */
4c476991
JB		 7881 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7882 NL80211_FLAG_NEED_RTNL,
ffb9eb3d 7883 },
d6dc1a38
JO		 7884 {
7885 .cmd = NL80211_CMD_SET_CQM,
7886 .doit = nl80211_set_cqm,
7887 .policy = nl80211_policy,
7888 .flags = GENL_ADMIN_PERM,
4c476991
JB		 7889 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7890 NL80211_FLAG_NEED_RTNL,
d6dc1a38 7891 },
f444de05
JB		 7892 {
7893 .cmd = NL80211_CMD_SET_CHANNEL,
7894 .doit = nl80211_set_channel,
7895 .policy = nl80211_policy,
7896 .flags = GENL_ADMIN_PERM,
4c476991
JB		 7897 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7898 NL80211_FLAG_NEED_RTNL,
f444de05 7899 },
e8347eba
BJ		 7900 {
7901 .cmd = NL80211_CMD_SET_WDS_PEER,
7902 .doit = nl80211_set_wds_peer,
7903 .policy = nl80211_policy,
7904 .flags = GENL_ADMIN_PERM,
43b19952
JB		 7905 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7906 NL80211_FLAG_NEED_RTNL,
e8347eba 7907 },
29cbe68c
JB		 7908 {
7909 .cmd = NL80211_CMD_JOIN_MESH,
7910 .doit = nl80211_join_mesh,
7911 .policy = nl80211_policy,
7912 .flags = GENL_ADMIN_PERM,
7913 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7914 NL80211_FLAG_NEED_RTNL,
7915 },
7916 {
7917 .cmd = NL80211_CMD_LEAVE_MESH,
7918 .doit = nl80211_leave_mesh,
7919 .policy = nl80211_policy,
7920 .flags = GENL_ADMIN_PERM,
7921 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7922 NL80211_FLAG_NEED_RTNL,
7923 },
dfb89c56 7924#ifdef CONFIG_PM
ff1b6e69
JB		 7925 {
7926 .cmd = NL80211_CMD_GET_WOWLAN,
7927 .doit = nl80211_get_wowlan,
7928 .policy = nl80211_policy,
7929 /* can be retrieved by unprivileged users */
7930 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7931 NL80211_FLAG_NEED_RTNL,
7932 },
7933 {
7934 .cmd = NL80211_CMD_SET_WOWLAN,
7935 .doit = nl80211_set_wowlan,
7936 .policy = nl80211_policy,
7937 .flags = GENL_ADMIN_PERM,
7938 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7939 NL80211_FLAG_NEED_RTNL,
7940 },
dfb89c56 7941#endif
e5497d76
JB		 7942 {
7943 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
7944 .doit = nl80211_set_rekey_data,
7945 .policy = nl80211_policy,
7946 .flags = GENL_ADMIN_PERM,
7947 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7948 NL80211_FLAG_NEED_RTNL,
7949 },
109086ce
AN		 7950 {
7951 .cmd = NL80211_CMD_TDLS_MGMT,
7952 .doit = nl80211_tdls_mgmt,
7953 .policy = nl80211_policy,
7954 .flags = GENL_ADMIN_PERM,
7955 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7956 NL80211_FLAG_NEED_RTNL,
7957 },
7958 {
7959 .cmd = NL80211_CMD_TDLS_OPER,
7960 .doit = nl80211_tdls_oper,
7961 .policy = nl80211_policy,
7962 .flags = GENL_ADMIN_PERM,
7963 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7964 NL80211_FLAG_NEED_RTNL,
7965 },
28946da7
JB		 7966 {
7967 .cmd = NL80211_CMD_UNEXPECTED_FRAME,
7968 .doit = nl80211_register_unexpected_frame,
7969 .policy = nl80211_policy,
7970 .flags = GENL_ADMIN_PERM,
7971 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7972 NL80211_FLAG_NEED_RTNL,
7973 },
7f6cf311
JB		 7974 {
7975 .cmd = NL80211_CMD_PROBE_CLIENT,
7976 .doit = nl80211_probe_client,
7977 .policy = nl80211_policy,
7978 .flags = GENL_ADMIN_PERM,
2b5f8b0b 7979 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7f6cf311
JB		 7980 NL80211_FLAG_NEED_RTNL,
7981 },
5e760230
JB		 7982 {
7983 .cmd = NL80211_CMD_REGISTER_BEACONS,
7984 .doit = nl80211_register_beacons,
7985 .policy = nl80211_policy,
7986 .flags = GENL_ADMIN_PERM,
7987 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7988 NL80211_FLAG_NEED_RTNL,
7989 },
1d9d9213
SW		 7990 {
7991 .cmd = NL80211_CMD_SET_NOACK_MAP,
7992 .doit = nl80211_set_noack_map,
7993 .policy = nl80211_policy,
7994 .flags = GENL_ADMIN_PERM,
7995 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7996 NL80211_FLAG_NEED_RTNL,
7997 },
98104fde
JB		 7998 {
7999 .cmd = NL80211_CMD_START_P2P_DEVICE,
8000 .doit = nl80211_start_p2p_device,
8001 .policy = nl80211_policy,
8002 .flags = GENL_ADMIN_PERM,
8003 .internal_flags = NL80211_FLAG_NEED_WDEV |
8004 NL80211_FLAG_NEED_RTNL,
8005 },
8006 {
8007 .cmd = NL80211_CMD_STOP_P2P_DEVICE,
8008 .doit = nl80211_stop_p2p_device,
8009 .policy = nl80211_policy,
8010 .flags = GENL_ADMIN_PERM,
8011 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
8012 NL80211_FLAG_NEED_RTNL,
8013 },
f4e583c8
AQ		 8014 {
8015 .cmd = NL80211_CMD_SET_MCAST_RATE,
8016 .doit = nl80211_set_mcast_rate,
77765eaf
VT		 8017 .policy = nl80211_policy,
8018 .flags = GENL_ADMIN_PERM,
8019 .internal_flags = NL80211_FLAG_NEED_NETDEV |
8020 NL80211_FLAG_NEED_RTNL,
8021 },
8022 {
8023 .cmd = NL80211_CMD_SET_MAC_ACL,
8024 .doit = nl80211_set_mac_acl,
f4e583c8
AQ		 8025 .policy = nl80211_policy,
8026 .flags = GENL_ADMIN_PERM,
8027 .internal_flags = NL80211_FLAG_NEED_NETDEV |
8028 NL80211_FLAG_NEED_RTNL,
8029 },
55682965 8030};
9588bbd5 8031
6039f6d2
JM		 8032static struct genl_multicast_group nl80211_mlme_mcgrp = {
8033 .name = "mlme",
8034};
55682965
JB		 8035
8036/* multicast groups */
8037static struct genl_multicast_group nl80211_config_mcgrp = {
8038 .name = "config",
8039};
2a519311
JB		 8040static struct genl_multicast_group nl80211_scan_mcgrp = {
8041 .name = "scan",
8042};
73d54c9e
LR		 8043static struct genl_multicast_group nl80211_regulatory_mcgrp = {
8044 .name = "regulatory",
8045};
55682965
JB		 8046
8047/* notification functions */
8048
8049void nl80211_notify_dev_rename(struct cfg80211_registered_device *rdev)
8050{
8051 struct sk_buff *msg;
8052
fd2120ca 8053 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
55682965
JB		 8054 if (!msg)
8055 return;
8056
8057 if (nl80211_send_wiphy(msg, 0, 0, 0, rdev) < 0) {
8058 nlmsg_free(msg);
8059 return;
8060 }
8061
463d0183
JB		 8062 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8063 nl80211_config_mcgrp.id, GFP_KERNEL);
55682965
JB		 8064}
8065
362a415d
JB		 8066static int nl80211_add_scan_req(struct sk_buff *msg,
8067 struct cfg80211_registered_device *rdev)
8068{
8069 struct cfg80211_scan_request *req = rdev->scan_req;
8070 struct nlattr *nest;
8071 int i;
8072
667503dd
JB		 8073 ASSERT_RDEV_LOCK(rdev);
8074
362a415d
JB		 8075 if (WARN_ON(!req))
8076 return 0;
8077
8078 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
8079 if (!nest)
8080 goto nla_put_failure;
9360ffd1
DM		 8081 for (i = 0; i < req->n_ssids; i++) {
8082 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
8083 goto nla_put_failure;
8084 }
362a415d
JB		 8085 nla_nest_end(msg, nest);
8086
8087 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
8088 if (!nest)
8089 goto nla_put_failure;
9360ffd1
DM		 8090 for (i = 0; i < req->n_channels; i++) {
8091 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
8092 goto nla_put_failure;
8093 }
362a415d
JB		 8094 nla_nest_end(msg, nest);
8095
9360ffd1
DM		 8096 if (req->ie &&
8097 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
8098 goto nla_put_failure;
362a415d 8099
ed473771
SL		 8100 if (req->flags)
8101 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags);
8102
362a415d
JB		 8103 return 0;
8104 nla_put_failure:
8105 return -ENOBUFS;
8106}
8107
a538e2d5
JB		 8108static int nl80211_send_scan_msg(struct sk_buff *msg,
8109 struct cfg80211_registered_device *rdev,
fd014284 8110 struct wireless_dev *wdev,
15e47304 8111 u32 portid, u32 seq, int flags,
a538e2d5 8112 u32 cmd)
2a519311
JB		 8113{
8114 void *hdr;
8115
15e47304 8116 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
2a519311
JB		 8117 if (!hdr)
8118 return -1;
8119
9360ffd1 8120 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
fd014284
JB		 8121 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
8122 wdev->netdev->ifindex)) ||
8123 nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)))
9360ffd1 8124 goto nla_put_failure;
2a519311 8125
362a415d
JB		 8126 /* ignore errors and send incomplete event anyway */
8127 nl80211_add_scan_req(msg, rdev);
2a519311
JB		 8128
8129 return genlmsg_end(msg, hdr);
8130
8131 nla_put_failure:
8132 genlmsg_cancel(msg, hdr);
8133 return -EMSGSIZE;
8134}
8135
807f8a8c
LC		 8136static int
8137nl80211_send_sched_scan_msg(struct sk_buff *msg,
8138 struct cfg80211_registered_device *rdev,
8139 struct net_device *netdev,
15e47304 8140 u32 portid, u32 seq, int flags, u32 cmd)
807f8a8c
LC		 8141{
8142 void *hdr;
8143
15e47304 8144 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
807f8a8c
LC		 8145 if (!hdr)
8146 return -1;
8147
9360ffd1
DM		 8148 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8149 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
8150 goto nla_put_failure;
807f8a8c
LC		 8151
8152 return genlmsg_end(msg, hdr);
8153
8154 nla_put_failure:
8155 genlmsg_cancel(msg, hdr);
8156 return -EMSGSIZE;
8157}
8158
a538e2d5 8159void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
fd014284 8160 struct wireless_dev *wdev)
a538e2d5
JB		 8161{
8162 struct sk_buff *msg;
8163
58050fce 8164 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
a538e2d5
JB		 8165 if (!msg)
8166 return;
8167
fd014284 8168 if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
a538e2d5
JB		 8169 NL80211_CMD_TRIGGER_SCAN) < 0) {
8170 nlmsg_free(msg);
8171 return;
8172 }
8173
463d0183
JB		 8174 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8175 nl80211_scan_mcgrp.id, GFP_KERNEL);
a538e2d5
JB		 8176}
8177
2a519311 8178void nl80211_send_scan_done(struct cfg80211_registered_device *rdev,
fd014284 8179 struct wireless_dev *wdev)
2a519311
JB		 8180{
8181 struct sk_buff *msg;
8182
fd2120ca 8183 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2a519311
JB		 8184 if (!msg)
8185 return;
8186
fd014284 8187 if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
a538e2d5 8188 NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
2a519311
JB		 8189 nlmsg_free(msg);
8190 return;
8191 }
8192
463d0183
JB		 8193 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8194 nl80211_scan_mcgrp.id, GFP_KERNEL);
2a519311
JB		 8195}
8196
8197void nl80211_send_scan_aborted(struct cfg80211_registered_device *rdev,
fd014284 8198 struct wireless_dev *wdev)
2a519311
JB		 8199{
8200 struct sk_buff *msg;
8201
fd2120ca 8202 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2a519311
JB		 8203 if (!msg)
8204 return;
8205
fd014284 8206 if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
a538e2d5 8207 NL80211_CMD_SCAN_ABORTED) < 0) {
2a519311
JB		 8208 nlmsg_free(msg);
8209 return;
8210 }
8211
463d0183
JB		 8212 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8213 nl80211_scan_mcgrp.id, GFP_KERNEL);
2a519311
JB		 8214}
8215
807f8a8c
LC		 8216void nl80211_send_sched_scan_results(struct cfg80211_registered_device *rdev,
8217 struct net_device *netdev)
8218{
8219 struct sk_buff *msg;
8220
8221 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
8222 if (!msg)
8223 return;
8224
8225 if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0,
8226 NL80211_CMD_SCHED_SCAN_RESULTS) < 0) {
8227 nlmsg_free(msg);
8228 return;
8229 }
8230
8231 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8232 nl80211_scan_mcgrp.id, GFP_KERNEL);
8233}
8234
8235void nl80211_send_sched_scan(struct cfg80211_registered_device *rdev,
8236 struct net_device *netdev, u32 cmd)
8237{
8238 struct sk_buff *msg;
8239
58050fce 8240 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
807f8a8c
LC		 8241 if (!msg)
8242 return;
8243
8244 if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0, cmd) < 0) {
8245 nlmsg_free(msg);
8246 return;
8247 }
8248
8249 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8250 nl80211_scan_mcgrp.id, GFP_KERNEL);
8251}
8252
73d54c9e
LR		 8253/*
8254 * This can happen on global regulatory changes or device specific settings
8255 * based on custom world regulatory domains.
8256 */
8257void nl80211_send_reg_change_event(struct regulatory_request *request)
8258{
8259 struct sk_buff *msg;
8260 void *hdr;
8261
fd2120ca 8262 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
73d54c9e
LR		 8263 if (!msg)
8264 return;
8265
8266 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_CHANGE);
8267 if (!hdr) {
8268 nlmsg_free(msg);
8269 return;
8270 }
8271
8272 /* Userspace can always count this one always being set */
9360ffd1
DM		 8273 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
8274 goto nla_put_failure;
8275
8276 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
8277 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
8278 NL80211_REGDOM_TYPE_WORLD))
8279 goto nla_put_failure;
8280 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
8281 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
8282 NL80211_REGDOM_TYPE_CUSTOM_WORLD))
8283 goto nla_put_failure;
8284 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
8285 request->intersect) {
8286 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
8287 NL80211_REGDOM_TYPE_INTERSECTION))
8288 goto nla_put_failure;
8289 } else {
8290 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
8291 NL80211_REGDOM_TYPE_COUNTRY) ||
8292 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
8293 request->alpha2))
8294 goto nla_put_failure;
8295 }
8296
f4173766 8297 if (request->wiphy_idx != WIPHY_IDX_INVALID &&
9360ffd1
DM		 8298 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
8299 goto nla_put_failure;
73d54c9e 8300
3b7b72ee 8301 genlmsg_end(msg, hdr);
73d54c9e 8302
bc43b28c 8303 rcu_read_lock();
463d0183 8304 genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
bc43b28c
JB		 8305 GFP_ATOMIC);
8306 rcu_read_unlock();
73d54c9e
LR		 8307
8308 return;
8309
8310nla_put_failure:
8311 genlmsg_cancel(msg, hdr);
8312 nlmsg_free(msg);
8313}
8314
6039f6d2
JM		 8315static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
8316 struct net_device *netdev,
8317 const u8 *buf, size_t len,
e6d6e342 8318 enum nl80211_commands cmd, gfp_t gfp)
6039f6d2
JM		 8319{
8320 struct sk_buff *msg;
8321 void *hdr;
8322
e6d6e342 8323 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
6039f6d2
JM		 8324 if (!msg)
8325 return;
8326
8327 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
8328 if (!hdr) {
8329 nlmsg_free(msg);
8330 return;
8331 }
8332
9360ffd1
DM		 8333 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8334 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8335 nla_put(msg, NL80211_ATTR_FRAME, len, buf))
8336 goto nla_put_failure;
6039f6d2 8337
3b7b72ee 8338 genlmsg_end(msg, hdr);
6039f6d2 8339
463d0183
JB		 8340 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8341 nl80211_mlme_mcgrp.id, gfp);
6039f6d2
JM		 8342 return;
8343
8344 nla_put_failure:
8345 genlmsg_cancel(msg, hdr);
8346 nlmsg_free(msg);
8347}
8348
8349void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
e6d6e342
JB		 8350 struct net_device *netdev, const u8 *buf,
8351 size_t len, gfp_t gfp)
6039f6d2
JM		 8352{
8353 nl80211_send_mlme_event(rdev, netdev, buf, len,
e6d6e342 8354 NL80211_CMD_AUTHENTICATE, gfp);
6039f6d2
JM		 8355}
8356
8357void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
8358 struct net_device *netdev, const u8 *buf,
e6d6e342 8359 size_t len, gfp_t gfp)
6039f6d2 8360{
e6d6e342
JB		 8361 nl80211_send_mlme_event(rdev, netdev, buf, len,
8362 NL80211_CMD_ASSOCIATE, gfp);
6039f6d2
JM		 8363}
8364
53b46b84 8365void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
e6d6e342
JB		 8366 struct net_device *netdev, const u8 *buf,
8367 size_t len, gfp_t gfp)
6039f6d2
JM		 8368{
8369 nl80211_send_mlme_event(rdev, netdev, buf, len,
e6d6e342 8370 NL80211_CMD_DEAUTHENTICATE, gfp);
6039f6d2
JM		 8371}
8372
53b46b84
JM		 8373void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
8374 struct net_device *netdev, const u8 *buf,
e6d6e342 8375 size_t len, gfp_t gfp)
6039f6d2
JM		 8376{
8377 nl80211_send_mlme_event(rdev, netdev, buf, len,
e6d6e342 8378 NL80211_CMD_DISASSOCIATE, gfp);
6039f6d2
JM		 8379}
8380
cf4e594e
JM		 8381void nl80211_send_unprot_deauth(struct cfg80211_registered_device *rdev,
8382 struct net_device *netdev, const u8 *buf,
8383 size_t len, gfp_t gfp)
8384{
8385 nl80211_send_mlme_event(rdev, netdev, buf, len,
8386 NL80211_CMD_UNPROT_DEAUTHENTICATE, gfp);
8387}
8388
8389void nl80211_send_unprot_disassoc(struct cfg80211_registered_device *rdev,
8390 struct net_device *netdev, const u8 *buf,
8391 size_t len, gfp_t gfp)
8392{
8393 nl80211_send_mlme_event(rdev, netdev, buf, len,
8394 NL80211_CMD_UNPROT_DISASSOCIATE, gfp);
8395}
8396
1b06bb40
LR		 8397static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
8398 struct net_device *netdev, int cmd,
e6d6e342 8399 const u8 *addr, gfp_t gfp)
1965c853
JM		 8400{
8401 struct sk_buff *msg;
8402 void *hdr;
8403
e6d6e342 8404 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
1965c853
JM		 8405 if (!msg)
8406 return;
8407
8408 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
8409 if (!hdr) {
8410 nlmsg_free(msg);
8411 return;
8412 }
8413
9360ffd1
DM		 8414 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8415 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8416 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
8417 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
8418 goto nla_put_failure;
1965c853 8419
3b7b72ee 8420 genlmsg_end(msg, hdr);
1965c853 8421
463d0183
JB		 8422 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8423 nl80211_mlme_mcgrp.id, gfp);
1965c853
JM		 8424 return;
8425
8426 nla_put_failure:
8427 genlmsg_cancel(msg, hdr);
8428 nlmsg_free(msg);
8429}
8430
8431void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
e6d6e342
JB		 8432 struct net_device *netdev, const u8 *addr,
8433 gfp_t gfp)
1965c853
JM		 8434{
8435 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
e6d6e342 8436 addr, gfp);
1965c853
JM		 8437}
8438
8439void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
e6d6e342
JB		 8440 struct net_device *netdev, const u8 *addr,
8441 gfp_t gfp)
1965c853 8442{
e6d6e342
JB		 8443 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
8444 addr, gfp);
1965c853
JM		 8445}
8446
b23aa676
SO		 8447void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
8448 struct net_device *netdev, const u8 *bssid,
8449 const u8 *req_ie, size_t req_ie_len,
8450 const u8 *resp_ie, size_t resp_ie_len,
8451 u16 status, gfp_t gfp)
8452{
8453 struct sk_buff *msg;
8454 void *hdr;
8455
58050fce 8456 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
b23aa676
SO		 8457 if (!msg)
8458 return;
8459
8460 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
8461 if (!hdr) {
8462 nlmsg_free(msg);
8463 return;
8464 }
8465
9360ffd1
DM		 8466 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8467 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8468 (bssid && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) ||
8469 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, status) ||
8470 (req_ie &&
8471 nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
8472 (resp_ie &&
8473 nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
8474 goto nla_put_failure;
b23aa676 8475
3b7b72ee 8476 genlmsg_end(msg, hdr);
b23aa676 8477
463d0183
JB		 8478 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8479 nl80211_mlme_mcgrp.id, gfp);
b23aa676
SO		 8480 return;
8481
8482 nla_put_failure:
8483 genlmsg_cancel(msg, hdr);
8484 nlmsg_free(msg);
8485
8486}
8487
8488void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
8489 struct net_device *netdev, const u8 *bssid,
8490 const u8 *req_ie, size_t req_ie_len,
8491 const u8 *resp_ie, size_t resp_ie_len, gfp_t gfp)
8492{
8493 struct sk_buff *msg;
8494 void *hdr;
8495
58050fce 8496 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
b23aa676
SO		 8497 if (!msg)
8498 return;
8499
8500 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
8501 if (!hdr) {
8502 nlmsg_free(msg);
8503 return;
8504 }
8505
9360ffd1
DM		 8506 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8507 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8508 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
8509 (req_ie &&
8510 nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
8511 (resp_ie &&
8512 nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
8513 goto nla_put_failure;
b23aa676 8514
3b7b72ee 8515 genlmsg_end(msg, hdr);
b23aa676 8516
463d0183
JB		 8517 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8518 nl80211_mlme_mcgrp.id, gfp);
b23aa676
SO		 8519 return;
8520
8521 nla_put_failure:
8522 genlmsg_cancel(msg, hdr);
8523 nlmsg_free(msg);
8524
8525}
8526
8527void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
8528 struct net_device *netdev, u16 reason,
667503dd 8529 const u8 *ie, size_t ie_len, bool from_ap)
b23aa676
SO		 8530{
8531 struct sk_buff *msg;
8532 void *hdr;
8533
58050fce 8534 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
b23aa676
SO		 8535 if (!msg)
8536 return;
8537
8538 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
8539 if (!hdr) {
8540 nlmsg_free(msg);
8541 return;
8542 }
8543
9360ffd1
DM		 8544 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8545 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8546 (from_ap && reason &&
8547 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
8548 (from_ap &&
8549 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
8550 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
8551 goto nla_put_failure;
b23aa676 8552
3b7b72ee 8553 genlmsg_end(msg, hdr);
b23aa676 8554
463d0183
JB		 8555 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8556 nl80211_mlme_mcgrp.id, GFP_KERNEL);
b23aa676
SO		 8557 return;
8558
8559 nla_put_failure:
8560 genlmsg_cancel(msg, hdr);
8561 nlmsg_free(msg);
8562
8563}
8564
04a773ad
JB		 8565void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
8566 struct net_device *netdev, const u8 *bssid,
8567 gfp_t gfp)
8568{
8569 struct sk_buff *msg;
8570 void *hdr;
8571
fd2120ca 8572 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
04a773ad
JB		 8573 if (!msg)
8574 return;
8575
8576 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
8577 if (!hdr) {
8578 nlmsg_free(msg);
8579 return;
8580 }
8581
9360ffd1
DM		 8582 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8583 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8584 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
8585 goto nla_put_failure;
04a773ad 8586
3b7b72ee 8587 genlmsg_end(msg, hdr);
04a773ad 8588
463d0183
JB		 8589 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8590 nl80211_mlme_mcgrp.id, gfp);
04a773ad
JB		 8591 return;
8592
8593 nla_put_failure:
8594 genlmsg_cancel(msg, hdr);
8595 nlmsg_free(msg);
8596}
8597
c93b5e71
JC		 8598void nl80211_send_new_peer_candidate(struct cfg80211_registered_device *rdev,
8599 struct net_device *netdev,
8600 const u8 *macaddr, const u8* ie, u8 ie_len,
8601 gfp_t gfp)
8602{
8603 struct sk_buff *msg;
8604 void *hdr;
8605
8606 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8607 if (!msg)
8608 return;
8609
8610 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
8611 if (!hdr) {
8612 nlmsg_free(msg);
8613 return;
8614 }
8615
9360ffd1
DM		 8616 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8617 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8618 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, macaddr) ||
8619 (ie_len && ie &&
8620 nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
8621 goto nla_put_failure;
c93b5e71 8622
3b7b72ee 8623 genlmsg_end(msg, hdr);
c93b5e71
JC		 8624
8625 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8626 nl80211_mlme_mcgrp.id, gfp);
8627 return;
8628
8629 nla_put_failure:
8630 genlmsg_cancel(msg, hdr);
8631 nlmsg_free(msg);
8632}
8633
a3b8b056
JM		 8634void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
8635 struct net_device *netdev, const u8 *addr,
8636 enum nl80211_key_type key_type, int key_id,
e6d6e342 8637 const u8 *tsc, gfp_t gfp)
a3b8b056
JM		 8638{
8639 struct sk_buff *msg;
8640 void *hdr;
8641
e6d6e342 8642 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
a3b8b056
JM		 8643 if (!msg)
8644 return;
8645
8646 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
8647 if (!hdr) {
8648 nlmsg_free(msg);
8649 return;
8650 }
8651
9360ffd1
DM		 8652 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8653 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8654 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
8655 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
8656 (key_id != -1 &&
8657 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
8658 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
8659 goto nla_put_failure;
a3b8b056 8660
3b7b72ee 8661 genlmsg_end(msg, hdr);
a3b8b056 8662
463d0183
JB		 8663 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8664 nl80211_mlme_mcgrp.id, gfp);
a3b8b056
JM		 8665 return;
8666
8667 nla_put_failure:
8668 genlmsg_cancel(msg, hdr);
8669 nlmsg_free(msg);
8670}
8671
6bad8766
LR		 8672void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
8673 struct ieee80211_channel *channel_before,
8674 struct ieee80211_channel *channel_after)
8675{
8676 struct sk_buff *msg;
8677 void *hdr;
8678 struct nlattr *nl_freq;
8679
fd2120ca 8680 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
6bad8766
LR		 8681 if (!msg)
8682 return;
8683
8684 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
8685 if (!hdr) {
8686 nlmsg_free(msg);
8687 return;
8688 }
8689
8690 /*
8691 * Since we are applying the beacon hint to a wiphy we know its
8692 * wiphy_idx is valid
8693 */
9360ffd1
DM		 8694 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
8695 goto nla_put_failure;
6bad8766
LR		 8696
8697 /* Before */
8698 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
8699 if (!nl_freq)
8700 goto nla_put_failure;
8701 if (nl80211_msg_put_channel(msg, channel_before))
8702 goto nla_put_failure;
8703 nla_nest_end(msg, nl_freq);
8704
8705 /* After */
8706 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
8707 if (!nl_freq)
8708 goto nla_put_failure;
8709 if (nl80211_msg_put_channel(msg, channel_after))
8710 goto nla_put_failure;
8711 nla_nest_end(msg, nl_freq);
8712
3b7b72ee 8713 genlmsg_end(msg, hdr);
6bad8766 8714
463d0183
JB		 8715 rcu_read_lock();
8716 genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
8717 GFP_ATOMIC);
8718 rcu_read_unlock();
6bad8766
LR		 8719
8720 return;
8721
8722nla_put_failure:
8723 genlmsg_cancel(msg, hdr);
8724 nlmsg_free(msg);
8725}
8726
9588bbd5
JM		 8727static void nl80211_send_remain_on_chan_event(
8728 int cmd, struct cfg80211_registered_device *rdev,
71bbc994 8729 struct wireless_dev *wdev, u64 cookie,
9588bbd5 8730 struct ieee80211_channel *chan,
9588bbd5
JM		 8731 unsigned int duration, gfp_t gfp)
8732{
8733 struct sk_buff *msg;
8734 void *hdr;
8735
8736 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8737 if (!msg)
8738 return;
8739
8740 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
8741 if (!hdr) {
8742 nlmsg_free(msg);
8743 return;
8744 }
8745
9360ffd1 8746 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
71bbc994
JB		 8747 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
8748 wdev->netdev->ifindex)) ||
00f53350 8749 nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)) ||
9360ffd1 8750 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
42d97a59
JB		 8751 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
8752 NL80211_CHAN_NO_HT) ||
9360ffd1
DM		 8753 nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
8754 goto nla_put_failure;
9588bbd5 8755
9360ffd1
DM		 8756 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
8757 nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
8758 goto nla_put_failure;
9588bbd5 8759
3b7b72ee 8760 genlmsg_end(msg, hdr);
9588bbd5
JM		 8761
8762 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8763 nl80211_mlme_mcgrp.id, gfp);
8764 return;
8765
8766 nla_put_failure:
8767 genlmsg_cancel(msg, hdr);
8768 nlmsg_free(msg);
8769}
8770
8771void nl80211_send_remain_on_channel(struct cfg80211_registered_device *rdev,
71bbc994 8772 struct wireless_dev *wdev, u64 cookie,
9588bbd5 8773 struct ieee80211_channel *chan,
9588bbd5
JM		 8774 unsigned int duration, gfp_t gfp)
8775{
8776 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
71bbc994 8777 rdev, wdev, cookie, chan,
42d97a59 8778 duration, gfp);
9588bbd5
JM		 8779}
8780
8781void nl80211_send_remain_on_channel_cancel(
71bbc994
JB		 8782 struct cfg80211_registered_device *rdev,
8783 struct wireless_dev *wdev,
42d97a59 8784 u64 cookie, struct ieee80211_channel *chan, gfp_t gfp)
9588bbd5
JM		 8785{
8786 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
42d97a59 8787 rdev, wdev, cookie, chan, 0, gfp);
9588bbd5
JM		 8788}
8789
98b62183
JB		 8790void nl80211_send_sta_event(struct cfg80211_registered_device *rdev,
8791 struct net_device *dev, const u8 *mac_addr,
8792 struct station_info *sinfo, gfp_t gfp)
8793{
8794 struct sk_buff *msg;
8795
58050fce 8796 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
98b62183
JB		 8797 if (!msg)
8798 return;
8799
66266b3a
JL		 8800 if (nl80211_send_station(msg, 0, 0, 0,
8801 rdev, dev, mac_addr, sinfo) < 0) {
98b62183
JB		 8802 nlmsg_free(msg);
8803 return;
8804 }
8805
8806 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8807 nl80211_mlme_mcgrp.id, gfp);
8808}
8809
ec15e68b
JM		 8810void nl80211_send_sta_del_event(struct cfg80211_registered_device *rdev,
8811 struct net_device *dev, const u8 *mac_addr,
8812 gfp_t gfp)
8813{
8814 struct sk_buff *msg;
8815 void *hdr;
8816
58050fce 8817 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
ec15e68b
JM		 8818 if (!msg)
8819 return;
8820
8821 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_STATION);
8822 if (!hdr) {
8823 nlmsg_free(msg);
8824 return;
8825 }
8826
9360ffd1
DM		 8827 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
8828 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
8829 goto nla_put_failure;
ec15e68b 8830
3b7b72ee 8831 genlmsg_end(msg, hdr);
ec15e68b
JM		 8832
8833 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8834 nl80211_mlme_mcgrp.id, gfp);
8835 return;
8836
8837 nla_put_failure:
8838 genlmsg_cancel(msg, hdr);
8839 nlmsg_free(msg);
8840}
8841
ed44a951
PP		 8842void nl80211_send_conn_failed_event(struct cfg80211_registered_device *rdev,
8843 struct net_device *dev, const u8 *mac_addr,
8844 enum nl80211_connect_failed_reason reason,
8845 gfp_t gfp)
8846{
8847 struct sk_buff *msg;
8848 void *hdr;
8849
8850 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
8851 if (!msg)
8852 return;
8853
8854 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
8855 if (!hdr) {
8856 nlmsg_free(msg);
8857 return;
8858 }
8859
8860 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
8861 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
8862 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
8863 goto nla_put_failure;
8864
8865 genlmsg_end(msg, hdr);
8866
8867 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8868 nl80211_mlme_mcgrp.id, gfp);
8869 return;
8870
8871 nla_put_failure:
8872 genlmsg_cancel(msg, hdr);
8873 nlmsg_free(msg);
8874}
8875
b92ab5d8
JB		 8876static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
8877 const u8 *addr, gfp_t gfp)
28946da7
JB		 8878{
8879 struct wireless_dev *wdev = dev->ieee80211_ptr;
8880 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
8881 struct sk_buff *msg;
8882 void *hdr;
8883 int err;
15e47304 8884 u32 nlportid = ACCESS_ONCE(wdev->ap_unexpected_nlportid);
28946da7 8885
15e47304 8886 if (!nlportid)
28946da7
JB		 8887 return false;
8888
8889 msg = nlmsg_new(100, gfp);
8890 if (!msg)
8891 return true;
8892
b92ab5d8 8893 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
28946da7
JB		 8894 if (!hdr) {
8895 nlmsg_free(msg);
8896 return true;
8897 }
8898
9360ffd1
DM		 8899 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8900 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
8901 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
8902 goto nla_put_failure;
28946da7
JB		 8903
8904 err = genlmsg_end(msg, hdr);
8905 if (err < 0) {
8906 nlmsg_free(msg);
8907 return true;
8908 }
8909
15e47304 8910 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
28946da7
JB		 8911 return true;
8912
8913 nla_put_failure:
8914 genlmsg_cancel(msg, hdr);
8915 nlmsg_free(msg);
8916 return true;
8917}
8918
b92ab5d8
JB		 8919bool nl80211_unexpected_frame(struct net_device *dev, const u8 *addr, gfp_t gfp)
8920{
8921 return __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
8922 addr, gfp);
8923}
8924
8925bool nl80211_unexpected_4addr_frame(struct net_device *dev,
8926 const u8 *addr, gfp_t gfp)
8927{
8928 return __nl80211_unexpected_frame(dev,
8929 NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
8930 addr, gfp);
8931}
8932
2e161f78 8933int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
15e47304 8934 struct wireless_dev *wdev, u32 nlportid,
804483e9
JB		 8935 int freq, int sig_dbm,
8936 const u8 *buf, size_t len, gfp_t gfp)
026331c4 8937{
71bbc994 8938 struct net_device *netdev = wdev->netdev;
026331c4
JM		 8939 struct sk_buff *msg;
8940 void *hdr;
026331c4
JM		 8941
8942 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8943 if (!msg)
8944 return -ENOMEM;
8945
2e161f78 8946 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
026331c4
JM		 8947 if (!hdr) {
8948 nlmsg_free(msg);
8949 return -ENOMEM;
8950 }
8951
9360ffd1 8952 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
71bbc994
JB		 8953 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
8954 netdev->ifindex)) ||
9360ffd1
DM		 8955 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
8956 (sig_dbm &&
8957 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
8958 nla_put(msg, NL80211_ATTR_FRAME, len, buf))
8959 goto nla_put_failure;
026331c4 8960
3b7b72ee 8961 genlmsg_end(msg, hdr);
026331c4 8962
15e47304 8963 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
026331c4
JM		 8964
8965 nla_put_failure:
8966 genlmsg_cancel(msg, hdr);
8967 nlmsg_free(msg);
8968 return -ENOBUFS;
8969}
8970
2e161f78 8971void nl80211_send_mgmt_tx_status(struct cfg80211_registered_device *rdev,
71bbc994 8972 struct wireless_dev *wdev, u64 cookie,
2e161f78
JB		 8973 const u8 *buf, size_t len, bool ack,
8974 gfp_t gfp)
026331c4 8975{
71bbc994 8976 struct net_device *netdev = wdev->netdev;
026331c4
JM		 8977 struct sk_buff *msg;
8978 void *hdr;
8979
8980 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8981 if (!msg)
8982 return;
8983
2e161f78 8984 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
026331c4
JM		 8985 if (!hdr) {
8986 nlmsg_free(msg);
8987 return;
8988 }
8989
9360ffd1 8990 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
71bbc994
JB		 8991 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
8992 netdev->ifindex)) ||
9360ffd1
DM		 8993 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
8994 nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie) ||
8995 (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
8996 goto nla_put_failure;
026331c4 8997
3b7b72ee 8998 genlmsg_end(msg, hdr);
026331c4
JM		 8999
9000 genlmsg_multicast(msg, 0, nl80211_mlme_mcgrp.id, gfp);
9001 return;
9002
9003 nla_put_failure:
9004 genlmsg_cancel(msg, hdr);
9005 nlmsg_free(msg);
9006}
9007
d6dc1a38
JO		 9008void
9009nl80211_send_cqm_rssi_notify(struct cfg80211_registered_device *rdev,
9010 struct net_device *netdev,
9011 enum nl80211_cqm_rssi_threshold_event rssi_event,
9012 gfp_t gfp)
9013{
9014 struct sk_buff *msg;
9015 struct nlattr *pinfoattr;
9016 void *hdr;
9017
58050fce 9018 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
d6dc1a38
JO		 9019 if (!msg)
9020 return;
9021
9022 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
9023 if (!hdr) {
9024 nlmsg_free(msg);
9025 return;
9026 }
9027
9360ffd1
DM		 9028 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9029 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
9030 goto nla_put_failure;
d6dc1a38
JO		 9031
9032 pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
9033 if (!pinfoattr)
9034 goto nla_put_failure;
9035
9360ffd1
DM		 9036 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
9037 rssi_event))
9038 goto nla_put_failure;
d6dc1a38
JO		 9039
9040 nla_nest_end(msg, pinfoattr);
9041
3b7b72ee 9042 genlmsg_end(msg, hdr);
d6dc1a38
JO		 9043
9044 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9045 nl80211_mlme_mcgrp.id, gfp);
9046 return;
9047
9048 nla_put_failure:
9049 genlmsg_cancel(msg, hdr);
9050 nlmsg_free(msg);
9051}
9052
e5497d76
JB		 9053void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
9054 struct net_device *netdev, const u8 *bssid,
9055 const u8 *replay_ctr, gfp_t gfp)
9056{
9057 struct sk_buff *msg;
9058 struct nlattr *rekey_attr;
9059 void *hdr;
9060
58050fce 9061 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
e5497d76
JB		 9062 if (!msg)
9063 return;
9064
9065 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
9066 if (!hdr) {
9067 nlmsg_free(msg);
9068 return;
9069 }
9070
9360ffd1
DM		 9071 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9072 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
9073 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
9074 goto nla_put_failure;
e5497d76
JB		 9075
9076 rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
9077 if (!rekey_attr)
9078 goto nla_put_failure;
9079
9360ffd1
DM		 9080 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
9081 NL80211_REPLAY_CTR_LEN, replay_ctr))
9082 goto nla_put_failure;
e5497d76
JB		 9083
9084 nla_nest_end(msg, rekey_attr);
9085
3b7b72ee 9086 genlmsg_end(msg, hdr);
e5497d76
JB		 9087
9088 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9089 nl80211_mlme_mcgrp.id, gfp);
9090 return;
9091
9092 nla_put_failure:
9093 genlmsg_cancel(msg, hdr);
9094 nlmsg_free(msg);
9095}
9096
c9df56b4
JM		 9097void nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
9098 struct net_device *netdev, int index,
9099 const u8 *bssid, bool preauth, gfp_t gfp)
9100{
9101 struct sk_buff *msg;
9102 struct nlattr *attr;
9103 void *hdr;
9104
58050fce 9105 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
c9df56b4
JM		 9106 if (!msg)
9107 return;
9108
9109 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
9110 if (!hdr) {
9111 nlmsg_free(msg);
9112 return;
9113 }
9114
9360ffd1
DM		 9115 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9116 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
9117 goto nla_put_failure;
c9df56b4
JM		 9118
9119 attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
9120 if (!attr)
9121 goto nla_put_failure;
9122
9360ffd1
DM		 9123 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
9124 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
9125 (preauth &&
9126 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
9127 goto nla_put_failure;
c9df56b4
JM		 9128
9129 nla_nest_end(msg, attr);
9130
3b7b72ee 9131 genlmsg_end(msg, hdr);
c9df56b4
JM		 9132
9133 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9134 nl80211_mlme_mcgrp.id, gfp);
9135 return;
9136
9137 nla_put_failure:
9138 genlmsg_cancel(msg, hdr);
9139 nlmsg_free(msg);
9140}
9141
5314526b 9142void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
683b6d3b
JB		 9143 struct net_device *netdev,
9144 struct cfg80211_chan_def *chandef, gfp_t gfp)
5314526b
TP		 9145{
9146 struct sk_buff *msg;
9147 void *hdr;
9148
58050fce 9149 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
5314526b
TP		 9150 if (!msg)
9151 return;
9152
9153 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CH_SWITCH_NOTIFY);
9154 if (!hdr) {
9155 nlmsg_free(msg);
9156 return;
9157 }
9158
683b6d3b
JB		 9159 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
9160 goto nla_put_failure;
9161
9162 if (nl80211_send_chandef(msg, chandef))
7eab0f64 9163 goto nla_put_failure;
5314526b
TP		 9164
9165 genlmsg_end(msg, hdr);
9166
9167 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9168 nl80211_mlme_mcgrp.id, gfp);
9169 return;
9170
9171 nla_put_failure:
9172 genlmsg_cancel(msg, hdr);
9173 nlmsg_free(msg);
9174}
9175
84f10708
TP		 9176void
9177nl80211_send_cqm_txe_notify(struct cfg80211_registered_device *rdev,
9178 struct net_device *netdev, const u8 *peer,
9179 u32 num_packets, u32 rate, u32 intvl, gfp_t gfp)
9180{
9181 struct sk_buff *msg;
9182 struct nlattr *pinfoattr;
9183 void *hdr;
9184
9185 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
9186 if (!msg)
9187 return;
9188
9189 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
9190 if (!hdr) {
9191 nlmsg_free(msg);
9192 return;
9193 }
9194
9195 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9196 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
9197 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer))
9198 goto nla_put_failure;
9199
9200 pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
9201 if (!pinfoattr)
9202 goto nla_put_failure;
9203
9204 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
9205 goto nla_put_failure;
9206
9207 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
9208 goto nla_put_failure;
9209
9210 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
9211 goto nla_put_failure;
9212
9213 nla_nest_end(msg, pinfoattr);
9214
9215 genlmsg_end(msg, hdr);
9216
9217 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9218 nl80211_mlme_mcgrp.id, gfp);
9219 return;
9220
9221 nla_put_failure:
9222 genlmsg_cancel(msg, hdr);
9223 nlmsg_free(msg);
9224}
9225
c063dbf5
JB		 9226void
9227nl80211_send_cqm_pktloss_notify(struct cfg80211_registered_device *rdev,
9228 struct net_device *netdev, const u8 *peer,
9229 u32 num_packets, gfp_t gfp)
9230{
9231 struct sk_buff *msg;
9232 struct nlattr *pinfoattr;
9233 void *hdr;
9234
58050fce 9235 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
c063dbf5
JB		 9236 if (!msg)
9237 return;
9238
9239 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
9240 if (!hdr) {
9241 nlmsg_free(msg);
9242 return;
9243 }
9244
9360ffd1
DM		 9245 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9246 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
9247 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer))
9248 goto nla_put_failure;
c063dbf5
JB		 9249
9250 pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
9251 if (!pinfoattr)
9252 goto nla_put_failure;
9253
9360ffd1
DM		 9254 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
9255 goto nla_put_failure;
c063dbf5
JB		 9256
9257 nla_nest_end(msg, pinfoattr);
9258
3b7b72ee 9259 genlmsg_end(msg, hdr);
c063dbf5
JB		 9260
9261 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9262 nl80211_mlme_mcgrp.id, gfp);
9263 return;
9264
9265 nla_put_failure:
9266 genlmsg_cancel(msg, hdr);
9267 nlmsg_free(msg);
9268}
9269
7f6cf311
JB		 9270void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
9271 u64 cookie, bool acked, gfp_t gfp)
9272{
9273 struct wireless_dev *wdev = dev->ieee80211_ptr;
9274 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
9275 struct sk_buff *msg;
9276 void *hdr;
9277 int err;
9278
4ee3e063
BL		 9279 trace_cfg80211_probe_status(dev, addr, cookie, acked);
9280
58050fce 9281 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
4ee3e063 9282
7f6cf311
JB		 9283 if (!msg)
9284 return;
9285
9286 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
9287 if (!hdr) {
9288 nlmsg_free(msg);
9289 return;
9290 }
9291
9360ffd1
DM		 9292 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9293 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
9294 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
9295 nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie) ||
9296 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)))
9297 goto nla_put_failure;
7f6cf311
JB		 9298
9299 err = genlmsg_end(msg, hdr);
9300 if (err < 0) {
9301 nlmsg_free(msg);
9302 return;
9303 }
9304
9305 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9306 nl80211_mlme_mcgrp.id, gfp);
9307 return;
9308
9309 nla_put_failure:
9310 genlmsg_cancel(msg, hdr);
9311 nlmsg_free(msg);
9312}
9313EXPORT_SYMBOL(cfg80211_probe_status);
9314
5e760230
JB		 9315void cfg80211_report_obss_beacon(struct wiphy *wiphy,
9316 const u8 *frame, size_t len,
37c73b5f 9317 int freq, int sig_dbm)
5e760230
JB		 9318{
9319 struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
9320 struct sk_buff *msg;
9321 void *hdr;
37c73b5f 9322 struct cfg80211_beacon_registration *reg;
5e760230 9323
4ee3e063
BL		 9324 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
9325
37c73b5f
BG		 9326 spin_lock_bh(&rdev->beacon_registrations_lock);
9327 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
9328 msg = nlmsg_new(len + 100, GFP_ATOMIC);
9329 if (!msg) {
9330 spin_unlock_bh(&rdev->beacon_registrations_lock);
9331 return;
9332 }
5e760230 9333
37c73b5f
BG		 9334 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
9335 if (!hdr)
9336 goto nla_put_failure;
5e760230 9337
37c73b5f
BG		 9338 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9339 (freq &&
9340 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
9341 (sig_dbm &&
9342 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
9343 nla_put(msg, NL80211_ATTR_FRAME, len, frame))
9344 goto nla_put_failure;
5e760230 9345
37c73b5f 9346 genlmsg_end(msg, hdr);
5e760230 9347
37c73b5f
BG		 9348 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
9349 }
9350 spin_unlock_bh(&rdev->beacon_registrations_lock);
5e760230
JB		 9351 return;
9352
9353 nla_put_failure:
37c73b5f
BG		 9354 spin_unlock_bh(&rdev->beacon_registrations_lock);
9355 if (hdr)
9356 genlmsg_cancel(msg, hdr);
5e760230
JB		 9357 nlmsg_free(msg);
9358}
9359EXPORT_SYMBOL(cfg80211_report_obss_beacon);
9360
cd8f7cb4
JB		 9361#ifdef CONFIG_PM
9362void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
9363 struct cfg80211_wowlan_wakeup *wakeup,
9364 gfp_t gfp)
9365{
9366 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
9367 struct sk_buff *msg;
9368 void *hdr;
9369 int err, size = 200;
9370
9371 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
9372
9373 if (wakeup)
9374 size += wakeup->packet_present_len;
9375
9376 msg = nlmsg_new(size, gfp);
9377 if (!msg)
9378 return;
9379
9380 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
9381 if (!hdr)
9382 goto free_msg;
9383
9384 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9385 nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)))
9386 goto free_msg;
9387
9388 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
9389 wdev->netdev->ifindex))
9390 goto free_msg;
9391
9392 if (wakeup) {
9393 struct nlattr *reasons;
9394
9395 reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
9396
9397 if (wakeup->disconnect &&
9398 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
9399 goto free_msg;
9400 if (wakeup->magic_pkt &&
9401 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
9402 goto free_msg;
9403 if (wakeup->gtk_rekey_failure &&
9404 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
9405 goto free_msg;
9406 if (wakeup->eap_identity_req &&
9407 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
9408 goto free_msg;
9409 if (wakeup->four_way_handshake &&
9410 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
9411 goto free_msg;
9412 if (wakeup->rfkill_release &&
9413 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
9414 goto free_msg;
9415
9416 if (wakeup->pattern_idx >= 0 &&
9417 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
9418 wakeup->pattern_idx))
9419 goto free_msg;
9420
9421 if (wakeup->packet) {
9422 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
9423 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
9424
9425 if (!wakeup->packet_80211) {
9426 pkt_attr =
9427 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
9428 len_attr =
9429 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
9430 }
9431
9432 if (wakeup->packet_len &&
9433 nla_put_u32(msg, len_attr, wakeup->packet_len))
9434 goto free_msg;
9435
9436 if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
9437 wakeup->packet))
9438 goto free_msg;
9439 }
9440
9441 nla_nest_end(msg, reasons);
9442 }
9443
9444 err = genlmsg_end(msg, hdr);
9445 if (err < 0)
9446 goto free_msg;
9447
9448 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9449 nl80211_mlme_mcgrp.id, gfp);
9450 return;
9451
9452 free_msg:
9453 nlmsg_free(msg);
9454}
9455EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
9456#endif
9457
3475b094
JM		 9458void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
9459 enum nl80211_tdls_operation oper,
9460 u16 reason_code, gfp_t gfp)
9461{
9462 struct wireless_dev *wdev = dev->ieee80211_ptr;
9463 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
9464 struct sk_buff *msg;
9465 void *hdr;
9466 int err;
9467
9468 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
9469 reason_code);
9470
9471 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
9472 if (!msg)
9473 return;
9474
9475 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
9476 if (!hdr) {
9477 nlmsg_free(msg);
9478 return;
9479 }
9480
9481 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9482 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
9483 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
9484 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
9485 (reason_code > 0 &&
9486 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
9487 goto nla_put_failure;
9488
9489 err = genlmsg_end(msg, hdr);
9490 if (err < 0) {
9491 nlmsg_free(msg);
9492 return;
9493 }
9494
9495 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9496 nl80211_mlme_mcgrp.id, gfp);
9497 return;
9498
9499 nla_put_failure:
9500 genlmsg_cancel(msg, hdr);
9501 nlmsg_free(msg);
9502}
9503EXPORT_SYMBOL(cfg80211_tdls_oper_request);
9504
026331c4
JM		 9505static int nl80211_netlink_notify(struct notifier_block * nb,
9506 unsigned long state,
9507 void *_notify)
9508{
9509 struct netlink_notify *notify = _notify;
9510 struct cfg80211_registered_device *rdev;
9511 struct wireless_dev *wdev;
37c73b5f 9512 struct cfg80211_beacon_registration *reg, *tmp;
026331c4
JM		 9513
9514 if (state != NETLINK_URELEASE)
9515 return NOTIFY_DONE;
9516
9517 rcu_read_lock();
9518
5e760230 9519 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
89a54e48 9520 list_for_each_entry_rcu(wdev, &rdev->wdev_list, list)
15e47304 9521 cfg80211_mlme_unregister_socket(wdev, notify->portid);
37c73b5f
BG		 9522
9523 spin_lock_bh(&rdev->beacon_registrations_lock);
9524 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
9525 list) {
9526 if (reg->nlportid == notify->portid) {
9527 list_del(&reg->list);
9528 kfree(reg);
9529 break;
9530 }
9531 }
9532 spin_unlock_bh(&rdev->beacon_registrations_lock);
5e760230 9533 }
026331c4
JM		 9534
9535 rcu_read_unlock();
9536
9537 return NOTIFY_DONE;
9538}
9539
9540static struct notifier_block nl80211_netlink_notifier = {
9541 .notifier_call = nl80211_netlink_notify,
9542};
9543
55682965
JB		 9544/* initialisation/exit functions */
9545
9546int nl80211_init(void)
9547{
0d63cbb5 9548 int err;
55682965 9549
0d63cbb5
MM		 9550 err = genl_register_family_with_ops(&nl80211_fam,
9551 nl80211_ops, ARRAY_SIZE(nl80211_ops));
55682965
JB		 9552 if (err)
9553 return err;
9554
55682965
JB		 9555 err = genl_register_mc_group(&nl80211_fam, &nl80211_config_mcgrp);
9556 if (err)
9557 goto err_out;
9558
2a519311
JB		 9559 err = genl_register_mc_group(&nl80211_fam, &nl80211_scan_mcgrp);
9560 if (err)
9561 goto err_out;
9562
73d54c9e
LR		 9563 err = genl_register_mc_group(&nl80211_fam, &nl80211_regulatory_mcgrp);
9564 if (err)
9565 goto err_out;
9566
6039f6d2
JM		 9567 err = genl_register_mc_group(&nl80211_fam, &nl80211_mlme_mcgrp);
9568 if (err)
9569 goto err_out;
9570
aff89a9b
JB		 9571#ifdef CONFIG_NL80211_TESTMODE
9572 err = genl_register_mc_group(&nl80211_fam, &nl80211_testmode_mcgrp);
9573 if (err)
9574 goto err_out;
9575#endif
9576
026331c4
JM		 9577 err = netlink_register_notifier(&nl80211_netlink_notifier);
9578 if (err)
9579 goto err_out;
9580
55682965
JB		 9581 return 0;
9582 err_out:
9583 genl_unregister_family(&nl80211_fam);
9584 return err;
9585}
9586
9587void nl80211_exit(void)
9588{
026331c4 9589 netlink_unregister_notifier(&nl80211_netlink_notifier);
55682965
JB		 9590 genl_unregister_family(&nl80211_fam);
9591}
Linux 6.x block layer and io_uring tree(s)