2 * This is the new netlink-based wireless configuration interface.
4 * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net>
8 #include <linux/module.h>
10 #include <linux/slab.h>
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>
17 #include <linux/etherdevice.h>
18 #include <net/net_namespace.h>
19 #include <net/genetlink.h>
20 #include <net/cfg80211.h>
27 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
28 struct genl_info *info,
29 struct cfg80211_crypto_settings *settings,
32 static int nl80211_pre_doit(struct genl_ops *ops, struct sk_buff *skb,
33 struct genl_info *info);
34 static void nl80211_post_doit(struct genl_ops *ops, struct sk_buff *skb,
35 struct genl_info *info);
37 /* the netlink family */
38 static 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,
45 .pre_doit = nl80211_pre_doit,
46 .post_doit = nl80211_post_doit,
49 /* returns ERR_PTR values */
50 static struct wireless_dev *
51 __cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
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];
61 assert_cfg80211_lock();
63 if (!have_ifidx && !have_wdev_id)
64 return ERR_PTR(-EINVAL);
67 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
69 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
70 wiphy_idx = wdev_id >> 32;
73 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
74 struct wireless_dev *wdev;
76 if (wiphy_net(&rdev->wiphy) != netns)
79 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
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) {
89 if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
94 mutex_unlock(&rdev->devlist_mtx);
102 return ERR_PTR(-ENODEV);
105 static struct cfg80211_registered_device *
106 __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
108 struct cfg80211_registered_device *rdev = NULL, *tmp;
109 struct net_device *netdev;
111 assert_cfg80211_lock();
113 if (!attrs[NL80211_ATTR_WIPHY] &&
114 !attrs[NL80211_ATTR_IFINDEX] &&
115 !attrs[NL80211_ATTR_WDEV])
116 return ERR_PTR(-EINVAL);
118 if (attrs[NL80211_ATTR_WIPHY])
119 rdev = cfg80211_rdev_by_wiphy_idx(
120 nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
122 if (attrs[NL80211_ATTR_WDEV]) {
123 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
124 struct wireless_dev *wdev;
127 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
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)
137 mutex_unlock(&tmp->devlist_mtx);
142 if (rdev && tmp != rdev)
143 return ERR_PTR(-EINVAL);
148 if (attrs[NL80211_ATTR_IFINDEX]) {
149 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
150 netdev = dev_get_by_index(netns, ifindex);
152 if (netdev->ieee80211_ptr)
154 netdev->ieee80211_ptr->wiphy);
160 /* not wireless device -- return error */
162 return ERR_PTR(-EINVAL);
164 /* mismatch -- return error */
165 if (rdev && tmp != rdev)
166 return ERR_PTR(-EINVAL);
173 return ERR_PTR(-ENODEV);
175 if (netns != wiphy_net(&rdev->wiphy))
176 return ERR_PTR(-ENODEV);
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!
187 * This means that you need to call cfg80211_unlock_rdev()
188 * before being allowed to acquire &cfg80211_mutex!
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.
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.
198 * The result of this can be a PTR_ERR and hence must
199 * be checked with IS_ERR() for errors.
201 static struct cfg80211_registered_device *
202 cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
204 struct cfg80211_registered_device *rdev;
206 mutex_lock(&cfg80211_mutex);
207 rdev = __cfg80211_rdev_from_attrs(netns, info->attrs);
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 */
213 mutex_lock(&rdev->mtx);
215 mutex_unlock(&cfg80211_mutex);
220 /* policy for the attributes */
221 static const struct nla_policy nl80211_policy[NL80211_ATTR_MAX+1] = {
222 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
223 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
225 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
227 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
228 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
229 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
230 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
231 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
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 },
237 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
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 },
243 [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
244 [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
246 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
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 },
252 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
253 [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
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 },
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 },
266 [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
267 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
268 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
269 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
270 .len = IEEE80211_MAX_MESH_ID_LEN },
271 [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
273 [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
274 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
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 },
279 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
280 .len = NL80211_MAX_SUPP_RATES },
281 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
283 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
284 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
286 [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
288 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
289 [NL80211_ATTR_IE] = { .type = NLA_BINARY,
290 .len = IEEE80211_MAX_DATA_LEN },
291 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
292 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
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 },
298 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
299 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
300 [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
301 [NL80211_ATTR_STA_FLAGS2] = {
302 .len = sizeof(struct nl80211_sta_flag_update),
304 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
305 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
306 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
307 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
308 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
309 [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
310 [NL80211_ATTR_PID] = { .type = NLA_U32 },
311 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
312 [NL80211_ATTR_PMKID] = { .type = NLA_BINARY,
313 .len = WLAN_PMKID_LEN },
314 [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
315 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
316 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
317 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
318 .len = IEEE80211_MAX_DATA_LEN },
319 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
320 [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
321 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
322 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
323 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
324 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
325 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
326 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
327 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
328 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
329 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
330 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
331 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
332 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
333 [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
334 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
335 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
336 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
337 [NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
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 },
342 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
343 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
344 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
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 },
350 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
351 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
352 .len = IEEE80211_MAX_DATA_LEN },
353 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
354 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
355 [NL80211_ATTR_HT_CAPABILITY_MASK] = {
356 .len = NL80211_HT_CAPABILITY_LEN
358 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
359 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
360 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
361 [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
362 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
363 [NL80211_ATTR_SAE_DATA] = { .type = NLA_BINARY, },
364 [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
365 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
366 [NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
367 [NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
370 /* policy for the key attributes */
371 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
372 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
373 [NL80211_KEY_IDX] = { .type = NLA_U8 },
374 [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
375 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
376 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
377 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
378 [NL80211_KEY_TYPE] = { .type = NLA_U32 },
379 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
382 /* policy for the key default flags */
383 static const struct nla_policy
384 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
385 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
386 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
389 /* policy for WoWLAN attributes */
390 static const struct nla_policy
391 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
392 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
393 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
394 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
395 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
396 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
397 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
398 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
399 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
402 /* policy for GTK rekey offload attributes */
403 static const struct nla_policy
404 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
405 [NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
406 [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
407 [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
410 static const struct nla_policy
411 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
412 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
413 .len = IEEE80211_MAX_SSID_LEN },
414 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
417 /* ifidx get helper */
418 static int nl80211_get_ifidx(struct netlink_callback *cb)
422 res = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
423 nl80211_fam.attrbuf, nl80211_fam.maxattr,
428 if (!nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX])
431 res = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX]);
437 static int nl80211_prepare_netdev_dump(struct sk_buff *skb,
438 struct netlink_callback *cb,
439 struct cfg80211_registered_device **rdev,
440 struct net_device **dev)
442 int ifidx = cb->args[0];
446 ifidx = nl80211_get_ifidx(cb);
454 *dev = __dev_get_by_index(sock_net(skb->sk), ifidx);
460 *rdev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
462 err = PTR_ERR(*rdev);
472 static void nl80211_finish_netdev_dump(struct cfg80211_registered_device *rdev)
474 cfg80211_unlock_rdev(rdev);
479 static bool is_valid_ie_attr(const struct nlattr *attr)
487 pos = nla_data(attr);
508 /* message building helper */
509 static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
512 /* since there is no private header just add the generic one */
513 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
516 static int nl80211_msg_put_channel(struct sk_buff *msg,
517 struct ieee80211_channel *chan)
519 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
521 goto nla_put_failure;
523 if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
524 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
525 goto nla_put_failure;
526 if ((chan->flags & IEEE80211_CHAN_PASSIVE_SCAN) &&
527 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_PASSIVE_SCAN))
528 goto nla_put_failure;
529 if ((chan->flags & IEEE80211_CHAN_NO_IBSS) &&
530 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IBSS))
531 goto nla_put_failure;
532 if ((chan->flags & IEEE80211_CHAN_RADAR) &&
533 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
534 goto nla_put_failure;
536 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
537 DBM_TO_MBM(chan->max_power)))
538 goto nla_put_failure;
546 /* netlink command implementations */
553 bool def_uni, def_multi;
556 static int nl80211_parse_key_new(struct nlattr *key, struct key_parse *k)
558 struct nlattr *tb[NL80211_KEY_MAX + 1];
559 int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
564 k->def = !!tb[NL80211_KEY_DEFAULT];
565 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
574 if (tb[NL80211_KEY_IDX])
575 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
577 if (tb[NL80211_KEY_DATA]) {
578 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
579 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
582 if (tb[NL80211_KEY_SEQ]) {
583 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
584 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
587 if (tb[NL80211_KEY_CIPHER])
588 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
590 if (tb[NL80211_KEY_TYPE]) {
591 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
592 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
596 if (tb[NL80211_KEY_DEFAULT_TYPES]) {
597 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
598 err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
599 tb[NL80211_KEY_DEFAULT_TYPES],
600 nl80211_key_default_policy);
604 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
605 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
611 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
613 if (info->attrs[NL80211_ATTR_KEY_DATA]) {
614 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
615 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
618 if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
619 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
620 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
623 if (info->attrs[NL80211_ATTR_KEY_IDX])
624 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
626 if (info->attrs[NL80211_ATTR_KEY_CIPHER])
627 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
629 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
630 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
639 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
640 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
641 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
645 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
646 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
647 int err = nla_parse_nested(
648 kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
649 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
650 nl80211_key_default_policy);
654 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
655 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
661 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
665 memset(k, 0, sizeof(*k));
669 if (info->attrs[NL80211_ATTR_KEY])
670 err = nl80211_parse_key_new(info->attrs[NL80211_ATTR_KEY], k);
672 err = nl80211_parse_key_old(info, k);
677 if (k->def && k->defmgmt)
681 if (k->def_uni || !k->def_multi)
687 if (k->idx < 4 || k->idx > 5)
690 if (k->idx < 0 || k->idx > 3)
693 if (k->idx < 0 || k->idx > 5)
701 static struct cfg80211_cached_keys *
702 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
703 struct nlattr *keys, bool *no_ht)
705 struct key_parse parse;
707 struct cfg80211_cached_keys *result;
708 int rem, err, def = 0;
710 result = kzalloc(sizeof(*result), GFP_KERNEL);
712 return ERR_PTR(-ENOMEM);
715 result->defmgmt = -1;
717 nla_for_each_nested(key, keys, rem) {
718 memset(&parse, 0, sizeof(parse));
721 err = nl80211_parse_key_new(key, &parse);
727 if (parse.idx < 0 || parse.idx > 4)
733 result->def = parse.idx;
734 if (!parse.def_uni || !parse.def_multi)
736 } else if (parse.defmgmt)
738 err = cfg80211_validate_key_settings(rdev, &parse.p,
739 parse.idx, false, NULL);
742 result->params[parse.idx].cipher = parse.p.cipher;
743 result->params[parse.idx].key_len = parse.p.key_len;
744 result->params[parse.idx].key = result->data[parse.idx];
745 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
747 if (parse.p.cipher == WLAN_CIPHER_SUITE_WEP40 ||
748 parse.p.cipher == WLAN_CIPHER_SUITE_WEP104) {
760 static int nl80211_key_allowed(struct wireless_dev *wdev)
762 ASSERT_WDEV_LOCK(wdev);
764 switch (wdev->iftype) {
765 case NL80211_IFTYPE_AP:
766 case NL80211_IFTYPE_AP_VLAN:
767 case NL80211_IFTYPE_P2P_GO:
768 case NL80211_IFTYPE_MESH_POINT:
770 case NL80211_IFTYPE_ADHOC:
771 if (!wdev->current_bss)
774 case NL80211_IFTYPE_STATION:
775 case NL80211_IFTYPE_P2P_CLIENT:
776 if (wdev->sme_state != CFG80211_SME_CONNECTED)
786 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
788 struct nlattr *nl_modes = nla_nest_start(msg, attr);
792 goto nla_put_failure;
796 if ((ifmodes & 1) && nla_put_flag(msg, i))
797 goto nla_put_failure;
802 nla_nest_end(msg, nl_modes);
809 static int nl80211_put_iface_combinations(struct wiphy *wiphy,
812 struct nlattr *nl_combis;
815 nl_combis = nla_nest_start(msg,
816 NL80211_ATTR_INTERFACE_COMBINATIONS);
818 goto nla_put_failure;
820 for (i = 0; i < wiphy->n_iface_combinations; i++) {
821 const struct ieee80211_iface_combination *c;
822 struct nlattr *nl_combi, *nl_limits;
824 c = &wiphy->iface_combinations[i];
826 nl_combi = nla_nest_start(msg, i + 1);
828 goto nla_put_failure;
830 nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
832 goto nla_put_failure;
834 for (j = 0; j < c->n_limits; j++) {
835 struct nlattr *nl_limit;
837 nl_limit = nla_nest_start(msg, j + 1);
839 goto nla_put_failure;
840 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
842 goto nla_put_failure;
843 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
845 goto nla_put_failure;
846 nla_nest_end(msg, nl_limit);
849 nla_nest_end(msg, nl_limits);
851 if (c->beacon_int_infra_match &&
852 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
853 goto nla_put_failure;
854 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
855 c->num_different_channels) ||
856 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
858 goto nla_put_failure;
860 nla_nest_end(msg, nl_combi);
863 nla_nest_end(msg, nl_combis);
870 static int nl80211_send_wiphy(struct sk_buff *msg, u32 portid, u32 seq, int flags,
871 struct cfg80211_registered_device *dev)
874 struct nlattr *nl_bands, *nl_band;
875 struct nlattr *nl_freqs, *nl_freq;
876 struct nlattr *nl_rates, *nl_rate;
877 struct nlattr *nl_cmds;
878 enum ieee80211_band band;
879 struct ieee80211_channel *chan;
880 struct ieee80211_rate *rate;
882 const struct ieee80211_txrx_stypes *mgmt_stypes =
883 dev->wiphy.mgmt_stypes;
885 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_WIPHY);
889 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, dev->wiphy_idx) ||
890 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME, wiphy_name(&dev->wiphy)) ||
891 nla_put_u32(msg, NL80211_ATTR_GENERATION,
892 cfg80211_rdev_list_generation) ||
893 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
894 dev->wiphy.retry_short) ||
895 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
896 dev->wiphy.retry_long) ||
897 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
898 dev->wiphy.frag_threshold) ||
899 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
900 dev->wiphy.rts_threshold) ||
901 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
902 dev->wiphy.coverage_class) ||
903 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
904 dev->wiphy.max_scan_ssids) ||
905 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
906 dev->wiphy.max_sched_scan_ssids) ||
907 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
908 dev->wiphy.max_scan_ie_len) ||
909 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
910 dev->wiphy.max_sched_scan_ie_len) ||
911 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
912 dev->wiphy.max_match_sets))
913 goto nla_put_failure;
915 if ((dev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
916 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
917 goto nla_put_failure;
918 if ((dev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
919 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
920 goto nla_put_failure;
921 if ((dev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
922 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
923 goto nla_put_failure;
924 if ((dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
925 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
926 goto nla_put_failure;
927 if ((dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
928 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
929 goto nla_put_failure;
930 if ((dev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
931 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
932 goto nla_put_failure;
934 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
935 sizeof(u32) * dev->wiphy.n_cipher_suites,
936 dev->wiphy.cipher_suites))
937 goto nla_put_failure;
939 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
940 dev->wiphy.max_num_pmkids))
941 goto nla_put_failure;
943 if ((dev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
944 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
945 goto nla_put_failure;
947 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
948 dev->wiphy.available_antennas_tx) ||
949 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
950 dev->wiphy.available_antennas_rx))
951 goto nla_put_failure;
953 if ((dev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
954 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
955 dev->wiphy.probe_resp_offload))
956 goto nla_put_failure;
958 if ((dev->wiphy.available_antennas_tx ||
959 dev->wiphy.available_antennas_rx) && dev->ops->get_antenna) {
960 u32 tx_ant = 0, rx_ant = 0;
962 res = rdev_get_antenna(dev, &tx_ant, &rx_ant);
964 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_TX,
966 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_RX,
968 goto nla_put_failure;
972 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
973 dev->wiphy.interface_modes))
974 goto nla_put_failure;
976 nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
978 goto nla_put_failure;
980 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
981 if (!dev->wiphy.bands[band])
984 nl_band = nla_nest_start(msg, band);
986 goto nla_put_failure;
989 if (dev->wiphy.bands[band]->ht_cap.ht_supported &&
990 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
991 sizeof(dev->wiphy.bands[band]->ht_cap.mcs),
992 &dev->wiphy.bands[band]->ht_cap.mcs) ||
993 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
994 dev->wiphy.bands[band]->ht_cap.cap) ||
995 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
996 dev->wiphy.bands[band]->ht_cap.ampdu_factor) ||
997 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
998 dev->wiphy.bands[band]->ht_cap.ampdu_density)))
999 goto nla_put_failure;
1002 if (dev->wiphy.bands[band]->vht_cap.vht_supported &&
1003 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1004 sizeof(dev->wiphy.bands[band]->vht_cap.vht_mcs),
1005 &dev->wiphy.bands[band]->vht_cap.vht_mcs) ||
1006 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1007 dev->wiphy.bands[band]->vht_cap.cap)))
1008 goto nla_put_failure;
1010 /* add frequencies */
1011 nl_freqs = nla_nest_start(msg, NL80211_BAND_ATTR_FREQS);
1013 goto nla_put_failure;
1015 for (i = 0; i < dev->wiphy.bands[band]->n_channels; i++) {
1016 nl_freq = nla_nest_start(msg, i);
1018 goto nla_put_failure;
1020 chan = &dev->wiphy.bands[band]->channels[i];
1022 if (nl80211_msg_put_channel(msg, chan))
1023 goto nla_put_failure;
1025 nla_nest_end(msg, nl_freq);
1028 nla_nest_end(msg, nl_freqs);
1031 nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
1033 goto nla_put_failure;
1035 for (i = 0; i < dev->wiphy.bands[band]->n_bitrates; i++) {
1036 nl_rate = nla_nest_start(msg, i);
1038 goto nla_put_failure;
1040 rate = &dev->wiphy.bands[band]->bitrates[i];
1041 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1043 goto nla_put_failure;
1044 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1046 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1047 goto nla_put_failure;
1049 nla_nest_end(msg, nl_rate);
1052 nla_nest_end(msg, nl_rates);
1054 nla_nest_end(msg, nl_band);
1056 nla_nest_end(msg, nl_bands);
1058 nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
1060 goto nla_put_failure;
1063 #define CMD(op, n) \
1065 if (dev->ops->op) { \
1067 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
1068 goto nla_put_failure; \
1072 CMD(add_virtual_intf, NEW_INTERFACE);
1073 CMD(change_virtual_intf, SET_INTERFACE);
1074 CMD(add_key, NEW_KEY);
1075 CMD(start_ap, START_AP);
1076 CMD(add_station, NEW_STATION);
1077 CMD(add_mpath, NEW_MPATH);
1078 CMD(update_mesh_config, SET_MESH_CONFIG);
1079 CMD(change_bss, SET_BSS);
1080 CMD(auth, AUTHENTICATE);
1081 CMD(assoc, ASSOCIATE);
1082 CMD(deauth, DEAUTHENTICATE);
1083 CMD(disassoc, DISASSOCIATE);
1084 CMD(join_ibss, JOIN_IBSS);
1085 CMD(join_mesh, JOIN_MESH);
1086 CMD(set_pmksa, SET_PMKSA);
1087 CMD(del_pmksa, DEL_PMKSA);
1088 CMD(flush_pmksa, FLUSH_PMKSA);
1089 if (dev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
1090 CMD(remain_on_channel, REMAIN_ON_CHANNEL);
1091 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
1092 CMD(mgmt_tx, FRAME);
1093 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
1094 if (dev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
1096 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
1097 goto nla_put_failure;
1099 if (dev->ops->set_monitor_channel || dev->ops->start_ap ||
1100 dev->ops->join_mesh) {
1102 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1103 goto nla_put_failure;
1105 CMD(set_wds_peer, SET_WDS_PEER);
1106 if (dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
1107 CMD(tdls_mgmt, TDLS_MGMT);
1108 CMD(tdls_oper, TDLS_OPER);
1110 if (dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN)
1111 CMD(sched_scan_start, START_SCHED_SCAN);
1112 CMD(probe_client, PROBE_CLIENT);
1113 CMD(set_noack_map, SET_NOACK_MAP);
1114 if (dev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
1116 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1117 goto nla_put_failure;
1119 CMD(start_p2p_device, START_P2P_DEVICE);
1120 CMD(set_mcast_rate, SET_MCAST_RATE);
1122 #ifdef CONFIG_NL80211_TESTMODE
1123 CMD(testmode_cmd, TESTMODE);
1128 if (dev->ops->connect || dev->ops->auth) {
1130 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
1131 goto nla_put_failure;
1134 if (dev->ops->disconnect || dev->ops->deauth) {
1136 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1137 goto nla_put_failure;
1140 nla_nest_end(msg, nl_cmds);
1142 if (dev->ops->remain_on_channel &&
1143 (dev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
1144 nla_put_u32(msg, NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
1145 dev->wiphy.max_remain_on_channel_duration))
1146 goto nla_put_failure;
1148 if ((dev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
1149 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
1150 goto nla_put_failure;
1154 struct nlattr *nl_ftypes, *nl_ifs;
1155 enum nl80211_iftype ift;
1157 nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
1159 goto nla_put_failure;
1161 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1162 nl_ftypes = nla_nest_start(msg, ift);
1164 goto nla_put_failure;
1166 stypes = mgmt_stypes[ift].tx;
1169 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1170 (i << 4) | IEEE80211_FTYPE_MGMT))
1171 goto nla_put_failure;
1175 nla_nest_end(msg, nl_ftypes);
1178 nla_nest_end(msg, nl_ifs);
1180 nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
1182 goto nla_put_failure;
1184 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1185 nl_ftypes = nla_nest_start(msg, ift);
1187 goto nla_put_failure;
1189 stypes = mgmt_stypes[ift].rx;
1192 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1193 (i << 4) | IEEE80211_FTYPE_MGMT))
1194 goto nla_put_failure;
1198 nla_nest_end(msg, nl_ftypes);
1200 nla_nest_end(msg, nl_ifs);
1204 if (dev->wiphy.wowlan.flags || dev->wiphy.wowlan.n_patterns) {
1205 struct nlattr *nl_wowlan;
1207 nl_wowlan = nla_nest_start(msg,
1208 NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1210 goto nla_put_failure;
1212 if (((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_ANY) &&
1213 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1214 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_DISCONNECT) &&
1215 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1216 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_MAGIC_PKT) &&
1217 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1218 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
1219 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1220 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
1221 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1222 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
1223 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1224 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
1225 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1226 ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
1227 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1228 goto nla_put_failure;
1229 if (dev->wiphy.wowlan.n_patterns) {
1230 struct nl80211_wowlan_pattern_support pat = {
1231 .max_patterns = dev->wiphy.wowlan.n_patterns,
1233 dev->wiphy.wowlan.pattern_min_len,
1235 dev->wiphy.wowlan.pattern_max_len,
1237 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1239 goto nla_put_failure;
1242 nla_nest_end(msg, nl_wowlan);
1246 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
1247 dev->wiphy.software_iftypes))
1248 goto nla_put_failure;
1250 if (nl80211_put_iface_combinations(&dev->wiphy, msg))
1251 goto nla_put_failure;
1253 if ((dev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
1254 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
1255 dev->wiphy.ap_sme_capa))
1256 goto nla_put_failure;
1258 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS,
1259 dev->wiphy.features))
1260 goto nla_put_failure;
1262 if (dev->wiphy.ht_capa_mod_mask &&
1263 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
1264 sizeof(*dev->wiphy.ht_capa_mod_mask),
1265 dev->wiphy.ht_capa_mod_mask))
1266 goto nla_put_failure;
1268 return genlmsg_end(msg, hdr);
1271 genlmsg_cancel(msg, hdr);
1275 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
1278 int start = cb->args[0];
1279 struct cfg80211_registered_device *dev;
1281 mutex_lock(&cfg80211_mutex);
1282 list_for_each_entry(dev, &cfg80211_rdev_list, list) {
1283 if (!net_eq(wiphy_net(&dev->wiphy), sock_net(skb->sk)))
1287 if (nl80211_send_wiphy(skb, NETLINK_CB(cb->skb).portid,
1288 cb->nlh->nlmsg_seq, NLM_F_MULTI,
1294 mutex_unlock(&cfg80211_mutex);
1301 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
1303 struct sk_buff *msg;
1304 struct cfg80211_registered_device *dev = info->user_ptr[0];
1306 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1310 if (nl80211_send_wiphy(msg, info->snd_portid, info->snd_seq, 0, dev) < 0) {
1315 return genlmsg_reply(msg, info);
1318 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
1319 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
1320 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
1321 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
1322 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
1323 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
1326 static int parse_txq_params(struct nlattr *tb[],
1327 struct ieee80211_txq_params *txq_params)
1329 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
1330 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
1331 !tb[NL80211_TXQ_ATTR_AIFS])
1334 txq_params->ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
1335 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
1336 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
1337 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
1338 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
1340 if (txq_params->ac >= NL80211_NUM_ACS)
1346 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
1349 * You can only set the channel explicitly for WDS interfaces,
1350 * all others have their channel managed via their respective
1351 * "establish a connection" command (connect, join, ...)
1353 * For AP/GO and mesh mode, the channel can be set with the
1354 * channel userspace API, but is only stored and passed to the
1355 * low-level driver when the AP starts or the mesh is joined.
1356 * This is for backward compatibility, userspace can also give
1357 * the channel in the start-ap or join-mesh commands instead.
1359 * Monitors are special as they are normally slaved to
1360 * whatever else is going on, so they have their own special
1361 * operation to set the monitor channel if possible.
1364 wdev->iftype == NL80211_IFTYPE_AP ||
1365 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
1366 wdev->iftype == NL80211_IFTYPE_MONITOR ||
1367 wdev->iftype == NL80211_IFTYPE_P2P_GO;
1370 static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
1371 struct genl_info *info,
1372 struct cfg80211_chan_def *chandef)
1374 struct ieee80211_sta_ht_cap *ht_cap;
1375 struct ieee80211_sta_vht_cap *vht_cap;
1376 u32 control_freq, width;
1378 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
1381 control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
1383 chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
1384 chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
1385 chandef->center_freq1 = control_freq;
1386 chandef->center_freq2 = 0;
1388 /* Primary channel not allowed */
1389 if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
1392 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
1393 enum nl80211_channel_type chantype;
1395 chantype = nla_get_u32(
1396 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
1399 case NL80211_CHAN_NO_HT:
1400 case NL80211_CHAN_HT20:
1401 case NL80211_CHAN_HT40PLUS:
1402 case NL80211_CHAN_HT40MINUS:
1403 cfg80211_chandef_create(chandef, chandef->chan,
1409 } else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
1411 nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
1412 if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
1413 chandef->center_freq1 =
1415 info->attrs[NL80211_ATTR_CENTER_FREQ1]);
1416 if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
1417 chandef->center_freq2 =
1419 info->attrs[NL80211_ATTR_CENTER_FREQ2]);
1422 ht_cap = &rdev->wiphy.bands[chandef->chan->band]->ht_cap;
1423 vht_cap = &rdev->wiphy.bands[chandef->chan->band]->vht_cap;
1425 if (!cfg80211_chandef_valid(chandef))
1428 switch (chandef->width) {
1429 case NL80211_CHAN_WIDTH_20:
1430 case NL80211_CHAN_WIDTH_20_NOHT:
1433 case NL80211_CHAN_WIDTH_40:
1436 case NL80211_CHAN_WIDTH_80:
1439 case NL80211_CHAN_WIDTH_80P80:
1442 case NL80211_CHAN_WIDTH_160:
1449 if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
1450 IEEE80211_CHAN_DISABLED))
1456 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
1457 struct wireless_dev *wdev,
1458 struct genl_info *info)
1460 struct cfg80211_chan_def chandef;
1462 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
1465 iftype = wdev->iftype;
1467 if (!nl80211_can_set_dev_channel(wdev))
1470 result = nl80211_parse_chandef(rdev, info, &chandef);
1474 mutex_lock(&rdev->devlist_mtx);
1476 case NL80211_IFTYPE_AP:
1477 case NL80211_IFTYPE_P2P_GO:
1478 if (wdev->beacon_interval) {
1482 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &chandef)) {
1486 wdev->preset_chandef = chandef;
1489 case NL80211_IFTYPE_MESH_POINT:
1490 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
1492 case NL80211_IFTYPE_MONITOR:
1493 result = cfg80211_set_monitor_channel(rdev, &chandef);
1498 mutex_unlock(&rdev->devlist_mtx);
1503 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
1505 struct cfg80211_registered_device *rdev = info->user_ptr[0];
1506 struct net_device *netdev = info->user_ptr[1];
1508 return __nl80211_set_channel(rdev, netdev->ieee80211_ptr, info);
1511 static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
1513 struct cfg80211_registered_device *rdev = info->user_ptr[0];
1514 struct net_device *dev = info->user_ptr[1];
1515 struct wireless_dev *wdev = dev->ieee80211_ptr;
1518 if (!info->attrs[NL80211_ATTR_MAC])
1521 if (netif_running(dev))
1524 if (!rdev->ops->set_wds_peer)
1527 if (wdev->iftype != NL80211_IFTYPE_WDS)
1530 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
1531 return rdev_set_wds_peer(rdev, dev, bssid);
1535 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
1537 struct cfg80211_registered_device *rdev;
1538 struct net_device *netdev = NULL;
1539 struct wireless_dev *wdev;
1540 int result = 0, rem_txq_params = 0;
1541 struct nlattr *nl_txq_params;
1543 u8 retry_short = 0, retry_long = 0;
1544 u32 frag_threshold = 0, rts_threshold = 0;
1545 u8 coverage_class = 0;
1548 * Try to find the wiphy and netdev. Normally this
1549 * function shouldn't need the netdev, but this is
1550 * done for backward compatibility -- previously
1551 * setting the channel was done per wiphy, but now
1552 * it is per netdev. Previous userland like hostapd
1553 * also passed a netdev to set_wiphy, so that it is
1554 * possible to let that go to the right netdev!
1556 mutex_lock(&cfg80211_mutex);
1558 if (info->attrs[NL80211_ATTR_IFINDEX]) {
1559 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
1561 netdev = dev_get_by_index(genl_info_net(info), ifindex);
1562 if (netdev && netdev->ieee80211_ptr) {
1563 rdev = wiphy_to_dev(netdev->ieee80211_ptr->wiphy);
1564 mutex_lock(&rdev->mtx);
1570 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
1573 mutex_unlock(&cfg80211_mutex);
1574 return PTR_ERR(rdev);
1580 mutex_lock(&rdev->mtx);
1582 wdev = netdev->ieee80211_ptr;
1585 * end workaround code, by now the rdev is available
1586 * and locked, and wdev may or may not be NULL.
1589 if (info->attrs[NL80211_ATTR_WIPHY_NAME])
1590 result = cfg80211_dev_rename(
1591 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
1593 mutex_unlock(&cfg80211_mutex);
1598 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
1599 struct ieee80211_txq_params txq_params;
1600 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
1602 if (!rdev->ops->set_txq_params) {
1603 result = -EOPNOTSUPP;
1612 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
1613 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
1618 if (!netif_running(netdev)) {
1623 nla_for_each_nested(nl_txq_params,
1624 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
1626 nla_parse(tb, NL80211_TXQ_ATTR_MAX,
1627 nla_data(nl_txq_params),
1628 nla_len(nl_txq_params),
1630 result = parse_txq_params(tb, &txq_params);
1634 result = rdev_set_txq_params(rdev, netdev,
1641 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
1642 result = __nl80211_set_channel(rdev,
1643 nl80211_can_set_dev_channel(wdev) ? wdev : NULL,
1649 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
1650 struct wireless_dev *txp_wdev = wdev;
1651 enum nl80211_tx_power_setting type;
1654 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
1657 if (!rdev->ops->set_tx_power) {
1658 result = -EOPNOTSUPP;
1662 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
1663 type = nla_get_u32(info->attrs[idx]);
1665 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
1666 (type != NL80211_TX_POWER_AUTOMATIC)) {
1671 if (type != NL80211_TX_POWER_AUTOMATIC) {
1672 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
1673 mbm = nla_get_u32(info->attrs[idx]);
1676 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
1681 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
1682 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
1684 if ((!rdev->wiphy.available_antennas_tx &&
1685 !rdev->wiphy.available_antennas_rx) ||
1686 !rdev->ops->set_antenna) {
1687 result = -EOPNOTSUPP;
1691 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
1692 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
1694 /* reject antenna configurations which don't match the
1695 * available antenna masks, except for the "all" mask */
1696 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
1697 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) {
1702 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
1703 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
1705 result = rdev_set_antenna(rdev, tx_ant, rx_ant);
1712 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
1713 retry_short = nla_get_u8(
1714 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
1715 if (retry_short == 0) {
1719 changed |= WIPHY_PARAM_RETRY_SHORT;
1722 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
1723 retry_long = nla_get_u8(
1724 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
1725 if (retry_long == 0) {
1729 changed |= WIPHY_PARAM_RETRY_LONG;
1732 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
1733 frag_threshold = nla_get_u32(
1734 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
1735 if (frag_threshold < 256) {
1739 if (frag_threshold != (u32) -1) {
1741 * Fragments (apart from the last one) are required to
1742 * have even length. Make the fragmentation code
1743 * simpler by stripping LSB should someone try to use
1744 * odd threshold value.
1746 frag_threshold &= ~0x1;
1748 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
1751 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
1752 rts_threshold = nla_get_u32(
1753 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
1754 changed |= WIPHY_PARAM_RTS_THRESHOLD;
1757 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
1758 coverage_class = nla_get_u8(
1759 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
1760 changed |= WIPHY_PARAM_COVERAGE_CLASS;
1764 u8 old_retry_short, old_retry_long;
1765 u32 old_frag_threshold, old_rts_threshold;
1766 u8 old_coverage_class;
1768 if (!rdev->ops->set_wiphy_params) {
1769 result = -EOPNOTSUPP;
1773 old_retry_short = rdev->wiphy.retry_short;
1774 old_retry_long = rdev->wiphy.retry_long;
1775 old_frag_threshold = rdev->wiphy.frag_threshold;
1776 old_rts_threshold = rdev->wiphy.rts_threshold;
1777 old_coverage_class = rdev->wiphy.coverage_class;
1779 if (changed & WIPHY_PARAM_RETRY_SHORT)
1780 rdev->wiphy.retry_short = retry_short;
1781 if (changed & WIPHY_PARAM_RETRY_LONG)
1782 rdev->wiphy.retry_long = retry_long;
1783 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
1784 rdev->wiphy.frag_threshold = frag_threshold;
1785 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
1786 rdev->wiphy.rts_threshold = rts_threshold;
1787 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
1788 rdev->wiphy.coverage_class = coverage_class;
1790 result = rdev_set_wiphy_params(rdev, changed);
1792 rdev->wiphy.retry_short = old_retry_short;
1793 rdev->wiphy.retry_long = old_retry_long;
1794 rdev->wiphy.frag_threshold = old_frag_threshold;
1795 rdev->wiphy.rts_threshold = old_rts_threshold;
1796 rdev->wiphy.coverage_class = old_coverage_class;
1801 mutex_unlock(&rdev->mtx);
1807 static inline u64 wdev_id(struct wireless_dev *wdev)
1809 return (u64)wdev->identifier |
1810 ((u64)wiphy_to_dev(wdev->wiphy)->wiphy_idx << 32);
1813 static int nl80211_send_chandef(struct sk_buff *msg,
1814 struct cfg80211_chan_def *chandef)
1816 WARN_ON(!cfg80211_chandef_valid(chandef));
1818 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
1819 chandef->chan->center_freq))
1821 switch (chandef->width) {
1822 case NL80211_CHAN_WIDTH_20_NOHT:
1823 case NL80211_CHAN_WIDTH_20:
1824 case NL80211_CHAN_WIDTH_40:
1825 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
1826 cfg80211_get_chandef_type(chandef)))
1832 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
1834 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
1836 if (chandef->center_freq2 &&
1837 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
1842 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
1843 struct cfg80211_registered_device *rdev,
1844 struct wireless_dev *wdev)
1846 struct net_device *dev = wdev->netdev;
1849 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_INTERFACE);
1854 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
1855 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
1856 goto nla_put_failure;
1858 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
1859 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
1860 nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)) ||
1861 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
1862 nla_put_u32(msg, NL80211_ATTR_GENERATION,
1863 rdev->devlist_generation ^
1864 (cfg80211_rdev_list_generation << 2)))
1865 goto nla_put_failure;
1867 if (rdev->ops->get_channel) {
1869 struct cfg80211_chan_def chandef;
1871 ret = rdev_get_channel(rdev, wdev, &chandef);
1873 if (nl80211_send_chandef(msg, &chandef))
1874 goto nla_put_failure;
1878 if (wdev->ssid_len) {
1879 if (nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
1880 goto nla_put_failure;
1883 return genlmsg_end(msg, hdr);
1886 genlmsg_cancel(msg, hdr);
1890 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
1894 int wp_start = cb->args[0];
1895 int if_start = cb->args[1];
1896 struct cfg80211_registered_device *rdev;
1897 struct wireless_dev *wdev;
1899 mutex_lock(&cfg80211_mutex);
1900 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1901 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
1903 if (wp_idx < wp_start) {
1909 mutex_lock(&rdev->devlist_mtx);
1910 list_for_each_entry(wdev, &rdev->wdev_list, list) {
1911 if (if_idx < if_start) {
1915 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
1916 cb->nlh->nlmsg_seq, NLM_F_MULTI,
1918 mutex_unlock(&rdev->devlist_mtx);
1923 mutex_unlock(&rdev->devlist_mtx);
1928 mutex_unlock(&cfg80211_mutex);
1930 cb->args[0] = wp_idx;
1931 cb->args[1] = if_idx;
1936 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
1938 struct sk_buff *msg;
1939 struct cfg80211_registered_device *dev = info->user_ptr[0];
1940 struct wireless_dev *wdev = info->user_ptr[1];
1942 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1946 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
1952 return genlmsg_reply(msg, info);
1955 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
1956 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
1957 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
1958 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
1959 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
1960 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
1963 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
1965 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
1973 if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX,
1974 nla, mntr_flags_policy))
1977 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
1979 *mntrflags |= (1<<flag);
1984 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
1985 struct net_device *netdev, u8 use_4addr,
1986 enum nl80211_iftype iftype)
1989 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
1995 case NL80211_IFTYPE_AP_VLAN:
1996 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
1999 case NL80211_IFTYPE_STATION:
2000 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
2010 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
2012 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2013 struct vif_params params;
2015 enum nl80211_iftype otype, ntype;
2016 struct net_device *dev = info->user_ptr[1];
2017 u32 _flags, *flags = NULL;
2018 bool change = false;
2020 memset(¶ms, 0, sizeof(params));
2022 otype = ntype = dev->ieee80211_ptr->iftype;
2024 if (info->attrs[NL80211_ATTR_IFTYPE]) {
2025 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2028 if (ntype > NL80211_IFTYPE_MAX)
2032 if (info->attrs[NL80211_ATTR_MESH_ID]) {
2033 struct wireless_dev *wdev = dev->ieee80211_ptr;
2035 if (ntype != NL80211_IFTYPE_MESH_POINT)
2037 if (netif_running(dev))
2041 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2042 IEEE80211_MAX_MESH_ID_LEN);
2043 wdev->mesh_id_up_len =
2044 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2045 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2046 wdev->mesh_id_up_len);
2050 if (info->attrs[NL80211_ATTR_4ADDR]) {
2051 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2053 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
2057 params.use_4addr = -1;
2060 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
2061 if (ntype != NL80211_IFTYPE_MONITOR)
2063 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
2073 err = cfg80211_change_iface(rdev, dev, ntype, flags, ¶ms);
2077 if (!err && params.use_4addr != -1)
2078 dev->ieee80211_ptr->use_4addr = params.use_4addr;
2083 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
2085 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2086 struct vif_params params;
2087 struct wireless_dev *wdev;
2088 struct sk_buff *msg;
2090 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
2093 memset(¶ms, 0, sizeof(params));
2095 if (!info->attrs[NL80211_ATTR_IFNAME])
2098 if (info->attrs[NL80211_ATTR_IFTYPE]) {
2099 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2100 if (type > NL80211_IFTYPE_MAX)
2104 if (!rdev->ops->add_virtual_intf ||
2105 !(rdev->wiphy.interface_modes & (1 << type)))
2108 if (info->attrs[NL80211_ATTR_4ADDR]) {
2109 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2110 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
2115 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2119 err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
2120 info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
2122 wdev = rdev_add_virtual_intf(rdev,
2123 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
2124 type, err ? NULL : &flags, ¶ms);
2127 return PTR_ERR(wdev);
2131 case NL80211_IFTYPE_MESH_POINT:
2132 if (!info->attrs[NL80211_ATTR_MESH_ID])
2135 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2136 IEEE80211_MAX_MESH_ID_LEN);
2137 wdev->mesh_id_up_len =
2138 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2139 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2140 wdev->mesh_id_up_len);
2143 case NL80211_IFTYPE_P2P_DEVICE:
2145 * P2P Device doesn't have a netdev, so doesn't go
2146 * through the netdev notifier and must be added here
2148 mutex_init(&wdev->mtx);
2149 INIT_LIST_HEAD(&wdev->event_list);
2150 spin_lock_init(&wdev->event_lock);
2151 INIT_LIST_HEAD(&wdev->mgmt_registrations);
2152 spin_lock_init(&wdev->mgmt_registrations_lock);
2154 mutex_lock(&rdev->devlist_mtx);
2155 wdev->identifier = ++rdev->wdev_id;
2156 list_add_rcu(&wdev->list, &rdev->wdev_list);
2157 rdev->devlist_generation++;
2158 mutex_unlock(&rdev->devlist_mtx);
2164 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
2170 return genlmsg_reply(msg, info);
2173 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
2175 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2176 struct wireless_dev *wdev = info->user_ptr[1];
2178 if (!rdev->ops->del_virtual_intf)
2182 * If we remove a wireless device without a netdev then clear
2183 * user_ptr[1] so that nl80211_post_doit won't dereference it
2184 * to check if it needs to do dev_put(). Otherwise it crashes
2185 * since the wdev has been freed, unlike with a netdev where
2186 * we need the dev_put() for the netdev to really be freed.
2189 info->user_ptr[1] = NULL;
2191 return rdev_del_virtual_intf(rdev, wdev);
2194 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
2196 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2197 struct net_device *dev = info->user_ptr[1];
2200 if (!info->attrs[NL80211_ATTR_NOACK_MAP])
2203 if (!rdev->ops->set_noack_map)
2206 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
2208 return rdev_set_noack_map(rdev, dev, noack_map);
2211 struct get_key_cookie {
2212 struct sk_buff *msg;
2217 static void get_key_callback(void *c, struct key_params *params)
2220 struct get_key_cookie *cookie = c;
2223 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
2224 params->key_len, params->key)) ||
2226 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
2227 params->seq_len, params->seq)) ||
2229 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
2231 goto nla_put_failure;
2233 key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
2235 goto nla_put_failure;
2238 nla_put(cookie->msg, NL80211_KEY_DATA,
2239 params->key_len, params->key)) ||
2241 nla_put(cookie->msg, NL80211_KEY_SEQ,
2242 params->seq_len, params->seq)) ||
2244 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
2246 goto nla_put_failure;
2248 if (nla_put_u8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx))
2249 goto nla_put_failure;
2251 nla_nest_end(cookie->msg, key);
2258 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
2260 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2262 struct net_device *dev = info->user_ptr[1];
2264 const u8 *mac_addr = NULL;
2266 struct get_key_cookie cookie = {
2270 struct sk_buff *msg;
2272 if (info->attrs[NL80211_ATTR_KEY_IDX])
2273 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
2278 if (info->attrs[NL80211_ATTR_MAC])
2279 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2281 pairwise = !!mac_addr;
2282 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
2283 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
2284 if (kt >= NUM_NL80211_KEYTYPES)
2286 if (kt != NL80211_KEYTYPE_GROUP &&
2287 kt != NL80211_KEYTYPE_PAIRWISE)
2289 pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
2292 if (!rdev->ops->get_key)
2295 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2299 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
2300 NL80211_CMD_NEW_KEY);
2302 return PTR_ERR(hdr);
2305 cookie.idx = key_idx;
2307 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
2308 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
2309 goto nla_put_failure;
2311 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
2312 goto nla_put_failure;
2314 if (pairwise && mac_addr &&
2315 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
2318 err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
2325 goto nla_put_failure;
2327 genlmsg_end(msg, hdr);
2328 return genlmsg_reply(msg, info);
2337 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
2339 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2340 struct key_parse key;
2342 struct net_device *dev = info->user_ptr[1];
2344 err = nl80211_parse_key(info, &key);
2351 /* only support setting default key */
2352 if (!key.def && !key.defmgmt)
2355 wdev_lock(dev->ieee80211_ptr);
2358 if (!rdev->ops->set_default_key) {
2363 err = nl80211_key_allowed(dev->ieee80211_ptr);
2367 err = rdev_set_default_key(rdev, dev, key.idx,
2368 key.def_uni, key.def_multi);
2373 #ifdef CONFIG_CFG80211_WEXT
2374 dev->ieee80211_ptr->wext.default_key = key.idx;
2377 if (key.def_uni || !key.def_multi) {
2382 if (!rdev->ops->set_default_mgmt_key) {
2387 err = nl80211_key_allowed(dev->ieee80211_ptr);
2391 err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
2395 #ifdef CONFIG_CFG80211_WEXT
2396 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
2401 wdev_unlock(dev->ieee80211_ptr);
2406 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
2408 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2410 struct net_device *dev = info->user_ptr[1];
2411 struct key_parse key;
2412 const u8 *mac_addr = NULL;
2414 err = nl80211_parse_key(info, &key);
2421 if (info->attrs[NL80211_ATTR_MAC])
2422 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2424 if (key.type == -1) {
2426 key.type = NL80211_KEYTYPE_PAIRWISE;
2428 key.type = NL80211_KEYTYPE_GROUP;
2432 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
2433 key.type != NL80211_KEYTYPE_GROUP)
2436 if (!rdev->ops->add_key)
2439 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
2440 key.type == NL80211_KEYTYPE_PAIRWISE,
2444 wdev_lock(dev->ieee80211_ptr);
2445 err = nl80211_key_allowed(dev->ieee80211_ptr);
2447 err = rdev_add_key(rdev, dev, key.idx,
2448 key.type == NL80211_KEYTYPE_PAIRWISE,
2450 wdev_unlock(dev->ieee80211_ptr);
2455 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
2457 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2459 struct net_device *dev = info->user_ptr[1];
2460 u8 *mac_addr = NULL;
2461 struct key_parse key;
2463 err = nl80211_parse_key(info, &key);
2467 if (info->attrs[NL80211_ATTR_MAC])
2468 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2470 if (key.type == -1) {
2472 key.type = NL80211_KEYTYPE_PAIRWISE;
2474 key.type = NL80211_KEYTYPE_GROUP;
2478 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
2479 key.type != NL80211_KEYTYPE_GROUP)
2482 if (!rdev->ops->del_key)
2485 wdev_lock(dev->ieee80211_ptr);
2486 err = nl80211_key_allowed(dev->ieee80211_ptr);
2488 if (key.type == NL80211_KEYTYPE_PAIRWISE && mac_addr &&
2489 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
2493 err = rdev_del_key(rdev, dev, key.idx,
2494 key.type == NL80211_KEYTYPE_PAIRWISE,
2497 #ifdef CONFIG_CFG80211_WEXT
2499 if (key.idx == dev->ieee80211_ptr->wext.default_key)
2500 dev->ieee80211_ptr->wext.default_key = -1;
2501 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
2502 dev->ieee80211_ptr->wext.default_mgmt_key = -1;
2505 wdev_unlock(dev->ieee80211_ptr);
2510 static int nl80211_parse_beacon(struct genl_info *info,
2511 struct cfg80211_beacon_data *bcn)
2513 bool haveinfo = false;
2515 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_BEACON_TAIL]) ||
2516 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]) ||
2517 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
2518 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE_ASSOC_RESP]))
2521 memset(bcn, 0, sizeof(*bcn));
2523 if (info->attrs[NL80211_ATTR_BEACON_HEAD]) {
2524 bcn->head = nla_data(info->attrs[NL80211_ATTR_BEACON_HEAD]);
2525 bcn->head_len = nla_len(info->attrs[NL80211_ATTR_BEACON_HEAD]);
2531 if (info->attrs[NL80211_ATTR_BEACON_TAIL]) {
2532 bcn->tail = nla_data(info->attrs[NL80211_ATTR_BEACON_TAIL]);
2534 nla_len(info->attrs[NL80211_ATTR_BEACON_TAIL]);
2541 if (info->attrs[NL80211_ATTR_IE]) {
2542 bcn->beacon_ies = nla_data(info->attrs[NL80211_ATTR_IE]);
2543 bcn->beacon_ies_len = nla_len(info->attrs[NL80211_ATTR_IE]);
2546 if (info->attrs[NL80211_ATTR_IE_PROBE_RESP]) {
2547 bcn->proberesp_ies =
2548 nla_data(info->attrs[NL80211_ATTR_IE_PROBE_RESP]);
2549 bcn->proberesp_ies_len =
2550 nla_len(info->attrs[NL80211_ATTR_IE_PROBE_RESP]);
2553 if (info->attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
2554 bcn->assocresp_ies =
2555 nla_data(info->attrs[NL80211_ATTR_IE_ASSOC_RESP]);
2556 bcn->assocresp_ies_len =
2557 nla_len(info->attrs[NL80211_ATTR_IE_ASSOC_RESP]);
2560 if (info->attrs[NL80211_ATTR_PROBE_RESP]) {
2562 nla_data(info->attrs[NL80211_ATTR_PROBE_RESP]);
2563 bcn->probe_resp_len =
2564 nla_len(info->attrs[NL80211_ATTR_PROBE_RESP]);
2570 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
2571 struct cfg80211_ap_settings *params)
2573 struct wireless_dev *wdev;
2576 mutex_lock(&rdev->devlist_mtx);
2578 list_for_each_entry(wdev, &rdev->wdev_list, list) {
2579 if (wdev->iftype != NL80211_IFTYPE_AP &&
2580 wdev->iftype != NL80211_IFTYPE_P2P_GO)
2583 if (!wdev->preset_chandef.chan)
2586 params->chandef = wdev->preset_chandef;
2591 mutex_unlock(&rdev->devlist_mtx);
2596 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
2597 enum nl80211_auth_type auth_type,
2598 enum nl80211_commands cmd)
2600 if (auth_type > NL80211_AUTHTYPE_MAX)
2604 case NL80211_CMD_AUTHENTICATE:
2605 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
2606 auth_type == NL80211_AUTHTYPE_SAE)
2609 case NL80211_CMD_CONNECT:
2610 case NL80211_CMD_START_AP:
2611 /* SAE not supported yet */
2612 if (auth_type == NL80211_AUTHTYPE_SAE)
2620 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
2622 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2623 struct net_device *dev = info->user_ptr[1];
2624 struct wireless_dev *wdev = dev->ieee80211_ptr;
2625 struct cfg80211_ap_settings params;
2628 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2629 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2632 if (!rdev->ops->start_ap)
2635 if (wdev->beacon_interval)
2638 memset(¶ms, 0, sizeof(params));
2640 /* these are required for START_AP */
2641 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
2642 !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
2643 !info->attrs[NL80211_ATTR_BEACON_HEAD])
2646 err = nl80211_parse_beacon(info, ¶ms.beacon);
2650 params.beacon_interval =
2651 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
2652 params.dtim_period =
2653 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
2655 err = cfg80211_validate_beacon_int(rdev, params.beacon_interval);
2660 * In theory, some of these attributes should be required here
2661 * but since they were not used when the command was originally
2662 * added, keep them optional for old user space programs to let
2663 * them continue to work with drivers that do not need the
2664 * additional information -- drivers must check!
2666 if (info->attrs[NL80211_ATTR_SSID]) {
2667 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
2669 nla_len(info->attrs[NL80211_ATTR_SSID]);
2670 if (params.ssid_len == 0 ||
2671 params.ssid_len > IEEE80211_MAX_SSID_LEN)
2675 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
2676 params.hidden_ssid = nla_get_u32(
2677 info->attrs[NL80211_ATTR_HIDDEN_SSID]);
2678 if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
2679 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
2680 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
2684 params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
2686 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
2687 params.auth_type = nla_get_u32(
2688 info->attrs[NL80211_ATTR_AUTH_TYPE]);
2689 if (!nl80211_valid_auth_type(rdev, params.auth_type,
2690 NL80211_CMD_START_AP))
2693 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
2695 err = nl80211_crypto_settings(rdev, info, ¶ms.crypto,
2696 NL80211_MAX_NR_CIPHER_SUITES);
2700 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
2701 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
2703 params.inactivity_timeout = nla_get_u16(
2704 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
2707 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
2708 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2710 params.p2p_ctwindow =
2711 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
2712 if (params.p2p_ctwindow > 127)
2714 if (params.p2p_ctwindow != 0 &&
2715 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
2719 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
2722 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2724 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
2727 params.p2p_opp_ps = tmp;
2728 if (params.p2p_opp_ps != 0 &&
2729 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
2733 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
2734 err = nl80211_parse_chandef(rdev, info, ¶ms.chandef);
2737 } else if (wdev->preset_chandef.chan) {
2738 params.chandef = wdev->preset_chandef;
2739 } else if (!nl80211_get_ap_channel(rdev, ¶ms))
2742 if (!cfg80211_reg_can_beacon(&rdev->wiphy, ¶ms.chandef))
2745 mutex_lock(&rdev->devlist_mtx);
2746 err = cfg80211_can_use_chan(rdev, wdev, params.chandef.chan,
2748 mutex_unlock(&rdev->devlist_mtx);
2753 err = rdev_start_ap(rdev, dev, ¶ms);
2755 wdev->preset_chandef = params.chandef;
2756 wdev->beacon_interval = params.beacon_interval;
2757 wdev->channel = params.chandef.chan;
2758 wdev->ssid_len = params.ssid_len;
2759 memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
2764 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
2766 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2767 struct net_device *dev = info->user_ptr[1];
2768 struct wireless_dev *wdev = dev->ieee80211_ptr;
2769 struct cfg80211_beacon_data params;
2772 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2773 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2776 if (!rdev->ops->change_beacon)
2779 if (!wdev->beacon_interval)
2782 err = nl80211_parse_beacon(info, ¶ms);
2786 return rdev_change_beacon(rdev, dev, ¶ms);
2789 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
2791 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2792 struct net_device *dev = info->user_ptr[1];
2794 return cfg80211_stop_ap(rdev, dev);
2797 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
2798 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
2799 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
2800 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
2801 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
2802 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
2803 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
2806 static int parse_station_flags(struct genl_info *info,
2807 enum nl80211_iftype iftype,
2808 struct station_parameters *params)
2810 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
2815 * Try parsing the new attribute first so userspace
2816 * can specify both for older kernels.
2818 nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
2820 struct nl80211_sta_flag_update *sta_flags;
2822 sta_flags = nla_data(nla);
2823 params->sta_flags_mask = sta_flags->mask;
2824 params->sta_flags_set = sta_flags->set;
2825 if ((params->sta_flags_mask |
2826 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
2831 /* if present, parse the old attribute */
2833 nla = info->attrs[NL80211_ATTR_STA_FLAGS];
2837 if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX,
2838 nla, sta_flags_policy))
2842 * Only allow certain flags for interface types so that
2843 * other attributes are silently ignored. Remember that
2844 * this is backward compatibility code with old userspace
2845 * and shouldn't be hit in other cases anyway.
2848 case NL80211_IFTYPE_AP:
2849 case NL80211_IFTYPE_AP_VLAN:
2850 case NL80211_IFTYPE_P2P_GO:
2851 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
2852 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
2853 BIT(NL80211_STA_FLAG_WME) |
2854 BIT(NL80211_STA_FLAG_MFP);
2856 case NL80211_IFTYPE_P2P_CLIENT:
2857 case NL80211_IFTYPE_STATION:
2858 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
2859 BIT(NL80211_STA_FLAG_TDLS_PEER);
2861 case NL80211_IFTYPE_MESH_POINT:
2862 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
2863 BIT(NL80211_STA_FLAG_MFP) |
2864 BIT(NL80211_STA_FLAG_AUTHORIZED);
2869 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
2871 params->sta_flags_set |= (1<<flag);
2873 /* no longer support new API additions in old API */
2874 if (flag > NL80211_STA_FLAG_MAX_OLD_API)
2882 static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
2885 struct nlattr *rate;
2889 rate = nla_nest_start(msg, attr);
2893 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
2894 bitrate = cfg80211_calculate_bitrate(info);
2895 /* report 16-bit bitrate only if we can */
2896 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
2898 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
2900 if (bitrate_compat > 0 &&
2901 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
2904 if (info->flags & RATE_INFO_FLAGS_MCS) {
2905 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
2907 if (info->flags & RATE_INFO_FLAGS_40_MHZ_WIDTH &&
2908 nla_put_flag(msg, NL80211_RATE_INFO_40_MHZ_WIDTH))
2910 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
2911 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
2913 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
2914 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
2916 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
2918 if (info->flags & RATE_INFO_FLAGS_40_MHZ_WIDTH &&
2919 nla_put_flag(msg, NL80211_RATE_INFO_40_MHZ_WIDTH))
2921 if (info->flags & RATE_INFO_FLAGS_80_MHZ_WIDTH &&
2922 nla_put_flag(msg, NL80211_RATE_INFO_80_MHZ_WIDTH))
2924 if (info->flags & RATE_INFO_FLAGS_80P80_MHZ_WIDTH &&
2925 nla_put_flag(msg, NL80211_RATE_INFO_80P80_MHZ_WIDTH))
2927 if (info->flags & RATE_INFO_FLAGS_160_MHZ_WIDTH &&
2928 nla_put_flag(msg, NL80211_RATE_INFO_160_MHZ_WIDTH))
2930 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
2931 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
2935 nla_nest_end(msg, rate);
2939 static int nl80211_send_station(struct sk_buff *msg, u32 portid, u32 seq,
2941 struct cfg80211_registered_device *rdev,
2942 struct net_device *dev,
2943 const u8 *mac_addr, struct station_info *sinfo)
2946 struct nlattr *sinfoattr, *bss_param;
2948 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_STATION);
2952 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
2953 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
2954 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
2955 goto nla_put_failure;
2957 sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
2959 goto nla_put_failure;
2960 if ((sinfo->filled & STATION_INFO_CONNECTED_TIME) &&
2961 nla_put_u32(msg, NL80211_STA_INFO_CONNECTED_TIME,
2962 sinfo->connected_time))
2963 goto nla_put_failure;
2964 if ((sinfo->filled & STATION_INFO_INACTIVE_TIME) &&
2965 nla_put_u32(msg, NL80211_STA_INFO_INACTIVE_TIME,
2966 sinfo->inactive_time))
2967 goto nla_put_failure;
2968 if ((sinfo->filled & STATION_INFO_RX_BYTES) &&
2969 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
2971 goto nla_put_failure;
2972 if ((sinfo->filled & STATION_INFO_TX_BYTES) &&
2973 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
2975 goto nla_put_failure;
2976 if ((sinfo->filled & STATION_INFO_LLID) &&
2977 nla_put_u16(msg, NL80211_STA_INFO_LLID, sinfo->llid))
2978 goto nla_put_failure;
2979 if ((sinfo->filled & STATION_INFO_PLID) &&
2980 nla_put_u16(msg, NL80211_STA_INFO_PLID, sinfo->plid))
2981 goto nla_put_failure;
2982 if ((sinfo->filled & STATION_INFO_PLINK_STATE) &&
2983 nla_put_u8(msg, NL80211_STA_INFO_PLINK_STATE,
2984 sinfo->plink_state))
2985 goto nla_put_failure;
2986 switch (rdev->wiphy.signal_type) {
2987 case CFG80211_SIGNAL_TYPE_MBM:
2988 if ((sinfo->filled & STATION_INFO_SIGNAL) &&
2989 nla_put_u8(msg, NL80211_STA_INFO_SIGNAL,
2991 goto nla_put_failure;
2992 if ((sinfo->filled & STATION_INFO_SIGNAL_AVG) &&
2993 nla_put_u8(msg, NL80211_STA_INFO_SIGNAL_AVG,
2995 goto nla_put_failure;
3000 if (sinfo->filled & STATION_INFO_TX_BITRATE) {
3001 if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
3002 NL80211_STA_INFO_TX_BITRATE))
3003 goto nla_put_failure;
3005 if (sinfo->filled & STATION_INFO_RX_BITRATE) {
3006 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
3007 NL80211_STA_INFO_RX_BITRATE))
3008 goto nla_put_failure;
3010 if ((sinfo->filled & STATION_INFO_RX_PACKETS) &&
3011 nla_put_u32(msg, NL80211_STA_INFO_RX_PACKETS,
3013 goto nla_put_failure;
3014 if ((sinfo->filled & STATION_INFO_TX_PACKETS) &&
3015 nla_put_u32(msg, NL80211_STA_INFO_TX_PACKETS,
3017 goto nla_put_failure;
3018 if ((sinfo->filled & STATION_INFO_TX_RETRIES) &&
3019 nla_put_u32(msg, NL80211_STA_INFO_TX_RETRIES,
3021 goto nla_put_failure;
3022 if ((sinfo->filled & STATION_INFO_TX_FAILED) &&
3023 nla_put_u32(msg, NL80211_STA_INFO_TX_FAILED,
3025 goto nla_put_failure;
3026 if ((sinfo->filled & STATION_INFO_BEACON_LOSS_COUNT) &&
3027 nla_put_u32(msg, NL80211_STA_INFO_BEACON_LOSS,
3028 sinfo->beacon_loss_count))
3029 goto nla_put_failure;
3030 if (sinfo->filled & STATION_INFO_BSS_PARAM) {
3031 bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
3033 goto nla_put_failure;
3035 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
3036 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
3037 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
3038 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
3039 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
3040 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
3041 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
3042 sinfo->bss_param.dtim_period) ||
3043 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
3044 sinfo->bss_param.beacon_interval))
3045 goto nla_put_failure;
3047 nla_nest_end(msg, bss_param);
3049 if ((sinfo->filled & STATION_INFO_STA_FLAGS) &&
3050 nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
3051 sizeof(struct nl80211_sta_flag_update),
3053 goto nla_put_failure;
3054 if ((sinfo->filled & STATION_INFO_T_OFFSET) &&
3055 nla_put_u64(msg, NL80211_STA_INFO_T_OFFSET,
3057 goto nla_put_failure;
3058 nla_nest_end(msg, sinfoattr);
3060 if ((sinfo->filled & STATION_INFO_ASSOC_REQ_IES) &&
3061 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
3062 sinfo->assoc_req_ies))
3063 goto nla_put_failure;
3065 return genlmsg_end(msg, hdr);
3068 genlmsg_cancel(msg, hdr);
3072 static int nl80211_dump_station(struct sk_buff *skb,
3073 struct netlink_callback *cb)
3075 struct station_info sinfo;
3076 struct cfg80211_registered_device *dev;
3077 struct net_device *netdev;
3078 u8 mac_addr[ETH_ALEN];
3079 int sta_idx = cb->args[1];
3082 err = nl80211_prepare_netdev_dump(skb, cb, &dev, &netdev);
3086 if (!dev->ops->dump_station) {
3092 memset(&sinfo, 0, sizeof(sinfo));
3093 err = rdev_dump_station(dev, netdev, sta_idx,
3100 if (nl80211_send_station(skb,
3101 NETLINK_CB(cb->skb).portid,
3102 cb->nlh->nlmsg_seq, NLM_F_MULTI,
3103 dev, netdev, mac_addr,
3112 cb->args[1] = sta_idx;
3115 nl80211_finish_netdev_dump(dev);
3120 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
3122 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3123 struct net_device *dev = info->user_ptr[1];
3124 struct station_info sinfo;
3125 struct sk_buff *msg;
3126 u8 *mac_addr = NULL;
3129 memset(&sinfo, 0, sizeof(sinfo));
3131 if (!info->attrs[NL80211_ATTR_MAC])
3134 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3136 if (!rdev->ops->get_station)
3139 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
3143 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3147 if (nl80211_send_station(msg, info->snd_portid, info->snd_seq, 0,
3148 rdev, dev, mac_addr, &sinfo) < 0) {
3153 return genlmsg_reply(msg, info);
3157 * Get vlan interface making sure it is running and on the right wiphy.
3159 static struct net_device *get_vlan(struct genl_info *info,
3160 struct cfg80211_registered_device *rdev)
3162 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
3163 struct net_device *v;
3169 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
3171 return ERR_PTR(-ENODEV);
3173 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
3178 if (!netif_running(v)) {
3186 return ERR_PTR(ret);
3189 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
3191 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3193 struct net_device *dev = info->user_ptr[1];
3194 struct station_parameters params;
3195 u8 *mac_addr = NULL;
3197 memset(¶ms, 0, sizeof(params));
3199 params.listen_interval = -1;
3200 params.plink_state = -1;
3202 if (info->attrs[NL80211_ATTR_STA_AID])
3205 if (!info->attrs[NL80211_ATTR_MAC])
3208 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3210 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
3211 params.supported_rates =
3212 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
3213 params.supported_rates_len =
3214 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
3217 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
3218 params.listen_interval =
3219 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
3221 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
3223 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
3225 if (!rdev->ops->change_station)
3228 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms))
3231 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
3232 params.plink_action =
3233 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
3235 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE])
3236 params.plink_state =
3237 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
3239 switch (dev->ieee80211_ptr->iftype) {
3240 case NL80211_IFTYPE_AP:
3241 case NL80211_IFTYPE_AP_VLAN:
3242 case NL80211_IFTYPE_P2P_GO:
3243 /* disallow mesh-specific things */
3244 if (params.plink_action)
3247 /* TDLS can't be set, ... */
3248 if (params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
3251 * ... but don't bother the driver with it. This works around
3252 * a hostapd/wpa_supplicant issue -- it always includes the
3253 * TLDS_PEER flag in the mask even for AP mode.
3255 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
3257 /* accept only the listed bits */
3258 if (params.sta_flags_mask &
3259 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
3260 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
3261 BIT(NL80211_STA_FLAG_WME) |
3262 BIT(NL80211_STA_FLAG_MFP)))
3265 /* must be last in here for error handling */
3266 params.vlan = get_vlan(info, rdev);
3267 if (IS_ERR(params.vlan))
3268 return PTR_ERR(params.vlan);
3270 case NL80211_IFTYPE_P2P_CLIENT:
3271 case NL80211_IFTYPE_STATION:
3273 * Don't allow userspace to change the TDLS_PEER flag,
3274 * but silently ignore attempts to change it since we
3275 * don't have state here to verify that it doesn't try
3276 * to change the flag.
3278 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
3280 case NL80211_IFTYPE_ADHOC:
3281 /* disallow things sta doesn't support */
3282 if (params.plink_action)
3286 if (params.listen_interval >= 0)
3288 /* reject any changes other than AUTHORIZED */
3289 if (params.sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
3292 case NL80211_IFTYPE_MESH_POINT:
3293 /* disallow things mesh doesn't support */
3298 if (params.listen_interval >= 0)
3301 * No special handling for TDLS here -- the userspace
3302 * mesh code doesn't have this bug.
3304 if (params.sta_flags_mask &
3305 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
3306 BIT(NL80211_STA_FLAG_MFP) |
3307 BIT(NL80211_STA_FLAG_AUTHORIZED)))
3314 /* be aware of params.vlan when changing code here */
3316 err = rdev_change_station(rdev, dev, mac_addr, ¶ms);
3319 dev_put(params.vlan);
3324 static struct nla_policy
3325 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] __read_mostly = {
3326 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
3327 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
3330 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
3332 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3334 struct net_device *dev = info->user_ptr[1];
3335 struct station_parameters params;
3336 u8 *mac_addr = NULL;
3338 memset(¶ms, 0, sizeof(params));
3340 if (!info->attrs[NL80211_ATTR_MAC])
3343 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
3346 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
3349 if (!info->attrs[NL80211_ATTR_STA_AID])
3352 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3353 params.supported_rates =
3354 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
3355 params.supported_rates_len =
3356 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
3357 params.listen_interval =
3358 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
3360 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
3361 if (!params.aid || params.aid > IEEE80211_MAX_AID)
3364 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
3366 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
3368 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
3370 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
3372 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
3373 params.plink_action =
3374 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
3376 if (!rdev->ops->add_station)
3379 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms))
3382 switch (dev->ieee80211_ptr->iftype) {
3383 case NL80211_IFTYPE_AP:
3384 case NL80211_IFTYPE_AP_VLAN:
3385 case NL80211_IFTYPE_P2P_GO:
3386 /* parse WME attributes if sta is WME capable */
3387 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
3388 (params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)) &&
3389 info->attrs[NL80211_ATTR_STA_WME]) {
3390 struct nlattr *tb[NL80211_STA_WME_MAX + 1];
3393 nla = info->attrs[NL80211_ATTR_STA_WME];
3394 err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
3395 nl80211_sta_wme_policy);
3399 if (tb[NL80211_STA_WME_UAPSD_QUEUES])
3400 params.uapsd_queues =
3401 nla_get_u8(tb[NL80211_STA_WME_UAPSD_QUEUES]);
3402 if (params.uapsd_queues &
3403 ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
3406 if (tb[NL80211_STA_WME_MAX_SP])
3408 nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
3411 ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
3414 params.sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
3416 /* TDLS peers cannot be added */
3417 if (params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
3419 /* but don't bother the driver with it */
3420 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
3422 /* must be last in here for error handling */
3423 params.vlan = get_vlan(info, rdev);
3424 if (IS_ERR(params.vlan))
3425 return PTR_ERR(params.vlan);
3427 case NL80211_IFTYPE_MESH_POINT:
3428 /* TDLS peers cannot be added */
3429 if (params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
3432 case NL80211_IFTYPE_STATION:
3433 /* Only TDLS peers can be added */
3434 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
3436 /* Can only add if TDLS ... */
3437 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
3439 /* ... with external setup is supported */
3440 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
3447 /* be aware of params.vlan when changing code here */
3449 err = rdev_add_station(rdev, dev, mac_addr, ¶ms);
3452 dev_put(params.vlan);
3456 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
3458 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3459 struct net_device *dev = info->user_ptr[1];
3460 u8 *mac_addr = NULL;
3462 if (info->attrs[NL80211_ATTR_MAC])
3463 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3465 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3466 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
3467 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
3468 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3471 if (!rdev->ops->del_station)
3474 return rdev_del_station(rdev, dev, mac_addr);
3477 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
3478 int flags, struct net_device *dev,
3479 u8 *dst, u8 *next_hop,
3480 struct mpath_info *pinfo)
3483 struct nlattr *pinfoattr;
3485 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_STATION);
3489 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3490 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
3491 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
3492 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
3493 goto nla_put_failure;
3495 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
3497 goto nla_put_failure;
3498 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
3499 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
3501 goto nla_put_failure;
3502 if (((pinfo->filled & MPATH_INFO_SN) &&
3503 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
3504 ((pinfo->filled & MPATH_INFO_METRIC) &&
3505 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
3507 ((pinfo->filled & MPATH_INFO_EXPTIME) &&
3508 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
3510 ((pinfo->filled & MPATH_INFO_FLAGS) &&
3511 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
3513 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
3514 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
3515 pinfo->discovery_timeout)) ||
3516 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
3517 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
3518 pinfo->discovery_retries)))
3519 goto nla_put_failure;
3521 nla_nest_end(msg, pinfoattr);
3523 return genlmsg_end(msg, hdr);
3526 genlmsg_cancel(msg, hdr);
3530 static int nl80211_dump_mpath(struct sk_buff *skb,
3531 struct netlink_callback *cb)
3533 struct mpath_info pinfo;
3534 struct cfg80211_registered_device *dev;
3535 struct net_device *netdev;
3537 u8 next_hop[ETH_ALEN];
3538 int path_idx = cb->args[1];
3541 err = nl80211_prepare_netdev_dump(skb, cb, &dev, &netdev);
3545 if (!dev->ops->dump_mpath) {
3550 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
3556 err = rdev_dump_mpath(dev, netdev, path_idx, dst, next_hop,
3563 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
3564 cb->nlh->nlmsg_seq, NLM_F_MULTI,
3565 netdev, dst, next_hop,
3574 cb->args[1] = path_idx;
3577 nl80211_finish_netdev_dump(dev);
3581 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
3583 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3585 struct net_device *dev = info->user_ptr[1];
3586 struct mpath_info pinfo;
3587 struct sk_buff *msg;
3589 u8 next_hop[ETH_ALEN];
3591 memset(&pinfo, 0, sizeof(pinfo));
3593 if (!info->attrs[NL80211_ATTR_MAC])
3596 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
3598 if (!rdev->ops->get_mpath)
3601 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
3604 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
3608 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3612 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
3613 dev, dst, next_hop, &pinfo) < 0) {
3618 return genlmsg_reply(msg, info);
3621 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
3623 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3624 struct net_device *dev = info->user_ptr[1];
3626 u8 *next_hop = NULL;
3628 if (!info->attrs[NL80211_ATTR_MAC])
3631 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
3634 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
3635 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
3637 if (!rdev->ops->change_mpath)
3640 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
3643 return rdev_change_mpath(rdev, dev, dst, next_hop);
3646 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
3648 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3649 struct net_device *dev = info->user_ptr[1];
3651 u8 *next_hop = NULL;
3653 if (!info->attrs[NL80211_ATTR_MAC])
3656 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
3659 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
3660 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
3662 if (!rdev->ops->add_mpath)
3665 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
3668 return rdev_add_mpath(rdev, dev, dst, next_hop);
3671 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
3673 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3674 struct net_device *dev = info->user_ptr[1];
3677 if (info->attrs[NL80211_ATTR_MAC])
3678 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
3680 if (!rdev->ops->del_mpath)
3683 return rdev_del_mpath(rdev, dev, dst);
3686 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
3688 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3689 struct net_device *dev = info->user_ptr[1];
3690 struct bss_parameters params;
3692 memset(¶ms, 0, sizeof(params));
3693 /* default to not changing parameters */
3694 params.use_cts_prot = -1;
3695 params.use_short_preamble = -1;
3696 params.use_short_slot_time = -1;
3697 params.ap_isolate = -1;
3698 params.ht_opmode = -1;
3699 params.p2p_ctwindow = -1;
3700 params.p2p_opp_ps = -1;
3702 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
3703 params.use_cts_prot =
3704 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
3705 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
3706 params.use_short_preamble =
3707 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
3708 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
3709 params.use_short_slot_time =
3710 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
3711 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
3712 params.basic_rates =
3713 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
3714 params.basic_rates_len =
3715 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
3717 if (info->attrs[NL80211_ATTR_AP_ISOLATE])
3718 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
3719 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
3721 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
3723 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
3724 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3726 params.p2p_ctwindow =
3727 nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
3728 if (params.p2p_ctwindow < 0)
3730 if (params.p2p_ctwindow != 0 &&
3731 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
3735 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
3738 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3740 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
3743 params.p2p_opp_ps = tmp;
3744 if (params.p2p_opp_ps &&
3745 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
3749 if (!rdev->ops->change_bss)
3752 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3753 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3756 return rdev_change_bss(rdev, dev, ¶ms);
3759 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
3760 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
3761 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
3762 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
3763 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
3764 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
3765 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
3768 static int parse_reg_rule(struct nlattr *tb[],
3769 struct ieee80211_reg_rule *reg_rule)
3771 struct ieee80211_freq_range *freq_range = ®_rule->freq_range;
3772 struct ieee80211_power_rule *power_rule = ®_rule->power_rule;
3774 if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
3776 if (!tb[NL80211_ATTR_FREQ_RANGE_START])
3778 if (!tb[NL80211_ATTR_FREQ_RANGE_END])
3780 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
3782 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
3785 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
3787 freq_range->start_freq_khz =
3788 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
3789 freq_range->end_freq_khz =
3790 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
3791 freq_range->max_bandwidth_khz =
3792 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
3794 power_rule->max_eirp =
3795 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
3797 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
3798 power_rule->max_antenna_gain =
3799 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
3804 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
3808 enum nl80211_user_reg_hint_type user_reg_hint_type;
3811 * You should only get this when cfg80211 hasn't yet initialized
3812 * completely when built-in to the kernel right between the time
3813 * window between nl80211_init() and regulatory_init(), if that is
3816 mutex_lock(&cfg80211_mutex);
3817 if (unlikely(!cfg80211_regdomain)) {
3818 mutex_unlock(&cfg80211_mutex);
3819 return -EINPROGRESS;
3821 mutex_unlock(&cfg80211_mutex);
3823 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
3826 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
3828 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
3829 user_reg_hint_type =
3830 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
3832 user_reg_hint_type = NL80211_USER_REG_HINT_USER;
3834 switch (user_reg_hint_type) {
3835 case NL80211_USER_REG_HINT_USER:
3836 case NL80211_USER_REG_HINT_CELL_BASE:
3842 r = regulatory_hint_user(data, user_reg_hint_type);
3847 static int nl80211_get_mesh_config(struct sk_buff *skb,
3848 struct genl_info *info)
3850 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3851 struct net_device *dev = info->user_ptr[1];
3852 struct wireless_dev *wdev = dev->ieee80211_ptr;
3853 struct mesh_config cur_params;
3856 struct nlattr *pinfoattr;
3857 struct sk_buff *msg;
3859 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
3862 if (!rdev->ops->get_mesh_config)
3866 /* If not connected, get default parameters */
3867 if (!wdev->mesh_id_len)
3868 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
3870 err = rdev_get_mesh_config(rdev, dev, &cur_params);
3876 /* Draw up a netlink message to send back */
3877 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3880 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
3881 NL80211_CMD_GET_MESH_CONFIG);
3884 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
3886 goto nla_put_failure;
3887 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3888 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
3889 cur_params.dot11MeshRetryTimeout) ||
3890 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
3891 cur_params.dot11MeshConfirmTimeout) ||
3892 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
3893 cur_params.dot11MeshHoldingTimeout) ||
3894 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
3895 cur_params.dot11MeshMaxPeerLinks) ||
3896 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
3897 cur_params.dot11MeshMaxRetries) ||
3898 nla_put_u8(msg, NL80211_MESHCONF_TTL,
3899 cur_params.dot11MeshTTL) ||
3900 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
3901 cur_params.element_ttl) ||
3902 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
3903 cur_params.auto_open_plinks) ||
3904 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
3905 cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
3906 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
3907 cur_params.dot11MeshHWMPmaxPREQretries) ||
3908 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
3909 cur_params.path_refresh_time) ||
3910 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
3911 cur_params.min_discovery_timeout) ||
3912 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
3913 cur_params.dot11MeshHWMPactivePathTimeout) ||
3914 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
3915 cur_params.dot11MeshHWMPpreqMinInterval) ||
3916 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
3917 cur_params.dot11MeshHWMPperrMinInterval) ||
3918 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
3919 cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
3920 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
3921 cur_params.dot11MeshHWMPRootMode) ||
3922 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
3923 cur_params.dot11MeshHWMPRannInterval) ||
3924 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
3925 cur_params.dot11MeshGateAnnouncementProtocol) ||
3926 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
3927 cur_params.dot11MeshForwarding) ||
3928 nla_put_u32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
3929 cur_params.rssi_threshold) ||
3930 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
3931 cur_params.ht_opmode) ||
3932 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
3933 cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
3934 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
3935 cur_params.dot11MeshHWMProotInterval) ||
3936 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
3937 cur_params.dot11MeshHWMPconfirmationInterval))
3938 goto nla_put_failure;
3939 nla_nest_end(msg, pinfoattr);
3940 genlmsg_end(msg, hdr);
3941 return genlmsg_reply(msg, info);
3944 genlmsg_cancel(msg, hdr);
3950 static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
3951 [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
3952 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
3953 [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
3954 [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
3955 [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
3956 [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
3957 [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
3958 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
3959 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
3960 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
3961 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
3962 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
3963 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
3964 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
3965 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
3966 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
3967 [NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
3968 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
3969 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
3970 [NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
3971 [NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
3972 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
3973 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
3974 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
3975 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
3978 static const struct nla_policy
3979 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
3980 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
3981 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
3982 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
3983 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
3984 [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
3985 .len = IEEE80211_MAX_DATA_LEN },
3986 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
3989 static int nl80211_parse_mesh_config(struct genl_info *info,
3990 struct mesh_config *cfg,
3993 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
3996 #define FILL_IN_MESH_PARAM_IF_SET(table, cfg, param, mask, attr_num, nla_fn) \
3998 if (table[attr_num]) {\
3999 cfg->param = nla_fn(table[attr_num]); \
4000 mask |= (1 << (attr_num - 1)); \
4005 if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
4007 if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
4008 info->attrs[NL80211_ATTR_MESH_CONFIG],
4009 nl80211_meshconf_params_policy))
4012 /* This makes sure that there aren't more than 32 mesh config
4013 * parameters (otherwise our bitfield scheme would not work.) */
4014 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
4016 /* Fill in the params struct */
4017 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout,
4018 mask, NL80211_MESHCONF_RETRY_TIMEOUT,
4020 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout,
4021 mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
4023 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout,
4024 mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
4026 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks,
4027 mask, NL80211_MESHCONF_MAX_PEER_LINKS,
4029 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries,
4030 mask, NL80211_MESHCONF_MAX_RETRIES,
4032 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL,
4033 mask, NL80211_MESHCONF_TTL, nla_get_u8);
4034 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl,
4035 mask, NL80211_MESHCONF_ELEMENT_TTL,
4037 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks,
4038 mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
4040 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor, mask,
4041 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
4043 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries,
4044 mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
4046 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time,
4047 mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
4049 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout,
4050 mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
4052 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout, mask,
4053 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
4055 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
4056 mask, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
4058 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
4059 mask, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
4061 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
4062 dot11MeshHWMPnetDiameterTraversalTime, mask,
4063 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
4065 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask,
4066 NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8);
4067 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask,
4068 NL80211_MESHCONF_HWMP_RANN_INTERVAL,
4070 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
4071 dot11MeshGateAnnouncementProtocol, mask,
4072 NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
4074 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding,
4075 mask, NL80211_MESHCONF_FORWARDING,
4077 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold,
4078 mask, NL80211_MESHCONF_RSSI_THRESHOLD,
4080 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, ht_opmode,
4081 mask, NL80211_MESHCONF_HT_OPMODE,
4083 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
4085 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
4087 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval,
4088 mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
4090 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
4091 dot11MeshHWMPconfirmationInterval, mask,
4092 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
4099 #undef FILL_IN_MESH_PARAM_IF_SET
4102 static int nl80211_parse_mesh_setup(struct genl_info *info,
4103 struct mesh_setup *setup)
4105 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
4107 if (!info->attrs[NL80211_ATTR_MESH_SETUP])
4109 if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
4110 info->attrs[NL80211_ATTR_MESH_SETUP],
4111 nl80211_mesh_setup_params_policy))
4114 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
4115 setup->sync_method =
4116 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
4117 IEEE80211_SYNC_METHOD_VENDOR :
4118 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
4120 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
4121 setup->path_sel_proto =
4122 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
4123 IEEE80211_PATH_PROTOCOL_VENDOR :
4124 IEEE80211_PATH_PROTOCOL_HWMP;
4126 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
4127 setup->path_metric =
4128 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
4129 IEEE80211_PATH_METRIC_VENDOR :
4130 IEEE80211_PATH_METRIC_AIRTIME;
4133 if (tb[NL80211_MESH_SETUP_IE]) {
4134 struct nlattr *ieattr =
4135 tb[NL80211_MESH_SETUP_IE];
4136 if (!is_valid_ie_attr(ieattr))
4138 setup->ie = nla_data(ieattr);
4139 setup->ie_len = nla_len(ieattr);
4141 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
4142 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
4147 static int nl80211_update_mesh_config(struct sk_buff *skb,
4148 struct genl_info *info)
4150 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4151 struct net_device *dev = info->user_ptr[1];
4152 struct wireless_dev *wdev = dev->ieee80211_ptr;
4153 struct mesh_config cfg;
4157 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
4160 if (!rdev->ops->update_mesh_config)
4163 err = nl80211_parse_mesh_config(info, &cfg, &mask);
4168 if (!wdev->mesh_id_len)
4172 err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
4179 static int nl80211_get_reg(struct sk_buff *skb, struct genl_info *info)
4181 struct sk_buff *msg;
4183 struct nlattr *nl_reg_rules;
4187 mutex_lock(&cfg80211_mutex);
4189 if (!cfg80211_regdomain)
4192 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4198 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
4199 NL80211_CMD_GET_REG);
4203 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
4204 cfg80211_regdomain->alpha2) ||
4205 (cfg80211_regdomain->dfs_region &&
4206 nla_put_u8(msg, NL80211_ATTR_DFS_REGION,
4207 cfg80211_regdomain->dfs_region)))
4208 goto nla_put_failure;
4210 if (reg_last_request_cell_base() &&
4211 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
4212 NL80211_USER_REG_HINT_CELL_BASE))
4213 goto nla_put_failure;
4215 nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
4217 goto nla_put_failure;
4219 for (i = 0; i < cfg80211_regdomain->n_reg_rules; i++) {
4220 struct nlattr *nl_reg_rule;
4221 const struct ieee80211_reg_rule *reg_rule;
4222 const struct ieee80211_freq_range *freq_range;
4223 const struct ieee80211_power_rule *power_rule;
4225 reg_rule = &cfg80211_regdomain->reg_rules[i];
4226 freq_range = ®_rule->freq_range;
4227 power_rule = ®_rule->power_rule;
4229 nl_reg_rule = nla_nest_start(msg, i);
4231 goto nla_put_failure;
4233 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
4235 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
4236 freq_range->start_freq_khz) ||
4237 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
4238 freq_range->end_freq_khz) ||
4239 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
4240 freq_range->max_bandwidth_khz) ||
4241 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
4242 power_rule->max_antenna_gain) ||
4243 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
4244 power_rule->max_eirp))
4245 goto nla_put_failure;
4247 nla_nest_end(msg, nl_reg_rule);
4250 nla_nest_end(msg, nl_reg_rules);
4252 genlmsg_end(msg, hdr);
4253 err = genlmsg_reply(msg, info);
4257 genlmsg_cancel(msg, hdr);
4262 mutex_unlock(&cfg80211_mutex);
4266 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
4268 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
4269 struct nlattr *nl_reg_rule;
4270 char *alpha2 = NULL;
4271 int rem_reg_rules = 0, r = 0;
4272 u32 num_rules = 0, rule_idx = 0, size_of_regd;
4274 struct ieee80211_regdomain *rd = NULL;
4276 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
4279 if (!info->attrs[NL80211_ATTR_REG_RULES])
4282 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
4284 if (info->attrs[NL80211_ATTR_DFS_REGION])
4285 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
4287 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
4290 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
4294 mutex_lock(&cfg80211_mutex);
4296 if (!reg_is_valid_request(alpha2)) {
4301 size_of_regd = sizeof(struct ieee80211_regdomain) +
4302 (num_rules * sizeof(struct ieee80211_reg_rule));
4304 rd = kzalloc(size_of_regd, GFP_KERNEL);
4310 rd->n_reg_rules = num_rules;
4311 rd->alpha2[0] = alpha2[0];
4312 rd->alpha2[1] = alpha2[1];
4315 * Disable DFS master mode if the DFS region was
4316 * not supported or known on this kernel.
4318 if (reg_supported_dfs_region(dfs_region))
4319 rd->dfs_region = dfs_region;
4321 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
4323 nla_parse(tb, NL80211_REG_RULE_ATTR_MAX,
4324 nla_data(nl_reg_rule), nla_len(nl_reg_rule),
4326 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
4332 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
4338 BUG_ON(rule_idx != num_rules);
4342 mutex_unlock(&cfg80211_mutex);
4347 mutex_unlock(&cfg80211_mutex);
4352 static int validate_scan_freqs(struct nlattr *freqs)
4354 struct nlattr *attr1, *attr2;
4355 int n_channels = 0, tmp1, tmp2;
4357 nla_for_each_nested(attr1, freqs, tmp1) {
4360 * Some hardware has a limited channel list for
4361 * scanning, and it is pretty much nonsensical
4362 * to scan for a channel twice, so disallow that
4363 * and don't require drivers to check that the
4364 * channel list they get isn't longer than what
4365 * they can scan, as long as they can scan all
4366 * the channels they registered at once.
4368 nla_for_each_nested(attr2, freqs, tmp2)
4369 if (attr1 != attr2 &&
4370 nla_get_u32(attr1) == nla_get_u32(attr2))
4377 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
4379 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4380 struct wireless_dev *wdev = info->user_ptr[1];
4381 struct cfg80211_scan_request *request;
4382 struct nlattr *attr;
4383 struct wiphy *wiphy;
4384 int err, tmp, n_ssids = 0, n_channels, i;
4387 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
4390 wiphy = &rdev->wiphy;
4392 if (!rdev->ops->scan)
4398 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
4399 n_channels = validate_scan_freqs(
4400 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
4404 enum ieee80211_band band;
4407 for (band = 0; band < IEEE80211_NUM_BANDS; band++)
4408 if (wiphy->bands[band])
4409 n_channels += wiphy->bands[band]->n_channels;
4412 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
4413 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
4416 if (n_ssids > wiphy->max_scan_ssids)
4419 if (info->attrs[NL80211_ATTR_IE])
4420 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4424 if (ie_len > wiphy->max_scan_ie_len)
4427 request = kzalloc(sizeof(*request)
4428 + sizeof(*request->ssids) * n_ssids
4429 + sizeof(*request->channels) * n_channels
4430 + ie_len, GFP_KERNEL);
4435 request->ssids = (void *)&request->channels[n_channels];
4436 request->n_ssids = n_ssids;
4439 request->ie = (void *)(request->ssids + n_ssids);
4441 request->ie = (void *)(request->channels + n_channels);
4445 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
4446 /* user specified, bail out if channel not found */
4447 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
4448 struct ieee80211_channel *chan;
4450 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
4457 /* ignore disabled channels */
4458 if (chan->flags & IEEE80211_CHAN_DISABLED)
4461 request->channels[i] = chan;
4465 enum ieee80211_band band;
4468 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
4470 if (!wiphy->bands[band])
4472 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
4473 struct ieee80211_channel *chan;
4475 chan = &wiphy->bands[band]->channels[j];
4477 if (chan->flags & IEEE80211_CHAN_DISABLED)
4480 request->channels[i] = chan;
4491 request->n_channels = i;
4494 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) {
4495 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
4496 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
4500 request->ssids[i].ssid_len = nla_len(attr);
4501 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
4506 if (info->attrs[NL80211_ATTR_IE]) {
4507 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4508 memcpy((void *)request->ie,
4509 nla_data(info->attrs[NL80211_ATTR_IE]),
4513 for (i = 0; i < IEEE80211_NUM_BANDS; i++)
4514 if (wiphy->bands[i])
4516 (1 << wiphy->bands[i]->n_bitrates) - 1;
4518 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
4519 nla_for_each_nested(attr,
4520 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
4522 enum ieee80211_band band = nla_type(attr);
4524 if (band < 0 || band >= IEEE80211_NUM_BANDS) {
4528 err = ieee80211_get_ratemask(wiphy->bands[band],
4531 &request->rates[band]);
4537 if (info->attrs[NL80211_ATTR_SCAN_FLAGS]) {
4538 request->flags = nla_get_u32(
4539 info->attrs[NL80211_ATTR_SCAN_FLAGS]);
4540 if (((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
4541 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
4542 ((request->flags & NL80211_SCAN_FLAG_FLUSH) &&
4543 !(wiphy->features & NL80211_FEATURE_SCAN_FLUSH))) {
4550 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
4552 request->wdev = wdev;
4553 request->wiphy = &rdev->wiphy;
4554 request->scan_start = jiffies;
4556 rdev->scan_req = request;
4557 err = rdev_scan(rdev, request);
4560 nl80211_send_scan_start(rdev, wdev);
4562 dev_hold(wdev->netdev);
4565 rdev->scan_req = NULL;
4572 static int nl80211_start_sched_scan(struct sk_buff *skb,
4573 struct genl_info *info)
4575 struct cfg80211_sched_scan_request *request;
4576 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4577 struct net_device *dev = info->user_ptr[1];
4578 struct nlattr *attr;
4579 struct wiphy *wiphy;
4580 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i;
4582 enum ieee80211_band band;
4584 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
4586 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
4587 !rdev->ops->sched_scan_start)
4590 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
4593 if (!info->attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
4596 interval = nla_get_u32(info->attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
4600 wiphy = &rdev->wiphy;
4602 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
4603 n_channels = validate_scan_freqs(
4604 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
4610 for (band = 0; band < IEEE80211_NUM_BANDS; band++)
4611 if (wiphy->bands[band])
4612 n_channels += wiphy->bands[band]->n_channels;
4615 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
4616 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS],
4620 if (n_ssids > wiphy->max_sched_scan_ssids)
4623 if (info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH])
4624 nla_for_each_nested(attr,
4625 info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
4629 if (n_match_sets > wiphy->max_match_sets)
4632 if (info->attrs[NL80211_ATTR_IE])
4633 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4637 if (ie_len > wiphy->max_sched_scan_ie_len)
4640 mutex_lock(&rdev->sched_scan_mtx);
4642 if (rdev->sched_scan_req) {
4647 request = kzalloc(sizeof(*request)
4648 + sizeof(*request->ssids) * n_ssids
4649 + sizeof(*request->match_sets) * n_match_sets
4650 + sizeof(*request->channels) * n_channels
4651 + ie_len, GFP_KERNEL);
4658 request->ssids = (void *)&request->channels[n_channels];
4659 request->n_ssids = n_ssids;
4662 request->ie = (void *)(request->ssids + n_ssids);
4664 request->ie = (void *)(request->channels + n_channels);
4669 request->match_sets = (void *)(request->ie + ie_len);
4670 else if (request->ssids)
4671 request->match_sets =
4672 (void *)(request->ssids + n_ssids);
4674 request->match_sets =
4675 (void *)(request->channels + n_channels);
4677 request->n_match_sets = n_match_sets;
4680 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
4681 /* user specified, bail out if channel not found */
4682 nla_for_each_nested(attr,
4683 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES],
4685 struct ieee80211_channel *chan;
4687 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
4694 /* ignore disabled channels */
4695 if (chan->flags & IEEE80211_CHAN_DISABLED)
4698 request->channels[i] = chan;
4703 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
4705 if (!wiphy->bands[band])
4707 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
4708 struct ieee80211_channel *chan;
4710 chan = &wiphy->bands[band]->channels[j];
4712 if (chan->flags & IEEE80211_CHAN_DISABLED)
4715 request->channels[i] = chan;
4726 request->n_channels = i;
4729 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) {
4730 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS],
4732 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
4736 request->ssids[i].ssid_len = nla_len(attr);
4737 memcpy(request->ssids[i].ssid, nla_data(attr),
4744 if (info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
4745 nla_for_each_nested(attr,
4746 info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
4748 struct nlattr *ssid, *rssi;
4750 nla_parse(tb, NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
4751 nla_data(attr), nla_len(attr),
4752 nl80211_match_policy);
4753 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
4755 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
4759 memcpy(request->match_sets[i].ssid.ssid,
4760 nla_data(ssid), nla_len(ssid));
4761 request->match_sets[i].ssid.ssid_len =
4764 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
4766 request->rssi_thold = nla_get_u32(rssi);
4768 request->rssi_thold =
4769 NL80211_SCAN_RSSI_THOLD_OFF;
4774 if (info->attrs[NL80211_ATTR_IE]) {
4775 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4776 memcpy((void *)request->ie,
4777 nla_data(info->attrs[NL80211_ATTR_IE]),
4781 if (info->attrs[NL80211_ATTR_SCAN_FLAGS]) {
4782 request->flags = nla_get_u32(
4783 info->attrs[NL80211_ATTR_SCAN_FLAGS]);
4784 if (((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
4785 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
4786 ((request->flags & NL80211_SCAN_FLAG_FLUSH) &&
4787 !(wiphy->features & NL80211_FEATURE_SCAN_FLUSH))) {
4794 request->wiphy = &rdev->wiphy;
4795 request->interval = interval;
4796 request->scan_start = jiffies;
4798 err = rdev_sched_scan_start(rdev, dev, request);
4800 rdev->sched_scan_req = request;
4801 nl80211_send_sched_scan(rdev, dev,
4802 NL80211_CMD_START_SCHED_SCAN);
4809 mutex_unlock(&rdev->sched_scan_mtx);
4813 static int nl80211_stop_sched_scan(struct sk_buff *skb,
4814 struct genl_info *info)
4816 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4819 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
4820 !rdev->ops->sched_scan_stop)
4823 mutex_lock(&rdev->sched_scan_mtx);
4824 err = __cfg80211_stop_sched_scan(rdev, false);
4825 mutex_unlock(&rdev->sched_scan_mtx);
4830 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
4832 struct cfg80211_registered_device *rdev,
4833 struct wireless_dev *wdev,
4834 struct cfg80211_internal_bss *intbss)
4836 struct cfg80211_bss *res = &intbss->pub;
4840 ASSERT_WDEV_LOCK(wdev);
4842 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
4843 NL80211_CMD_NEW_SCAN_RESULTS);
4847 genl_dump_check_consistent(cb, hdr, &nl80211_fam);
4849 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation) ||
4850 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
4851 goto nla_put_failure;
4853 bss = nla_nest_start(msg, NL80211_ATTR_BSS);
4855 goto nla_put_failure;
4856 if ((!is_zero_ether_addr(res->bssid) &&
4857 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)) ||
4858 (res->information_elements && res->len_information_elements &&
4859 nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
4860 res->len_information_elements,
4861 res->information_elements)) ||
4862 (res->beacon_ies && res->len_beacon_ies &&
4863 res->beacon_ies != res->information_elements &&
4864 nla_put(msg, NL80211_BSS_BEACON_IES,
4865 res->len_beacon_ies, res->beacon_ies)))
4866 goto nla_put_failure;
4868 nla_put_u64(msg, NL80211_BSS_TSF, res->tsf))
4869 goto nla_put_failure;
4870 if (res->beacon_interval &&
4871 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
4872 goto nla_put_failure;
4873 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
4874 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
4875 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
4876 jiffies_to_msecs(jiffies - intbss->ts)))
4877 goto nla_put_failure;
4879 switch (rdev->wiphy.signal_type) {
4880 case CFG80211_SIGNAL_TYPE_MBM:
4881 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
4882 goto nla_put_failure;
4884 case CFG80211_SIGNAL_TYPE_UNSPEC:
4885 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
4886 goto nla_put_failure;
4892 switch (wdev->iftype) {
4893 case NL80211_IFTYPE_P2P_CLIENT:
4894 case NL80211_IFTYPE_STATION:
4895 if (intbss == wdev->current_bss &&
4896 nla_put_u32(msg, NL80211_BSS_STATUS,
4897 NL80211_BSS_STATUS_ASSOCIATED))
4898 goto nla_put_failure;
4900 case NL80211_IFTYPE_ADHOC:
4901 if (intbss == wdev->current_bss &&
4902 nla_put_u32(msg, NL80211_BSS_STATUS,
4903 NL80211_BSS_STATUS_IBSS_JOINED))
4904 goto nla_put_failure;
4910 nla_nest_end(msg, bss);
4912 return genlmsg_end(msg, hdr);
4915 genlmsg_cancel(msg, hdr);
4919 static int nl80211_dump_scan(struct sk_buff *skb,
4920 struct netlink_callback *cb)
4922 struct cfg80211_registered_device *rdev;
4923 struct net_device *dev;
4924 struct cfg80211_internal_bss *scan;
4925 struct wireless_dev *wdev;
4926 int start = cb->args[1], idx = 0;
4929 err = nl80211_prepare_netdev_dump(skb, cb, &rdev, &dev);
4933 wdev = dev->ieee80211_ptr;
4936 spin_lock_bh(&rdev->bss_lock);
4937 cfg80211_bss_expire(rdev);
4939 cb->seq = rdev->bss_generation;
4941 list_for_each_entry(scan, &rdev->bss_list, list) {
4944 if (nl80211_send_bss(skb, cb,
4945 cb->nlh->nlmsg_seq, NLM_F_MULTI,
4946 rdev, wdev, scan) < 0) {
4952 spin_unlock_bh(&rdev->bss_lock);
4956 nl80211_finish_netdev_dump(rdev);
4961 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
4962 int flags, struct net_device *dev,
4963 struct survey_info *survey)
4966 struct nlattr *infoattr;
4968 hdr = nl80211hdr_put(msg, portid, seq, flags,
4969 NL80211_CMD_NEW_SURVEY_RESULTS);
4973 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
4974 goto nla_put_failure;
4976 infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
4978 goto nla_put_failure;
4980 if (nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
4981 survey->channel->center_freq))
4982 goto nla_put_failure;
4984 if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
4985 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
4986 goto nla_put_failure;
4987 if ((survey->filled & SURVEY_INFO_IN_USE) &&
4988 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
4989 goto nla_put_failure;
4990 if ((survey->filled & SURVEY_INFO_CHANNEL_TIME) &&
4991 nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME,
4992 survey->channel_time))
4993 goto nla_put_failure;
4994 if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_BUSY) &&
4995 nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_BUSY,
4996 survey->channel_time_busy))
4997 goto nla_put_failure;
4998 if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_EXT_BUSY) &&
4999 nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_EXT_BUSY,
5000 survey->channel_time_ext_busy))
5001 goto nla_put_failure;
5002 if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_RX) &&
5003 nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_RX,
5004 survey->channel_time_rx))
5005 goto nla_put_failure;
5006 if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_TX) &&
5007 nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_TX,
5008 survey->channel_time_tx))
5009 goto nla_put_failure;
5011 nla_nest_end(msg, infoattr);
5013 return genlmsg_end(msg, hdr);
5016 genlmsg_cancel(msg, hdr);
5020 static int nl80211_dump_survey(struct sk_buff *skb,
5021 struct netlink_callback *cb)
5023 struct survey_info survey;
5024 struct cfg80211_registered_device *dev;
5025 struct net_device *netdev;
5026 int survey_idx = cb->args[1];
5029 res = nl80211_prepare_netdev_dump(skb, cb, &dev, &netdev);
5033 if (!dev->ops->dump_survey) {
5039 struct ieee80211_channel *chan;
5041 res = rdev_dump_survey(dev, netdev, survey_idx, &survey);
5047 /* Survey without a channel doesn't make sense */
5048 if (!survey.channel) {
5053 chan = ieee80211_get_channel(&dev->wiphy,
5054 survey.channel->center_freq);
5055 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED) {
5060 if (nl80211_send_survey(skb,
5061 NETLINK_CB(cb->skb).portid,
5062 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5070 cb->args[1] = survey_idx;
5073 nl80211_finish_netdev_dump(dev);
5077 static bool nl80211_valid_wpa_versions(u32 wpa_versions)
5079 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
5080 NL80211_WPA_VERSION_2));
5083 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
5085 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5086 struct net_device *dev = info->user_ptr[1];
5087 struct ieee80211_channel *chan;
5088 const u8 *bssid, *ssid, *ie = NULL, *sae_data = NULL;
5089 int err, ssid_len, ie_len = 0, sae_data_len = 0;
5090 enum nl80211_auth_type auth_type;
5091 struct key_parse key;
5092 bool local_state_change;
5094 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5097 if (!info->attrs[NL80211_ATTR_MAC])
5100 if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
5103 if (!info->attrs[NL80211_ATTR_SSID])
5106 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
5109 err = nl80211_parse_key(info, &key);
5114 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
5116 if (!key.p.key || !key.p.key_len)
5118 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
5119 key.p.key_len != WLAN_KEY_LEN_WEP40) &&
5120 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
5121 key.p.key_len != WLAN_KEY_LEN_WEP104))
5133 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
5134 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
5143 if (!rdev->ops->auth)
5146 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
5147 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5150 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
5151 chan = ieee80211_get_channel(&rdev->wiphy,
5152 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
5153 if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED))
5156 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
5157 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
5159 if (info->attrs[NL80211_ATTR_IE]) {
5160 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5161 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
5164 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
5165 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
5168 if (auth_type == NL80211_AUTHTYPE_SAE &&
5169 !info->attrs[NL80211_ATTR_SAE_DATA])
5172 if (info->attrs[NL80211_ATTR_SAE_DATA]) {
5173 if (auth_type != NL80211_AUTHTYPE_SAE)
5175 sae_data = nla_data(info->attrs[NL80211_ATTR_SAE_DATA]);
5176 sae_data_len = nla_len(info->attrs[NL80211_ATTR_SAE_DATA]);
5177 /* need to include at least Auth Transaction and Status Code */
5178 if (sae_data_len < 4)
5182 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
5185 * Since we no longer track auth state, ignore
5186 * requests to only change local state.
5188 if (local_state_change)
5191 return cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
5192 ssid, ssid_len, ie, ie_len,
5193 key.p.key, key.p.key_len, key.idx,
5194 sae_data, sae_data_len);
5197 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
5198 struct genl_info *info,
5199 struct cfg80211_crypto_settings *settings,
5202 memset(settings, 0, sizeof(*settings));
5204 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
5206 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
5208 proto = nla_get_u16(
5209 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
5210 settings->control_port_ethertype = cpu_to_be16(proto);
5211 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
5214 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
5215 settings->control_port_no_encrypt = true;
5217 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
5219 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
5223 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
5224 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
5225 settings->n_ciphers_pairwise = len / sizeof(u32);
5227 if (len % sizeof(u32))
5230 if (settings->n_ciphers_pairwise > cipher_limit)
5233 memcpy(settings->ciphers_pairwise, data, len);
5235 for (i = 0; i < settings->n_ciphers_pairwise; i++)
5236 if (!cfg80211_supported_cipher_suite(
5238 settings->ciphers_pairwise[i]))
5242 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
5243 settings->cipher_group =
5244 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
5245 if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
5246 settings->cipher_group))
5250 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
5251 settings->wpa_versions =
5252 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
5253 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
5257 if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
5261 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
5262 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
5263 settings->n_akm_suites = len / sizeof(u32);
5265 if (len % sizeof(u32))
5268 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
5271 memcpy(settings->akm_suites, data, len);
5277 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
5279 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5280 struct net_device *dev = info->user_ptr[1];
5281 struct cfg80211_crypto_settings crypto;
5282 struct ieee80211_channel *chan;
5283 const u8 *bssid, *ssid, *ie = NULL, *prev_bssid = NULL;
5284 int err, ssid_len, ie_len = 0;
5285 bool use_mfp = false;
5287 struct ieee80211_ht_cap *ht_capa = NULL;
5288 struct ieee80211_ht_cap *ht_capa_mask = NULL;
5290 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5293 if (!info->attrs[NL80211_ATTR_MAC] ||
5294 !info->attrs[NL80211_ATTR_SSID] ||
5295 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
5298 if (!rdev->ops->assoc)
5301 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
5302 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5305 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
5307 chan = ieee80211_get_channel(&rdev->wiphy,
5308 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
5309 if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED))
5312 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
5313 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
5315 if (info->attrs[NL80211_ATTR_IE]) {
5316 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5317 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
5320 if (info->attrs[NL80211_ATTR_USE_MFP]) {
5321 enum nl80211_mfp mfp =
5322 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
5323 if (mfp == NL80211_MFP_REQUIRED)
5325 else if (mfp != NL80211_MFP_NO)
5329 if (info->attrs[NL80211_ATTR_PREV_BSSID])
5330 prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
5332 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
5333 flags |= ASSOC_REQ_DISABLE_HT;
5335 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
5337 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]);
5339 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
5342 ht_capa = nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5345 err = nl80211_crypto_settings(rdev, info, &crypto, 1);
5347 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid, prev_bssid,
5348 ssid, ssid_len, ie, ie_len, use_mfp,
5349 &crypto, flags, ht_capa,
5355 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
5357 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5358 struct net_device *dev = info->user_ptr[1];
5359 const u8 *ie = NULL, *bssid;
5362 bool local_state_change;
5364 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5367 if (!info->attrs[NL80211_ATTR_MAC])
5370 if (!info->attrs[NL80211_ATTR_REASON_CODE])
5373 if (!rdev->ops->deauth)
5376 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
5377 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5380 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
5382 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5383 if (reason_code == 0) {
5384 /* Reason Code 0 is reserved */
5388 if (info->attrs[NL80211_ATTR_IE]) {
5389 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5390 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
5393 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
5395 return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
5396 local_state_change);
5399 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
5401 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5402 struct net_device *dev = info->user_ptr[1];
5403 const u8 *ie = NULL, *bssid;
5406 bool local_state_change;
5408 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5411 if (!info->attrs[NL80211_ATTR_MAC])
5414 if (!info->attrs[NL80211_ATTR_REASON_CODE])
5417 if (!rdev->ops->disassoc)
5420 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
5421 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5424 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
5426 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5427 if (reason_code == 0) {
5428 /* Reason Code 0 is reserved */
5432 if (info->attrs[NL80211_ATTR_IE]) {
5433 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5434 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
5437 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
5439 return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
5440 local_state_change);
5444 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
5445 int mcast_rate[IEEE80211_NUM_BANDS],
5448 struct wiphy *wiphy = &rdev->wiphy;
5452 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
5453 struct ieee80211_supported_band *sband;
5455 sband = wiphy->bands[band];
5459 for (i = 0; i < sband->n_bitrates; i++) {
5460 if (sband->bitrates[i].bitrate == rateval) {
5461 mcast_rate[band] = i + 1;
5471 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
5473 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5474 struct net_device *dev = info->user_ptr[1];
5475 struct cfg80211_ibss_params ibss;
5476 struct wiphy *wiphy;
5477 struct cfg80211_cached_keys *connkeys = NULL;
5480 memset(&ibss, 0, sizeof(ibss));
5482 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5485 if (!info->attrs[NL80211_ATTR_SSID] ||
5486 !nla_len(info->attrs[NL80211_ATTR_SSID]))
5489 ibss.beacon_interval = 100;
5491 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
5492 ibss.beacon_interval =
5493 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
5494 if (ibss.beacon_interval < 1 || ibss.beacon_interval > 10000)
5498 if (!rdev->ops->join_ibss)
5501 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
5504 wiphy = &rdev->wiphy;
5506 if (info->attrs[NL80211_ATTR_MAC]) {
5507 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
5509 if (!is_valid_ether_addr(ibss.bssid))
5512 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
5513 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
5515 if (info->attrs[NL80211_ATTR_IE]) {
5516 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5517 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
5520 err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
5524 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef))
5527 if (ibss.chandef.width > NL80211_CHAN_WIDTH_40)
5529 if (ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
5530 !(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
5532 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
5533 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
5535 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
5537 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5539 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5540 struct ieee80211_supported_band *sband =
5541 wiphy->bands[ibss.chandef.chan->band];
5543 err = ieee80211_get_ratemask(sband, rates, n_rates,
5549 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
5550 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
5551 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
5554 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
5557 connkeys = nl80211_parse_connkeys(rdev,
5558 info->attrs[NL80211_ATTR_KEYS],
5560 if (IS_ERR(connkeys))
5561 return PTR_ERR(connkeys);
5563 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
5571 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
5573 err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
5579 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
5581 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5582 struct net_device *dev = info->user_ptr[1];
5584 if (!rdev->ops->leave_ibss)
5587 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
5590 return cfg80211_leave_ibss(rdev, dev, false);
5593 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
5595 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5596 struct net_device *dev = info->user_ptr[1];
5597 int mcast_rate[IEEE80211_NUM_BANDS];
5601 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
5602 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5605 if (!rdev->ops->set_mcast_rate)
5608 memset(mcast_rate, 0, sizeof(mcast_rate));
5610 if (!info->attrs[NL80211_ATTR_MCAST_RATE])
5613 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
5614 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
5617 err = rdev->ops->set_mcast_rate(&rdev->wiphy, dev, mcast_rate);
5623 #ifdef CONFIG_NL80211_TESTMODE
5624 static struct genl_multicast_group nl80211_testmode_mcgrp = {
5628 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
5630 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5633 if (!info->attrs[NL80211_ATTR_TESTDATA])
5637 if (rdev->ops->testmode_cmd) {
5638 rdev->testmode_info = info;
5639 err = rdev_testmode_cmd(rdev,
5640 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
5641 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
5642 rdev->testmode_info = NULL;
5648 static int nl80211_testmode_dump(struct sk_buff *skb,
5649 struct netlink_callback *cb)
5651 struct cfg80211_registered_device *rdev;
5659 * 0 is a valid index, but not valid for args[0],
5660 * so we need to offset by 1.
5662 phy_idx = cb->args[0] - 1;
5664 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
5665 nl80211_fam.attrbuf, nl80211_fam.maxattr,
5670 mutex_lock(&cfg80211_mutex);
5671 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk),
5672 nl80211_fam.attrbuf);
5674 mutex_unlock(&cfg80211_mutex);
5675 return PTR_ERR(rdev);
5677 phy_idx = rdev->wiphy_idx;
5679 mutex_unlock(&cfg80211_mutex);
5681 if (nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA])
5683 (long)nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA];
5687 data = nla_data((void *)cb->args[1]);
5688 data_len = nla_len((void *)cb->args[1]);
5691 mutex_lock(&cfg80211_mutex);
5692 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
5694 mutex_unlock(&cfg80211_mutex);
5697 cfg80211_lock_rdev(rdev);
5698 mutex_unlock(&cfg80211_mutex);
5700 if (!rdev->ops->testmode_dump) {
5706 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
5707 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5708 NL80211_CMD_TESTMODE);
5709 struct nlattr *tmdata;
5711 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
5712 genlmsg_cancel(skb, hdr);
5716 tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
5718 genlmsg_cancel(skb, hdr);
5721 err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
5722 nla_nest_end(skb, tmdata);
5724 if (err == -ENOBUFS || err == -ENOENT) {
5725 genlmsg_cancel(skb, hdr);
5728 genlmsg_cancel(skb, hdr);
5732 genlmsg_end(skb, hdr);
5737 cb->args[0] = phy_idx + 1;
5739 cfg80211_unlock_rdev(rdev);
5743 static struct sk_buff *
5744 __cfg80211_testmode_alloc_skb(struct cfg80211_registered_device *rdev,
5745 int approxlen, u32 portid, u32 seq, gfp_t gfp)
5747 struct sk_buff *skb;
5749 struct nlattr *data;
5751 skb = nlmsg_new(approxlen + 100, gfp);
5755 hdr = nl80211hdr_put(skb, portid, seq, 0, NL80211_CMD_TESTMODE);
5761 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
5762 goto nla_put_failure;
5763 data = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
5765 ((void **)skb->cb)[0] = rdev;
5766 ((void **)skb->cb)[1] = hdr;
5767 ((void **)skb->cb)[2] = data;
5776 struct sk_buff *cfg80211_testmode_alloc_reply_skb(struct wiphy *wiphy,
5779 struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
5781 if (WARN_ON(!rdev->testmode_info))
5784 return __cfg80211_testmode_alloc_skb(rdev, approxlen,
5785 rdev->testmode_info->snd_portid,
5786 rdev->testmode_info->snd_seq,
5789 EXPORT_SYMBOL(cfg80211_testmode_alloc_reply_skb);
5791 int cfg80211_testmode_reply(struct sk_buff *skb)
5793 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
5794 void *hdr = ((void **)skb->cb)[1];
5795 struct nlattr *data = ((void **)skb->cb)[2];
5797 if (WARN_ON(!rdev->testmode_info)) {
5802 nla_nest_end(skb, data);
5803 genlmsg_end(skb, hdr);
5804 return genlmsg_reply(skb, rdev->testmode_info);
5806 EXPORT_SYMBOL(cfg80211_testmode_reply);
5808 struct sk_buff *cfg80211_testmode_alloc_event_skb(struct wiphy *wiphy,
5809 int approxlen, gfp_t gfp)
5811 struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
5813 return __cfg80211_testmode_alloc_skb(rdev, approxlen, 0, 0, gfp);
5815 EXPORT_SYMBOL(cfg80211_testmode_alloc_event_skb);
5817 void cfg80211_testmode_event(struct sk_buff *skb, gfp_t gfp)
5819 void *hdr = ((void **)skb->cb)[1];
5820 struct nlattr *data = ((void **)skb->cb)[2];
5822 nla_nest_end(skb, data);
5823 genlmsg_end(skb, hdr);
5824 genlmsg_multicast(skb, 0, nl80211_testmode_mcgrp.id, gfp);
5826 EXPORT_SYMBOL(cfg80211_testmode_event);
5829 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
5831 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5832 struct net_device *dev = info->user_ptr[1];
5833 struct cfg80211_connect_params connect;
5834 struct wiphy *wiphy;
5835 struct cfg80211_cached_keys *connkeys = NULL;
5838 memset(&connect, 0, sizeof(connect));
5840 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
5843 if (!info->attrs[NL80211_ATTR_SSID] ||
5844 !nla_len(info->attrs[NL80211_ATTR_SSID]))
5847 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
5849 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
5850 if (!nl80211_valid_auth_type(rdev, connect.auth_type,
5851 NL80211_CMD_CONNECT))
5854 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
5856 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
5858 err = nl80211_crypto_settings(rdev, info, &connect.crypto,
5859 NL80211_MAX_NR_CIPHER_SUITES);
5863 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
5864 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5867 wiphy = &rdev->wiphy;
5869 connect.bg_scan_period = -1;
5870 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
5871 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
5872 connect.bg_scan_period =
5873 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
5876 if (info->attrs[NL80211_ATTR_MAC])
5877 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
5878 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
5879 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
5881 if (info->attrs[NL80211_ATTR_IE]) {
5882 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
5883 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
5886 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
5888 ieee80211_get_channel(wiphy,
5889 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
5890 if (!connect.channel ||
5891 connect.channel->flags & IEEE80211_CHAN_DISABLED)
5895 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
5896 connkeys = nl80211_parse_connkeys(rdev,
5897 info->attrs[NL80211_ATTR_KEYS], NULL);
5898 if (IS_ERR(connkeys))
5899 return PTR_ERR(connkeys);
5902 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
5903 connect.flags |= ASSOC_REQ_DISABLE_HT;
5905 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
5906 memcpy(&connect.ht_capa_mask,
5907 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
5908 sizeof(connect.ht_capa_mask));
5910 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
5911 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
5915 memcpy(&connect.ht_capa,
5916 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
5917 sizeof(connect.ht_capa));
5920 err = cfg80211_connect(rdev, dev, &connect, connkeys);
5926 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
5928 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5929 struct net_device *dev = info->user_ptr[1];
5932 if (!info->attrs[NL80211_ATTR_REASON_CODE])
5933 reason = WLAN_REASON_DEAUTH_LEAVING;
5935 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5940 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
5941 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5944 return cfg80211_disconnect(rdev, dev, reason, true);
5947 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
5949 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5954 if (!info->attrs[NL80211_ATTR_PID])
5957 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
5959 net = get_net_ns_by_pid(pid);
5961 return PTR_ERR(net);
5965 /* check if anything to do */
5966 if (!net_eq(wiphy_net(&rdev->wiphy), net))
5967 err = cfg80211_switch_netns(rdev, net);
5973 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
5975 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5976 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
5977 struct cfg80211_pmksa *pmksa) = NULL;
5978 struct net_device *dev = info->user_ptr[1];
5979 struct cfg80211_pmksa pmksa;
5981 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
5983 if (!info->attrs[NL80211_ATTR_MAC])
5986 if (!info->attrs[NL80211_ATTR_PMKID])
5989 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
5990 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
5992 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
5993 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
5996 switch (info->genlhdr->cmd) {
5997 case NL80211_CMD_SET_PMKSA:
5998 rdev_ops = rdev->ops->set_pmksa;
6000 case NL80211_CMD_DEL_PMKSA:
6001 rdev_ops = rdev->ops->del_pmksa;
6011 return rdev_ops(&rdev->wiphy, dev, &pmksa);
6014 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
6016 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6017 struct net_device *dev = info->user_ptr[1];
6019 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
6020 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
6023 if (!rdev->ops->flush_pmksa)
6026 return rdev_flush_pmksa(rdev, dev);
6029 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
6031 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6032 struct net_device *dev = info->user_ptr[1];
6033 u8 action_code, dialog_token;
6037 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
6038 !rdev->ops->tdls_mgmt)
6041 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
6042 !info->attrs[NL80211_ATTR_STATUS_CODE] ||
6043 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
6044 !info->attrs[NL80211_ATTR_IE] ||
6045 !info->attrs[NL80211_ATTR_MAC])
6048 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
6049 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
6050 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
6051 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
6053 return rdev_tdls_mgmt(rdev, dev, peer, action_code,
6054 dialog_token, status_code,
6055 nla_data(info->attrs[NL80211_ATTR_IE]),
6056 nla_len(info->attrs[NL80211_ATTR_IE]));
6059 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
6061 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6062 struct net_device *dev = info->user_ptr[1];
6063 enum nl80211_tdls_operation operation;
6066 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
6067 !rdev->ops->tdls_oper)
6070 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
6071 !info->attrs[NL80211_ATTR_MAC])
6074 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
6075 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
6077 return rdev_tdls_oper(rdev, dev, peer, operation);
6080 static int nl80211_remain_on_channel(struct sk_buff *skb,
6081 struct genl_info *info)
6083 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6084 struct wireless_dev *wdev = info->user_ptr[1];
6085 struct cfg80211_chan_def chandef;
6086 struct sk_buff *msg;
6092 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
6093 !info->attrs[NL80211_ATTR_DURATION])
6096 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
6098 if (!rdev->ops->remain_on_channel ||
6099 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
6103 * We should be on that channel for at least a minimum amount of
6104 * time (10ms) but no longer than the driver supports.
6106 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
6107 duration > rdev->wiphy.max_remain_on_channel_duration)
6110 err = nl80211_parse_chandef(rdev, info, &chandef);
6114 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6118 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6119 NL80211_CMD_REMAIN_ON_CHANNEL);
6126 err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
6132 if (nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
6133 goto nla_put_failure;
6135 genlmsg_end(msg, hdr);
6137 return genlmsg_reply(msg, info);
6146 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
6147 struct genl_info *info)
6149 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6150 struct wireless_dev *wdev = info->user_ptr[1];
6153 if (!info->attrs[NL80211_ATTR_COOKIE])
6156 if (!rdev->ops->cancel_remain_on_channel)
6159 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
6161 return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
6164 static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
6165 u8 *rates, u8 rates_len)
6170 for (i = 0; i < rates_len; i++) {
6171 int rate = (rates[i] & 0x7f) * 5;
6173 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
6174 struct ieee80211_rate *srate =
6175 &sband->bitrates[ridx];
6176 if (rate == srate->bitrate) {
6181 if (ridx == sband->n_bitrates)
6182 return 0; /* rate not found */
6188 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
6189 u8 *rates, u8 rates_len,
6190 u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
6194 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
6196 for (i = 0; i < rates_len; i++) {
6199 ridx = rates[i] / 8;
6200 rbit = BIT(rates[i] % 8);
6202 /* check validity */
6203 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
6206 /* check availability */
6207 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
6216 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
6217 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
6218 .len = NL80211_MAX_SUPP_RATES },
6219 [NL80211_TXRATE_MCS] = { .type = NLA_BINARY,
6220 .len = NL80211_MAX_SUPP_HT_RATES },
6223 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
6224 struct genl_info *info)
6226 struct nlattr *tb[NL80211_TXRATE_MAX + 1];
6227 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6228 struct cfg80211_bitrate_mask mask;
6230 struct net_device *dev = info->user_ptr[1];
6231 struct nlattr *tx_rates;
6232 struct ieee80211_supported_band *sband;
6234 if (info->attrs[NL80211_ATTR_TX_RATES] == NULL)
6237 if (!rdev->ops->set_bitrate_mask)
6240 memset(&mask, 0, sizeof(mask));
6241 /* Default to all rates enabled */
6242 for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
6243 sband = rdev->wiphy.bands[i];
6244 mask.control[i].legacy =
6245 sband ? (1 << sband->n_bitrates) - 1 : 0;
6247 memcpy(mask.control[i].mcs,
6248 sband->ht_cap.mcs.rx_mask,
6249 sizeof(mask.control[i].mcs));
6251 memset(mask.control[i].mcs, 0,
6252 sizeof(mask.control[i].mcs));
6256 * The nested attribute uses enum nl80211_band as the index. This maps
6257 * directly to the enum ieee80211_band values used in cfg80211.
6259 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
6260 nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem)
6262 enum ieee80211_band band = nla_type(tx_rates);
6263 if (band < 0 || band >= IEEE80211_NUM_BANDS)
6265 sband = rdev->wiphy.bands[band];
6268 nla_parse(tb, NL80211_TXRATE_MAX, nla_data(tx_rates),
6269 nla_len(tx_rates), nl80211_txattr_policy);
6270 if (tb[NL80211_TXRATE_LEGACY]) {
6271 mask.control[band].legacy = rateset_to_mask(
6273 nla_data(tb[NL80211_TXRATE_LEGACY]),
6274 nla_len(tb[NL80211_TXRATE_LEGACY]));
6275 if ((mask.control[band].legacy == 0) &&
6276 nla_len(tb[NL80211_TXRATE_LEGACY]))
6279 if (tb[NL80211_TXRATE_MCS]) {
6280 if (!ht_rateset_to_mask(
6282 nla_data(tb[NL80211_TXRATE_MCS]),
6283 nla_len(tb[NL80211_TXRATE_MCS]),
6284 mask.control[band].mcs))
6288 if (mask.control[band].legacy == 0) {
6289 /* don't allow empty legacy rates if HT
6290 * is not even supported. */
6291 if (!rdev->wiphy.bands[band]->ht_cap.ht_supported)
6294 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
6295 if (mask.control[band].mcs[i])
6298 /* legacy and mcs rates may not be both empty */
6299 if (i == IEEE80211_HT_MCS_MASK_LEN)
6304 return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
6307 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
6309 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6310 struct wireless_dev *wdev = info->user_ptr[1];
6311 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
6313 if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
6316 if (info->attrs[NL80211_ATTR_FRAME_TYPE])
6317 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
6319 switch (wdev->iftype) {
6320 case NL80211_IFTYPE_STATION:
6321 case NL80211_IFTYPE_ADHOC:
6322 case NL80211_IFTYPE_P2P_CLIENT:
6323 case NL80211_IFTYPE_AP:
6324 case NL80211_IFTYPE_AP_VLAN:
6325 case NL80211_IFTYPE_MESH_POINT:
6326 case NL80211_IFTYPE_P2P_GO:
6327 case NL80211_IFTYPE_P2P_DEVICE:
6333 /* not much point in registering if we can't reply */
6334 if (!rdev->ops->mgmt_tx)
6337 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
6338 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
6339 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
6342 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
6344 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6345 struct wireless_dev *wdev = info->user_ptr[1];
6346 struct cfg80211_chan_def chandef;
6350 struct sk_buff *msg = NULL;
6351 unsigned int wait = 0;
6352 bool offchan, no_cck, dont_wait_for_ack;
6354 dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK];
6356 if (!info->attrs[NL80211_ATTR_FRAME])
6359 if (!rdev->ops->mgmt_tx)
6362 switch (wdev->iftype) {
6363 case NL80211_IFTYPE_STATION:
6364 case NL80211_IFTYPE_ADHOC:
6365 case NL80211_IFTYPE_P2P_CLIENT:
6366 case NL80211_IFTYPE_AP:
6367 case NL80211_IFTYPE_AP_VLAN:
6368 case NL80211_IFTYPE_MESH_POINT:
6369 case NL80211_IFTYPE_P2P_GO:
6370 case NL80211_IFTYPE_P2P_DEVICE:
6376 if (info->attrs[NL80211_ATTR_DURATION]) {
6377 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
6379 wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
6382 * We should wait on the channel for at least a minimum amount
6383 * of time (10ms) but no longer than the driver supports.
6385 if (wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
6386 wait > rdev->wiphy.max_remain_on_channel_duration)
6391 offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
6393 if (offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
6396 no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
6398 err = nl80211_parse_chandef(rdev, info, &chandef);
6402 if (!dont_wait_for_ack) {
6403 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6407 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6416 err = cfg80211_mlme_mgmt_tx(rdev, wdev, chandef.chan, offchan, wait,
6417 nla_data(info->attrs[NL80211_ATTR_FRAME]),
6418 nla_len(info->attrs[NL80211_ATTR_FRAME]),
6419 no_cck, dont_wait_for_ack, &cookie);
6424 if (nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
6425 goto nla_put_failure;
6427 genlmsg_end(msg, hdr);
6428 return genlmsg_reply(msg, info);
6440 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
6442 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6443 struct wireless_dev *wdev = info->user_ptr[1];
6446 if (!info->attrs[NL80211_ATTR_COOKIE])
6449 if (!rdev->ops->mgmt_tx_cancel_wait)
6452 switch (wdev->iftype) {
6453 case NL80211_IFTYPE_STATION:
6454 case NL80211_IFTYPE_ADHOC:
6455 case NL80211_IFTYPE_P2P_CLIENT:
6456 case NL80211_IFTYPE_AP:
6457 case NL80211_IFTYPE_AP_VLAN:
6458 case NL80211_IFTYPE_P2P_GO:
6459 case NL80211_IFTYPE_P2P_DEVICE:
6465 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
6467 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
6470 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
6472 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6473 struct wireless_dev *wdev;
6474 struct net_device *dev = info->user_ptr[1];
6479 if (!info->attrs[NL80211_ATTR_PS_STATE])
6482 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
6484 if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
6487 wdev = dev->ieee80211_ptr;
6489 if (!rdev->ops->set_power_mgmt)
6492 state = (ps_state == NL80211_PS_ENABLED) ? true : false;
6494 if (state == wdev->ps)
6497 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
6503 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
6505 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6506 enum nl80211_ps_state ps_state;
6507 struct wireless_dev *wdev;
6508 struct net_device *dev = info->user_ptr[1];
6509 struct sk_buff *msg;
6513 wdev = dev->ieee80211_ptr;
6515 if (!rdev->ops->set_power_mgmt)
6518 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6522 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6523 NL80211_CMD_GET_POWER_SAVE);
6530 ps_state = NL80211_PS_ENABLED;
6532 ps_state = NL80211_PS_DISABLED;
6534 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
6535 goto nla_put_failure;
6537 genlmsg_end(msg, hdr);
6538 return genlmsg_reply(msg, info);
6547 static struct nla_policy
6548 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] __read_mostly = {
6549 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
6550 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
6551 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
6552 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
6553 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
6554 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
6557 static int nl80211_set_cqm_txe(struct genl_info *info,
6558 u32 rate, u32 pkts, u32 intvl)
6560 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6561 struct wireless_dev *wdev;
6562 struct net_device *dev = info->user_ptr[1];
6564 if ((rate < 0 || rate > 100) ||
6565 (intvl < 0 || intvl > NL80211_CQM_TXE_MAX_INTVL))
6568 wdev = dev->ieee80211_ptr;
6570 if (!rdev->ops->set_cqm_txe_config)
6573 if (wdev->iftype != NL80211_IFTYPE_STATION &&
6574 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
6577 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
6580 static int nl80211_set_cqm_rssi(struct genl_info *info,
6581 s32 threshold, u32 hysteresis)
6583 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6584 struct wireless_dev *wdev;
6585 struct net_device *dev = info->user_ptr[1];
6590 wdev = dev->ieee80211_ptr;
6592 if (!rdev->ops->set_cqm_rssi_config)
6595 if (wdev->iftype != NL80211_IFTYPE_STATION &&
6596 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
6599 return rdev_set_cqm_rssi_config(rdev, dev, threshold, hysteresis);
6602 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
6604 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
6608 cqm = info->attrs[NL80211_ATTR_CQM];
6614 err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
6615 nl80211_attr_cqm_policy);
6619 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
6620 attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
6623 threshold = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
6624 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
6625 err = nl80211_set_cqm_rssi(info, threshold, hysteresis);
6626 } else if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
6627 attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
6628 attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
6629 u32 rate, pkts, intvl;
6630 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
6631 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
6632 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
6633 err = nl80211_set_cqm_txe(info, rate, pkts, intvl);
6641 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
6643 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6644 struct net_device *dev = info->user_ptr[1];
6645 struct mesh_config cfg;
6646 struct mesh_setup setup;
6649 /* start with default */
6650 memcpy(&cfg, &default_mesh_config, sizeof(cfg));
6651 memcpy(&setup, &default_mesh_setup, sizeof(setup));
6653 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
6654 /* and parse parameters if given */
6655 err = nl80211_parse_mesh_config(info, &cfg, NULL);
6660 if (!info->attrs[NL80211_ATTR_MESH_ID] ||
6661 !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
6664 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
6665 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
6667 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
6668 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
6669 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
6672 if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
6673 /* parse additional setup parameters if given */
6674 err = nl80211_parse_mesh_setup(info, &setup);
6679 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
6680 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
6684 /* cfg80211_join_mesh() will sort it out */
6685 setup.chandef.chan = NULL;
6688 return cfg80211_join_mesh(rdev, dev, &setup, &cfg);
6691 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
6693 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6694 struct net_device *dev = info->user_ptr[1];
6696 return cfg80211_leave_mesh(rdev, dev);
6700 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
6702 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6703 struct sk_buff *msg;
6706 if (!rdev->wiphy.wowlan.flags && !rdev->wiphy.wowlan.n_patterns)
6709 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6713 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6714 NL80211_CMD_GET_WOWLAN);
6716 goto nla_put_failure;
6719 struct nlattr *nl_wowlan;
6721 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
6723 goto nla_put_failure;
6725 if ((rdev->wowlan->any &&
6726 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
6727 (rdev->wowlan->disconnect &&
6728 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
6729 (rdev->wowlan->magic_pkt &&
6730 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
6731 (rdev->wowlan->gtk_rekey_failure &&
6732 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
6733 (rdev->wowlan->eap_identity_req &&
6734 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
6735 (rdev->wowlan->four_way_handshake &&
6736 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
6737 (rdev->wowlan->rfkill_release &&
6738 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
6739 goto nla_put_failure;
6740 if (rdev->wowlan->n_patterns) {
6741 struct nlattr *nl_pats, *nl_pat;
6744 nl_pats = nla_nest_start(msg,
6745 NL80211_WOWLAN_TRIG_PKT_PATTERN);
6747 goto nla_put_failure;
6749 for (i = 0; i < rdev->wowlan->n_patterns; i++) {
6750 nl_pat = nla_nest_start(msg, i + 1);
6752 goto nla_put_failure;
6753 pat_len = rdev->wowlan->patterns[i].pattern_len;
6754 if (nla_put(msg, NL80211_WOWLAN_PKTPAT_MASK,
6755 DIV_ROUND_UP(pat_len, 8),
6756 rdev->wowlan->patterns[i].mask) ||
6757 nla_put(msg, NL80211_WOWLAN_PKTPAT_PATTERN,
6759 rdev->wowlan->patterns[i].pattern))
6760 goto nla_put_failure;
6761 nla_nest_end(msg, nl_pat);
6763 nla_nest_end(msg, nl_pats);
6766 nla_nest_end(msg, nl_wowlan);
6769 genlmsg_end(msg, hdr);
6770 return genlmsg_reply(msg, info);
6777 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
6779 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6780 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
6781 struct cfg80211_wowlan new_triggers = {};
6782 struct cfg80211_wowlan *ntrig;
6783 struct wiphy_wowlan_support *wowlan = &rdev->wiphy.wowlan;
6785 bool prev_enabled = rdev->wowlan;
6787 if (!rdev->wiphy.wowlan.flags && !rdev->wiphy.wowlan.n_patterns)
6790 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
6791 cfg80211_rdev_free_wowlan(rdev);
6792 rdev->wowlan = NULL;
6796 err = nla_parse(tb, MAX_NL80211_WOWLAN_TRIG,
6797 nla_data(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
6798 nla_len(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
6799 nl80211_wowlan_policy);
6803 if (tb[NL80211_WOWLAN_TRIG_ANY]) {
6804 if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
6806 new_triggers.any = true;
6809 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
6810 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
6812 new_triggers.disconnect = true;
6815 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
6816 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
6818 new_triggers.magic_pkt = true;
6821 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
6824 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
6825 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
6827 new_triggers.gtk_rekey_failure = true;
6830 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
6831 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
6833 new_triggers.eap_identity_req = true;
6836 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
6837 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
6839 new_triggers.four_way_handshake = true;
6842 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
6843 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
6845 new_triggers.rfkill_release = true;
6848 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
6851 int rem, pat_len, mask_len;
6852 struct nlattr *pat_tb[NUM_NL80211_WOWLAN_PKTPAT];
6854 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
6857 if (n_patterns > wowlan->n_patterns)
6860 new_triggers.patterns = kcalloc(n_patterns,
6861 sizeof(new_triggers.patterns[0]),
6863 if (!new_triggers.patterns)
6866 new_triggers.n_patterns = n_patterns;
6869 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
6871 nla_parse(pat_tb, MAX_NL80211_WOWLAN_PKTPAT,
6872 nla_data(pat), nla_len(pat), NULL);
6874 if (!pat_tb[NL80211_WOWLAN_PKTPAT_MASK] ||
6875 !pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN])
6877 pat_len = nla_len(pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN]);
6878 mask_len = DIV_ROUND_UP(pat_len, 8);
6879 if (nla_len(pat_tb[NL80211_WOWLAN_PKTPAT_MASK]) !=
6882 if (pat_len > wowlan->pattern_max_len ||
6883 pat_len < wowlan->pattern_min_len)
6886 new_triggers.patterns[i].mask =
6887 kmalloc(mask_len + pat_len, GFP_KERNEL);
6888 if (!new_triggers.patterns[i].mask) {
6892 new_triggers.patterns[i].pattern =
6893 new_triggers.patterns[i].mask + mask_len;
6894 memcpy(new_triggers.patterns[i].mask,
6895 nla_data(pat_tb[NL80211_WOWLAN_PKTPAT_MASK]),
6897 new_triggers.patterns[i].pattern_len = pat_len;
6898 memcpy(new_triggers.patterns[i].pattern,
6899 nla_data(pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN]),
6905 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
6910 cfg80211_rdev_free_wowlan(rdev);
6911 rdev->wowlan = ntrig;
6914 if (rdev->ops->set_wakeup && prev_enabled != !!rdev->wowlan)
6915 rdev_set_wakeup(rdev, rdev->wowlan);
6919 for (i = 0; i < new_triggers.n_patterns; i++)
6920 kfree(new_triggers.patterns[i].mask);
6921 kfree(new_triggers.patterns);
6926 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
6928 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6929 struct net_device *dev = info->user_ptr[1];
6930 struct wireless_dev *wdev = dev->ieee80211_ptr;
6931 struct nlattr *tb[NUM_NL80211_REKEY_DATA];
6932 struct cfg80211_gtk_rekey_data rekey_data;
6935 if (!info->attrs[NL80211_ATTR_REKEY_DATA])
6938 err = nla_parse(tb, MAX_NL80211_REKEY_DATA,
6939 nla_data(info->attrs[NL80211_ATTR_REKEY_DATA]),
6940 nla_len(info->attrs[NL80211_ATTR_REKEY_DATA]),
6941 nl80211_rekey_policy);
6945 if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
6947 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
6949 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
6952 memcpy(rekey_data.kek, nla_data(tb[NL80211_REKEY_DATA_KEK]),
6954 memcpy(rekey_data.kck, nla_data(tb[NL80211_REKEY_DATA_KCK]),
6956 memcpy(rekey_data.replay_ctr,
6957 nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]),
6958 NL80211_REPLAY_CTR_LEN);
6961 if (!wdev->current_bss) {
6966 if (!rdev->ops->set_rekey_data) {
6971 err = rdev_set_rekey_data(rdev, dev, &rekey_data);
6977 static int nl80211_register_unexpected_frame(struct sk_buff *skb,
6978 struct genl_info *info)
6980 struct net_device *dev = info->user_ptr[1];
6981 struct wireless_dev *wdev = dev->ieee80211_ptr;
6983 if (wdev->iftype != NL80211_IFTYPE_AP &&
6984 wdev->iftype != NL80211_IFTYPE_P2P_GO)
6987 if (wdev->ap_unexpected_nlportid)
6990 wdev->ap_unexpected_nlportid = info->snd_portid;
6994 static int nl80211_probe_client(struct sk_buff *skb,
6995 struct genl_info *info)
6997 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6998 struct net_device *dev = info->user_ptr[1];
6999 struct wireless_dev *wdev = dev->ieee80211_ptr;
7000 struct sk_buff *msg;
7006 if (wdev->iftype != NL80211_IFTYPE_AP &&
7007 wdev->iftype != NL80211_IFTYPE_P2P_GO)
7010 if (!info->attrs[NL80211_ATTR_MAC])
7013 if (!rdev->ops->probe_client)
7016 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
7020 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
7021 NL80211_CMD_PROBE_CLIENT);
7028 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
7030 err = rdev_probe_client(rdev, dev, addr, &cookie);
7034 if (nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
7035 goto nla_put_failure;
7037 genlmsg_end(msg, hdr);
7039 return genlmsg_reply(msg, info);
7048 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
7050 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7051 struct cfg80211_beacon_registration *reg, *nreg;
7054 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
7057 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
7061 /* First, check if already registered. */
7062 spin_lock_bh(&rdev->beacon_registrations_lock);
7063 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
7064 if (reg->nlportid == info->snd_portid) {
7069 /* Add it to the list */
7070 nreg->nlportid = info->snd_portid;
7071 list_add(&nreg->list, &rdev->beacon_registrations);
7073 spin_unlock_bh(&rdev->beacon_registrations_lock);
7077 spin_unlock_bh(&rdev->beacon_registrations_lock);
7082 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
7084 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7085 struct wireless_dev *wdev = info->user_ptr[1];
7088 if (!rdev->ops->start_p2p_device)
7091 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
7094 if (wdev->p2p_started)
7097 mutex_lock(&rdev->devlist_mtx);
7098 err = cfg80211_can_add_interface(rdev, wdev->iftype);
7099 mutex_unlock(&rdev->devlist_mtx);
7103 err = rdev_start_p2p_device(rdev, wdev);
7107 wdev->p2p_started = true;
7108 mutex_lock(&rdev->devlist_mtx);
7110 mutex_unlock(&rdev->devlist_mtx);
7115 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
7117 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7118 struct wireless_dev *wdev = info->user_ptr[1];
7120 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
7123 if (!rdev->ops->stop_p2p_device)
7126 if (!wdev->p2p_started)
7129 rdev_stop_p2p_device(rdev, wdev);
7130 wdev->p2p_started = false;
7132 mutex_lock(&rdev->devlist_mtx);
7134 mutex_unlock(&rdev->devlist_mtx);
7136 if (WARN_ON(rdev->scan_req && rdev->scan_req->wdev == wdev)) {
7137 rdev->scan_req->aborted = true;
7138 ___cfg80211_scan_done(rdev, true);
7144 #define NL80211_FLAG_NEED_WIPHY 0x01
7145 #define NL80211_FLAG_NEED_NETDEV 0x02
7146 #define NL80211_FLAG_NEED_RTNL 0x04
7147 #define NL80211_FLAG_CHECK_NETDEV_UP 0x08
7148 #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
7149 NL80211_FLAG_CHECK_NETDEV_UP)
7150 #define NL80211_FLAG_NEED_WDEV 0x10
7151 /* If a netdev is associated, it must be UP, P2P must be started */
7152 #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
7153 NL80211_FLAG_CHECK_NETDEV_UP)
7155 static int nl80211_pre_doit(struct genl_ops *ops, struct sk_buff *skb,
7156 struct genl_info *info)
7158 struct cfg80211_registered_device *rdev;
7159 struct wireless_dev *wdev;
7160 struct net_device *dev;
7161 bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
7166 if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
7167 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
7171 return PTR_ERR(rdev);
7173 info->user_ptr[0] = rdev;
7174 } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
7175 ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
7176 mutex_lock(&cfg80211_mutex);
7177 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
7180 mutex_unlock(&cfg80211_mutex);
7183 return PTR_ERR(wdev);
7187 rdev = wiphy_to_dev(wdev->wiphy);
7189 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
7191 mutex_unlock(&cfg80211_mutex);
7197 info->user_ptr[1] = dev;
7199 info->user_ptr[1] = wdev;
7203 if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
7204 !netif_running(dev)) {
7205 mutex_unlock(&cfg80211_mutex);
7212 } else if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP) {
7213 if (!wdev->p2p_started) {
7214 mutex_unlock(&cfg80211_mutex);
7221 cfg80211_lock_rdev(rdev);
7223 mutex_unlock(&cfg80211_mutex);
7225 info->user_ptr[0] = rdev;
7231 static void nl80211_post_doit(struct genl_ops *ops, struct sk_buff *skb,
7232 struct genl_info *info)
7234 if (info->user_ptr[0])
7235 cfg80211_unlock_rdev(info->user_ptr[0]);
7236 if (info->user_ptr[1]) {
7237 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
7238 struct wireless_dev *wdev = info->user_ptr[1];
7241 dev_put(wdev->netdev);
7243 dev_put(info->user_ptr[1]);
7246 if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
7250 static struct genl_ops nl80211_ops[] = {
7252 .cmd = NL80211_CMD_GET_WIPHY,
7253 .doit = nl80211_get_wiphy,
7254 .dumpit = nl80211_dump_wiphy,
7255 .policy = nl80211_policy,
7256 /* can be retrieved by unprivileged users */
7257 .internal_flags = NL80211_FLAG_NEED_WIPHY,
7260 .cmd = NL80211_CMD_SET_WIPHY,
7261 .doit = nl80211_set_wiphy,
7262 .policy = nl80211_policy,
7263 .flags = GENL_ADMIN_PERM,
7264 .internal_flags = NL80211_FLAG_NEED_RTNL,
7267 .cmd = NL80211_CMD_GET_INTERFACE,
7268 .doit = nl80211_get_interface,
7269 .dumpit = nl80211_dump_interface,
7270 .policy = nl80211_policy,
7271 /* can be retrieved by unprivileged users */
7272 .internal_flags = NL80211_FLAG_NEED_WDEV,
7275 .cmd = NL80211_CMD_SET_INTERFACE,
7276 .doit = nl80211_set_interface,
7277 .policy = nl80211_policy,
7278 .flags = GENL_ADMIN_PERM,
7279 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7280 NL80211_FLAG_NEED_RTNL,
7283 .cmd = NL80211_CMD_NEW_INTERFACE,
7284 .doit = nl80211_new_interface,
7285 .policy = nl80211_policy,
7286 .flags = GENL_ADMIN_PERM,
7287 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7288 NL80211_FLAG_NEED_RTNL,
7291 .cmd = NL80211_CMD_DEL_INTERFACE,
7292 .doit = nl80211_del_interface,
7293 .policy = nl80211_policy,
7294 .flags = GENL_ADMIN_PERM,
7295 .internal_flags = NL80211_FLAG_NEED_WDEV |
7296 NL80211_FLAG_NEED_RTNL,
7299 .cmd = NL80211_CMD_GET_KEY,
7300 .doit = nl80211_get_key,
7301 .policy = nl80211_policy,
7302 .flags = GENL_ADMIN_PERM,
7303 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7304 NL80211_FLAG_NEED_RTNL,
7307 .cmd = NL80211_CMD_SET_KEY,
7308 .doit = nl80211_set_key,
7309 .policy = nl80211_policy,
7310 .flags = GENL_ADMIN_PERM,
7311 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7312 NL80211_FLAG_NEED_RTNL,
7315 .cmd = NL80211_CMD_NEW_KEY,
7316 .doit = nl80211_new_key,
7317 .policy = nl80211_policy,
7318 .flags = GENL_ADMIN_PERM,
7319 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7320 NL80211_FLAG_NEED_RTNL,
7323 .cmd = NL80211_CMD_DEL_KEY,
7324 .doit = nl80211_del_key,
7325 .policy = nl80211_policy,
7326 .flags = GENL_ADMIN_PERM,
7327 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7328 NL80211_FLAG_NEED_RTNL,
7331 .cmd = NL80211_CMD_SET_BEACON,
7332 .policy = nl80211_policy,
7333 .flags = GENL_ADMIN_PERM,
7334 .doit = nl80211_set_beacon,
7335 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7336 NL80211_FLAG_NEED_RTNL,
7339 .cmd = NL80211_CMD_START_AP,
7340 .policy = nl80211_policy,
7341 .flags = GENL_ADMIN_PERM,
7342 .doit = nl80211_start_ap,
7343 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7344 NL80211_FLAG_NEED_RTNL,
7347 .cmd = NL80211_CMD_STOP_AP,
7348 .policy = nl80211_policy,
7349 .flags = GENL_ADMIN_PERM,
7350 .doit = nl80211_stop_ap,
7351 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7352 NL80211_FLAG_NEED_RTNL,
7355 .cmd = NL80211_CMD_GET_STATION,
7356 .doit = nl80211_get_station,
7357 .dumpit = nl80211_dump_station,
7358 .policy = nl80211_policy,
7359 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7360 NL80211_FLAG_NEED_RTNL,
7363 .cmd = NL80211_CMD_SET_STATION,
7364 .doit = nl80211_set_station,
7365 .policy = nl80211_policy,
7366 .flags = GENL_ADMIN_PERM,
7367 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7368 NL80211_FLAG_NEED_RTNL,
7371 .cmd = NL80211_CMD_NEW_STATION,
7372 .doit = nl80211_new_station,
7373 .policy = nl80211_policy,
7374 .flags = GENL_ADMIN_PERM,
7375 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7376 NL80211_FLAG_NEED_RTNL,
7379 .cmd = NL80211_CMD_DEL_STATION,
7380 .doit = nl80211_del_station,
7381 .policy = nl80211_policy,
7382 .flags = GENL_ADMIN_PERM,
7383 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7384 NL80211_FLAG_NEED_RTNL,
7387 .cmd = NL80211_CMD_GET_MPATH,
7388 .doit = nl80211_get_mpath,
7389 .dumpit = nl80211_dump_mpath,
7390 .policy = nl80211_policy,
7391 .flags = GENL_ADMIN_PERM,
7392 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7393 NL80211_FLAG_NEED_RTNL,
7396 .cmd = NL80211_CMD_SET_MPATH,
7397 .doit = nl80211_set_mpath,
7398 .policy = nl80211_policy,
7399 .flags = GENL_ADMIN_PERM,
7400 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7401 NL80211_FLAG_NEED_RTNL,
7404 .cmd = NL80211_CMD_NEW_MPATH,
7405 .doit = nl80211_new_mpath,
7406 .policy = nl80211_policy,
7407 .flags = GENL_ADMIN_PERM,
7408 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7409 NL80211_FLAG_NEED_RTNL,
7412 .cmd = NL80211_CMD_DEL_MPATH,
7413 .doit = nl80211_del_mpath,
7414 .policy = nl80211_policy,
7415 .flags = GENL_ADMIN_PERM,
7416 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7417 NL80211_FLAG_NEED_RTNL,
7420 .cmd = NL80211_CMD_SET_BSS,
7421 .doit = nl80211_set_bss,
7422 .policy = nl80211_policy,
7423 .flags = GENL_ADMIN_PERM,
7424 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7425 NL80211_FLAG_NEED_RTNL,
7428 .cmd = NL80211_CMD_GET_REG,
7429 .doit = nl80211_get_reg,
7430 .policy = nl80211_policy,
7431 /* can be retrieved by unprivileged users */
7434 .cmd = NL80211_CMD_SET_REG,
7435 .doit = nl80211_set_reg,
7436 .policy = nl80211_policy,
7437 .flags = GENL_ADMIN_PERM,
7440 .cmd = NL80211_CMD_REQ_SET_REG,
7441 .doit = nl80211_req_set_reg,
7442 .policy = nl80211_policy,
7443 .flags = GENL_ADMIN_PERM,
7446 .cmd = NL80211_CMD_GET_MESH_CONFIG,
7447 .doit = nl80211_get_mesh_config,
7448 .policy = nl80211_policy,
7449 /* can be retrieved by unprivileged users */
7450 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7451 NL80211_FLAG_NEED_RTNL,
7454 .cmd = NL80211_CMD_SET_MESH_CONFIG,
7455 .doit = nl80211_update_mesh_config,
7456 .policy = nl80211_policy,
7457 .flags = GENL_ADMIN_PERM,
7458 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7459 NL80211_FLAG_NEED_RTNL,
7462 .cmd = NL80211_CMD_TRIGGER_SCAN,
7463 .doit = nl80211_trigger_scan,
7464 .policy = nl80211_policy,
7465 .flags = GENL_ADMIN_PERM,
7466 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
7467 NL80211_FLAG_NEED_RTNL,
7470 .cmd = NL80211_CMD_GET_SCAN,
7471 .policy = nl80211_policy,
7472 .dumpit = nl80211_dump_scan,
7475 .cmd = NL80211_CMD_START_SCHED_SCAN,
7476 .doit = nl80211_start_sched_scan,
7477 .policy = nl80211_policy,
7478 .flags = GENL_ADMIN_PERM,
7479 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7480 NL80211_FLAG_NEED_RTNL,
7483 .cmd = NL80211_CMD_STOP_SCHED_SCAN,
7484 .doit = nl80211_stop_sched_scan,
7485 .policy = nl80211_policy,
7486 .flags = GENL_ADMIN_PERM,
7487 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7488 NL80211_FLAG_NEED_RTNL,
7491 .cmd = NL80211_CMD_AUTHENTICATE,
7492 .doit = nl80211_authenticate,
7493 .policy = nl80211_policy,
7494 .flags = GENL_ADMIN_PERM,
7495 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7496 NL80211_FLAG_NEED_RTNL,
7499 .cmd = NL80211_CMD_ASSOCIATE,
7500 .doit = nl80211_associate,
7501 .policy = nl80211_policy,
7502 .flags = GENL_ADMIN_PERM,
7503 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7504 NL80211_FLAG_NEED_RTNL,
7507 .cmd = NL80211_CMD_DEAUTHENTICATE,
7508 .doit = nl80211_deauthenticate,
7509 .policy = nl80211_policy,
7510 .flags = GENL_ADMIN_PERM,
7511 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7512 NL80211_FLAG_NEED_RTNL,
7515 .cmd = NL80211_CMD_DISASSOCIATE,
7516 .doit = nl80211_disassociate,
7517 .policy = nl80211_policy,
7518 .flags = GENL_ADMIN_PERM,
7519 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7520 NL80211_FLAG_NEED_RTNL,
7523 .cmd = NL80211_CMD_JOIN_IBSS,
7524 .doit = nl80211_join_ibss,
7525 .policy = nl80211_policy,
7526 .flags = GENL_ADMIN_PERM,
7527 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7528 NL80211_FLAG_NEED_RTNL,
7531 .cmd = NL80211_CMD_LEAVE_IBSS,
7532 .doit = nl80211_leave_ibss,
7533 .policy = nl80211_policy,
7534 .flags = GENL_ADMIN_PERM,
7535 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7536 NL80211_FLAG_NEED_RTNL,
7538 #ifdef CONFIG_NL80211_TESTMODE
7540 .cmd = NL80211_CMD_TESTMODE,
7541 .doit = nl80211_testmode_do,
7542 .dumpit = nl80211_testmode_dump,
7543 .policy = nl80211_policy,
7544 .flags = GENL_ADMIN_PERM,
7545 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7546 NL80211_FLAG_NEED_RTNL,
7550 .cmd = NL80211_CMD_CONNECT,
7551 .doit = nl80211_connect,
7552 .policy = nl80211_policy,
7553 .flags = GENL_ADMIN_PERM,
7554 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7555 NL80211_FLAG_NEED_RTNL,
7558 .cmd = NL80211_CMD_DISCONNECT,
7559 .doit = nl80211_disconnect,
7560 .policy = nl80211_policy,
7561 .flags = GENL_ADMIN_PERM,
7562 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7563 NL80211_FLAG_NEED_RTNL,
7566 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
7567 .doit = nl80211_wiphy_netns,
7568 .policy = nl80211_policy,
7569 .flags = GENL_ADMIN_PERM,
7570 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7571 NL80211_FLAG_NEED_RTNL,
7574 .cmd = NL80211_CMD_GET_SURVEY,
7575 .policy = nl80211_policy,
7576 .dumpit = nl80211_dump_survey,
7579 .cmd = NL80211_CMD_SET_PMKSA,
7580 .doit = nl80211_setdel_pmksa,
7581 .policy = nl80211_policy,
7582 .flags = GENL_ADMIN_PERM,
7583 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7584 NL80211_FLAG_NEED_RTNL,
7587 .cmd = NL80211_CMD_DEL_PMKSA,
7588 .doit = nl80211_setdel_pmksa,
7589 .policy = nl80211_policy,
7590 .flags = GENL_ADMIN_PERM,
7591 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7592 NL80211_FLAG_NEED_RTNL,
7595 .cmd = NL80211_CMD_FLUSH_PMKSA,
7596 .doit = nl80211_flush_pmksa,
7597 .policy = nl80211_policy,
7598 .flags = GENL_ADMIN_PERM,
7599 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7600 NL80211_FLAG_NEED_RTNL,
7603 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
7604 .doit = nl80211_remain_on_channel,
7605 .policy = nl80211_policy,
7606 .flags = GENL_ADMIN_PERM,
7607 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
7608 NL80211_FLAG_NEED_RTNL,
7611 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
7612 .doit = nl80211_cancel_remain_on_channel,
7613 .policy = nl80211_policy,
7614 .flags = GENL_ADMIN_PERM,
7615 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
7616 NL80211_FLAG_NEED_RTNL,
7619 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
7620 .doit = nl80211_set_tx_bitrate_mask,
7621 .policy = nl80211_policy,
7622 .flags = GENL_ADMIN_PERM,
7623 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7624 NL80211_FLAG_NEED_RTNL,
7627 .cmd = NL80211_CMD_REGISTER_FRAME,
7628 .doit = nl80211_register_mgmt,
7629 .policy = nl80211_policy,
7630 .flags = GENL_ADMIN_PERM,
7631 .internal_flags = NL80211_FLAG_NEED_WDEV |
7632 NL80211_FLAG_NEED_RTNL,
7635 .cmd = NL80211_CMD_FRAME,
7636 .doit = nl80211_tx_mgmt,
7637 .policy = nl80211_policy,
7638 .flags = GENL_ADMIN_PERM,
7639 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
7640 NL80211_FLAG_NEED_RTNL,
7643 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
7644 .doit = nl80211_tx_mgmt_cancel_wait,
7645 .policy = nl80211_policy,
7646 .flags = GENL_ADMIN_PERM,
7647 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
7648 NL80211_FLAG_NEED_RTNL,
7651 .cmd = NL80211_CMD_SET_POWER_SAVE,
7652 .doit = nl80211_set_power_save,
7653 .policy = nl80211_policy,
7654 .flags = GENL_ADMIN_PERM,
7655 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7656 NL80211_FLAG_NEED_RTNL,
7659 .cmd = NL80211_CMD_GET_POWER_SAVE,
7660 .doit = nl80211_get_power_save,
7661 .policy = nl80211_policy,
7662 /* can be retrieved by unprivileged users */
7663 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7664 NL80211_FLAG_NEED_RTNL,
7667 .cmd = NL80211_CMD_SET_CQM,
7668 .doit = nl80211_set_cqm,
7669 .policy = nl80211_policy,
7670 .flags = GENL_ADMIN_PERM,
7671 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7672 NL80211_FLAG_NEED_RTNL,
7675 .cmd = NL80211_CMD_SET_CHANNEL,
7676 .doit = nl80211_set_channel,
7677 .policy = nl80211_policy,
7678 .flags = GENL_ADMIN_PERM,
7679 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7680 NL80211_FLAG_NEED_RTNL,
7683 .cmd = NL80211_CMD_SET_WDS_PEER,
7684 .doit = nl80211_set_wds_peer,
7685 .policy = nl80211_policy,
7686 .flags = GENL_ADMIN_PERM,
7687 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7688 NL80211_FLAG_NEED_RTNL,
7691 .cmd = NL80211_CMD_JOIN_MESH,
7692 .doit = nl80211_join_mesh,
7693 .policy = nl80211_policy,
7694 .flags = GENL_ADMIN_PERM,
7695 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7696 NL80211_FLAG_NEED_RTNL,
7699 .cmd = NL80211_CMD_LEAVE_MESH,
7700 .doit = nl80211_leave_mesh,
7701 .policy = nl80211_policy,
7702 .flags = GENL_ADMIN_PERM,
7703 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7704 NL80211_FLAG_NEED_RTNL,
7708 .cmd = NL80211_CMD_GET_WOWLAN,
7709 .doit = nl80211_get_wowlan,
7710 .policy = nl80211_policy,
7711 /* can be retrieved by unprivileged users */
7712 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7713 NL80211_FLAG_NEED_RTNL,
7716 .cmd = NL80211_CMD_SET_WOWLAN,
7717 .doit = nl80211_set_wowlan,
7718 .policy = nl80211_policy,
7719 .flags = GENL_ADMIN_PERM,
7720 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7721 NL80211_FLAG_NEED_RTNL,
7725 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
7726 .doit = nl80211_set_rekey_data,
7727 .policy = nl80211_policy,
7728 .flags = GENL_ADMIN_PERM,
7729 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7730 NL80211_FLAG_NEED_RTNL,
7733 .cmd = NL80211_CMD_TDLS_MGMT,
7734 .doit = nl80211_tdls_mgmt,
7735 .policy = nl80211_policy,
7736 .flags = GENL_ADMIN_PERM,
7737 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7738 NL80211_FLAG_NEED_RTNL,
7741 .cmd = NL80211_CMD_TDLS_OPER,
7742 .doit = nl80211_tdls_oper,
7743 .policy = nl80211_policy,
7744 .flags = GENL_ADMIN_PERM,
7745 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7746 NL80211_FLAG_NEED_RTNL,
7749 .cmd = NL80211_CMD_UNEXPECTED_FRAME,
7750 .doit = nl80211_register_unexpected_frame,
7751 .policy = nl80211_policy,
7752 .flags = GENL_ADMIN_PERM,
7753 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7754 NL80211_FLAG_NEED_RTNL,
7757 .cmd = NL80211_CMD_PROBE_CLIENT,
7758 .doit = nl80211_probe_client,
7759 .policy = nl80211_policy,
7760 .flags = GENL_ADMIN_PERM,
7761 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
7762 NL80211_FLAG_NEED_RTNL,
7765 .cmd = NL80211_CMD_REGISTER_BEACONS,
7766 .doit = nl80211_register_beacons,
7767 .policy = nl80211_policy,
7768 .flags = GENL_ADMIN_PERM,
7769 .internal_flags = NL80211_FLAG_NEED_WIPHY |
7770 NL80211_FLAG_NEED_RTNL,
7773 .cmd = NL80211_CMD_SET_NOACK_MAP,
7774 .doit = nl80211_set_noack_map,
7775 .policy = nl80211_policy,
7776 .flags = GENL_ADMIN_PERM,
7777 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7778 NL80211_FLAG_NEED_RTNL,
7781 .cmd = NL80211_CMD_START_P2P_DEVICE,
7782 .doit = nl80211_start_p2p_device,
7783 .policy = nl80211_policy,
7784 .flags = GENL_ADMIN_PERM,
7785 .internal_flags = NL80211_FLAG_NEED_WDEV |
7786 NL80211_FLAG_NEED_RTNL,
7789 .cmd = NL80211_CMD_STOP_P2P_DEVICE,
7790 .doit = nl80211_stop_p2p_device,
7791 .policy = nl80211_policy,
7792 .flags = GENL_ADMIN_PERM,
7793 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
7794 NL80211_FLAG_NEED_RTNL,
7797 .cmd = NL80211_CMD_SET_MCAST_RATE,
7798 .doit = nl80211_set_mcast_rate,
7799 .policy = nl80211_policy,
7800 .flags = GENL_ADMIN_PERM,
7801 .internal_flags = NL80211_FLAG_NEED_NETDEV |
7802 NL80211_FLAG_NEED_RTNL,
7806 static struct genl_multicast_group nl80211_mlme_mcgrp = {
7810 /* multicast groups */
7811 static struct genl_multicast_group nl80211_config_mcgrp = {
7814 static struct genl_multicast_group nl80211_scan_mcgrp = {
7817 static struct genl_multicast_group nl80211_regulatory_mcgrp = {
7818 .name = "regulatory",
7821 /* notification functions */
7823 void nl80211_notify_dev_rename(struct cfg80211_registered_device *rdev)
7825 struct sk_buff *msg;
7827 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
7831 if (nl80211_send_wiphy(msg, 0, 0, 0, rdev) < 0) {
7836 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
7837 nl80211_config_mcgrp.id, GFP_KERNEL);
7840 static int nl80211_add_scan_req(struct sk_buff *msg,
7841 struct cfg80211_registered_device *rdev)
7843 struct cfg80211_scan_request *req = rdev->scan_req;
7844 struct nlattr *nest;
7847 ASSERT_RDEV_LOCK(rdev);
7852 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
7854 goto nla_put_failure;
7855 for (i = 0; i < req->n_ssids; i++) {
7856 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
7857 goto nla_put_failure;
7859 nla_nest_end(msg, nest);
7861 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
7863 goto nla_put_failure;
7864 for (i = 0; i < req->n_channels; i++) {
7865 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
7866 goto nla_put_failure;
7868 nla_nest_end(msg, nest);
7871 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
7872 goto nla_put_failure;
7875 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags);
7882 static int nl80211_send_scan_msg(struct sk_buff *msg,
7883 struct cfg80211_registered_device *rdev,
7884 struct wireless_dev *wdev,
7885 u32 portid, u32 seq, int flags,
7890 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
7894 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
7895 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
7896 wdev->netdev->ifindex)) ||
7897 nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)))
7898 goto nla_put_failure;
7900 /* ignore errors and send incomplete event anyway */
7901 nl80211_add_scan_req(msg, rdev);
7903 return genlmsg_end(msg, hdr);
7906 genlmsg_cancel(msg, hdr);
7911 nl80211_send_sched_scan_msg(struct sk_buff *msg,
7912 struct cfg80211_registered_device *rdev,
7913 struct net_device *netdev,
7914 u32 portid, u32 seq, int flags, u32 cmd)
7918 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
7922 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
7923 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
7924 goto nla_put_failure;
7926 return genlmsg_end(msg, hdr);
7929 genlmsg_cancel(msg, hdr);
7933 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
7934 struct wireless_dev *wdev)
7936 struct sk_buff *msg;
7938 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
7942 if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
7943 NL80211_CMD_TRIGGER_SCAN) < 0) {
7948 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
7949 nl80211_scan_mcgrp.id, GFP_KERNEL);
7952 void nl80211_send_scan_done(struct cfg80211_registered_device *rdev,
7953 struct wireless_dev *wdev)
7955 struct sk_buff *msg;
7957 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
7961 if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
7962 NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
7967 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
7968 nl80211_scan_mcgrp.id, GFP_KERNEL);
7971 void nl80211_send_scan_aborted(struct cfg80211_registered_device *rdev,
7972 struct wireless_dev *wdev)
7974 struct sk_buff *msg;
7976 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
7980 if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
7981 NL80211_CMD_SCAN_ABORTED) < 0) {
7986 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
7987 nl80211_scan_mcgrp.id, GFP_KERNEL);
7990 void nl80211_send_sched_scan_results(struct cfg80211_registered_device *rdev,
7991 struct net_device *netdev)
7993 struct sk_buff *msg;
7995 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
7999 if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0,
8000 NL80211_CMD_SCHED_SCAN_RESULTS) < 0) {
8005 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8006 nl80211_scan_mcgrp.id, GFP_KERNEL);
8009 void nl80211_send_sched_scan(struct cfg80211_registered_device *rdev,
8010 struct net_device *netdev, u32 cmd)
8012 struct sk_buff *msg;
8014 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
8018 if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0, cmd) < 0) {
8023 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8024 nl80211_scan_mcgrp.id, GFP_KERNEL);
8028 * This can happen on global regulatory changes or device specific settings
8029 * based on custom world regulatory domains.
8031 void nl80211_send_reg_change_event(struct regulatory_request *request)
8033 struct sk_buff *msg;
8036 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
8040 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_CHANGE);
8046 /* Userspace can always count this one always being set */
8047 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
8048 goto nla_put_failure;
8050 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
8051 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
8052 NL80211_REGDOM_TYPE_WORLD))
8053 goto nla_put_failure;
8054 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
8055 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
8056 NL80211_REGDOM_TYPE_CUSTOM_WORLD))
8057 goto nla_put_failure;
8058 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
8059 request->intersect) {
8060 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
8061 NL80211_REGDOM_TYPE_INTERSECTION))
8062 goto nla_put_failure;
8064 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
8065 NL80211_REGDOM_TYPE_COUNTRY) ||
8066 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
8068 goto nla_put_failure;
8071 if (wiphy_idx_valid(request->wiphy_idx) &&
8072 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
8073 goto nla_put_failure;
8075 genlmsg_end(msg, hdr);
8078 genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
8085 genlmsg_cancel(msg, hdr);
8089 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
8090 struct net_device *netdev,
8091 const u8 *buf, size_t len,
8092 enum nl80211_commands cmd, gfp_t gfp)
8094 struct sk_buff *msg;
8097 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8101 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
8107 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8108 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8109 nla_put(msg, NL80211_ATTR_FRAME, len, buf))
8110 goto nla_put_failure;
8112 genlmsg_end(msg, hdr);
8114 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8115 nl80211_mlme_mcgrp.id, gfp);
8119 genlmsg_cancel(msg, hdr);
8123 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
8124 struct net_device *netdev, const u8 *buf,
8125 size_t len, gfp_t gfp)
8127 nl80211_send_mlme_event(rdev, netdev, buf, len,
8128 NL80211_CMD_AUTHENTICATE, gfp);
8131 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
8132 struct net_device *netdev, const u8 *buf,
8133 size_t len, gfp_t gfp)
8135 nl80211_send_mlme_event(rdev, netdev, buf, len,
8136 NL80211_CMD_ASSOCIATE, gfp);
8139 void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
8140 struct net_device *netdev, const u8 *buf,
8141 size_t len, gfp_t gfp)
8143 nl80211_send_mlme_event(rdev, netdev, buf, len,
8144 NL80211_CMD_DEAUTHENTICATE, gfp);
8147 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
8148 struct net_device *netdev, const u8 *buf,
8149 size_t len, gfp_t gfp)
8151 nl80211_send_mlme_event(rdev, netdev, buf, len,
8152 NL80211_CMD_DISASSOCIATE, gfp);
8155 void nl80211_send_unprot_deauth(struct cfg80211_registered_device *rdev,
8156 struct net_device *netdev, const u8 *buf,
8157 size_t len, gfp_t gfp)
8159 nl80211_send_mlme_event(rdev, netdev, buf, len,
8160 NL80211_CMD_UNPROT_DEAUTHENTICATE, gfp);
8163 void nl80211_send_unprot_disassoc(struct cfg80211_registered_device *rdev,
8164 struct net_device *netdev, const u8 *buf,
8165 size_t len, gfp_t gfp)
8167 nl80211_send_mlme_event(rdev, netdev, buf, len,
8168 NL80211_CMD_UNPROT_DISASSOCIATE, gfp);
8171 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
8172 struct net_device *netdev, int cmd,
8173 const u8 *addr, gfp_t gfp)
8175 struct sk_buff *msg;
8178 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8182 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
8188 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8189 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8190 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
8191 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
8192 goto nla_put_failure;
8194 genlmsg_end(msg, hdr);
8196 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8197 nl80211_mlme_mcgrp.id, gfp);
8201 genlmsg_cancel(msg, hdr);
8205 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
8206 struct net_device *netdev, const u8 *addr,
8209 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
8213 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
8214 struct net_device *netdev, const u8 *addr,
8217 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
8221 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
8222 struct net_device *netdev, const u8 *bssid,
8223 const u8 *req_ie, size_t req_ie_len,
8224 const u8 *resp_ie, size_t resp_ie_len,
8225 u16 status, gfp_t gfp)
8227 struct sk_buff *msg;
8230 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8234 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
8240 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8241 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8242 (bssid && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) ||
8243 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, status) ||
8245 nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
8247 nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
8248 goto nla_put_failure;
8250 genlmsg_end(msg, hdr);
8252 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8253 nl80211_mlme_mcgrp.id, gfp);
8257 genlmsg_cancel(msg, hdr);
8262 void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
8263 struct net_device *netdev, const u8 *bssid,
8264 const u8 *req_ie, size_t req_ie_len,
8265 const u8 *resp_ie, size_t resp_ie_len, gfp_t gfp)
8267 struct sk_buff *msg;
8270 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8274 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
8280 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8281 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8282 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
8284 nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
8286 nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
8287 goto nla_put_failure;
8289 genlmsg_end(msg, hdr);
8291 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8292 nl80211_mlme_mcgrp.id, gfp);
8296 genlmsg_cancel(msg, hdr);
8301 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
8302 struct net_device *netdev, u16 reason,
8303 const u8 *ie, size_t ie_len, bool from_ap)
8305 struct sk_buff *msg;
8308 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
8312 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
8318 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8319 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8320 (from_ap && reason &&
8321 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
8323 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
8324 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
8325 goto nla_put_failure;
8327 genlmsg_end(msg, hdr);
8329 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8330 nl80211_mlme_mcgrp.id, GFP_KERNEL);
8334 genlmsg_cancel(msg, hdr);
8339 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
8340 struct net_device *netdev, const u8 *bssid,
8343 struct sk_buff *msg;
8346 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8350 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
8356 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8357 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8358 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
8359 goto nla_put_failure;
8361 genlmsg_end(msg, hdr);
8363 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8364 nl80211_mlme_mcgrp.id, gfp);
8368 genlmsg_cancel(msg, hdr);
8372 void nl80211_send_new_peer_candidate(struct cfg80211_registered_device *rdev,
8373 struct net_device *netdev,
8374 const u8 *macaddr, const u8* ie, u8 ie_len,
8377 struct sk_buff *msg;
8380 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8384 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
8390 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8391 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8392 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, macaddr) ||
8394 nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
8395 goto nla_put_failure;
8397 genlmsg_end(msg, hdr);
8399 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8400 nl80211_mlme_mcgrp.id, gfp);
8404 genlmsg_cancel(msg, hdr);
8408 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
8409 struct net_device *netdev, const u8 *addr,
8410 enum nl80211_key_type key_type, int key_id,
8411 const u8 *tsc, gfp_t gfp)
8413 struct sk_buff *msg;
8416 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8420 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
8426 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8427 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8428 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
8429 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
8431 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
8432 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
8433 goto nla_put_failure;
8435 genlmsg_end(msg, hdr);
8437 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8438 nl80211_mlme_mcgrp.id, gfp);
8442 genlmsg_cancel(msg, hdr);
8446 void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
8447 struct ieee80211_channel *channel_before,
8448 struct ieee80211_channel *channel_after)
8450 struct sk_buff *msg;
8452 struct nlattr *nl_freq;
8454 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
8458 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
8465 * Since we are applying the beacon hint to a wiphy we know its
8466 * wiphy_idx is valid
8468 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
8469 goto nla_put_failure;
8472 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
8474 goto nla_put_failure;
8475 if (nl80211_msg_put_channel(msg, channel_before))
8476 goto nla_put_failure;
8477 nla_nest_end(msg, nl_freq);
8480 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
8482 goto nla_put_failure;
8483 if (nl80211_msg_put_channel(msg, channel_after))
8484 goto nla_put_failure;
8485 nla_nest_end(msg, nl_freq);
8487 genlmsg_end(msg, hdr);
8490 genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
8497 genlmsg_cancel(msg, hdr);
8501 static void nl80211_send_remain_on_chan_event(
8502 int cmd, struct cfg80211_registered_device *rdev,
8503 struct wireless_dev *wdev, u64 cookie,
8504 struct ieee80211_channel *chan,
8505 unsigned int duration, gfp_t gfp)
8507 struct sk_buff *msg;
8510 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8514 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
8520 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8521 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
8522 wdev->netdev->ifindex)) ||
8523 nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)) ||
8524 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
8525 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
8526 NL80211_CHAN_NO_HT) ||
8527 nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
8528 goto nla_put_failure;
8530 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
8531 nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
8532 goto nla_put_failure;
8534 genlmsg_end(msg, hdr);
8536 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8537 nl80211_mlme_mcgrp.id, gfp);
8541 genlmsg_cancel(msg, hdr);
8545 void nl80211_send_remain_on_channel(struct cfg80211_registered_device *rdev,
8546 struct wireless_dev *wdev, u64 cookie,
8547 struct ieee80211_channel *chan,
8548 unsigned int duration, gfp_t gfp)
8550 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
8551 rdev, wdev, cookie, chan,
8555 void nl80211_send_remain_on_channel_cancel(
8556 struct cfg80211_registered_device *rdev,
8557 struct wireless_dev *wdev,
8558 u64 cookie, struct ieee80211_channel *chan, gfp_t gfp)
8560 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
8561 rdev, wdev, cookie, chan, 0, gfp);
8564 void nl80211_send_sta_event(struct cfg80211_registered_device *rdev,
8565 struct net_device *dev, const u8 *mac_addr,
8566 struct station_info *sinfo, gfp_t gfp)
8568 struct sk_buff *msg;
8570 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8574 if (nl80211_send_station(msg, 0, 0, 0,
8575 rdev, dev, mac_addr, sinfo) < 0) {
8580 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8581 nl80211_mlme_mcgrp.id, gfp);
8584 void nl80211_send_sta_del_event(struct cfg80211_registered_device *rdev,
8585 struct net_device *dev, const u8 *mac_addr,
8588 struct sk_buff *msg;
8591 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8595 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_STATION);
8601 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
8602 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
8603 goto nla_put_failure;
8605 genlmsg_end(msg, hdr);
8607 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8608 nl80211_mlme_mcgrp.id, gfp);
8612 genlmsg_cancel(msg, hdr);
8616 void nl80211_send_conn_failed_event(struct cfg80211_registered_device *rdev,
8617 struct net_device *dev, const u8 *mac_addr,
8618 enum nl80211_connect_failed_reason reason,
8621 struct sk_buff *msg;
8624 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
8628 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
8634 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
8635 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
8636 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
8637 goto nla_put_failure;
8639 genlmsg_end(msg, hdr);
8641 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8642 nl80211_mlme_mcgrp.id, gfp);
8646 genlmsg_cancel(msg, hdr);
8650 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
8651 const u8 *addr, gfp_t gfp)
8653 struct wireless_dev *wdev = dev->ieee80211_ptr;
8654 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
8655 struct sk_buff *msg;
8658 u32 nlportid = ACCESS_ONCE(wdev->ap_unexpected_nlportid);
8663 msg = nlmsg_new(100, gfp);
8667 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
8673 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8674 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
8675 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
8676 goto nla_put_failure;
8678 err = genlmsg_end(msg, hdr);
8684 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
8688 genlmsg_cancel(msg, hdr);
8693 bool nl80211_unexpected_frame(struct net_device *dev, const u8 *addr, gfp_t gfp)
8695 return __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
8699 bool nl80211_unexpected_4addr_frame(struct net_device *dev,
8700 const u8 *addr, gfp_t gfp)
8702 return __nl80211_unexpected_frame(dev,
8703 NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
8707 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
8708 struct wireless_dev *wdev, u32 nlportid,
8709 int freq, int sig_dbm,
8710 const u8 *buf, size_t len, gfp_t gfp)
8712 struct net_device *netdev = wdev->netdev;
8713 struct sk_buff *msg;
8716 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8720 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
8726 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8727 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
8728 netdev->ifindex)) ||
8729 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
8731 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
8732 nla_put(msg, NL80211_ATTR_FRAME, len, buf))
8733 goto nla_put_failure;
8735 genlmsg_end(msg, hdr);
8737 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
8740 genlmsg_cancel(msg, hdr);
8745 void nl80211_send_mgmt_tx_status(struct cfg80211_registered_device *rdev,
8746 struct wireless_dev *wdev, u64 cookie,
8747 const u8 *buf, size_t len, bool ack,
8750 struct net_device *netdev = wdev->netdev;
8751 struct sk_buff *msg;
8754 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8758 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
8764 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8765 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
8766 netdev->ifindex)) ||
8767 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
8768 nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie) ||
8769 (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
8770 goto nla_put_failure;
8772 genlmsg_end(msg, hdr);
8774 genlmsg_multicast(msg, 0, nl80211_mlme_mcgrp.id, gfp);
8778 genlmsg_cancel(msg, hdr);
8783 nl80211_send_cqm_rssi_notify(struct cfg80211_registered_device *rdev,
8784 struct net_device *netdev,
8785 enum nl80211_cqm_rssi_threshold_event rssi_event,
8788 struct sk_buff *msg;
8789 struct nlattr *pinfoattr;
8792 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8796 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
8802 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8803 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
8804 goto nla_put_failure;
8806 pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
8808 goto nla_put_failure;
8810 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
8812 goto nla_put_failure;
8814 nla_nest_end(msg, pinfoattr);
8816 genlmsg_end(msg, hdr);
8818 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8819 nl80211_mlme_mcgrp.id, gfp);
8823 genlmsg_cancel(msg, hdr);
8827 void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
8828 struct net_device *netdev, const u8 *bssid,
8829 const u8 *replay_ctr, gfp_t gfp)
8831 struct sk_buff *msg;
8832 struct nlattr *rekey_attr;
8835 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8839 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
8845 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8846 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8847 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
8848 goto nla_put_failure;
8850 rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
8852 goto nla_put_failure;
8854 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
8855 NL80211_REPLAY_CTR_LEN, replay_ctr))
8856 goto nla_put_failure;
8858 nla_nest_end(msg, rekey_attr);
8860 genlmsg_end(msg, hdr);
8862 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8863 nl80211_mlme_mcgrp.id, gfp);
8867 genlmsg_cancel(msg, hdr);
8871 void nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
8872 struct net_device *netdev, int index,
8873 const u8 *bssid, bool preauth, gfp_t gfp)
8875 struct sk_buff *msg;
8876 struct nlattr *attr;
8879 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8883 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
8889 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8890 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
8891 goto nla_put_failure;
8893 attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
8895 goto nla_put_failure;
8897 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
8898 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
8900 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
8901 goto nla_put_failure;
8903 nla_nest_end(msg, attr);
8905 genlmsg_end(msg, hdr);
8907 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8908 nl80211_mlme_mcgrp.id, gfp);
8912 genlmsg_cancel(msg, hdr);
8916 void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
8917 struct net_device *netdev,
8918 struct cfg80211_chan_def *chandef, gfp_t gfp)
8920 struct sk_buff *msg;
8923 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
8927 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CH_SWITCH_NOTIFY);
8933 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
8934 goto nla_put_failure;
8936 if (nl80211_send_chandef(msg, chandef))
8937 goto nla_put_failure;
8939 genlmsg_end(msg, hdr);
8941 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8942 nl80211_mlme_mcgrp.id, gfp);
8946 genlmsg_cancel(msg, hdr);
8951 nl80211_send_cqm_txe_notify(struct cfg80211_registered_device *rdev,
8952 struct net_device *netdev, const u8 *peer,
8953 u32 num_packets, u32 rate, u32 intvl, gfp_t gfp)
8955 struct sk_buff *msg;
8956 struct nlattr *pinfoattr;
8959 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
8963 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
8969 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
8970 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
8971 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer))
8972 goto nla_put_failure;
8974 pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
8976 goto nla_put_failure;
8978 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
8979 goto nla_put_failure;
8981 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
8982 goto nla_put_failure;
8984 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
8985 goto nla_put_failure;
8987 nla_nest_end(msg, pinfoattr);
8989 genlmsg_end(msg, hdr);
8991 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
8992 nl80211_mlme_mcgrp.id, gfp);
8996 genlmsg_cancel(msg, hdr);
9001 nl80211_send_cqm_pktloss_notify(struct cfg80211_registered_device *rdev,
9002 struct net_device *netdev, const u8 *peer,
9003 u32 num_packets, gfp_t gfp)
9005 struct sk_buff *msg;
9006 struct nlattr *pinfoattr;
9009 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
9013 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
9019 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9020 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
9021 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer))
9022 goto nla_put_failure;
9024 pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
9026 goto nla_put_failure;
9028 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
9029 goto nla_put_failure;
9031 nla_nest_end(msg, pinfoattr);
9033 genlmsg_end(msg, hdr);
9035 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9036 nl80211_mlme_mcgrp.id, gfp);
9040 genlmsg_cancel(msg, hdr);
9044 void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
9045 u64 cookie, bool acked, gfp_t gfp)
9047 struct wireless_dev *wdev = dev->ieee80211_ptr;
9048 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
9049 struct sk_buff *msg;
9053 trace_cfg80211_probe_status(dev, addr, cookie, acked);
9055 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
9060 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
9066 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9067 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
9068 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
9069 nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie) ||
9070 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)))
9071 goto nla_put_failure;
9073 err = genlmsg_end(msg, hdr);
9079 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9080 nl80211_mlme_mcgrp.id, gfp);
9084 genlmsg_cancel(msg, hdr);
9087 EXPORT_SYMBOL(cfg80211_probe_status);
9089 void cfg80211_report_obss_beacon(struct wiphy *wiphy,
9090 const u8 *frame, size_t len,
9091 int freq, int sig_dbm)
9093 struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
9094 struct sk_buff *msg;
9096 struct cfg80211_beacon_registration *reg;
9098 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
9100 spin_lock_bh(&rdev->beacon_registrations_lock);
9101 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
9102 msg = nlmsg_new(len + 100, GFP_ATOMIC);
9104 spin_unlock_bh(&rdev->beacon_registrations_lock);
9108 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
9110 goto nla_put_failure;
9112 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9114 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
9116 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
9117 nla_put(msg, NL80211_ATTR_FRAME, len, frame))
9118 goto nla_put_failure;
9120 genlmsg_end(msg, hdr);
9122 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
9124 spin_unlock_bh(&rdev->beacon_registrations_lock);
9128 spin_unlock_bh(&rdev->beacon_registrations_lock);
9130 genlmsg_cancel(msg, hdr);
9133 EXPORT_SYMBOL(cfg80211_report_obss_beacon);
9135 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
9136 enum nl80211_tdls_operation oper,
9137 u16 reason_code, gfp_t gfp)
9139 struct wireless_dev *wdev = dev->ieee80211_ptr;
9140 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
9141 struct sk_buff *msg;
9145 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
9148 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
9152 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
9158 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
9159 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
9160 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
9161 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
9163 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
9164 goto nla_put_failure;
9166 err = genlmsg_end(msg, hdr);
9172 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
9173 nl80211_mlme_mcgrp.id, gfp);
9177 genlmsg_cancel(msg, hdr);
9180 EXPORT_SYMBOL(cfg80211_tdls_oper_request);
9182 static int nl80211_netlink_notify(struct notifier_block * nb,
9183 unsigned long state,
9186 struct netlink_notify *notify = _notify;
9187 struct cfg80211_registered_device *rdev;
9188 struct wireless_dev *wdev;
9189 struct cfg80211_beacon_registration *reg, *tmp;
9191 if (state != NETLINK_URELEASE)
9196 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
9197 list_for_each_entry_rcu(wdev, &rdev->wdev_list, list)
9198 cfg80211_mlme_unregister_socket(wdev, notify->portid);
9200 spin_lock_bh(&rdev->beacon_registrations_lock);
9201 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
9203 if (reg->nlportid == notify->portid) {
9204 list_del(®->list);
9209 spin_unlock_bh(&rdev->beacon_registrations_lock);
9217 static struct notifier_block nl80211_netlink_notifier = {
9218 .notifier_call = nl80211_netlink_notify,
9221 /* initialisation/exit functions */
9223 int nl80211_init(void)
9227 err = genl_register_family_with_ops(&nl80211_fam,
9228 nl80211_ops, ARRAY_SIZE(nl80211_ops));
9232 err = genl_register_mc_group(&nl80211_fam, &nl80211_config_mcgrp);
9236 err = genl_register_mc_group(&nl80211_fam, &nl80211_scan_mcgrp);
9240 err = genl_register_mc_group(&nl80211_fam, &nl80211_regulatory_mcgrp);
9244 err = genl_register_mc_group(&nl80211_fam, &nl80211_mlme_mcgrp);
9248 #ifdef CONFIG_NL80211_TESTMODE
9249 err = genl_register_mc_group(&nl80211_fam, &nl80211_testmode_mcgrp);
9254 err = netlink_register_notifier(&nl80211_netlink_notifier);
9260 genl_unregister_family(&nl80211_fam);
9264 void nl80211_exit(void)
9266 netlink_unregister_notifier(&nl80211_netlink_notifier);
9267 genl_unregister_family(&nl80211_fam);