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>
26 /* the netlink family */
27 static struct genl_family nl80211_fam = {
28 .id = GENL_ID_GENERATE, /* don't bother with a hardcoded ID */
29 .name = "nl80211", /* have users key off the name instead */
30 .hdrsize = 0, /* no private header */
31 .version = 1, /* no particular meaning now */
32 .maxattr = NL80211_ATTR_MAX,
36 /* internal helper: get rdev and dev */
37 static int get_rdev_dev_by_info_ifindex(struct genl_info *info,
38 struct cfg80211_registered_device **rdev,
39 struct net_device **dev)
41 struct nlattr **attrs = info->attrs;
44 if (!attrs[NL80211_ATTR_IFINDEX])
47 ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
48 *dev = dev_get_by_index(genl_info_net(info), ifindex);
52 *rdev = cfg80211_get_dev_from_ifindex(genl_info_net(info), ifindex);
55 return PTR_ERR(*rdev);
61 /* policy for the attributes */
62 static const struct nla_policy nl80211_policy[NL80211_ATTR_MAX+1] = {
63 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
64 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
66 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
67 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
68 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
69 [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
70 [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
71 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
72 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
73 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
75 [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
76 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
77 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
79 [NL80211_ATTR_MAC] = { .type = NLA_BINARY, .len = ETH_ALEN },
80 [NL80211_ATTR_PREV_BSSID] = { .type = NLA_BINARY, .len = ETH_ALEN },
82 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
83 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
84 .len = WLAN_MAX_KEY_LEN },
85 [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
86 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
87 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
88 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 8 },
90 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
91 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
92 [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
93 .len = IEEE80211_MAX_DATA_LEN },
94 [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
95 .len = IEEE80211_MAX_DATA_LEN },
96 [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
97 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
98 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
99 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
100 .len = NL80211_MAX_SUPP_RATES },
101 [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
102 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
103 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
104 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
105 .len = IEEE80211_MAX_MESH_ID_LEN },
106 [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
108 [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
109 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
111 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
112 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
113 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
114 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
115 .len = NL80211_MAX_SUPP_RATES },
117 [NL80211_ATTR_MESH_PARAMS] = { .type = NLA_NESTED },
119 [NL80211_ATTR_HT_CAPABILITY] = { .type = NLA_BINARY,
120 .len = NL80211_HT_CAPABILITY_LEN },
122 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
123 [NL80211_ATTR_IE] = { .type = NLA_BINARY,
124 .len = IEEE80211_MAX_DATA_LEN },
125 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
126 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
128 [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
129 .len = IEEE80211_MAX_SSID_LEN },
130 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
131 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
132 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
133 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
134 [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
135 [NL80211_ATTR_STA_FLAGS2] = {
136 .len = sizeof(struct nl80211_sta_flag_update),
138 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
139 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
140 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
141 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
142 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
143 [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
144 [NL80211_ATTR_PID] = { .type = NLA_U32 },
145 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
146 [NL80211_ATTR_PMKID] = { .type = NLA_BINARY,
147 .len = WLAN_PMKID_LEN },
148 [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
149 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
150 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
151 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
152 .len = IEEE80211_MAX_DATA_LEN },
153 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
154 [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
155 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
156 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
157 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
159 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
160 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
161 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
164 /* policy for the attributes */
165 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
166 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
167 [NL80211_KEY_IDX] = { .type = NLA_U8 },
168 [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
169 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 8 },
170 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
171 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
174 /* ifidx get helper */
175 static int nl80211_get_ifidx(struct netlink_callback *cb)
179 res = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
180 nl80211_fam.attrbuf, nl80211_fam.maxattr,
185 if (!nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX])
188 res = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX]);
195 static bool is_valid_ie_attr(const struct nlattr *attr)
203 pos = nla_data(attr);
224 /* message building helper */
225 static inline void *nl80211hdr_put(struct sk_buff *skb, u32 pid, u32 seq,
228 /* since there is no private header just add the generic one */
229 return genlmsg_put(skb, pid, seq, &nl80211_fam, flags, cmd);
232 static int nl80211_msg_put_channel(struct sk_buff *msg,
233 struct ieee80211_channel *chan)
235 NLA_PUT_U32(msg, NL80211_FREQUENCY_ATTR_FREQ,
238 if (chan->flags & IEEE80211_CHAN_DISABLED)
239 NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_DISABLED);
240 if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN)
241 NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_PASSIVE_SCAN);
242 if (chan->flags & IEEE80211_CHAN_NO_IBSS)
243 NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_NO_IBSS);
244 if (chan->flags & IEEE80211_CHAN_RADAR)
245 NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_RADAR);
247 NLA_PUT_U32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
248 DBM_TO_MBM(chan->max_power));
256 /* netlink command implementations */
264 static int nl80211_parse_key_new(struct nlattr *key, struct key_parse *k)
266 struct nlattr *tb[NL80211_KEY_MAX + 1];
267 int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
272 k->def = !!tb[NL80211_KEY_DEFAULT];
273 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
275 if (tb[NL80211_KEY_IDX])
276 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
278 if (tb[NL80211_KEY_DATA]) {
279 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
280 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
283 if (tb[NL80211_KEY_SEQ]) {
284 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
285 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
288 if (tb[NL80211_KEY_CIPHER])
289 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
294 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
296 if (info->attrs[NL80211_ATTR_KEY_DATA]) {
297 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
298 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
301 if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
302 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
303 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
306 if (info->attrs[NL80211_ATTR_KEY_IDX])
307 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
309 if (info->attrs[NL80211_ATTR_KEY_CIPHER])
310 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
312 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
313 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
318 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
322 memset(k, 0, sizeof(*k));
325 if (info->attrs[NL80211_ATTR_KEY])
326 err = nl80211_parse_key_new(info->attrs[NL80211_ATTR_KEY], k);
328 err = nl80211_parse_key_old(info, k);
333 if (k->def && k->defmgmt)
338 if (k->idx < 4 || k->idx > 5)
341 if (k->idx < 0 || k->idx > 3)
344 if (k->idx < 0 || k->idx > 5)
352 static struct cfg80211_cached_keys *
353 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
356 struct key_parse parse;
358 struct cfg80211_cached_keys *result;
359 int rem, err, def = 0;
361 result = kzalloc(sizeof(*result), GFP_KERNEL);
363 return ERR_PTR(-ENOMEM);
366 result->defmgmt = -1;
368 nla_for_each_nested(key, keys, rem) {
369 memset(&parse, 0, sizeof(parse));
372 err = nl80211_parse_key_new(key, &parse);
378 if (parse.idx < 0 || parse.idx > 4)
384 result->def = parse.idx;
385 } else if (parse.defmgmt)
387 err = cfg80211_validate_key_settings(rdev, &parse.p,
391 result->params[parse.idx].cipher = parse.p.cipher;
392 result->params[parse.idx].key_len = parse.p.key_len;
393 result->params[parse.idx].key = result->data[parse.idx];
394 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
403 static int nl80211_key_allowed(struct wireless_dev *wdev)
405 ASSERT_WDEV_LOCK(wdev);
407 if (!netif_running(wdev->netdev))
410 switch (wdev->iftype) {
411 case NL80211_IFTYPE_AP:
412 case NL80211_IFTYPE_AP_VLAN:
413 case NL80211_IFTYPE_P2P_GO:
415 case NL80211_IFTYPE_ADHOC:
416 if (!wdev->current_bss)
419 case NL80211_IFTYPE_STATION:
420 case NL80211_IFTYPE_P2P_CLIENT:
421 if (wdev->sme_state != CFG80211_SME_CONNECTED)
431 static int nl80211_send_wiphy(struct sk_buff *msg, u32 pid, u32 seq, int flags,
432 struct cfg80211_registered_device *dev)
435 struct nlattr *nl_bands, *nl_band;
436 struct nlattr *nl_freqs, *nl_freq;
437 struct nlattr *nl_rates, *nl_rate;
438 struct nlattr *nl_modes;
439 struct nlattr *nl_cmds;
440 enum ieee80211_band band;
441 struct ieee80211_channel *chan;
442 struct ieee80211_rate *rate;
444 u16 ifmodes = dev->wiphy.interface_modes;
445 const struct ieee80211_txrx_stypes *mgmt_stypes =
446 dev->wiphy.mgmt_stypes;
448 hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_WIPHY);
452 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, dev->wiphy_idx);
453 NLA_PUT_STRING(msg, NL80211_ATTR_WIPHY_NAME, wiphy_name(&dev->wiphy));
455 NLA_PUT_U32(msg, NL80211_ATTR_GENERATION,
456 cfg80211_rdev_list_generation);
458 NLA_PUT_U8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
459 dev->wiphy.retry_short);
460 NLA_PUT_U8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
461 dev->wiphy.retry_long);
462 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
463 dev->wiphy.frag_threshold);
464 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
465 dev->wiphy.rts_threshold);
466 NLA_PUT_U8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
467 dev->wiphy.coverage_class);
469 NLA_PUT_U8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
470 dev->wiphy.max_scan_ssids);
471 NLA_PUT_U16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
472 dev->wiphy.max_scan_ie_len);
474 NLA_PUT(msg, NL80211_ATTR_CIPHER_SUITES,
475 sizeof(u32) * dev->wiphy.n_cipher_suites,
476 dev->wiphy.cipher_suites);
478 NLA_PUT_U8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
479 dev->wiphy.max_num_pmkids);
481 if (dev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL)
482 NLA_PUT_FLAG(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE);
484 nl_modes = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_IFTYPES);
486 goto nla_put_failure;
491 NLA_PUT_FLAG(msg, i);
496 nla_nest_end(msg, nl_modes);
498 nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
500 goto nla_put_failure;
502 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
503 if (!dev->wiphy.bands[band])
506 nl_band = nla_nest_start(msg, band);
508 goto nla_put_failure;
511 if (dev->wiphy.bands[band]->ht_cap.ht_supported) {
512 NLA_PUT(msg, NL80211_BAND_ATTR_HT_MCS_SET,
513 sizeof(dev->wiphy.bands[band]->ht_cap.mcs),
514 &dev->wiphy.bands[band]->ht_cap.mcs);
515 NLA_PUT_U16(msg, NL80211_BAND_ATTR_HT_CAPA,
516 dev->wiphy.bands[band]->ht_cap.cap);
517 NLA_PUT_U8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
518 dev->wiphy.bands[band]->ht_cap.ampdu_factor);
519 NLA_PUT_U8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
520 dev->wiphy.bands[band]->ht_cap.ampdu_density);
523 /* add frequencies */
524 nl_freqs = nla_nest_start(msg, NL80211_BAND_ATTR_FREQS);
526 goto nla_put_failure;
528 for (i = 0; i < dev->wiphy.bands[band]->n_channels; i++) {
529 nl_freq = nla_nest_start(msg, i);
531 goto nla_put_failure;
533 chan = &dev->wiphy.bands[band]->channels[i];
535 if (nl80211_msg_put_channel(msg, chan))
536 goto nla_put_failure;
538 nla_nest_end(msg, nl_freq);
541 nla_nest_end(msg, nl_freqs);
544 nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
546 goto nla_put_failure;
548 for (i = 0; i < dev->wiphy.bands[band]->n_bitrates; i++) {
549 nl_rate = nla_nest_start(msg, i);
551 goto nla_put_failure;
553 rate = &dev->wiphy.bands[band]->bitrates[i];
554 NLA_PUT_U32(msg, NL80211_BITRATE_ATTR_RATE,
556 if (rate->flags & IEEE80211_RATE_SHORT_PREAMBLE)
558 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE);
560 nla_nest_end(msg, nl_rate);
563 nla_nest_end(msg, nl_rates);
565 nla_nest_end(msg, nl_band);
567 nla_nest_end(msg, nl_bands);
569 nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
571 goto nla_put_failure;
576 if (dev->ops->op) { \
578 NLA_PUT_U32(msg, i, NL80211_CMD_ ## n); \
582 CMD(add_virtual_intf, NEW_INTERFACE);
583 CMD(change_virtual_intf, SET_INTERFACE);
584 CMD(add_key, NEW_KEY);
585 CMD(add_beacon, NEW_BEACON);
586 CMD(add_station, NEW_STATION);
587 CMD(add_mpath, NEW_MPATH);
588 CMD(set_mesh_params, SET_MESH_PARAMS);
589 CMD(change_bss, SET_BSS);
590 CMD(auth, AUTHENTICATE);
591 CMD(assoc, ASSOCIATE);
592 CMD(deauth, DEAUTHENTICATE);
593 CMD(disassoc, DISASSOCIATE);
594 CMD(join_ibss, JOIN_IBSS);
595 CMD(set_pmksa, SET_PMKSA);
596 CMD(del_pmksa, DEL_PMKSA);
597 CMD(flush_pmksa, FLUSH_PMKSA);
598 CMD(remain_on_channel, REMAIN_ON_CHANNEL);
599 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
601 if (dev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
603 NLA_PUT_U32(msg, i, NL80211_CMD_SET_WIPHY_NETNS);
605 CMD(set_channel, SET_CHANNEL);
609 if (dev->ops->connect || dev->ops->auth) {
611 NLA_PUT_U32(msg, i, NL80211_CMD_CONNECT);
614 if (dev->ops->disconnect || dev->ops->deauth) {
616 NLA_PUT_U32(msg, i, NL80211_CMD_DISCONNECT);
619 nla_nest_end(msg, nl_cmds);
623 struct nlattr *nl_ftypes, *nl_ifs;
624 enum nl80211_iftype ift;
626 nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
628 goto nla_put_failure;
630 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
631 nl_ftypes = nla_nest_start(msg, ift);
633 goto nla_put_failure;
635 stypes = mgmt_stypes[ift].tx;
638 NLA_PUT_U16(msg, NL80211_ATTR_FRAME_TYPE,
639 (i << 4) | IEEE80211_FTYPE_MGMT);
643 nla_nest_end(msg, nl_ftypes);
646 nla_nest_end(msg, nl_ifs);
648 nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
650 goto nla_put_failure;
652 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
653 nl_ftypes = nla_nest_start(msg, ift);
655 goto nla_put_failure;
657 stypes = mgmt_stypes[ift].rx;
660 NLA_PUT_U16(msg, NL80211_ATTR_FRAME_TYPE,
661 (i << 4) | IEEE80211_FTYPE_MGMT);
665 nla_nest_end(msg, nl_ftypes);
667 nla_nest_end(msg, nl_ifs);
670 return genlmsg_end(msg, hdr);
673 genlmsg_cancel(msg, hdr);
677 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
680 int start = cb->args[0];
681 struct cfg80211_registered_device *dev;
683 mutex_lock(&cfg80211_mutex);
684 list_for_each_entry(dev, &cfg80211_rdev_list, list) {
685 if (!net_eq(wiphy_net(&dev->wiphy), sock_net(skb->sk)))
689 if (nl80211_send_wiphy(skb, NETLINK_CB(cb->skb).pid,
690 cb->nlh->nlmsg_seq, NLM_F_MULTI,
696 mutex_unlock(&cfg80211_mutex);
703 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
706 struct cfg80211_registered_device *dev;
708 dev = cfg80211_get_dev_from_info(info);
712 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
716 if (nl80211_send_wiphy(msg, info->snd_pid, info->snd_seq, 0, dev) < 0)
719 cfg80211_unlock_rdev(dev);
721 return genlmsg_reply(msg, info);
726 cfg80211_unlock_rdev(dev);
730 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
731 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
732 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
733 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
734 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
735 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
738 static int parse_txq_params(struct nlattr *tb[],
739 struct ieee80211_txq_params *txq_params)
741 if (!tb[NL80211_TXQ_ATTR_QUEUE] || !tb[NL80211_TXQ_ATTR_TXOP] ||
742 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
743 !tb[NL80211_TXQ_ATTR_AIFS])
746 txq_params->queue = nla_get_u8(tb[NL80211_TXQ_ATTR_QUEUE]);
747 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
748 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
749 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
750 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
755 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
758 * You can only set the channel explicitly for AP, mesh
759 * and WDS type interfaces; all others have their channel
760 * managed via their respective "establish a connection"
761 * command (connect, join, ...)
763 * Monitors are special as they are normally slaved to
764 * whatever else is going on, so they behave as though
765 * you tried setting the wiphy channel itself.
768 wdev->iftype == NL80211_IFTYPE_AP ||
769 wdev->iftype == NL80211_IFTYPE_WDS ||
770 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
771 wdev->iftype == NL80211_IFTYPE_MONITOR ||
772 wdev->iftype == NL80211_IFTYPE_P2P_GO;
775 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
776 struct wireless_dev *wdev,
777 struct genl_info *info)
779 enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;
783 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
786 if (!nl80211_can_set_dev_channel(wdev))
789 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
790 channel_type = nla_get_u32(info->attrs[
791 NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
792 if (channel_type != NL80211_CHAN_NO_HT &&
793 channel_type != NL80211_CHAN_HT20 &&
794 channel_type != NL80211_CHAN_HT40PLUS &&
795 channel_type != NL80211_CHAN_HT40MINUS)
799 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
801 mutex_lock(&rdev->devlist_mtx);
804 result = cfg80211_set_freq(rdev, wdev, freq, channel_type);
807 result = cfg80211_set_freq(rdev, NULL, freq, channel_type);
809 mutex_unlock(&rdev->devlist_mtx);
814 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
816 struct cfg80211_registered_device *rdev;
817 struct net_device *netdev;
822 result = get_rdev_dev_by_info_ifindex(info, &rdev, &netdev);
826 result = __nl80211_set_channel(rdev, netdev->ieee80211_ptr, info);
829 cfg80211_unlock_rdev(rdev);
836 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
838 struct cfg80211_registered_device *rdev;
839 struct net_device *netdev = NULL;
840 struct wireless_dev *wdev;
841 int result = 0, rem_txq_params = 0;
842 struct nlattr *nl_txq_params;
844 u8 retry_short = 0, retry_long = 0;
845 u32 frag_threshold = 0, rts_threshold = 0;
846 u8 coverage_class = 0;
851 * Try to find the wiphy and netdev. Normally this
852 * function shouldn't need the netdev, but this is
853 * done for backward compatibility -- previously
854 * setting the channel was done per wiphy, but now
855 * it is per netdev. Previous userland like hostapd
856 * also passed a netdev to set_wiphy, so that it is
857 * possible to let that go to the right netdev!
859 mutex_lock(&cfg80211_mutex);
861 if (info->attrs[NL80211_ATTR_IFINDEX]) {
862 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
864 netdev = dev_get_by_index(genl_info_net(info), ifindex);
865 if (netdev && netdev->ieee80211_ptr) {
866 rdev = wiphy_to_dev(netdev->ieee80211_ptr->wiphy);
867 mutex_lock(&rdev->mtx);
873 rdev = __cfg80211_rdev_from_info(info);
875 mutex_unlock(&cfg80211_mutex);
876 result = PTR_ERR(rdev);
883 mutex_lock(&rdev->mtx);
884 } else if (netif_running(netdev) &&
885 nl80211_can_set_dev_channel(netdev->ieee80211_ptr))
886 wdev = netdev->ieee80211_ptr;
891 * end workaround code, by now the rdev is available
892 * and locked, and wdev may or may not be NULL.
895 if (info->attrs[NL80211_ATTR_WIPHY_NAME])
896 result = cfg80211_dev_rename(
897 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
899 mutex_unlock(&cfg80211_mutex);
904 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
905 struct ieee80211_txq_params txq_params;
906 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
908 if (!rdev->ops->set_txq_params) {
909 result = -EOPNOTSUPP;
913 nla_for_each_nested(nl_txq_params,
914 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
916 nla_parse(tb, NL80211_TXQ_ATTR_MAX,
917 nla_data(nl_txq_params),
918 nla_len(nl_txq_params),
920 result = parse_txq_params(tb, &txq_params);
924 result = rdev->ops->set_txq_params(&rdev->wiphy,
931 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
932 result = __nl80211_set_channel(rdev, wdev, info);
937 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
938 enum nl80211_tx_power_setting type;
941 if (!rdev->ops->set_tx_power) {
942 result = -EOPNOTSUPP;
946 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
947 type = nla_get_u32(info->attrs[idx]);
949 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
950 (type != NL80211_TX_POWER_AUTOMATIC)) {
955 if (type != NL80211_TX_POWER_AUTOMATIC) {
956 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
957 mbm = nla_get_u32(info->attrs[idx]);
960 result = rdev->ops->set_tx_power(&rdev->wiphy, type, mbm);
967 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
968 retry_short = nla_get_u8(
969 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
970 if (retry_short == 0) {
974 changed |= WIPHY_PARAM_RETRY_SHORT;
977 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
978 retry_long = nla_get_u8(
979 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
980 if (retry_long == 0) {
984 changed |= WIPHY_PARAM_RETRY_LONG;
987 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
988 frag_threshold = nla_get_u32(
989 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
990 if (frag_threshold < 256) {
994 if (frag_threshold != (u32) -1) {
996 * Fragments (apart from the last one) are required to
997 * have even length. Make the fragmentation code
998 * simpler by stripping LSB should someone try to use
999 * odd threshold value.
1001 frag_threshold &= ~0x1;
1003 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
1006 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
1007 rts_threshold = nla_get_u32(
1008 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
1009 changed |= WIPHY_PARAM_RTS_THRESHOLD;
1012 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
1013 coverage_class = nla_get_u8(
1014 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
1015 changed |= WIPHY_PARAM_COVERAGE_CLASS;
1019 u8 old_retry_short, old_retry_long;
1020 u32 old_frag_threshold, old_rts_threshold;
1021 u8 old_coverage_class;
1023 if (!rdev->ops->set_wiphy_params) {
1024 result = -EOPNOTSUPP;
1028 old_retry_short = rdev->wiphy.retry_short;
1029 old_retry_long = rdev->wiphy.retry_long;
1030 old_frag_threshold = rdev->wiphy.frag_threshold;
1031 old_rts_threshold = rdev->wiphy.rts_threshold;
1032 old_coverage_class = rdev->wiphy.coverage_class;
1034 if (changed & WIPHY_PARAM_RETRY_SHORT)
1035 rdev->wiphy.retry_short = retry_short;
1036 if (changed & WIPHY_PARAM_RETRY_LONG)
1037 rdev->wiphy.retry_long = retry_long;
1038 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
1039 rdev->wiphy.frag_threshold = frag_threshold;
1040 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
1041 rdev->wiphy.rts_threshold = rts_threshold;
1042 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
1043 rdev->wiphy.coverage_class = coverage_class;
1045 result = rdev->ops->set_wiphy_params(&rdev->wiphy, changed);
1047 rdev->wiphy.retry_short = old_retry_short;
1048 rdev->wiphy.retry_long = old_retry_long;
1049 rdev->wiphy.frag_threshold = old_frag_threshold;
1050 rdev->wiphy.rts_threshold = old_rts_threshold;
1051 rdev->wiphy.coverage_class = old_coverage_class;
1056 mutex_unlock(&rdev->mtx);
1065 static int nl80211_send_iface(struct sk_buff *msg, u32 pid, u32 seq, int flags,
1066 struct cfg80211_registered_device *rdev,
1067 struct net_device *dev)
1071 hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_INTERFACE);
1075 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
1076 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
1077 NLA_PUT_STRING(msg, NL80211_ATTR_IFNAME, dev->name);
1078 NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, dev->ieee80211_ptr->iftype);
1080 NLA_PUT_U32(msg, NL80211_ATTR_GENERATION,
1081 rdev->devlist_generation ^
1082 (cfg80211_rdev_list_generation << 2));
1084 return genlmsg_end(msg, hdr);
1087 genlmsg_cancel(msg, hdr);
1091 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
1095 int wp_start = cb->args[0];
1096 int if_start = cb->args[1];
1097 struct cfg80211_registered_device *rdev;
1098 struct wireless_dev *wdev;
1100 mutex_lock(&cfg80211_mutex);
1101 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1102 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
1104 if (wp_idx < wp_start) {
1110 mutex_lock(&rdev->devlist_mtx);
1111 list_for_each_entry(wdev, &rdev->netdev_list, list) {
1112 if (if_idx < if_start) {
1116 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).pid,
1117 cb->nlh->nlmsg_seq, NLM_F_MULTI,
1118 rdev, wdev->netdev) < 0) {
1119 mutex_unlock(&rdev->devlist_mtx);
1124 mutex_unlock(&rdev->devlist_mtx);
1129 mutex_unlock(&cfg80211_mutex);
1131 cb->args[0] = wp_idx;
1132 cb->args[1] = if_idx;
1137 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
1139 struct sk_buff *msg;
1140 struct cfg80211_registered_device *dev;
1141 struct net_device *netdev;
1144 err = get_rdev_dev_by_info_ifindex(info, &dev, &netdev);
1148 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1152 if (nl80211_send_iface(msg, info->snd_pid, info->snd_seq, 0,
1157 cfg80211_unlock_rdev(dev);
1159 return genlmsg_reply(msg, info);
1165 cfg80211_unlock_rdev(dev);
1169 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
1170 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
1171 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
1172 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
1173 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
1174 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
1177 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
1179 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
1187 if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX,
1188 nla, mntr_flags_policy))
1191 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
1193 *mntrflags |= (1<<flag);
1198 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
1199 struct net_device *netdev, u8 use_4addr,
1200 enum nl80211_iftype iftype)
1203 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
1209 case NL80211_IFTYPE_AP_VLAN:
1210 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
1213 case NL80211_IFTYPE_STATION:
1214 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
1224 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
1226 struct cfg80211_registered_device *rdev;
1227 struct vif_params params;
1229 enum nl80211_iftype otype, ntype;
1230 struct net_device *dev;
1231 u32 _flags, *flags = NULL;
1232 bool change = false;
1234 memset(¶ms, 0, sizeof(params));
1238 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1242 otype = ntype = dev->ieee80211_ptr->iftype;
1244 if (info->attrs[NL80211_ATTR_IFTYPE]) {
1245 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
1248 if (ntype > NL80211_IFTYPE_MAX) {
1254 if (info->attrs[NL80211_ATTR_MESH_ID]) {
1255 if (ntype != NL80211_IFTYPE_MESH_POINT) {
1259 params.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
1260 params.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
1264 if (info->attrs[NL80211_ATTR_4ADDR]) {
1265 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
1267 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
1271 params.use_4addr = -1;
1274 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
1275 if (ntype != NL80211_IFTYPE_MONITOR) {
1279 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
1289 err = cfg80211_change_iface(rdev, dev, ntype, flags, ¶ms);
1293 if (!err && params.use_4addr != -1)
1294 dev->ieee80211_ptr->use_4addr = params.use_4addr;
1298 cfg80211_unlock_rdev(rdev);
1304 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
1306 struct cfg80211_registered_device *rdev;
1307 struct vif_params params;
1309 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
1312 memset(¶ms, 0, sizeof(params));
1314 if (!info->attrs[NL80211_ATTR_IFNAME])
1317 if (info->attrs[NL80211_ATTR_IFTYPE]) {
1318 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
1319 if (type > NL80211_IFTYPE_MAX)
1325 rdev = cfg80211_get_dev_from_info(info);
1327 err = PTR_ERR(rdev);
1331 if (!rdev->ops->add_virtual_intf ||
1332 !(rdev->wiphy.interface_modes & (1 << type))) {
1337 if (type == NL80211_IFTYPE_MESH_POINT &&
1338 info->attrs[NL80211_ATTR_MESH_ID]) {
1339 params.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
1340 params.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
1343 if (info->attrs[NL80211_ATTR_4ADDR]) {
1344 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
1345 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
1350 err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
1351 info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
1353 err = rdev->ops->add_virtual_intf(&rdev->wiphy,
1354 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
1355 type, err ? NULL : &flags, ¶ms);
1358 cfg80211_unlock_rdev(rdev);
1364 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
1366 struct cfg80211_registered_device *rdev;
1368 struct net_device *dev;
1372 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1376 if (!rdev->ops->del_virtual_intf) {
1381 err = rdev->ops->del_virtual_intf(&rdev->wiphy, dev);
1384 cfg80211_unlock_rdev(rdev);
1391 struct get_key_cookie {
1392 struct sk_buff *msg;
1397 static void get_key_callback(void *c, struct key_params *params)
1400 struct get_key_cookie *cookie = c;
1403 NLA_PUT(cookie->msg, NL80211_ATTR_KEY_DATA,
1404 params->key_len, params->key);
1407 NLA_PUT(cookie->msg, NL80211_ATTR_KEY_SEQ,
1408 params->seq_len, params->seq);
1411 NLA_PUT_U32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
1414 key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
1416 goto nla_put_failure;
1419 NLA_PUT(cookie->msg, NL80211_KEY_DATA,
1420 params->key_len, params->key);
1423 NLA_PUT(cookie->msg, NL80211_KEY_SEQ,
1424 params->seq_len, params->seq);
1427 NLA_PUT_U32(cookie->msg, NL80211_KEY_CIPHER,
1430 NLA_PUT_U8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx);
1432 nla_nest_end(cookie->msg, key);
1439 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
1441 struct cfg80211_registered_device *rdev;
1443 struct net_device *dev;
1445 u8 *mac_addr = NULL;
1446 struct get_key_cookie cookie = {
1450 struct sk_buff *msg;
1452 if (info->attrs[NL80211_ATTR_KEY_IDX])
1453 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
1458 if (info->attrs[NL80211_ATTR_MAC])
1459 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
1463 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1467 if (!rdev->ops->get_key) {
1472 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1478 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
1479 NL80211_CMD_NEW_KEY);
1487 cookie.idx = key_idx;
1489 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
1490 NLA_PUT_U8(msg, NL80211_ATTR_KEY_IDX, key_idx);
1492 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
1494 err = rdev->ops->get_key(&rdev->wiphy, dev, key_idx, mac_addr,
1495 &cookie, get_key_callback);
1501 goto nla_put_failure;
1503 genlmsg_end(msg, hdr);
1504 err = genlmsg_reply(msg, info);
1512 cfg80211_unlock_rdev(rdev);
1520 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
1522 struct cfg80211_registered_device *rdev;
1523 struct key_parse key;
1525 struct net_device *dev;
1526 int (*func)(struct wiphy *wiphy, struct net_device *netdev,
1529 err = nl80211_parse_key(info, &key);
1536 /* only support setting default key */
1537 if (!key.def && !key.defmgmt)
1542 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1547 func = rdev->ops->set_default_key;
1549 func = rdev->ops->set_default_mgmt_key;
1556 wdev_lock(dev->ieee80211_ptr);
1557 err = nl80211_key_allowed(dev->ieee80211_ptr);
1559 err = func(&rdev->wiphy, dev, key.idx);
1561 #ifdef CONFIG_CFG80211_WEXT
1563 if (func == rdev->ops->set_default_key)
1564 dev->ieee80211_ptr->wext.default_key = key.idx;
1566 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
1569 wdev_unlock(dev->ieee80211_ptr);
1572 cfg80211_unlock_rdev(rdev);
1581 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
1583 struct cfg80211_registered_device *rdev;
1585 struct net_device *dev;
1586 struct key_parse key;
1587 u8 *mac_addr = NULL;
1589 err = nl80211_parse_key(info, &key);
1596 if (info->attrs[NL80211_ATTR_MAC])
1597 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
1601 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1605 if (!rdev->ops->add_key) {
1610 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx, mac_addr)) {
1615 wdev_lock(dev->ieee80211_ptr);
1616 err = nl80211_key_allowed(dev->ieee80211_ptr);
1618 err = rdev->ops->add_key(&rdev->wiphy, dev, key.idx,
1620 wdev_unlock(dev->ieee80211_ptr);
1623 cfg80211_unlock_rdev(rdev);
1631 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
1633 struct cfg80211_registered_device *rdev;
1635 struct net_device *dev;
1636 u8 *mac_addr = NULL;
1637 struct key_parse key;
1639 err = nl80211_parse_key(info, &key);
1643 if (info->attrs[NL80211_ATTR_MAC])
1644 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
1648 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1652 if (!rdev->ops->del_key) {
1657 wdev_lock(dev->ieee80211_ptr);
1658 err = nl80211_key_allowed(dev->ieee80211_ptr);
1660 err = rdev->ops->del_key(&rdev->wiphy, dev, key.idx, mac_addr);
1662 #ifdef CONFIG_CFG80211_WEXT
1664 if (key.idx == dev->ieee80211_ptr->wext.default_key)
1665 dev->ieee80211_ptr->wext.default_key = -1;
1666 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
1667 dev->ieee80211_ptr->wext.default_mgmt_key = -1;
1670 wdev_unlock(dev->ieee80211_ptr);
1673 cfg80211_unlock_rdev(rdev);
1682 static int nl80211_addset_beacon(struct sk_buff *skb, struct genl_info *info)
1684 int (*call)(struct wiphy *wiphy, struct net_device *dev,
1685 struct beacon_parameters *info);
1686 struct cfg80211_registered_device *rdev;
1688 struct net_device *dev;
1689 struct beacon_parameters params;
1692 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_BEACON_TAIL]))
1697 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1701 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
1702 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
1707 switch (info->genlhdr->cmd) {
1708 case NL80211_CMD_NEW_BEACON:
1709 /* these are required for NEW_BEACON */
1710 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
1711 !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
1712 !info->attrs[NL80211_ATTR_BEACON_HEAD]) {
1717 call = rdev->ops->add_beacon;
1719 case NL80211_CMD_SET_BEACON:
1720 call = rdev->ops->set_beacon;
1733 memset(¶ms, 0, sizeof(params));
1735 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
1737 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
1741 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
1742 params.dtim_period =
1743 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
1747 if (info->attrs[NL80211_ATTR_BEACON_HEAD]) {
1748 params.head = nla_data(info->attrs[NL80211_ATTR_BEACON_HEAD]);
1750 nla_len(info->attrs[NL80211_ATTR_BEACON_HEAD]);
1754 if (info->attrs[NL80211_ATTR_BEACON_TAIL]) {
1755 params.tail = nla_data(info->attrs[NL80211_ATTR_BEACON_TAIL]);
1757 nla_len(info->attrs[NL80211_ATTR_BEACON_TAIL]);
1766 err = call(&rdev->wiphy, dev, ¶ms);
1769 cfg80211_unlock_rdev(rdev);
1777 static int nl80211_del_beacon(struct sk_buff *skb, struct genl_info *info)
1779 struct cfg80211_registered_device *rdev;
1781 struct net_device *dev;
1785 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1789 if (!rdev->ops->del_beacon) {
1794 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
1795 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
1799 err = rdev->ops->del_beacon(&rdev->wiphy, dev);
1802 cfg80211_unlock_rdev(rdev);
1810 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
1811 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
1812 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
1813 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
1814 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
1817 static int parse_station_flags(struct genl_info *info,
1818 struct station_parameters *params)
1820 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
1825 * Try parsing the new attribute first so userspace
1826 * can specify both for older kernels.
1828 nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
1830 struct nl80211_sta_flag_update *sta_flags;
1832 sta_flags = nla_data(nla);
1833 params->sta_flags_mask = sta_flags->mask;
1834 params->sta_flags_set = sta_flags->set;
1835 if ((params->sta_flags_mask |
1836 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
1841 /* if present, parse the old attribute */
1843 nla = info->attrs[NL80211_ATTR_STA_FLAGS];
1847 if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX,
1848 nla, sta_flags_policy))
1851 params->sta_flags_mask = (1 << __NL80211_STA_FLAG_AFTER_LAST) - 1;
1852 params->sta_flags_mask &= ~1;
1854 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++)
1856 params->sta_flags_set |= (1<<flag);
1861 static int nl80211_send_station(struct sk_buff *msg, u32 pid, u32 seq,
1862 int flags, struct net_device *dev,
1863 const u8 *mac_addr, struct station_info *sinfo)
1866 struct nlattr *sinfoattr, *txrate;
1869 hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_STATION);
1873 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
1874 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
1876 NLA_PUT_U32(msg, NL80211_ATTR_GENERATION, sinfo->generation);
1878 sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
1880 goto nla_put_failure;
1881 if (sinfo->filled & STATION_INFO_INACTIVE_TIME)
1882 NLA_PUT_U32(msg, NL80211_STA_INFO_INACTIVE_TIME,
1883 sinfo->inactive_time);
1884 if (sinfo->filled & STATION_INFO_RX_BYTES)
1885 NLA_PUT_U32(msg, NL80211_STA_INFO_RX_BYTES,
1887 if (sinfo->filled & STATION_INFO_TX_BYTES)
1888 NLA_PUT_U32(msg, NL80211_STA_INFO_TX_BYTES,
1890 if (sinfo->filled & STATION_INFO_LLID)
1891 NLA_PUT_U16(msg, NL80211_STA_INFO_LLID,
1893 if (sinfo->filled & STATION_INFO_PLID)
1894 NLA_PUT_U16(msg, NL80211_STA_INFO_PLID,
1896 if (sinfo->filled & STATION_INFO_PLINK_STATE)
1897 NLA_PUT_U8(msg, NL80211_STA_INFO_PLINK_STATE,
1898 sinfo->plink_state);
1899 if (sinfo->filled & STATION_INFO_SIGNAL)
1900 NLA_PUT_U8(msg, NL80211_STA_INFO_SIGNAL,
1902 if (sinfo->filled & STATION_INFO_TX_BITRATE) {
1903 txrate = nla_nest_start(msg, NL80211_STA_INFO_TX_BITRATE);
1905 goto nla_put_failure;
1907 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
1908 bitrate = cfg80211_calculate_bitrate(&sinfo->txrate);
1910 NLA_PUT_U16(msg, NL80211_RATE_INFO_BITRATE, bitrate);
1912 if (sinfo->txrate.flags & RATE_INFO_FLAGS_MCS)
1913 NLA_PUT_U8(msg, NL80211_RATE_INFO_MCS,
1915 if (sinfo->txrate.flags & RATE_INFO_FLAGS_40_MHZ_WIDTH)
1916 NLA_PUT_FLAG(msg, NL80211_RATE_INFO_40_MHZ_WIDTH);
1917 if (sinfo->txrate.flags & RATE_INFO_FLAGS_SHORT_GI)
1918 NLA_PUT_FLAG(msg, NL80211_RATE_INFO_SHORT_GI);
1920 nla_nest_end(msg, txrate);
1922 if (sinfo->filled & STATION_INFO_RX_PACKETS)
1923 NLA_PUT_U32(msg, NL80211_STA_INFO_RX_PACKETS,
1925 if (sinfo->filled & STATION_INFO_TX_PACKETS)
1926 NLA_PUT_U32(msg, NL80211_STA_INFO_TX_PACKETS,
1928 nla_nest_end(msg, sinfoattr);
1930 return genlmsg_end(msg, hdr);
1933 genlmsg_cancel(msg, hdr);
1937 static int nl80211_dump_station(struct sk_buff *skb,
1938 struct netlink_callback *cb)
1940 struct station_info sinfo;
1941 struct cfg80211_registered_device *dev;
1942 struct net_device *netdev;
1943 u8 mac_addr[ETH_ALEN];
1944 int ifidx = cb->args[0];
1945 int sta_idx = cb->args[1];
1949 ifidx = nl80211_get_ifidx(cb);
1955 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
1961 dev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
1967 if (!dev->ops->dump_station) {
1973 err = dev->ops->dump_station(&dev->wiphy, netdev, sta_idx,
1980 if (nl80211_send_station(skb,
1981 NETLINK_CB(cb->skb).pid,
1982 cb->nlh->nlmsg_seq, NLM_F_MULTI,
1992 cb->args[1] = sta_idx;
1995 cfg80211_unlock_rdev(dev);
2002 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
2004 struct cfg80211_registered_device *rdev;
2006 struct net_device *dev;
2007 struct station_info sinfo;
2008 struct sk_buff *msg;
2009 u8 *mac_addr = NULL;
2011 memset(&sinfo, 0, sizeof(sinfo));
2013 if (!info->attrs[NL80211_ATTR_MAC])
2016 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2020 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2024 if (!rdev->ops->get_station) {
2029 err = rdev->ops->get_station(&rdev->wiphy, dev, mac_addr, &sinfo);
2033 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2037 if (nl80211_send_station(msg, info->snd_pid, info->snd_seq, 0,
2038 dev, mac_addr, &sinfo) < 0)
2041 err = genlmsg_reply(msg, info);
2047 cfg80211_unlock_rdev(rdev);
2056 * Get vlan interface making sure it is running and on the right wiphy.
2058 static int get_vlan(struct genl_info *info,
2059 struct cfg80211_registered_device *rdev,
2060 struct net_device **vlan)
2062 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
2066 *vlan = dev_get_by_index(genl_info_net(info),
2067 nla_get_u32(vlanattr));
2070 if (!(*vlan)->ieee80211_ptr)
2072 if ((*vlan)->ieee80211_ptr->wiphy != &rdev->wiphy)
2074 if (!netif_running(*vlan))
2080 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
2082 struct cfg80211_registered_device *rdev;
2084 struct net_device *dev;
2085 struct station_parameters params;
2086 u8 *mac_addr = NULL;
2088 memset(¶ms, 0, sizeof(params));
2090 params.listen_interval = -1;
2092 if (info->attrs[NL80211_ATTR_STA_AID])
2095 if (!info->attrs[NL80211_ATTR_MAC])
2098 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2100 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
2101 params.supported_rates =
2102 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
2103 params.supported_rates_len =
2104 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
2107 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
2108 params.listen_interval =
2109 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
2111 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
2113 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
2115 if (parse_station_flags(info, ¶ms))
2118 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
2119 params.plink_action =
2120 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
2124 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2128 err = get_vlan(info, rdev, ¶ms.vlan);
2132 /* validate settings */
2135 switch (dev->ieee80211_ptr->iftype) {
2136 case NL80211_IFTYPE_AP:
2137 case NL80211_IFTYPE_AP_VLAN:
2138 case NL80211_IFTYPE_P2P_GO:
2139 /* disallow mesh-specific things */
2140 if (params.plink_action)
2143 case NL80211_IFTYPE_P2P_CLIENT:
2144 case NL80211_IFTYPE_STATION:
2145 /* disallow everything but AUTHORIZED flag */
2146 if (params.plink_action)
2150 if (params.supported_rates)
2154 if (params.listen_interval >= 0)
2156 if (params.sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
2159 case NL80211_IFTYPE_MESH_POINT:
2160 /* disallow things mesh doesn't support */
2165 if (params.listen_interval >= 0)
2167 if (params.supported_rates)
2169 if (params.sta_flags_mask)
2179 if (!rdev->ops->change_station) {
2184 err = rdev->ops->change_station(&rdev->wiphy, dev, mac_addr, ¶ms);
2188 dev_put(params.vlan);
2189 cfg80211_unlock_rdev(rdev);
2197 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
2199 struct cfg80211_registered_device *rdev;
2201 struct net_device *dev;
2202 struct station_parameters params;
2203 u8 *mac_addr = NULL;
2205 memset(¶ms, 0, sizeof(params));
2207 if (!info->attrs[NL80211_ATTR_MAC])
2210 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
2213 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
2216 if (!info->attrs[NL80211_ATTR_STA_AID])
2219 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2220 params.supported_rates =
2221 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
2222 params.supported_rates_len =
2223 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
2224 params.listen_interval =
2225 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
2227 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
2228 if (!params.aid || params.aid > IEEE80211_MAX_AID)
2231 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
2233 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
2235 if (parse_station_flags(info, ¶ms))
2240 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2244 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2245 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
2246 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
2251 err = get_vlan(info, rdev, ¶ms.vlan);
2255 /* validate settings */
2258 if (!rdev->ops->add_station) {
2263 if (!netif_running(dev)) {
2268 err = rdev->ops->add_station(&rdev->wiphy, dev, mac_addr, ¶ms);
2272 dev_put(params.vlan);
2273 cfg80211_unlock_rdev(rdev);
2281 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
2283 struct cfg80211_registered_device *rdev;
2285 struct net_device *dev;
2286 u8 *mac_addr = NULL;
2288 if (info->attrs[NL80211_ATTR_MAC])
2289 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2293 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2297 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2298 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
2299 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
2300 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
2305 if (!rdev->ops->del_station) {
2310 err = rdev->ops->del_station(&rdev->wiphy, dev, mac_addr);
2313 cfg80211_unlock_rdev(rdev);
2321 static int nl80211_send_mpath(struct sk_buff *msg, u32 pid, u32 seq,
2322 int flags, struct net_device *dev,
2323 u8 *dst, u8 *next_hop,
2324 struct mpath_info *pinfo)
2327 struct nlattr *pinfoattr;
2329 hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_STATION);
2333 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
2334 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, dst);
2335 NLA_PUT(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop);
2337 NLA_PUT_U32(msg, NL80211_ATTR_GENERATION, pinfo->generation);
2339 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
2341 goto nla_put_failure;
2342 if (pinfo->filled & MPATH_INFO_FRAME_QLEN)
2343 NLA_PUT_U32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
2345 if (pinfo->filled & MPATH_INFO_SN)
2346 NLA_PUT_U32(msg, NL80211_MPATH_INFO_SN,
2348 if (pinfo->filled & MPATH_INFO_METRIC)
2349 NLA_PUT_U32(msg, NL80211_MPATH_INFO_METRIC,
2351 if (pinfo->filled & MPATH_INFO_EXPTIME)
2352 NLA_PUT_U32(msg, NL80211_MPATH_INFO_EXPTIME,
2354 if (pinfo->filled & MPATH_INFO_FLAGS)
2355 NLA_PUT_U8(msg, NL80211_MPATH_INFO_FLAGS,
2357 if (pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT)
2358 NLA_PUT_U32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
2359 pinfo->discovery_timeout);
2360 if (pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES)
2361 NLA_PUT_U8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
2362 pinfo->discovery_retries);
2364 nla_nest_end(msg, pinfoattr);
2366 return genlmsg_end(msg, hdr);
2369 genlmsg_cancel(msg, hdr);
2373 static int nl80211_dump_mpath(struct sk_buff *skb,
2374 struct netlink_callback *cb)
2376 struct mpath_info pinfo;
2377 struct cfg80211_registered_device *dev;
2378 struct net_device *netdev;
2380 u8 next_hop[ETH_ALEN];
2381 int ifidx = cb->args[0];
2382 int path_idx = cb->args[1];
2386 ifidx = nl80211_get_ifidx(cb);
2392 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
2398 dev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
2404 if (!dev->ops->dump_mpath) {
2409 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
2415 err = dev->ops->dump_mpath(&dev->wiphy, netdev, path_idx,
2416 dst, next_hop, &pinfo);
2422 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).pid,
2423 cb->nlh->nlmsg_seq, NLM_F_MULTI,
2424 netdev, dst, next_hop,
2433 cb->args[1] = path_idx;
2436 cfg80211_unlock_rdev(dev);
2443 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
2445 struct cfg80211_registered_device *rdev;
2447 struct net_device *dev;
2448 struct mpath_info pinfo;
2449 struct sk_buff *msg;
2451 u8 next_hop[ETH_ALEN];
2453 memset(&pinfo, 0, sizeof(pinfo));
2455 if (!info->attrs[NL80211_ATTR_MAC])
2458 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
2462 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2466 if (!rdev->ops->get_mpath) {
2471 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
2476 err = rdev->ops->get_mpath(&rdev->wiphy, dev, dst, next_hop, &pinfo);
2480 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2484 if (nl80211_send_mpath(msg, info->snd_pid, info->snd_seq, 0,
2485 dev, dst, next_hop, &pinfo) < 0)
2488 err = genlmsg_reply(msg, info);
2494 cfg80211_unlock_rdev(rdev);
2502 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
2504 struct cfg80211_registered_device *rdev;
2506 struct net_device *dev;
2508 u8 *next_hop = NULL;
2510 if (!info->attrs[NL80211_ATTR_MAC])
2513 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
2516 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
2517 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
2521 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2525 if (!rdev->ops->change_mpath) {
2530 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
2535 if (!netif_running(dev)) {
2540 err = rdev->ops->change_mpath(&rdev->wiphy, dev, dst, next_hop);
2543 cfg80211_unlock_rdev(rdev);
2550 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
2552 struct cfg80211_registered_device *rdev;
2554 struct net_device *dev;
2556 u8 *next_hop = NULL;
2558 if (!info->attrs[NL80211_ATTR_MAC])
2561 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
2564 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
2565 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
2569 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2573 if (!rdev->ops->add_mpath) {
2578 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
2583 if (!netif_running(dev)) {
2588 err = rdev->ops->add_mpath(&rdev->wiphy, dev, dst, next_hop);
2591 cfg80211_unlock_rdev(rdev);
2599 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
2601 struct cfg80211_registered_device *rdev;
2603 struct net_device *dev;
2606 if (info->attrs[NL80211_ATTR_MAC])
2607 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
2611 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2615 if (!rdev->ops->del_mpath) {
2620 err = rdev->ops->del_mpath(&rdev->wiphy, dev, dst);
2623 cfg80211_unlock_rdev(rdev);
2631 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
2633 struct cfg80211_registered_device *rdev;
2635 struct net_device *dev;
2636 struct bss_parameters params;
2638 memset(¶ms, 0, sizeof(params));
2639 /* default to not changing parameters */
2640 params.use_cts_prot = -1;
2641 params.use_short_preamble = -1;
2642 params.use_short_slot_time = -1;
2643 params.ap_isolate = -1;
2645 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
2646 params.use_cts_prot =
2647 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
2648 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
2649 params.use_short_preamble =
2650 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
2651 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
2652 params.use_short_slot_time =
2653 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
2654 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
2655 params.basic_rates =
2656 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
2657 params.basic_rates_len =
2658 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
2660 if (info->attrs[NL80211_ATTR_AP_ISOLATE])
2661 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
2665 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2669 if (!rdev->ops->change_bss) {
2674 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2675 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
2680 err = rdev->ops->change_bss(&rdev->wiphy, dev, ¶ms);
2683 cfg80211_unlock_rdev(rdev);
2691 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
2692 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
2693 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
2694 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
2695 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
2696 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
2697 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
2700 static int parse_reg_rule(struct nlattr *tb[],
2701 struct ieee80211_reg_rule *reg_rule)
2703 struct ieee80211_freq_range *freq_range = ®_rule->freq_range;
2704 struct ieee80211_power_rule *power_rule = ®_rule->power_rule;
2706 if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
2708 if (!tb[NL80211_ATTR_FREQ_RANGE_START])
2710 if (!tb[NL80211_ATTR_FREQ_RANGE_END])
2712 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
2714 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
2717 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
2719 freq_range->start_freq_khz =
2720 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
2721 freq_range->end_freq_khz =
2722 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
2723 freq_range->max_bandwidth_khz =
2724 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
2726 power_rule->max_eirp =
2727 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
2729 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
2730 power_rule->max_antenna_gain =
2731 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
2736 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
2742 * You should only get this when cfg80211 hasn't yet initialized
2743 * completely when built-in to the kernel right between the time
2744 * window between nl80211_init() and regulatory_init(), if that is
2747 mutex_lock(&cfg80211_mutex);
2748 if (unlikely(!cfg80211_regdomain)) {
2749 mutex_unlock(&cfg80211_mutex);
2750 return -EINPROGRESS;
2752 mutex_unlock(&cfg80211_mutex);
2754 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
2757 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
2759 r = regulatory_hint_user(data);
2764 static int nl80211_get_mesh_params(struct sk_buff *skb,
2765 struct genl_info *info)
2767 struct cfg80211_registered_device *rdev;
2768 struct mesh_config cur_params;
2770 struct net_device *dev;
2772 struct nlattr *pinfoattr;
2773 struct sk_buff *msg;
2777 /* Look up our device */
2778 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2782 if (!rdev->ops->get_mesh_params) {
2787 /* Get the mesh params */
2788 err = rdev->ops->get_mesh_params(&rdev->wiphy, dev, &cur_params);
2792 /* Draw up a netlink message to send back */
2793 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2798 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
2799 NL80211_CMD_GET_MESH_PARAMS);
2801 goto nla_put_failure;
2802 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_PARAMS);
2804 goto nla_put_failure;
2805 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
2806 NLA_PUT_U16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
2807 cur_params.dot11MeshRetryTimeout);
2808 NLA_PUT_U16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
2809 cur_params.dot11MeshConfirmTimeout);
2810 NLA_PUT_U16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
2811 cur_params.dot11MeshHoldingTimeout);
2812 NLA_PUT_U16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
2813 cur_params.dot11MeshMaxPeerLinks);
2814 NLA_PUT_U8(msg, NL80211_MESHCONF_MAX_RETRIES,
2815 cur_params.dot11MeshMaxRetries);
2816 NLA_PUT_U8(msg, NL80211_MESHCONF_TTL,
2817 cur_params.dot11MeshTTL);
2818 NLA_PUT_U8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
2819 cur_params.auto_open_plinks);
2820 NLA_PUT_U8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
2821 cur_params.dot11MeshHWMPmaxPREQretries);
2822 NLA_PUT_U32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
2823 cur_params.path_refresh_time);
2824 NLA_PUT_U16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
2825 cur_params.min_discovery_timeout);
2826 NLA_PUT_U32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
2827 cur_params.dot11MeshHWMPactivePathTimeout);
2828 NLA_PUT_U16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
2829 cur_params.dot11MeshHWMPpreqMinInterval);
2830 NLA_PUT_U16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
2831 cur_params.dot11MeshHWMPnetDiameterTraversalTime);
2832 NLA_PUT_U8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
2833 cur_params.dot11MeshHWMPRootMode);
2834 nla_nest_end(msg, pinfoattr);
2835 genlmsg_end(msg, hdr);
2836 err = genlmsg_reply(msg, info);
2840 genlmsg_cancel(msg, hdr);
2845 cfg80211_unlock_rdev(rdev);
2853 #define FILL_IN_MESH_PARAM_IF_SET(table, cfg, param, mask, attr_num, nla_fn) \
2855 if (table[attr_num]) {\
2856 cfg.param = nla_fn(table[attr_num]); \
2857 mask |= (1 << (attr_num - 1)); \
2861 static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
2862 [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
2863 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
2864 [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
2865 [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
2866 [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
2867 [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
2868 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
2870 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
2871 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
2872 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
2873 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
2874 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
2875 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
2878 static int nl80211_set_mesh_params(struct sk_buff *skb, struct genl_info *info)
2882 struct cfg80211_registered_device *rdev;
2883 struct net_device *dev;
2884 struct mesh_config cfg;
2885 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
2886 struct nlattr *parent_attr;
2888 parent_attr = info->attrs[NL80211_ATTR_MESH_PARAMS];
2891 if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
2892 parent_attr, nl80211_meshconf_params_policy))
2897 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2901 if (!rdev->ops->set_mesh_params) {
2906 /* This makes sure that there aren't more than 32 mesh config
2907 * parameters (otherwise our bitfield scheme would not work.) */
2908 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
2910 /* Fill in the params struct */
2912 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout,
2913 mask, NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16);
2914 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout,
2915 mask, NL80211_MESHCONF_CONFIRM_TIMEOUT, nla_get_u16);
2916 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout,
2917 mask, NL80211_MESHCONF_HOLDING_TIMEOUT, nla_get_u16);
2918 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks,
2919 mask, NL80211_MESHCONF_MAX_PEER_LINKS, nla_get_u16);
2920 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries,
2921 mask, NL80211_MESHCONF_MAX_RETRIES, nla_get_u8);
2922 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL,
2923 mask, NL80211_MESHCONF_TTL, nla_get_u8);
2924 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks,
2925 mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS, nla_get_u8);
2926 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries,
2927 mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
2929 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time,
2930 mask, NL80211_MESHCONF_PATH_REFRESH_TIME, nla_get_u32);
2931 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout,
2932 mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
2934 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
2935 mask, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
2937 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
2938 mask, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
2940 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
2941 dot11MeshHWMPnetDiameterTraversalTime,
2942 mask, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
2944 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
2945 dot11MeshHWMPRootMode, mask,
2946 NL80211_MESHCONF_HWMP_ROOTMODE,
2950 err = rdev->ops->set_mesh_params(&rdev->wiphy, dev, &cfg, mask);
2954 cfg80211_unlock_rdev(rdev);
2962 #undef FILL_IN_MESH_PARAM_IF_SET
2964 static int nl80211_get_reg(struct sk_buff *skb, struct genl_info *info)
2966 struct sk_buff *msg;
2968 struct nlattr *nl_reg_rules;
2972 mutex_lock(&cfg80211_mutex);
2974 if (!cfg80211_regdomain)
2977 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2983 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
2984 NL80211_CMD_GET_REG);
2986 goto nla_put_failure;
2988 NLA_PUT_STRING(msg, NL80211_ATTR_REG_ALPHA2,
2989 cfg80211_regdomain->alpha2);
2991 nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
2993 goto nla_put_failure;
2995 for (i = 0; i < cfg80211_regdomain->n_reg_rules; i++) {
2996 struct nlattr *nl_reg_rule;
2997 const struct ieee80211_reg_rule *reg_rule;
2998 const struct ieee80211_freq_range *freq_range;
2999 const struct ieee80211_power_rule *power_rule;
3001 reg_rule = &cfg80211_regdomain->reg_rules[i];
3002 freq_range = ®_rule->freq_range;
3003 power_rule = ®_rule->power_rule;
3005 nl_reg_rule = nla_nest_start(msg, i);
3007 goto nla_put_failure;
3009 NLA_PUT_U32(msg, NL80211_ATTR_REG_RULE_FLAGS,
3011 NLA_PUT_U32(msg, NL80211_ATTR_FREQ_RANGE_START,
3012 freq_range->start_freq_khz);
3013 NLA_PUT_U32(msg, NL80211_ATTR_FREQ_RANGE_END,
3014 freq_range->end_freq_khz);
3015 NLA_PUT_U32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
3016 freq_range->max_bandwidth_khz);
3017 NLA_PUT_U32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
3018 power_rule->max_antenna_gain);
3019 NLA_PUT_U32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
3020 power_rule->max_eirp);
3022 nla_nest_end(msg, nl_reg_rule);
3025 nla_nest_end(msg, nl_reg_rules);
3027 genlmsg_end(msg, hdr);
3028 err = genlmsg_reply(msg, info);
3032 genlmsg_cancel(msg, hdr);
3036 mutex_unlock(&cfg80211_mutex);
3040 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
3042 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
3043 struct nlattr *nl_reg_rule;
3044 char *alpha2 = NULL;
3045 int rem_reg_rules = 0, r = 0;
3046 u32 num_rules = 0, rule_idx = 0, size_of_regd;
3047 struct ieee80211_regdomain *rd = NULL;
3049 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
3052 if (!info->attrs[NL80211_ATTR_REG_RULES])
3055 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
3057 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
3060 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
3064 mutex_lock(&cfg80211_mutex);
3066 if (!reg_is_valid_request(alpha2)) {
3071 size_of_regd = sizeof(struct ieee80211_regdomain) +
3072 (num_rules * sizeof(struct ieee80211_reg_rule));
3074 rd = kzalloc(size_of_regd, GFP_KERNEL);
3080 rd->n_reg_rules = num_rules;
3081 rd->alpha2[0] = alpha2[0];
3082 rd->alpha2[1] = alpha2[1];
3084 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
3086 nla_parse(tb, NL80211_REG_RULE_ATTR_MAX,
3087 nla_data(nl_reg_rule), nla_len(nl_reg_rule),
3089 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
3095 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
3101 BUG_ON(rule_idx != num_rules);
3105 mutex_unlock(&cfg80211_mutex);
3110 mutex_unlock(&cfg80211_mutex);
3115 static int validate_scan_freqs(struct nlattr *freqs)
3117 struct nlattr *attr1, *attr2;
3118 int n_channels = 0, tmp1, tmp2;
3120 nla_for_each_nested(attr1, freqs, tmp1) {
3123 * Some hardware has a limited channel list for
3124 * scanning, and it is pretty much nonsensical
3125 * to scan for a channel twice, so disallow that
3126 * and don't require drivers to check that the
3127 * channel list they get isn't longer than what
3128 * they can scan, as long as they can scan all
3129 * the channels they registered at once.
3131 nla_for_each_nested(attr2, freqs, tmp2)
3132 if (attr1 != attr2 &&
3133 nla_get_u32(attr1) == nla_get_u32(attr2))
3140 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
3142 struct cfg80211_registered_device *rdev;
3143 struct net_device *dev;
3144 struct cfg80211_scan_request *request;
3145 struct cfg80211_ssid *ssid;
3146 struct ieee80211_channel *channel;
3147 struct nlattr *attr;
3148 struct wiphy *wiphy;
3149 int err, tmp, n_ssids = 0, n_channels, i;
3150 enum ieee80211_band band;
3153 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
3158 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
3162 wiphy = &rdev->wiphy;
3164 if (!rdev->ops->scan) {
3169 if (!netif_running(dev)) {
3174 if (rdev->scan_req) {
3179 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
3180 n_channels = validate_scan_freqs(
3181 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
3189 for (band = 0; band < IEEE80211_NUM_BANDS; band++)
3190 if (wiphy->bands[band])
3191 n_channels += wiphy->bands[band]->n_channels;
3194 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
3195 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
3198 if (n_ssids > wiphy->max_scan_ssids) {
3203 if (info->attrs[NL80211_ATTR_IE])
3204 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3208 if (ie_len > wiphy->max_scan_ie_len) {
3213 request = kzalloc(sizeof(*request)
3214 + sizeof(*ssid) * n_ssids
3215 + sizeof(channel) * n_channels
3216 + ie_len, GFP_KERNEL);
3223 request->ssids = (void *)&request->channels[n_channels];
3224 request->n_ssids = n_ssids;
3227 request->ie = (void *)(request->ssids + n_ssids);
3229 request->ie = (void *)(request->channels + n_channels);
3233 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
3234 /* user specified, bail out if channel not found */
3235 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
3236 struct ieee80211_channel *chan;
3238 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
3245 /* ignore disabled channels */
3246 if (chan->flags & IEEE80211_CHAN_DISABLED)
3249 request->channels[i] = chan;
3254 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
3256 if (!wiphy->bands[band])
3258 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
3259 struct ieee80211_channel *chan;
3261 chan = &wiphy->bands[band]->channels[j];
3263 if (chan->flags & IEEE80211_CHAN_DISABLED)
3266 request->channels[i] = chan;
3277 request->n_channels = i;
3280 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) {
3281 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
3282 if (request->ssids[i].ssid_len > IEEE80211_MAX_SSID_LEN) {
3286 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
3287 request->ssids[i].ssid_len = nla_len(attr);
3292 if (info->attrs[NL80211_ATTR_IE]) {
3293 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3294 memcpy((void *)request->ie,
3295 nla_data(info->attrs[NL80211_ATTR_IE]),
3300 request->wiphy = &rdev->wiphy;
3302 rdev->scan_req = request;
3303 err = rdev->ops->scan(&rdev->wiphy, dev, request);
3306 nl80211_send_scan_start(rdev, dev);
3312 rdev->scan_req = NULL;
3316 cfg80211_unlock_rdev(rdev);
3324 static int nl80211_send_bss(struct sk_buff *msg, u32 pid, u32 seq, int flags,
3325 struct cfg80211_registered_device *rdev,
3326 struct wireless_dev *wdev,
3327 struct cfg80211_internal_bss *intbss)
3329 struct cfg80211_bss *res = &intbss->pub;
3334 ASSERT_WDEV_LOCK(wdev);
3336 hdr = nl80211hdr_put(msg, pid, seq, flags,
3337 NL80211_CMD_NEW_SCAN_RESULTS);
3341 NLA_PUT_U32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation);
3342 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex);
3344 bss = nla_nest_start(msg, NL80211_ATTR_BSS);
3346 goto nla_put_failure;
3347 if (!is_zero_ether_addr(res->bssid))
3348 NLA_PUT(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid);
3349 if (res->information_elements && res->len_information_elements)
3350 NLA_PUT(msg, NL80211_BSS_INFORMATION_ELEMENTS,
3351 res->len_information_elements,
3352 res->information_elements);
3353 if (res->beacon_ies && res->len_beacon_ies &&
3354 res->beacon_ies != res->information_elements)
3355 NLA_PUT(msg, NL80211_BSS_BEACON_IES,
3356 res->len_beacon_ies, res->beacon_ies);
3358 NLA_PUT_U64(msg, NL80211_BSS_TSF, res->tsf);
3359 if (res->beacon_interval)
3360 NLA_PUT_U16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval);
3361 NLA_PUT_U16(msg, NL80211_BSS_CAPABILITY, res->capability);
3362 NLA_PUT_U32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq);
3363 NLA_PUT_U32(msg, NL80211_BSS_SEEN_MS_AGO,
3364 jiffies_to_msecs(jiffies - intbss->ts));
3366 switch (rdev->wiphy.signal_type) {
3367 case CFG80211_SIGNAL_TYPE_MBM:
3368 NLA_PUT_U32(msg, NL80211_BSS_SIGNAL_MBM, res->signal);
3370 case CFG80211_SIGNAL_TYPE_UNSPEC:
3371 NLA_PUT_U8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal);
3377 switch (wdev->iftype) {
3378 case NL80211_IFTYPE_P2P_CLIENT:
3379 case NL80211_IFTYPE_STATION:
3380 if (intbss == wdev->current_bss)
3381 NLA_PUT_U32(msg, NL80211_BSS_STATUS,
3382 NL80211_BSS_STATUS_ASSOCIATED);
3383 else for (i = 0; i < MAX_AUTH_BSSES; i++) {
3384 if (intbss != wdev->auth_bsses[i])
3386 NLA_PUT_U32(msg, NL80211_BSS_STATUS,
3387 NL80211_BSS_STATUS_AUTHENTICATED);
3391 case NL80211_IFTYPE_ADHOC:
3392 if (intbss == wdev->current_bss)
3393 NLA_PUT_U32(msg, NL80211_BSS_STATUS,
3394 NL80211_BSS_STATUS_IBSS_JOINED);
3400 nla_nest_end(msg, bss);
3402 return genlmsg_end(msg, hdr);
3405 genlmsg_cancel(msg, hdr);
3409 static int nl80211_dump_scan(struct sk_buff *skb,
3410 struct netlink_callback *cb)
3412 struct cfg80211_registered_device *rdev;
3413 struct net_device *dev;
3414 struct cfg80211_internal_bss *scan;
3415 struct wireless_dev *wdev;
3416 int ifidx = cb->args[0];
3417 int start = cb->args[1], idx = 0;
3421 ifidx = nl80211_get_ifidx(cb);
3424 cb->args[0] = ifidx;
3426 dev = dev_get_by_index(sock_net(skb->sk), ifidx);
3430 rdev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
3432 err = PTR_ERR(rdev);
3433 goto out_put_netdev;
3436 wdev = dev->ieee80211_ptr;
3439 spin_lock_bh(&rdev->bss_lock);
3440 cfg80211_bss_expire(rdev);
3442 list_for_each_entry(scan, &rdev->bss_list, list) {
3445 if (nl80211_send_bss(skb,
3446 NETLINK_CB(cb->skb).pid,
3447 cb->nlh->nlmsg_seq, NLM_F_MULTI,
3448 rdev, wdev, scan) < 0) {
3455 spin_unlock_bh(&rdev->bss_lock);
3460 cfg80211_unlock_rdev(rdev);
3467 static int nl80211_send_survey(struct sk_buff *msg, u32 pid, u32 seq,
3468 int flags, struct net_device *dev,
3469 struct survey_info *survey)
3472 struct nlattr *infoattr;
3474 /* Survey without a channel doesn't make sense */
3475 if (!survey->channel)
3478 hdr = nl80211hdr_put(msg, pid, seq, flags,
3479 NL80211_CMD_NEW_SURVEY_RESULTS);
3483 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
3485 infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
3487 goto nla_put_failure;
3489 NLA_PUT_U32(msg, NL80211_SURVEY_INFO_FREQUENCY,
3490 survey->channel->center_freq);
3491 if (survey->filled & SURVEY_INFO_NOISE_DBM)
3492 NLA_PUT_U8(msg, NL80211_SURVEY_INFO_NOISE,
3494 if (survey->filled & SURVEY_INFO_IN_USE)
3495 NLA_PUT_FLAG(msg, NL80211_SURVEY_INFO_IN_USE);
3497 nla_nest_end(msg, infoattr);
3499 return genlmsg_end(msg, hdr);
3502 genlmsg_cancel(msg, hdr);
3506 static int nl80211_dump_survey(struct sk_buff *skb,
3507 struct netlink_callback *cb)
3509 struct survey_info survey;
3510 struct cfg80211_registered_device *dev;
3511 struct net_device *netdev;
3512 int ifidx = cb->args[0];
3513 int survey_idx = cb->args[1];
3517 ifidx = nl80211_get_ifidx(cb);
3520 cb->args[0] = ifidx;
3524 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
3530 dev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
3536 if (!dev->ops->dump_survey) {
3542 res = dev->ops->dump_survey(&dev->wiphy, netdev, survey_idx,
3549 if (nl80211_send_survey(skb,
3550 NETLINK_CB(cb->skb).pid,
3551 cb->nlh->nlmsg_seq, NLM_F_MULTI,
3559 cb->args[1] = survey_idx;
3562 cfg80211_unlock_rdev(dev);
3569 static bool nl80211_valid_auth_type(enum nl80211_auth_type auth_type)
3571 return auth_type <= NL80211_AUTHTYPE_MAX;
3574 static bool nl80211_valid_wpa_versions(u32 wpa_versions)
3576 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
3577 NL80211_WPA_VERSION_2));
3580 static bool nl80211_valid_akm_suite(u32 akm)
3582 return akm == WLAN_AKM_SUITE_8021X ||
3583 akm == WLAN_AKM_SUITE_PSK;
3586 static bool nl80211_valid_cipher_suite(u32 cipher)
3588 return cipher == WLAN_CIPHER_SUITE_WEP40 ||
3589 cipher == WLAN_CIPHER_SUITE_WEP104 ||
3590 cipher == WLAN_CIPHER_SUITE_TKIP ||
3591 cipher == WLAN_CIPHER_SUITE_CCMP ||
3592 cipher == WLAN_CIPHER_SUITE_AES_CMAC;
3596 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
3598 struct cfg80211_registered_device *rdev;
3599 struct net_device *dev;
3600 struct ieee80211_channel *chan;
3601 const u8 *bssid, *ssid, *ie = NULL;
3602 int err, ssid_len, ie_len = 0;
3603 enum nl80211_auth_type auth_type;
3604 struct key_parse key;
3605 bool local_state_change;
3607 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
3610 if (!info->attrs[NL80211_ATTR_MAC])
3613 if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
3616 if (!info->attrs[NL80211_ATTR_SSID])
3619 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
3622 err = nl80211_parse_key(info, &key);
3627 if (!key.p.key || !key.p.key_len)
3629 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
3630 key.p.key_len != WLAN_KEY_LEN_WEP40) &&
3631 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
3632 key.p.key_len != WLAN_KEY_LEN_WEP104))
3643 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
3650 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
3651 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
3662 if (!rdev->ops->auth) {
3667 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
3668 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
3673 if (!netif_running(dev)) {
3678 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
3679 chan = ieee80211_get_channel(&rdev->wiphy,
3680 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
3681 if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED)) {
3686 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
3687 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
3689 if (info->attrs[NL80211_ATTR_IE]) {
3690 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
3691 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3694 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
3695 if (!nl80211_valid_auth_type(auth_type)) {
3700 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
3702 err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
3703 ssid, ssid_len, ie, ie_len,
3704 key.p.key, key.p.key_len, key.idx,
3705 local_state_change);
3708 cfg80211_unlock_rdev(rdev);
3715 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
3716 struct genl_info *info,
3717 struct cfg80211_crypto_settings *settings,
3720 memset(settings, 0, sizeof(*settings));
3722 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
3724 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
3726 proto = nla_get_u16(
3727 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
3728 settings->control_port_ethertype = cpu_to_be16(proto);
3729 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
3732 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
3733 settings->control_port_no_encrypt = true;
3735 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
3737 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
3741 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
3742 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
3743 settings->n_ciphers_pairwise = len / sizeof(u32);
3745 if (len % sizeof(u32))
3748 if (settings->n_ciphers_pairwise > cipher_limit)
3751 memcpy(settings->ciphers_pairwise, data, len);
3753 for (i = 0; i < settings->n_ciphers_pairwise; i++)
3754 if (!nl80211_valid_cipher_suite(
3755 settings->ciphers_pairwise[i]))
3759 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
3760 settings->cipher_group =
3761 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
3762 if (!nl80211_valid_cipher_suite(settings->cipher_group))
3766 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
3767 settings->wpa_versions =
3768 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
3769 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
3773 if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
3777 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
3778 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
3779 settings->n_akm_suites = len / sizeof(u32);
3781 if (len % sizeof(u32))
3784 memcpy(settings->akm_suites, data, len);
3786 for (i = 0; i < settings->n_ciphers_pairwise; i++)
3787 if (!nl80211_valid_akm_suite(settings->akm_suites[i]))
3794 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
3796 struct cfg80211_registered_device *rdev;
3797 struct net_device *dev;
3798 struct cfg80211_crypto_settings crypto;
3799 struct ieee80211_channel *chan;
3800 const u8 *bssid, *ssid, *ie = NULL, *prev_bssid = NULL;
3801 int err, ssid_len, ie_len = 0;
3802 bool use_mfp = false;
3804 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
3807 if (!info->attrs[NL80211_ATTR_MAC] ||
3808 !info->attrs[NL80211_ATTR_SSID] ||
3809 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
3814 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
3818 if (!rdev->ops->assoc) {
3823 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
3824 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
3829 if (!netif_running(dev)) {
3834 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
3836 chan = ieee80211_get_channel(&rdev->wiphy,
3837 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
3838 if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED)) {
3843 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
3844 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
3846 if (info->attrs[NL80211_ATTR_IE]) {
3847 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
3848 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3851 if (info->attrs[NL80211_ATTR_USE_MFP]) {
3852 enum nl80211_mfp mfp =
3853 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
3854 if (mfp == NL80211_MFP_REQUIRED)
3856 else if (mfp != NL80211_MFP_NO) {
3862 if (info->attrs[NL80211_ATTR_PREV_BSSID])
3863 prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
3865 err = nl80211_crypto_settings(rdev, info, &crypto, 1);
3867 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid, prev_bssid,
3868 ssid, ssid_len, ie, ie_len, use_mfp,
3872 cfg80211_unlock_rdev(rdev);
3879 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
3881 struct cfg80211_registered_device *rdev;
3882 struct net_device *dev;
3883 const u8 *ie = NULL, *bssid;
3884 int err, ie_len = 0;
3886 bool local_state_change;
3888 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
3891 if (!info->attrs[NL80211_ATTR_MAC])
3894 if (!info->attrs[NL80211_ATTR_REASON_CODE])
3899 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
3903 if (!rdev->ops->deauth) {
3908 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
3909 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
3914 if (!netif_running(dev)) {
3919 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
3921 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
3922 if (reason_code == 0) {
3923 /* Reason Code 0 is reserved */
3928 if (info->attrs[NL80211_ATTR_IE]) {
3929 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
3930 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3933 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
3935 err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
3936 local_state_change);
3939 cfg80211_unlock_rdev(rdev);
3946 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
3948 struct cfg80211_registered_device *rdev;
3949 struct net_device *dev;
3950 const u8 *ie = NULL, *bssid;
3951 int err, ie_len = 0;
3953 bool local_state_change;
3955 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
3958 if (!info->attrs[NL80211_ATTR_MAC])
3961 if (!info->attrs[NL80211_ATTR_REASON_CODE])
3966 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
3970 if (!rdev->ops->disassoc) {
3975 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
3976 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
3981 if (!netif_running(dev)) {
3986 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
3988 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
3989 if (reason_code == 0) {
3990 /* Reason Code 0 is reserved */
3995 if (info->attrs[NL80211_ATTR_IE]) {
3996 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
3997 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4000 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
4002 err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
4003 local_state_change);
4006 cfg80211_unlock_rdev(rdev);
4013 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
4015 struct cfg80211_registered_device *rdev;
4016 struct net_device *dev;
4017 struct cfg80211_ibss_params ibss;
4018 struct wiphy *wiphy;
4019 struct cfg80211_cached_keys *connkeys = NULL;
4022 memset(&ibss, 0, sizeof(ibss));
4024 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
4027 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
4028 !info->attrs[NL80211_ATTR_SSID] ||
4029 !nla_len(info->attrs[NL80211_ATTR_SSID]))
4032 ibss.beacon_interval = 100;
4034 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
4035 ibss.beacon_interval =
4036 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
4037 if (ibss.beacon_interval < 1 || ibss.beacon_interval > 10000)
4043 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4047 if (!rdev->ops->join_ibss) {
4052 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) {
4057 if (!netif_running(dev)) {
4062 wiphy = &rdev->wiphy;
4064 if (info->attrs[NL80211_ATTR_MAC])
4065 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
4066 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
4067 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
4069 if (info->attrs[NL80211_ATTR_IE]) {
4070 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
4071 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4074 ibss.channel = ieee80211_get_channel(wiphy,
4075 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
4076 if (!ibss.channel ||
4077 ibss.channel->flags & IEEE80211_CHAN_NO_IBSS ||
4078 ibss.channel->flags & IEEE80211_CHAN_DISABLED) {
4083 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
4084 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
4086 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
4087 connkeys = nl80211_parse_connkeys(rdev,
4088 info->attrs[NL80211_ATTR_KEYS]);
4089 if (IS_ERR(connkeys)) {
4090 err = PTR_ERR(connkeys);
4096 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
4098 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
4100 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
4101 struct ieee80211_supported_band *sband =
4102 wiphy->bands[ibss.channel->band];
4110 for (i = 0; i < n_rates; i++) {
4111 int rate = (rates[i] & 0x7f) * 5;
4114 for (j = 0; j < sband->n_bitrates; j++) {
4115 if (sband->bitrates[j].bitrate == rate) {
4117 ibss.basic_rates |= BIT(j);
4128 err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
4131 cfg80211_unlock_rdev(rdev);
4140 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
4142 struct cfg80211_registered_device *rdev;
4143 struct net_device *dev;
4148 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4152 if (!rdev->ops->leave_ibss) {
4157 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) {
4162 if (!netif_running(dev)) {
4167 err = cfg80211_leave_ibss(rdev, dev, false);
4170 cfg80211_unlock_rdev(rdev);
4177 #ifdef CONFIG_NL80211_TESTMODE
4178 static struct genl_multicast_group nl80211_testmode_mcgrp = {
4182 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
4184 struct cfg80211_registered_device *rdev;
4187 if (!info->attrs[NL80211_ATTR_TESTDATA])
4192 rdev = cfg80211_get_dev_from_info(info);
4194 err = PTR_ERR(rdev);
4199 if (rdev->ops->testmode_cmd) {
4200 rdev->testmode_info = info;
4201 err = rdev->ops->testmode_cmd(&rdev->wiphy,
4202 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
4203 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
4204 rdev->testmode_info = NULL;
4207 cfg80211_unlock_rdev(rdev);
4214 static struct sk_buff *
4215 __cfg80211_testmode_alloc_skb(struct cfg80211_registered_device *rdev,
4216 int approxlen, u32 pid, u32 seq, gfp_t gfp)
4218 struct sk_buff *skb;
4220 struct nlattr *data;
4222 skb = nlmsg_new(approxlen + 100, gfp);
4226 hdr = nl80211hdr_put(skb, pid, seq, 0, NL80211_CMD_TESTMODE);
4232 NLA_PUT_U32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
4233 data = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
4235 ((void **)skb->cb)[0] = rdev;
4236 ((void **)skb->cb)[1] = hdr;
4237 ((void **)skb->cb)[2] = data;
4246 struct sk_buff *cfg80211_testmode_alloc_reply_skb(struct wiphy *wiphy,
4249 struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
4251 if (WARN_ON(!rdev->testmode_info))
4254 return __cfg80211_testmode_alloc_skb(rdev, approxlen,
4255 rdev->testmode_info->snd_pid,
4256 rdev->testmode_info->snd_seq,
4259 EXPORT_SYMBOL(cfg80211_testmode_alloc_reply_skb);
4261 int cfg80211_testmode_reply(struct sk_buff *skb)
4263 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
4264 void *hdr = ((void **)skb->cb)[1];
4265 struct nlattr *data = ((void **)skb->cb)[2];
4267 if (WARN_ON(!rdev->testmode_info)) {
4272 nla_nest_end(skb, data);
4273 genlmsg_end(skb, hdr);
4274 return genlmsg_reply(skb, rdev->testmode_info);
4276 EXPORT_SYMBOL(cfg80211_testmode_reply);
4278 struct sk_buff *cfg80211_testmode_alloc_event_skb(struct wiphy *wiphy,
4279 int approxlen, gfp_t gfp)
4281 struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
4283 return __cfg80211_testmode_alloc_skb(rdev, approxlen, 0, 0, gfp);
4285 EXPORT_SYMBOL(cfg80211_testmode_alloc_event_skb);
4287 void cfg80211_testmode_event(struct sk_buff *skb, gfp_t gfp)
4289 void *hdr = ((void **)skb->cb)[1];
4290 struct nlattr *data = ((void **)skb->cb)[2];
4292 nla_nest_end(skb, data);
4293 genlmsg_end(skb, hdr);
4294 genlmsg_multicast(skb, 0, nl80211_testmode_mcgrp.id, gfp);
4296 EXPORT_SYMBOL(cfg80211_testmode_event);
4299 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
4301 struct cfg80211_registered_device *rdev;
4302 struct net_device *dev;
4303 struct cfg80211_connect_params connect;
4304 struct wiphy *wiphy;
4305 struct cfg80211_cached_keys *connkeys = NULL;
4308 memset(&connect, 0, sizeof(connect));
4310 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
4313 if (!info->attrs[NL80211_ATTR_SSID] ||
4314 !nla_len(info->attrs[NL80211_ATTR_SSID]))
4317 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
4319 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
4320 if (!nl80211_valid_auth_type(connect.auth_type))
4323 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
4325 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
4327 err = nl80211_crypto_settings(rdev, info, &connect.crypto,
4328 NL80211_MAX_NR_CIPHER_SUITES);
4333 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4337 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4338 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
4343 if (!netif_running(dev)) {
4348 wiphy = &rdev->wiphy;
4350 if (info->attrs[NL80211_ATTR_MAC])
4351 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
4352 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
4353 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
4355 if (info->attrs[NL80211_ATTR_IE]) {
4356 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
4357 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4360 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
4362 ieee80211_get_channel(wiphy,
4363 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
4364 if (!connect.channel ||
4365 connect.channel->flags & IEEE80211_CHAN_DISABLED) {
4371 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
4372 connkeys = nl80211_parse_connkeys(rdev,
4373 info->attrs[NL80211_ATTR_KEYS]);
4374 if (IS_ERR(connkeys)) {
4375 err = PTR_ERR(connkeys);
4381 err = cfg80211_connect(rdev, dev, &connect, connkeys);
4384 cfg80211_unlock_rdev(rdev);
4393 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
4395 struct cfg80211_registered_device *rdev;
4396 struct net_device *dev;
4400 if (!info->attrs[NL80211_ATTR_REASON_CODE])
4401 reason = WLAN_REASON_DEAUTH_LEAVING;
4403 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
4410 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4414 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4415 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
4420 if (!netif_running(dev)) {
4425 err = cfg80211_disconnect(rdev, dev, reason, true);
4428 cfg80211_unlock_rdev(rdev);
4435 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
4437 struct cfg80211_registered_device *rdev;
4442 if (!info->attrs[NL80211_ATTR_PID])
4445 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
4449 rdev = cfg80211_get_dev_from_info(info);
4451 err = PTR_ERR(rdev);
4455 net = get_net_ns_by_pid(pid);
4463 /* check if anything to do */
4464 if (net_eq(wiphy_net(&rdev->wiphy), net))
4467 err = cfg80211_switch_netns(rdev, net);
4471 cfg80211_unlock_rdev(rdev);
4477 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
4479 struct cfg80211_registered_device *rdev;
4480 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
4481 struct cfg80211_pmksa *pmksa) = NULL;
4483 struct net_device *dev;
4484 struct cfg80211_pmksa pmksa;
4486 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
4488 if (!info->attrs[NL80211_ATTR_MAC])
4491 if (!info->attrs[NL80211_ATTR_PMKID])
4496 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4500 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
4501 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
4503 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4504 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
4509 switch (info->genlhdr->cmd) {
4510 case NL80211_CMD_SET_PMKSA:
4511 rdev_ops = rdev->ops->set_pmksa;
4513 case NL80211_CMD_DEL_PMKSA:
4514 rdev_ops = rdev->ops->del_pmksa;
4526 err = rdev_ops(&rdev->wiphy, dev, &pmksa);
4529 cfg80211_unlock_rdev(rdev);
4537 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
4539 struct cfg80211_registered_device *rdev;
4541 struct net_device *dev;
4545 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4549 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4550 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
4555 if (!rdev->ops->flush_pmksa) {
4560 err = rdev->ops->flush_pmksa(&rdev->wiphy, dev);
4563 cfg80211_unlock_rdev(rdev);
4572 static int nl80211_remain_on_channel(struct sk_buff *skb,
4573 struct genl_info *info)
4575 struct cfg80211_registered_device *rdev;
4576 struct net_device *dev;
4577 struct ieee80211_channel *chan;
4578 struct sk_buff *msg;
4581 enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;
4585 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
4586 !info->attrs[NL80211_ATTR_DURATION])
4589 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
4592 * We should be on that channel for at least one jiffie,
4593 * and more than 5 seconds seems excessive.
4595 if (!duration || !msecs_to_jiffies(duration) || duration > 5000)
4600 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4604 if (!rdev->ops->remain_on_channel) {
4609 if (!netif_running(dev)) {
4614 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
4615 channel_type = nla_get_u32(
4616 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
4617 if (channel_type != NL80211_CHAN_NO_HT &&
4618 channel_type != NL80211_CHAN_HT20 &&
4619 channel_type != NL80211_CHAN_HT40PLUS &&
4620 channel_type != NL80211_CHAN_HT40MINUS) {
4626 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
4627 chan = rdev_freq_to_chan(rdev, freq, channel_type);
4633 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4639 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
4640 NL80211_CMD_REMAIN_ON_CHANNEL);
4647 err = rdev->ops->remain_on_channel(&rdev->wiphy, dev, chan,
4648 channel_type, duration, &cookie);
4653 NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
4655 genlmsg_end(msg, hdr);
4656 err = genlmsg_reply(msg, info);
4664 cfg80211_unlock_rdev(rdev);
4671 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
4672 struct genl_info *info)
4674 struct cfg80211_registered_device *rdev;
4675 struct net_device *dev;
4679 if (!info->attrs[NL80211_ATTR_COOKIE])
4684 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4688 if (!rdev->ops->cancel_remain_on_channel) {
4693 if (!netif_running(dev)) {
4698 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
4700 err = rdev->ops->cancel_remain_on_channel(&rdev->wiphy, dev, cookie);
4703 cfg80211_unlock_rdev(rdev);
4710 static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
4711 u8 *rates, u8 rates_len)
4716 for (i = 0; i < rates_len; i++) {
4717 int rate = (rates[i] & 0x7f) * 5;
4719 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
4720 struct ieee80211_rate *srate =
4721 &sband->bitrates[ridx];
4722 if (rate == srate->bitrate) {
4727 if (ridx == sband->n_bitrates)
4728 return 0; /* rate not found */
4734 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
4735 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
4736 .len = NL80211_MAX_SUPP_RATES },
4739 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
4740 struct genl_info *info)
4742 struct nlattr *tb[NL80211_TXRATE_MAX + 1];
4743 struct cfg80211_registered_device *rdev;
4744 struct cfg80211_bitrate_mask mask;
4746 struct net_device *dev;
4747 struct nlattr *tx_rates;
4748 struct ieee80211_supported_band *sband;
4750 if (info->attrs[NL80211_ATTR_TX_RATES] == NULL)
4755 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4759 if (!rdev->ops->set_bitrate_mask) {
4764 memset(&mask, 0, sizeof(mask));
4765 /* Default to all rates enabled */
4766 for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
4767 sband = rdev->wiphy.bands[i];
4768 mask.control[i].legacy =
4769 sband ? (1 << sband->n_bitrates) - 1 : 0;
4773 * The nested attribute uses enum nl80211_band as the index. This maps
4774 * directly to the enum ieee80211_band values used in cfg80211.
4776 nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem)
4778 enum ieee80211_band band = nla_type(tx_rates);
4779 if (band < 0 || band >= IEEE80211_NUM_BANDS) {
4783 sband = rdev->wiphy.bands[band];
4784 if (sband == NULL) {
4788 nla_parse(tb, NL80211_TXRATE_MAX, nla_data(tx_rates),
4789 nla_len(tx_rates), nl80211_txattr_policy);
4790 if (tb[NL80211_TXRATE_LEGACY]) {
4791 mask.control[band].legacy = rateset_to_mask(
4793 nla_data(tb[NL80211_TXRATE_LEGACY]),
4794 nla_len(tb[NL80211_TXRATE_LEGACY]));
4795 if (mask.control[band].legacy == 0) {
4802 err = rdev->ops->set_bitrate_mask(&rdev->wiphy, dev, NULL, &mask);
4806 cfg80211_unlock_rdev(rdev);
4812 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
4814 struct cfg80211_registered_device *rdev;
4815 struct net_device *dev;
4816 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
4819 if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
4822 if (info->attrs[NL80211_ATTR_FRAME_TYPE])
4823 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
4827 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4831 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4832 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
4833 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
4834 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4835 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
4836 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
4841 /* not much point in registering if we can't reply */
4842 if (!rdev->ops->mgmt_tx) {
4847 err = cfg80211_mlme_register_mgmt(dev->ieee80211_ptr, info->snd_pid,
4849 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
4850 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
4852 cfg80211_unlock_rdev(rdev);
4859 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
4861 struct cfg80211_registered_device *rdev;
4862 struct net_device *dev;
4863 struct ieee80211_channel *chan;
4864 enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;
4865 bool channel_type_valid = false;
4870 struct sk_buff *msg;
4872 if (!info->attrs[NL80211_ATTR_FRAME] ||
4873 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
4878 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4882 if (!rdev->ops->mgmt_tx) {
4887 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4888 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
4889 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
4890 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4891 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
4892 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
4897 if (!netif_running(dev)) {
4902 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
4903 channel_type = nla_get_u32(
4904 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
4905 if (channel_type != NL80211_CHAN_NO_HT &&
4906 channel_type != NL80211_CHAN_HT20 &&
4907 channel_type != NL80211_CHAN_HT40PLUS &&
4908 channel_type != NL80211_CHAN_HT40MINUS) {
4912 channel_type_valid = true;
4915 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
4916 chan = rdev_freq_to_chan(rdev, freq, channel_type);
4922 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4928 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
4935 err = cfg80211_mlme_mgmt_tx(rdev, dev, chan, channel_type,
4937 nla_data(info->attrs[NL80211_ATTR_FRAME]),
4938 nla_len(info->attrs[NL80211_ATTR_FRAME]),
4943 NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
4945 genlmsg_end(msg, hdr);
4946 err = genlmsg_reply(msg, info);
4954 cfg80211_unlock_rdev(rdev);
4961 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
4963 struct cfg80211_registered_device *rdev;
4964 struct wireless_dev *wdev;
4965 struct net_device *dev;
4970 if (!info->attrs[NL80211_ATTR_PS_STATE]) {
4975 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
4977 if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED) {
4984 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4988 wdev = dev->ieee80211_ptr;
4990 if (!rdev->ops->set_power_mgmt) {
4995 state = (ps_state == NL80211_PS_ENABLED) ? true : false;
4997 if (state == wdev->ps)
5002 if (rdev->ops->set_power_mgmt(wdev->wiphy, dev, wdev->ps,
5004 /* assume this means it's off */
5008 cfg80211_unlock_rdev(rdev);
5017 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
5019 struct cfg80211_registered_device *rdev;
5020 enum nl80211_ps_state ps_state;
5021 struct wireless_dev *wdev;
5022 struct net_device *dev;
5023 struct sk_buff *msg;
5029 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
5033 wdev = dev->ieee80211_ptr;
5035 if (!rdev->ops->set_power_mgmt) {
5040 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5046 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
5047 NL80211_CMD_GET_POWER_SAVE);
5054 ps_state = NL80211_PS_ENABLED;
5056 ps_state = NL80211_PS_DISABLED;
5058 NLA_PUT_U32(msg, NL80211_ATTR_PS_STATE, ps_state);
5060 genlmsg_end(msg, hdr);
5061 err = genlmsg_reply(msg, info);
5071 cfg80211_unlock_rdev(rdev);
5080 static struct nla_policy
5081 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] __read_mostly = {
5082 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
5083 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
5084 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
5087 static int nl80211_set_cqm_rssi(struct genl_info *info,
5088 s32 threshold, u32 hysteresis)
5090 struct cfg80211_registered_device *rdev;
5091 struct wireless_dev *wdev;
5092 struct net_device *dev;
5100 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
5104 wdev = dev->ieee80211_ptr;
5106 if (!rdev->ops->set_cqm_rssi_config) {
5111 if (wdev->iftype != NL80211_IFTYPE_STATION &&
5112 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) {
5117 err = rdev->ops->set_cqm_rssi_config(wdev->wiphy, dev,
5118 threshold, hysteresis);
5121 cfg80211_unlock_rdev(rdev);
5129 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
5131 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
5135 cqm = info->attrs[NL80211_ATTR_CQM];
5141 err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
5142 nl80211_attr_cqm_policy);
5146 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
5147 attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
5150 threshold = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
5151 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
5152 err = nl80211_set_cqm_rssi(info, threshold, hysteresis);
5160 static struct genl_ops nl80211_ops[] = {
5162 .cmd = NL80211_CMD_GET_WIPHY,
5163 .doit = nl80211_get_wiphy,
5164 .dumpit = nl80211_dump_wiphy,
5165 .policy = nl80211_policy,
5166 /* can be retrieved by unprivileged users */
5169 .cmd = NL80211_CMD_SET_WIPHY,
5170 .doit = nl80211_set_wiphy,
5171 .policy = nl80211_policy,
5172 .flags = GENL_ADMIN_PERM,
5175 .cmd = NL80211_CMD_GET_INTERFACE,
5176 .doit = nl80211_get_interface,
5177 .dumpit = nl80211_dump_interface,
5178 .policy = nl80211_policy,
5179 /* can be retrieved by unprivileged users */
5182 .cmd = NL80211_CMD_SET_INTERFACE,
5183 .doit = nl80211_set_interface,
5184 .policy = nl80211_policy,
5185 .flags = GENL_ADMIN_PERM,
5188 .cmd = NL80211_CMD_NEW_INTERFACE,
5189 .doit = nl80211_new_interface,
5190 .policy = nl80211_policy,
5191 .flags = GENL_ADMIN_PERM,
5194 .cmd = NL80211_CMD_DEL_INTERFACE,
5195 .doit = nl80211_del_interface,
5196 .policy = nl80211_policy,
5197 .flags = GENL_ADMIN_PERM,
5200 .cmd = NL80211_CMD_GET_KEY,
5201 .doit = nl80211_get_key,
5202 .policy = nl80211_policy,
5203 .flags = GENL_ADMIN_PERM,
5206 .cmd = NL80211_CMD_SET_KEY,
5207 .doit = nl80211_set_key,
5208 .policy = nl80211_policy,
5209 .flags = GENL_ADMIN_PERM,
5212 .cmd = NL80211_CMD_NEW_KEY,
5213 .doit = nl80211_new_key,
5214 .policy = nl80211_policy,
5215 .flags = GENL_ADMIN_PERM,
5218 .cmd = NL80211_CMD_DEL_KEY,
5219 .doit = nl80211_del_key,
5220 .policy = nl80211_policy,
5221 .flags = GENL_ADMIN_PERM,
5224 .cmd = NL80211_CMD_SET_BEACON,
5225 .policy = nl80211_policy,
5226 .flags = GENL_ADMIN_PERM,
5227 .doit = nl80211_addset_beacon,
5230 .cmd = NL80211_CMD_NEW_BEACON,
5231 .policy = nl80211_policy,
5232 .flags = GENL_ADMIN_PERM,
5233 .doit = nl80211_addset_beacon,
5236 .cmd = NL80211_CMD_DEL_BEACON,
5237 .policy = nl80211_policy,
5238 .flags = GENL_ADMIN_PERM,
5239 .doit = nl80211_del_beacon,
5242 .cmd = NL80211_CMD_GET_STATION,
5243 .doit = nl80211_get_station,
5244 .dumpit = nl80211_dump_station,
5245 .policy = nl80211_policy,
5248 .cmd = NL80211_CMD_SET_STATION,
5249 .doit = nl80211_set_station,
5250 .policy = nl80211_policy,
5251 .flags = GENL_ADMIN_PERM,
5254 .cmd = NL80211_CMD_NEW_STATION,
5255 .doit = nl80211_new_station,
5256 .policy = nl80211_policy,
5257 .flags = GENL_ADMIN_PERM,
5260 .cmd = NL80211_CMD_DEL_STATION,
5261 .doit = nl80211_del_station,
5262 .policy = nl80211_policy,
5263 .flags = GENL_ADMIN_PERM,
5266 .cmd = NL80211_CMD_GET_MPATH,
5267 .doit = nl80211_get_mpath,
5268 .dumpit = nl80211_dump_mpath,
5269 .policy = nl80211_policy,
5270 .flags = GENL_ADMIN_PERM,
5273 .cmd = NL80211_CMD_SET_MPATH,
5274 .doit = nl80211_set_mpath,
5275 .policy = nl80211_policy,
5276 .flags = GENL_ADMIN_PERM,
5279 .cmd = NL80211_CMD_NEW_MPATH,
5280 .doit = nl80211_new_mpath,
5281 .policy = nl80211_policy,
5282 .flags = GENL_ADMIN_PERM,
5285 .cmd = NL80211_CMD_DEL_MPATH,
5286 .doit = nl80211_del_mpath,
5287 .policy = nl80211_policy,
5288 .flags = GENL_ADMIN_PERM,
5291 .cmd = NL80211_CMD_SET_BSS,
5292 .doit = nl80211_set_bss,
5293 .policy = nl80211_policy,
5294 .flags = GENL_ADMIN_PERM,
5297 .cmd = NL80211_CMD_GET_REG,
5298 .doit = nl80211_get_reg,
5299 .policy = nl80211_policy,
5300 /* can be retrieved by unprivileged users */
5303 .cmd = NL80211_CMD_SET_REG,
5304 .doit = nl80211_set_reg,
5305 .policy = nl80211_policy,
5306 .flags = GENL_ADMIN_PERM,
5309 .cmd = NL80211_CMD_REQ_SET_REG,
5310 .doit = nl80211_req_set_reg,
5311 .policy = nl80211_policy,
5312 .flags = GENL_ADMIN_PERM,
5315 .cmd = NL80211_CMD_GET_MESH_PARAMS,
5316 .doit = nl80211_get_mesh_params,
5317 .policy = nl80211_policy,
5318 /* can be retrieved by unprivileged users */
5321 .cmd = NL80211_CMD_SET_MESH_PARAMS,
5322 .doit = nl80211_set_mesh_params,
5323 .policy = nl80211_policy,
5324 .flags = GENL_ADMIN_PERM,
5327 .cmd = NL80211_CMD_TRIGGER_SCAN,
5328 .doit = nl80211_trigger_scan,
5329 .policy = nl80211_policy,
5330 .flags = GENL_ADMIN_PERM,
5333 .cmd = NL80211_CMD_GET_SCAN,
5334 .policy = nl80211_policy,
5335 .dumpit = nl80211_dump_scan,
5338 .cmd = NL80211_CMD_AUTHENTICATE,
5339 .doit = nl80211_authenticate,
5340 .policy = nl80211_policy,
5341 .flags = GENL_ADMIN_PERM,
5344 .cmd = NL80211_CMD_ASSOCIATE,
5345 .doit = nl80211_associate,
5346 .policy = nl80211_policy,
5347 .flags = GENL_ADMIN_PERM,
5350 .cmd = NL80211_CMD_DEAUTHENTICATE,
5351 .doit = nl80211_deauthenticate,
5352 .policy = nl80211_policy,
5353 .flags = GENL_ADMIN_PERM,
5356 .cmd = NL80211_CMD_DISASSOCIATE,
5357 .doit = nl80211_disassociate,
5358 .policy = nl80211_policy,
5359 .flags = GENL_ADMIN_PERM,
5362 .cmd = NL80211_CMD_JOIN_IBSS,
5363 .doit = nl80211_join_ibss,
5364 .policy = nl80211_policy,
5365 .flags = GENL_ADMIN_PERM,
5368 .cmd = NL80211_CMD_LEAVE_IBSS,
5369 .doit = nl80211_leave_ibss,
5370 .policy = nl80211_policy,
5371 .flags = GENL_ADMIN_PERM,
5373 #ifdef CONFIG_NL80211_TESTMODE
5375 .cmd = NL80211_CMD_TESTMODE,
5376 .doit = nl80211_testmode_do,
5377 .policy = nl80211_policy,
5378 .flags = GENL_ADMIN_PERM,
5382 .cmd = NL80211_CMD_CONNECT,
5383 .doit = nl80211_connect,
5384 .policy = nl80211_policy,
5385 .flags = GENL_ADMIN_PERM,
5388 .cmd = NL80211_CMD_DISCONNECT,
5389 .doit = nl80211_disconnect,
5390 .policy = nl80211_policy,
5391 .flags = GENL_ADMIN_PERM,
5394 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
5395 .doit = nl80211_wiphy_netns,
5396 .policy = nl80211_policy,
5397 .flags = GENL_ADMIN_PERM,
5400 .cmd = NL80211_CMD_GET_SURVEY,
5401 .policy = nl80211_policy,
5402 .dumpit = nl80211_dump_survey,
5405 .cmd = NL80211_CMD_SET_PMKSA,
5406 .doit = nl80211_setdel_pmksa,
5407 .policy = nl80211_policy,
5408 .flags = GENL_ADMIN_PERM,
5411 .cmd = NL80211_CMD_DEL_PMKSA,
5412 .doit = nl80211_setdel_pmksa,
5413 .policy = nl80211_policy,
5414 .flags = GENL_ADMIN_PERM,
5417 .cmd = NL80211_CMD_FLUSH_PMKSA,
5418 .doit = nl80211_flush_pmksa,
5419 .policy = nl80211_policy,
5420 .flags = GENL_ADMIN_PERM,
5423 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
5424 .doit = nl80211_remain_on_channel,
5425 .policy = nl80211_policy,
5426 .flags = GENL_ADMIN_PERM,
5429 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
5430 .doit = nl80211_cancel_remain_on_channel,
5431 .policy = nl80211_policy,
5432 .flags = GENL_ADMIN_PERM,
5435 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
5436 .doit = nl80211_set_tx_bitrate_mask,
5437 .policy = nl80211_policy,
5438 .flags = GENL_ADMIN_PERM,
5441 .cmd = NL80211_CMD_REGISTER_FRAME,
5442 .doit = nl80211_register_mgmt,
5443 .policy = nl80211_policy,
5444 .flags = GENL_ADMIN_PERM,
5447 .cmd = NL80211_CMD_FRAME,
5448 .doit = nl80211_tx_mgmt,
5449 .policy = nl80211_policy,
5450 .flags = GENL_ADMIN_PERM,
5453 .cmd = NL80211_CMD_SET_POWER_SAVE,
5454 .doit = nl80211_set_power_save,
5455 .policy = nl80211_policy,
5456 .flags = GENL_ADMIN_PERM,
5459 .cmd = NL80211_CMD_GET_POWER_SAVE,
5460 .doit = nl80211_get_power_save,
5461 .policy = nl80211_policy,
5462 /* can be retrieved by unprivileged users */
5465 .cmd = NL80211_CMD_SET_CQM,
5466 .doit = nl80211_set_cqm,
5467 .policy = nl80211_policy,
5468 .flags = GENL_ADMIN_PERM,
5471 .cmd = NL80211_CMD_SET_CHANNEL,
5472 .doit = nl80211_set_channel,
5473 .policy = nl80211_policy,
5474 .flags = GENL_ADMIN_PERM,
5478 static struct genl_multicast_group nl80211_mlme_mcgrp = {
5482 /* multicast groups */
5483 static struct genl_multicast_group nl80211_config_mcgrp = {
5486 static struct genl_multicast_group nl80211_scan_mcgrp = {
5489 static struct genl_multicast_group nl80211_regulatory_mcgrp = {
5490 .name = "regulatory",
5493 /* notification functions */
5495 void nl80211_notify_dev_rename(struct cfg80211_registered_device *rdev)
5497 struct sk_buff *msg;
5499 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5503 if (nl80211_send_wiphy(msg, 0, 0, 0, rdev) < 0) {
5508 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5509 nl80211_config_mcgrp.id, GFP_KERNEL);
5512 static int nl80211_add_scan_req(struct sk_buff *msg,
5513 struct cfg80211_registered_device *rdev)
5515 struct cfg80211_scan_request *req = rdev->scan_req;
5516 struct nlattr *nest;
5519 ASSERT_RDEV_LOCK(rdev);
5524 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
5526 goto nla_put_failure;
5527 for (i = 0; i < req->n_ssids; i++)
5528 NLA_PUT(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid);
5529 nla_nest_end(msg, nest);
5531 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
5533 goto nla_put_failure;
5534 for (i = 0; i < req->n_channels; i++)
5535 NLA_PUT_U32(msg, i, req->channels[i]->center_freq);
5536 nla_nest_end(msg, nest);
5539 NLA_PUT(msg, NL80211_ATTR_IE, req->ie_len, req->ie);
5546 static int nl80211_send_scan_msg(struct sk_buff *msg,
5547 struct cfg80211_registered_device *rdev,
5548 struct net_device *netdev,
5549 u32 pid, u32 seq, int flags,
5554 hdr = nl80211hdr_put(msg, pid, seq, flags, cmd);
5558 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5559 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5561 /* ignore errors and send incomplete event anyway */
5562 nl80211_add_scan_req(msg, rdev);
5564 return genlmsg_end(msg, hdr);
5567 genlmsg_cancel(msg, hdr);
5571 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
5572 struct net_device *netdev)
5574 struct sk_buff *msg;
5576 msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
5580 if (nl80211_send_scan_msg(msg, rdev, netdev, 0, 0, 0,
5581 NL80211_CMD_TRIGGER_SCAN) < 0) {
5586 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5587 nl80211_scan_mcgrp.id, GFP_KERNEL);
5590 void nl80211_send_scan_done(struct cfg80211_registered_device *rdev,
5591 struct net_device *netdev)
5593 struct sk_buff *msg;
5595 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5599 if (nl80211_send_scan_msg(msg, rdev, netdev, 0, 0, 0,
5600 NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
5605 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5606 nl80211_scan_mcgrp.id, GFP_KERNEL);
5609 void nl80211_send_scan_aborted(struct cfg80211_registered_device *rdev,
5610 struct net_device *netdev)
5612 struct sk_buff *msg;
5614 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5618 if (nl80211_send_scan_msg(msg, rdev, netdev, 0, 0, 0,
5619 NL80211_CMD_SCAN_ABORTED) < 0) {
5624 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5625 nl80211_scan_mcgrp.id, GFP_KERNEL);
5629 * This can happen on global regulatory changes or device specific settings
5630 * based on custom world regulatory domains.
5632 void nl80211_send_reg_change_event(struct regulatory_request *request)
5634 struct sk_buff *msg;
5637 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5641 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_CHANGE);
5647 /* Userspace can always count this one always being set */
5648 NLA_PUT_U8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator);
5650 if (request->alpha2[0] == '0' && request->alpha2[1] == '0')
5651 NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
5652 NL80211_REGDOM_TYPE_WORLD);
5653 else if (request->alpha2[0] == '9' && request->alpha2[1] == '9')
5654 NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
5655 NL80211_REGDOM_TYPE_CUSTOM_WORLD);
5656 else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
5658 NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
5659 NL80211_REGDOM_TYPE_INTERSECTION);
5661 NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
5662 NL80211_REGDOM_TYPE_COUNTRY);
5663 NLA_PUT_STRING(msg, NL80211_ATTR_REG_ALPHA2, request->alpha2);
5666 if (wiphy_idx_valid(request->wiphy_idx))
5667 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx);
5669 if (genlmsg_end(msg, hdr) < 0) {
5675 genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
5682 genlmsg_cancel(msg, hdr);
5686 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
5687 struct net_device *netdev,
5688 const u8 *buf, size_t len,
5689 enum nl80211_commands cmd, gfp_t gfp)
5691 struct sk_buff *msg;
5694 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
5698 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
5704 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5705 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5706 NLA_PUT(msg, NL80211_ATTR_FRAME, len, buf);
5708 if (genlmsg_end(msg, hdr) < 0) {
5713 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5714 nl80211_mlme_mcgrp.id, gfp);
5718 genlmsg_cancel(msg, hdr);
5722 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
5723 struct net_device *netdev, const u8 *buf,
5724 size_t len, gfp_t gfp)
5726 nl80211_send_mlme_event(rdev, netdev, buf, len,
5727 NL80211_CMD_AUTHENTICATE, gfp);
5730 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
5731 struct net_device *netdev, const u8 *buf,
5732 size_t len, gfp_t gfp)
5734 nl80211_send_mlme_event(rdev, netdev, buf, len,
5735 NL80211_CMD_ASSOCIATE, gfp);
5738 void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
5739 struct net_device *netdev, const u8 *buf,
5740 size_t len, gfp_t gfp)
5742 nl80211_send_mlme_event(rdev, netdev, buf, len,
5743 NL80211_CMD_DEAUTHENTICATE, gfp);
5746 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
5747 struct net_device *netdev, const u8 *buf,
5748 size_t len, gfp_t gfp)
5750 nl80211_send_mlme_event(rdev, netdev, buf, len,
5751 NL80211_CMD_DISASSOCIATE, gfp);
5754 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
5755 struct net_device *netdev, int cmd,
5756 const u8 *addr, gfp_t gfp)
5758 struct sk_buff *msg;
5761 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
5765 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
5771 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5772 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5773 NLA_PUT_FLAG(msg, NL80211_ATTR_TIMED_OUT);
5774 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, addr);
5776 if (genlmsg_end(msg, hdr) < 0) {
5781 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5782 nl80211_mlme_mcgrp.id, gfp);
5786 genlmsg_cancel(msg, hdr);
5790 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
5791 struct net_device *netdev, const u8 *addr,
5794 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
5798 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
5799 struct net_device *netdev, const u8 *addr,
5802 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
5806 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
5807 struct net_device *netdev, const u8 *bssid,
5808 const u8 *req_ie, size_t req_ie_len,
5809 const u8 *resp_ie, size_t resp_ie_len,
5810 u16 status, gfp_t gfp)
5812 struct sk_buff *msg;
5815 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
5819 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
5825 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5826 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5828 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid);
5829 NLA_PUT_U16(msg, NL80211_ATTR_STATUS_CODE, status);
5831 NLA_PUT(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie);
5833 NLA_PUT(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie);
5835 if (genlmsg_end(msg, hdr) < 0) {
5840 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5841 nl80211_mlme_mcgrp.id, gfp);
5845 genlmsg_cancel(msg, hdr);
5850 void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
5851 struct net_device *netdev, const u8 *bssid,
5852 const u8 *req_ie, size_t req_ie_len,
5853 const u8 *resp_ie, size_t resp_ie_len, gfp_t gfp)
5855 struct sk_buff *msg;
5858 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
5862 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
5868 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5869 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5870 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid);
5872 NLA_PUT(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie);
5874 NLA_PUT(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie);
5876 if (genlmsg_end(msg, hdr) < 0) {
5881 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5882 nl80211_mlme_mcgrp.id, gfp);
5886 genlmsg_cancel(msg, hdr);
5891 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
5892 struct net_device *netdev, u16 reason,
5893 const u8 *ie, size_t ie_len, bool from_ap)
5895 struct sk_buff *msg;
5898 msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
5902 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
5908 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5909 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5910 if (from_ap && reason)
5911 NLA_PUT_U16(msg, NL80211_ATTR_REASON_CODE, reason);
5913 NLA_PUT_FLAG(msg, NL80211_ATTR_DISCONNECTED_BY_AP);
5915 NLA_PUT(msg, NL80211_ATTR_IE, ie_len, ie);
5917 if (genlmsg_end(msg, hdr) < 0) {
5922 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5923 nl80211_mlme_mcgrp.id, GFP_KERNEL);
5927 genlmsg_cancel(msg, hdr);
5932 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
5933 struct net_device *netdev, const u8 *bssid,
5936 struct sk_buff *msg;
5939 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
5943 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
5949 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5950 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5951 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid);
5953 if (genlmsg_end(msg, hdr) < 0) {
5958 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5959 nl80211_mlme_mcgrp.id, gfp);
5963 genlmsg_cancel(msg, hdr);
5967 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
5968 struct net_device *netdev, const u8 *addr,
5969 enum nl80211_key_type key_type, int key_id,
5970 const u8 *tsc, gfp_t gfp)
5972 struct sk_buff *msg;
5975 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
5979 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
5985 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5986 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5988 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, addr);
5989 NLA_PUT_U32(msg, NL80211_ATTR_KEY_TYPE, key_type);
5990 NLA_PUT_U8(msg, NL80211_ATTR_KEY_IDX, key_id);
5992 NLA_PUT(msg, NL80211_ATTR_KEY_SEQ, 6, tsc);
5994 if (genlmsg_end(msg, hdr) < 0) {
5999 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
6000 nl80211_mlme_mcgrp.id, gfp);
6004 genlmsg_cancel(msg, hdr);
6008 void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
6009 struct ieee80211_channel *channel_before,
6010 struct ieee80211_channel *channel_after)
6012 struct sk_buff *msg;
6014 struct nlattr *nl_freq;
6016 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
6020 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
6027 * Since we are applying the beacon hint to a wiphy we know its
6028 * wiphy_idx is valid
6030 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy));
6033 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
6035 goto nla_put_failure;
6036 if (nl80211_msg_put_channel(msg, channel_before))
6037 goto nla_put_failure;
6038 nla_nest_end(msg, nl_freq);
6041 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
6043 goto nla_put_failure;
6044 if (nl80211_msg_put_channel(msg, channel_after))
6045 goto nla_put_failure;
6046 nla_nest_end(msg, nl_freq);
6048 if (genlmsg_end(msg, hdr) < 0) {
6054 genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
6061 genlmsg_cancel(msg, hdr);
6065 static void nl80211_send_remain_on_chan_event(
6066 int cmd, struct cfg80211_registered_device *rdev,
6067 struct net_device *netdev, u64 cookie,
6068 struct ieee80211_channel *chan,
6069 enum nl80211_channel_type channel_type,
6070 unsigned int duration, gfp_t gfp)
6072 struct sk_buff *msg;
6075 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
6079 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
6085 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
6086 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
6087 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq);
6088 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, channel_type);
6089 NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
6091 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL)
6092 NLA_PUT_U32(msg, NL80211_ATTR_DURATION, duration);
6094 if (genlmsg_end(msg, hdr) < 0) {
6099 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
6100 nl80211_mlme_mcgrp.id, gfp);
6104 genlmsg_cancel(msg, hdr);
6108 void nl80211_send_remain_on_channel(struct cfg80211_registered_device *rdev,
6109 struct net_device *netdev, u64 cookie,
6110 struct ieee80211_channel *chan,
6111 enum nl80211_channel_type channel_type,
6112 unsigned int duration, gfp_t gfp)
6114 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
6115 rdev, netdev, cookie, chan,
6116 channel_type, duration, gfp);
6119 void nl80211_send_remain_on_channel_cancel(
6120 struct cfg80211_registered_device *rdev, struct net_device *netdev,
6121 u64 cookie, struct ieee80211_channel *chan,
6122 enum nl80211_channel_type channel_type, gfp_t gfp)
6124 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
6125 rdev, netdev, cookie, chan,
6126 channel_type, 0, gfp);
6129 void nl80211_send_sta_event(struct cfg80211_registered_device *rdev,
6130 struct net_device *dev, const u8 *mac_addr,
6131 struct station_info *sinfo, gfp_t gfp)
6133 struct sk_buff *msg;
6135 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
6139 if (nl80211_send_station(msg, 0, 0, 0, dev, mac_addr, sinfo) < 0) {
6144 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
6145 nl80211_mlme_mcgrp.id, gfp);
6148 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
6149 struct net_device *netdev, u32 nlpid,
6150 int freq, const u8 *buf, size_t len, gfp_t gfp)
6152 struct sk_buff *msg;
6156 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
6160 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
6166 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
6167 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
6168 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FREQ, freq);
6169 NLA_PUT(msg, NL80211_ATTR_FRAME, len, buf);
6171 err = genlmsg_end(msg, hdr);
6177 err = genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlpid);
6183 genlmsg_cancel(msg, hdr);
6188 void nl80211_send_mgmt_tx_status(struct cfg80211_registered_device *rdev,
6189 struct net_device *netdev, u64 cookie,
6190 const u8 *buf, size_t len, bool ack,
6193 struct sk_buff *msg;
6196 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
6200 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
6206 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
6207 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
6208 NLA_PUT(msg, NL80211_ATTR_FRAME, len, buf);
6209 NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
6211 NLA_PUT_FLAG(msg, NL80211_ATTR_ACK);
6213 if (genlmsg_end(msg, hdr) < 0) {
6218 genlmsg_multicast(msg, 0, nl80211_mlme_mcgrp.id, gfp);
6222 genlmsg_cancel(msg, hdr);
6227 nl80211_send_cqm_rssi_notify(struct cfg80211_registered_device *rdev,
6228 struct net_device *netdev,
6229 enum nl80211_cqm_rssi_threshold_event rssi_event,
6232 struct sk_buff *msg;
6233 struct nlattr *pinfoattr;
6236 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
6240 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
6246 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
6247 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
6249 pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
6251 goto nla_put_failure;
6253 NLA_PUT_U32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
6256 nla_nest_end(msg, pinfoattr);
6258 if (genlmsg_end(msg, hdr) < 0) {
6263 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
6264 nl80211_mlme_mcgrp.id, gfp);
6268 genlmsg_cancel(msg, hdr);
6272 static int nl80211_netlink_notify(struct notifier_block * nb,
6273 unsigned long state,
6276 struct netlink_notify *notify = _notify;
6277 struct cfg80211_registered_device *rdev;
6278 struct wireless_dev *wdev;
6280 if (state != NETLINK_URELEASE)
6285 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list)
6286 list_for_each_entry_rcu(wdev, &rdev->netdev_list, list)
6287 cfg80211_mlme_unregister_socket(wdev, notify->pid);
6294 static struct notifier_block nl80211_netlink_notifier = {
6295 .notifier_call = nl80211_netlink_notify,
6298 /* initialisation/exit functions */
6300 int nl80211_init(void)
6304 err = genl_register_family_with_ops(&nl80211_fam,
6305 nl80211_ops, ARRAY_SIZE(nl80211_ops));
6309 err = genl_register_mc_group(&nl80211_fam, &nl80211_config_mcgrp);
6313 err = genl_register_mc_group(&nl80211_fam, &nl80211_scan_mcgrp);
6317 err = genl_register_mc_group(&nl80211_fam, &nl80211_regulatory_mcgrp);
6321 err = genl_register_mc_group(&nl80211_fam, &nl80211_mlme_mcgrp);
6325 #ifdef CONFIG_NL80211_TESTMODE
6326 err = genl_register_mc_group(&nl80211_fam, &nl80211_testmode_mcgrp);
6331 err = netlink_register_notifier(&nl80211_netlink_notifier);
6337 genl_unregister_family(&nl80211_fam);
6341 void nl80211_exit(void)
6343 netlink_unregister_notifier(&nl80211_netlink_notifier);
6344 genl_unregister_family(&nl80211_fam);