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);
834 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
836 struct cfg80211_registered_device *rdev;
837 struct net_device *netdev = NULL;
838 struct wireless_dev *wdev;
839 int result = 0, rem_txq_params = 0;
840 struct nlattr *nl_txq_params;
842 u8 retry_short = 0, retry_long = 0;
843 u32 frag_threshold = 0, rts_threshold = 0;
844 u8 coverage_class = 0;
849 * Try to find the wiphy and netdev. Normally this
850 * function shouldn't need the netdev, but this is
851 * done for backward compatibility -- previously
852 * setting the channel was done per wiphy, but now
853 * it is per netdev. Previous userland like hostapd
854 * also passed a netdev to set_wiphy, so that it is
855 * possible to let that go to the right netdev!
857 mutex_lock(&cfg80211_mutex);
859 if (info->attrs[NL80211_ATTR_IFINDEX]) {
860 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
862 netdev = dev_get_by_index(genl_info_net(info), ifindex);
863 if (netdev && netdev->ieee80211_ptr) {
864 rdev = wiphy_to_dev(netdev->ieee80211_ptr->wiphy);
865 mutex_lock(&rdev->mtx);
871 rdev = __cfg80211_rdev_from_info(info);
873 mutex_unlock(&cfg80211_mutex);
874 result = PTR_ERR(rdev);
881 mutex_lock(&rdev->mtx);
882 } else if (netif_running(netdev) &&
883 nl80211_can_set_dev_channel(netdev->ieee80211_ptr))
884 wdev = netdev->ieee80211_ptr;
889 * end workaround code, by now the rdev is available
890 * and locked, and wdev may or may not be NULL.
893 if (info->attrs[NL80211_ATTR_WIPHY_NAME])
894 result = cfg80211_dev_rename(
895 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
897 mutex_unlock(&cfg80211_mutex);
902 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
903 struct ieee80211_txq_params txq_params;
904 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
906 if (!rdev->ops->set_txq_params) {
907 result = -EOPNOTSUPP;
911 nla_for_each_nested(nl_txq_params,
912 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
914 nla_parse(tb, NL80211_TXQ_ATTR_MAX,
915 nla_data(nl_txq_params),
916 nla_len(nl_txq_params),
918 result = parse_txq_params(tb, &txq_params);
922 result = rdev->ops->set_txq_params(&rdev->wiphy,
929 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
930 result = __nl80211_set_channel(rdev, wdev, info);
935 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
936 enum nl80211_tx_power_setting type;
939 if (!rdev->ops->set_tx_power) {
940 result = -EOPNOTSUPP;
944 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
945 type = nla_get_u32(info->attrs[idx]);
947 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
948 (type != NL80211_TX_POWER_AUTOMATIC)) {
953 if (type != NL80211_TX_POWER_AUTOMATIC) {
954 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
955 mbm = nla_get_u32(info->attrs[idx]);
958 result = rdev->ops->set_tx_power(&rdev->wiphy, type, mbm);
965 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
966 retry_short = nla_get_u8(
967 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
968 if (retry_short == 0) {
972 changed |= WIPHY_PARAM_RETRY_SHORT;
975 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
976 retry_long = nla_get_u8(
977 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
978 if (retry_long == 0) {
982 changed |= WIPHY_PARAM_RETRY_LONG;
985 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
986 frag_threshold = nla_get_u32(
987 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
988 if (frag_threshold < 256) {
992 if (frag_threshold != (u32) -1) {
994 * Fragments (apart from the last one) are required to
995 * have even length. Make the fragmentation code
996 * simpler by stripping LSB should someone try to use
997 * odd threshold value.
999 frag_threshold &= ~0x1;
1001 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
1004 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
1005 rts_threshold = nla_get_u32(
1006 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
1007 changed |= WIPHY_PARAM_RTS_THRESHOLD;
1010 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
1011 coverage_class = nla_get_u8(
1012 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
1013 changed |= WIPHY_PARAM_COVERAGE_CLASS;
1017 u8 old_retry_short, old_retry_long;
1018 u32 old_frag_threshold, old_rts_threshold;
1019 u8 old_coverage_class;
1021 if (!rdev->ops->set_wiphy_params) {
1022 result = -EOPNOTSUPP;
1026 old_retry_short = rdev->wiphy.retry_short;
1027 old_retry_long = rdev->wiphy.retry_long;
1028 old_frag_threshold = rdev->wiphy.frag_threshold;
1029 old_rts_threshold = rdev->wiphy.rts_threshold;
1030 old_coverage_class = rdev->wiphy.coverage_class;
1032 if (changed & WIPHY_PARAM_RETRY_SHORT)
1033 rdev->wiphy.retry_short = retry_short;
1034 if (changed & WIPHY_PARAM_RETRY_LONG)
1035 rdev->wiphy.retry_long = retry_long;
1036 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
1037 rdev->wiphy.frag_threshold = frag_threshold;
1038 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
1039 rdev->wiphy.rts_threshold = rts_threshold;
1040 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
1041 rdev->wiphy.coverage_class = coverage_class;
1043 result = rdev->ops->set_wiphy_params(&rdev->wiphy, changed);
1045 rdev->wiphy.retry_short = old_retry_short;
1046 rdev->wiphy.retry_long = old_retry_long;
1047 rdev->wiphy.frag_threshold = old_frag_threshold;
1048 rdev->wiphy.rts_threshold = old_rts_threshold;
1049 rdev->wiphy.coverage_class = old_coverage_class;
1054 mutex_unlock(&rdev->mtx);
1063 static int nl80211_send_iface(struct sk_buff *msg, u32 pid, u32 seq, int flags,
1064 struct cfg80211_registered_device *rdev,
1065 struct net_device *dev)
1069 hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_INTERFACE);
1073 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
1074 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
1075 NLA_PUT_STRING(msg, NL80211_ATTR_IFNAME, dev->name);
1076 NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, dev->ieee80211_ptr->iftype);
1078 NLA_PUT_U32(msg, NL80211_ATTR_GENERATION,
1079 rdev->devlist_generation ^
1080 (cfg80211_rdev_list_generation << 2));
1082 return genlmsg_end(msg, hdr);
1085 genlmsg_cancel(msg, hdr);
1089 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
1093 int wp_start = cb->args[0];
1094 int if_start = cb->args[1];
1095 struct cfg80211_registered_device *rdev;
1096 struct wireless_dev *wdev;
1098 mutex_lock(&cfg80211_mutex);
1099 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1100 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
1102 if (wp_idx < wp_start) {
1108 mutex_lock(&rdev->devlist_mtx);
1109 list_for_each_entry(wdev, &rdev->netdev_list, list) {
1110 if (if_idx < if_start) {
1114 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).pid,
1115 cb->nlh->nlmsg_seq, NLM_F_MULTI,
1116 rdev, wdev->netdev) < 0) {
1117 mutex_unlock(&rdev->devlist_mtx);
1122 mutex_unlock(&rdev->devlist_mtx);
1127 mutex_unlock(&cfg80211_mutex);
1129 cb->args[0] = wp_idx;
1130 cb->args[1] = if_idx;
1135 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
1137 struct sk_buff *msg;
1138 struct cfg80211_registered_device *dev;
1139 struct net_device *netdev;
1142 err = get_rdev_dev_by_info_ifindex(info, &dev, &netdev);
1146 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1150 if (nl80211_send_iface(msg, info->snd_pid, info->snd_seq, 0,
1155 cfg80211_unlock_rdev(dev);
1157 return genlmsg_reply(msg, info);
1163 cfg80211_unlock_rdev(dev);
1167 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
1168 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
1169 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
1170 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
1171 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
1172 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
1175 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
1177 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
1185 if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX,
1186 nla, mntr_flags_policy))
1189 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
1191 *mntrflags |= (1<<flag);
1196 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
1197 struct net_device *netdev, u8 use_4addr,
1198 enum nl80211_iftype iftype)
1201 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
1207 case NL80211_IFTYPE_AP_VLAN:
1208 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
1211 case NL80211_IFTYPE_STATION:
1212 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
1222 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
1224 struct cfg80211_registered_device *rdev;
1225 struct vif_params params;
1227 enum nl80211_iftype otype, ntype;
1228 struct net_device *dev;
1229 u32 _flags, *flags = NULL;
1230 bool change = false;
1232 memset(¶ms, 0, sizeof(params));
1236 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1240 otype = ntype = dev->ieee80211_ptr->iftype;
1242 if (info->attrs[NL80211_ATTR_IFTYPE]) {
1243 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
1246 if (ntype > NL80211_IFTYPE_MAX) {
1252 if (info->attrs[NL80211_ATTR_MESH_ID]) {
1253 if (ntype != NL80211_IFTYPE_MESH_POINT) {
1257 params.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
1258 params.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
1262 if (info->attrs[NL80211_ATTR_4ADDR]) {
1263 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
1265 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
1269 params.use_4addr = -1;
1272 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
1273 if (ntype != NL80211_IFTYPE_MONITOR) {
1277 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
1287 err = cfg80211_change_iface(rdev, dev, ntype, flags, ¶ms);
1291 if (!err && params.use_4addr != -1)
1292 dev->ieee80211_ptr->use_4addr = params.use_4addr;
1296 cfg80211_unlock_rdev(rdev);
1302 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
1304 struct cfg80211_registered_device *rdev;
1305 struct vif_params params;
1307 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
1310 memset(¶ms, 0, sizeof(params));
1312 if (!info->attrs[NL80211_ATTR_IFNAME])
1315 if (info->attrs[NL80211_ATTR_IFTYPE]) {
1316 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
1317 if (type > NL80211_IFTYPE_MAX)
1323 rdev = cfg80211_get_dev_from_info(info);
1325 err = PTR_ERR(rdev);
1329 if (!rdev->ops->add_virtual_intf ||
1330 !(rdev->wiphy.interface_modes & (1 << type))) {
1335 if (type == NL80211_IFTYPE_MESH_POINT &&
1336 info->attrs[NL80211_ATTR_MESH_ID]) {
1337 params.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
1338 params.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
1341 if (info->attrs[NL80211_ATTR_4ADDR]) {
1342 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
1343 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
1348 err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
1349 info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
1351 err = rdev->ops->add_virtual_intf(&rdev->wiphy,
1352 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
1353 type, err ? NULL : &flags, ¶ms);
1356 cfg80211_unlock_rdev(rdev);
1362 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
1364 struct cfg80211_registered_device *rdev;
1366 struct net_device *dev;
1370 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1374 if (!rdev->ops->del_virtual_intf) {
1379 err = rdev->ops->del_virtual_intf(&rdev->wiphy, dev);
1382 cfg80211_unlock_rdev(rdev);
1389 struct get_key_cookie {
1390 struct sk_buff *msg;
1395 static void get_key_callback(void *c, struct key_params *params)
1398 struct get_key_cookie *cookie = c;
1401 NLA_PUT(cookie->msg, NL80211_ATTR_KEY_DATA,
1402 params->key_len, params->key);
1405 NLA_PUT(cookie->msg, NL80211_ATTR_KEY_SEQ,
1406 params->seq_len, params->seq);
1409 NLA_PUT_U32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
1412 key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
1414 goto nla_put_failure;
1417 NLA_PUT(cookie->msg, NL80211_KEY_DATA,
1418 params->key_len, params->key);
1421 NLA_PUT(cookie->msg, NL80211_KEY_SEQ,
1422 params->seq_len, params->seq);
1425 NLA_PUT_U32(cookie->msg, NL80211_KEY_CIPHER,
1428 NLA_PUT_U8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx);
1430 nla_nest_end(cookie->msg, key);
1437 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
1439 struct cfg80211_registered_device *rdev;
1441 struct net_device *dev;
1443 u8 *mac_addr = NULL;
1444 struct get_key_cookie cookie = {
1448 struct sk_buff *msg;
1450 if (info->attrs[NL80211_ATTR_KEY_IDX])
1451 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
1456 if (info->attrs[NL80211_ATTR_MAC])
1457 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
1461 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1465 if (!rdev->ops->get_key) {
1470 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1476 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
1477 NL80211_CMD_NEW_KEY);
1485 cookie.idx = key_idx;
1487 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
1488 NLA_PUT_U8(msg, NL80211_ATTR_KEY_IDX, key_idx);
1490 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
1492 err = rdev->ops->get_key(&rdev->wiphy, dev, key_idx, mac_addr,
1493 &cookie, get_key_callback);
1499 goto nla_put_failure;
1501 genlmsg_end(msg, hdr);
1502 err = genlmsg_reply(msg, info);
1510 cfg80211_unlock_rdev(rdev);
1518 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
1520 struct cfg80211_registered_device *rdev;
1521 struct key_parse key;
1523 struct net_device *dev;
1524 int (*func)(struct wiphy *wiphy, struct net_device *netdev,
1527 err = nl80211_parse_key(info, &key);
1534 /* only support setting default key */
1535 if (!key.def && !key.defmgmt)
1540 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1545 func = rdev->ops->set_default_key;
1547 func = rdev->ops->set_default_mgmt_key;
1554 wdev_lock(dev->ieee80211_ptr);
1555 err = nl80211_key_allowed(dev->ieee80211_ptr);
1557 err = func(&rdev->wiphy, dev, key.idx);
1559 #ifdef CONFIG_CFG80211_WEXT
1561 if (func == rdev->ops->set_default_key)
1562 dev->ieee80211_ptr->wext.default_key = key.idx;
1564 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
1567 wdev_unlock(dev->ieee80211_ptr);
1570 cfg80211_unlock_rdev(rdev);
1579 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
1581 struct cfg80211_registered_device *rdev;
1583 struct net_device *dev;
1584 struct key_parse key;
1585 u8 *mac_addr = NULL;
1587 err = nl80211_parse_key(info, &key);
1594 if (info->attrs[NL80211_ATTR_MAC])
1595 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
1599 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1603 if (!rdev->ops->add_key) {
1608 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx, mac_addr)) {
1613 wdev_lock(dev->ieee80211_ptr);
1614 err = nl80211_key_allowed(dev->ieee80211_ptr);
1616 err = rdev->ops->add_key(&rdev->wiphy, dev, key.idx,
1618 wdev_unlock(dev->ieee80211_ptr);
1621 cfg80211_unlock_rdev(rdev);
1629 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
1631 struct cfg80211_registered_device *rdev;
1633 struct net_device *dev;
1634 u8 *mac_addr = NULL;
1635 struct key_parse key;
1637 err = nl80211_parse_key(info, &key);
1641 if (info->attrs[NL80211_ATTR_MAC])
1642 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
1646 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1650 if (!rdev->ops->del_key) {
1655 wdev_lock(dev->ieee80211_ptr);
1656 err = nl80211_key_allowed(dev->ieee80211_ptr);
1658 err = rdev->ops->del_key(&rdev->wiphy, dev, key.idx, mac_addr);
1660 #ifdef CONFIG_CFG80211_WEXT
1662 if (key.idx == dev->ieee80211_ptr->wext.default_key)
1663 dev->ieee80211_ptr->wext.default_key = -1;
1664 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
1665 dev->ieee80211_ptr->wext.default_mgmt_key = -1;
1668 wdev_unlock(dev->ieee80211_ptr);
1671 cfg80211_unlock_rdev(rdev);
1680 static int nl80211_addset_beacon(struct sk_buff *skb, struct genl_info *info)
1682 int (*call)(struct wiphy *wiphy, struct net_device *dev,
1683 struct beacon_parameters *info);
1684 struct cfg80211_registered_device *rdev;
1686 struct net_device *dev;
1687 struct beacon_parameters params;
1690 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_BEACON_TAIL]))
1695 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1699 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
1700 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
1705 switch (info->genlhdr->cmd) {
1706 case NL80211_CMD_NEW_BEACON:
1707 /* these are required for NEW_BEACON */
1708 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
1709 !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
1710 !info->attrs[NL80211_ATTR_BEACON_HEAD]) {
1715 call = rdev->ops->add_beacon;
1717 case NL80211_CMD_SET_BEACON:
1718 call = rdev->ops->set_beacon;
1731 memset(¶ms, 0, sizeof(params));
1733 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
1735 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
1739 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
1740 params.dtim_period =
1741 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
1745 if (info->attrs[NL80211_ATTR_BEACON_HEAD]) {
1746 params.head = nla_data(info->attrs[NL80211_ATTR_BEACON_HEAD]);
1748 nla_len(info->attrs[NL80211_ATTR_BEACON_HEAD]);
1752 if (info->attrs[NL80211_ATTR_BEACON_TAIL]) {
1753 params.tail = nla_data(info->attrs[NL80211_ATTR_BEACON_TAIL]);
1755 nla_len(info->attrs[NL80211_ATTR_BEACON_TAIL]);
1764 err = call(&rdev->wiphy, dev, ¶ms);
1767 cfg80211_unlock_rdev(rdev);
1775 static int nl80211_del_beacon(struct sk_buff *skb, struct genl_info *info)
1777 struct cfg80211_registered_device *rdev;
1779 struct net_device *dev;
1783 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
1787 if (!rdev->ops->del_beacon) {
1792 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
1793 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
1797 err = rdev->ops->del_beacon(&rdev->wiphy, dev);
1800 cfg80211_unlock_rdev(rdev);
1808 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
1809 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
1810 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
1811 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
1812 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
1815 static int parse_station_flags(struct genl_info *info,
1816 struct station_parameters *params)
1818 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
1823 * Try parsing the new attribute first so userspace
1824 * can specify both for older kernels.
1826 nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
1828 struct nl80211_sta_flag_update *sta_flags;
1830 sta_flags = nla_data(nla);
1831 params->sta_flags_mask = sta_flags->mask;
1832 params->sta_flags_set = sta_flags->set;
1833 if ((params->sta_flags_mask |
1834 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
1839 /* if present, parse the old attribute */
1841 nla = info->attrs[NL80211_ATTR_STA_FLAGS];
1845 if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX,
1846 nla, sta_flags_policy))
1849 params->sta_flags_mask = (1 << __NL80211_STA_FLAG_AFTER_LAST) - 1;
1850 params->sta_flags_mask &= ~1;
1852 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++)
1854 params->sta_flags_set |= (1<<flag);
1859 static int nl80211_send_station(struct sk_buff *msg, u32 pid, u32 seq,
1860 int flags, struct net_device *dev,
1861 const u8 *mac_addr, struct station_info *sinfo)
1864 struct nlattr *sinfoattr, *txrate;
1867 hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_STATION);
1871 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
1872 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
1874 NLA_PUT_U32(msg, NL80211_ATTR_GENERATION, sinfo->generation);
1876 sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
1878 goto nla_put_failure;
1879 if (sinfo->filled & STATION_INFO_INACTIVE_TIME)
1880 NLA_PUT_U32(msg, NL80211_STA_INFO_INACTIVE_TIME,
1881 sinfo->inactive_time);
1882 if (sinfo->filled & STATION_INFO_RX_BYTES)
1883 NLA_PUT_U32(msg, NL80211_STA_INFO_RX_BYTES,
1885 if (sinfo->filled & STATION_INFO_TX_BYTES)
1886 NLA_PUT_U32(msg, NL80211_STA_INFO_TX_BYTES,
1888 if (sinfo->filled & STATION_INFO_LLID)
1889 NLA_PUT_U16(msg, NL80211_STA_INFO_LLID,
1891 if (sinfo->filled & STATION_INFO_PLID)
1892 NLA_PUT_U16(msg, NL80211_STA_INFO_PLID,
1894 if (sinfo->filled & STATION_INFO_PLINK_STATE)
1895 NLA_PUT_U8(msg, NL80211_STA_INFO_PLINK_STATE,
1896 sinfo->plink_state);
1897 if (sinfo->filled & STATION_INFO_SIGNAL)
1898 NLA_PUT_U8(msg, NL80211_STA_INFO_SIGNAL,
1900 if (sinfo->filled & STATION_INFO_TX_BITRATE) {
1901 txrate = nla_nest_start(msg, NL80211_STA_INFO_TX_BITRATE);
1903 goto nla_put_failure;
1905 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
1906 bitrate = cfg80211_calculate_bitrate(&sinfo->txrate);
1908 NLA_PUT_U16(msg, NL80211_RATE_INFO_BITRATE, bitrate);
1910 if (sinfo->txrate.flags & RATE_INFO_FLAGS_MCS)
1911 NLA_PUT_U8(msg, NL80211_RATE_INFO_MCS,
1913 if (sinfo->txrate.flags & RATE_INFO_FLAGS_40_MHZ_WIDTH)
1914 NLA_PUT_FLAG(msg, NL80211_RATE_INFO_40_MHZ_WIDTH);
1915 if (sinfo->txrate.flags & RATE_INFO_FLAGS_SHORT_GI)
1916 NLA_PUT_FLAG(msg, NL80211_RATE_INFO_SHORT_GI);
1918 nla_nest_end(msg, txrate);
1920 if (sinfo->filled & STATION_INFO_RX_PACKETS)
1921 NLA_PUT_U32(msg, NL80211_STA_INFO_RX_PACKETS,
1923 if (sinfo->filled & STATION_INFO_TX_PACKETS)
1924 NLA_PUT_U32(msg, NL80211_STA_INFO_TX_PACKETS,
1926 nla_nest_end(msg, sinfoattr);
1928 return genlmsg_end(msg, hdr);
1931 genlmsg_cancel(msg, hdr);
1935 static int nl80211_dump_station(struct sk_buff *skb,
1936 struct netlink_callback *cb)
1938 struct station_info sinfo;
1939 struct cfg80211_registered_device *dev;
1940 struct net_device *netdev;
1941 u8 mac_addr[ETH_ALEN];
1942 int ifidx = cb->args[0];
1943 int sta_idx = cb->args[1];
1947 ifidx = nl80211_get_ifidx(cb);
1953 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
1959 dev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
1965 if (!dev->ops->dump_station) {
1971 err = dev->ops->dump_station(&dev->wiphy, netdev, sta_idx,
1978 if (nl80211_send_station(skb,
1979 NETLINK_CB(cb->skb).pid,
1980 cb->nlh->nlmsg_seq, NLM_F_MULTI,
1990 cb->args[1] = sta_idx;
1993 cfg80211_unlock_rdev(dev);
2000 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
2002 struct cfg80211_registered_device *rdev;
2004 struct net_device *dev;
2005 struct station_info sinfo;
2006 struct sk_buff *msg;
2007 u8 *mac_addr = NULL;
2009 memset(&sinfo, 0, sizeof(sinfo));
2011 if (!info->attrs[NL80211_ATTR_MAC])
2014 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2018 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2022 if (!rdev->ops->get_station) {
2027 err = rdev->ops->get_station(&rdev->wiphy, dev, mac_addr, &sinfo);
2031 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2035 if (nl80211_send_station(msg, info->snd_pid, info->snd_seq, 0,
2036 dev, mac_addr, &sinfo) < 0)
2039 err = genlmsg_reply(msg, info);
2045 cfg80211_unlock_rdev(rdev);
2054 * Get vlan interface making sure it is running and on the right wiphy.
2056 static int get_vlan(struct genl_info *info,
2057 struct cfg80211_registered_device *rdev,
2058 struct net_device **vlan)
2060 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
2064 *vlan = dev_get_by_index(genl_info_net(info),
2065 nla_get_u32(vlanattr));
2068 if (!(*vlan)->ieee80211_ptr)
2070 if ((*vlan)->ieee80211_ptr->wiphy != &rdev->wiphy)
2072 if (!netif_running(*vlan))
2078 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
2080 struct cfg80211_registered_device *rdev;
2082 struct net_device *dev;
2083 struct station_parameters params;
2084 u8 *mac_addr = NULL;
2086 memset(¶ms, 0, sizeof(params));
2088 params.listen_interval = -1;
2090 if (info->attrs[NL80211_ATTR_STA_AID])
2093 if (!info->attrs[NL80211_ATTR_MAC])
2096 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2098 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
2099 params.supported_rates =
2100 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
2101 params.supported_rates_len =
2102 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
2105 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
2106 params.listen_interval =
2107 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
2109 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
2111 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
2113 if (parse_station_flags(info, ¶ms))
2116 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
2117 params.plink_action =
2118 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
2122 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2126 err = get_vlan(info, rdev, ¶ms.vlan);
2130 /* validate settings */
2133 switch (dev->ieee80211_ptr->iftype) {
2134 case NL80211_IFTYPE_AP:
2135 case NL80211_IFTYPE_AP_VLAN:
2136 case NL80211_IFTYPE_P2P_GO:
2137 /* disallow mesh-specific things */
2138 if (params.plink_action)
2141 case NL80211_IFTYPE_P2P_CLIENT:
2142 case NL80211_IFTYPE_STATION:
2143 /* disallow everything but AUTHORIZED flag */
2144 if (params.plink_action)
2148 if (params.supported_rates)
2152 if (params.listen_interval >= 0)
2154 if (params.sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
2157 case NL80211_IFTYPE_MESH_POINT:
2158 /* disallow things mesh doesn't support */
2163 if (params.listen_interval >= 0)
2165 if (params.supported_rates)
2167 if (params.sta_flags_mask)
2177 if (!rdev->ops->change_station) {
2182 err = rdev->ops->change_station(&rdev->wiphy, dev, mac_addr, ¶ms);
2186 dev_put(params.vlan);
2187 cfg80211_unlock_rdev(rdev);
2195 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
2197 struct cfg80211_registered_device *rdev;
2199 struct net_device *dev;
2200 struct station_parameters params;
2201 u8 *mac_addr = NULL;
2203 memset(¶ms, 0, sizeof(params));
2205 if (!info->attrs[NL80211_ATTR_MAC])
2208 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
2211 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
2214 if (!info->attrs[NL80211_ATTR_STA_AID])
2217 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2218 params.supported_rates =
2219 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
2220 params.supported_rates_len =
2221 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
2222 params.listen_interval =
2223 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
2225 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
2226 if (!params.aid || params.aid > IEEE80211_MAX_AID)
2229 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
2231 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
2233 if (parse_station_flags(info, ¶ms))
2238 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2242 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2243 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
2244 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
2249 err = get_vlan(info, rdev, ¶ms.vlan);
2253 /* validate settings */
2256 if (!rdev->ops->add_station) {
2261 if (!netif_running(dev)) {
2266 err = rdev->ops->add_station(&rdev->wiphy, dev, mac_addr, ¶ms);
2270 dev_put(params.vlan);
2271 cfg80211_unlock_rdev(rdev);
2279 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
2281 struct cfg80211_registered_device *rdev;
2283 struct net_device *dev;
2284 u8 *mac_addr = NULL;
2286 if (info->attrs[NL80211_ATTR_MAC])
2287 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
2291 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2295 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2296 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
2297 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
2298 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
2303 if (!rdev->ops->del_station) {
2308 err = rdev->ops->del_station(&rdev->wiphy, dev, mac_addr);
2311 cfg80211_unlock_rdev(rdev);
2319 static int nl80211_send_mpath(struct sk_buff *msg, u32 pid, u32 seq,
2320 int flags, struct net_device *dev,
2321 u8 *dst, u8 *next_hop,
2322 struct mpath_info *pinfo)
2325 struct nlattr *pinfoattr;
2327 hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_STATION);
2331 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
2332 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, dst);
2333 NLA_PUT(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop);
2335 NLA_PUT_U32(msg, NL80211_ATTR_GENERATION, pinfo->generation);
2337 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
2339 goto nla_put_failure;
2340 if (pinfo->filled & MPATH_INFO_FRAME_QLEN)
2341 NLA_PUT_U32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
2343 if (pinfo->filled & MPATH_INFO_SN)
2344 NLA_PUT_U32(msg, NL80211_MPATH_INFO_SN,
2346 if (pinfo->filled & MPATH_INFO_METRIC)
2347 NLA_PUT_U32(msg, NL80211_MPATH_INFO_METRIC,
2349 if (pinfo->filled & MPATH_INFO_EXPTIME)
2350 NLA_PUT_U32(msg, NL80211_MPATH_INFO_EXPTIME,
2352 if (pinfo->filled & MPATH_INFO_FLAGS)
2353 NLA_PUT_U8(msg, NL80211_MPATH_INFO_FLAGS,
2355 if (pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT)
2356 NLA_PUT_U32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
2357 pinfo->discovery_timeout);
2358 if (pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES)
2359 NLA_PUT_U8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
2360 pinfo->discovery_retries);
2362 nla_nest_end(msg, pinfoattr);
2364 return genlmsg_end(msg, hdr);
2367 genlmsg_cancel(msg, hdr);
2371 static int nl80211_dump_mpath(struct sk_buff *skb,
2372 struct netlink_callback *cb)
2374 struct mpath_info pinfo;
2375 struct cfg80211_registered_device *dev;
2376 struct net_device *netdev;
2378 u8 next_hop[ETH_ALEN];
2379 int ifidx = cb->args[0];
2380 int path_idx = cb->args[1];
2384 ifidx = nl80211_get_ifidx(cb);
2390 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
2396 dev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
2402 if (!dev->ops->dump_mpath) {
2407 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
2413 err = dev->ops->dump_mpath(&dev->wiphy, netdev, path_idx,
2414 dst, next_hop, &pinfo);
2420 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).pid,
2421 cb->nlh->nlmsg_seq, NLM_F_MULTI,
2422 netdev, dst, next_hop,
2431 cb->args[1] = path_idx;
2434 cfg80211_unlock_rdev(dev);
2441 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
2443 struct cfg80211_registered_device *rdev;
2445 struct net_device *dev;
2446 struct mpath_info pinfo;
2447 struct sk_buff *msg;
2449 u8 next_hop[ETH_ALEN];
2451 memset(&pinfo, 0, sizeof(pinfo));
2453 if (!info->attrs[NL80211_ATTR_MAC])
2456 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
2460 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2464 if (!rdev->ops->get_mpath) {
2469 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
2474 err = rdev->ops->get_mpath(&rdev->wiphy, dev, dst, next_hop, &pinfo);
2478 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2482 if (nl80211_send_mpath(msg, info->snd_pid, info->snd_seq, 0,
2483 dev, dst, next_hop, &pinfo) < 0)
2486 err = genlmsg_reply(msg, info);
2492 cfg80211_unlock_rdev(rdev);
2500 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
2502 struct cfg80211_registered_device *rdev;
2504 struct net_device *dev;
2506 u8 *next_hop = NULL;
2508 if (!info->attrs[NL80211_ATTR_MAC])
2511 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
2514 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
2515 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
2519 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2523 if (!rdev->ops->change_mpath) {
2528 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
2533 if (!netif_running(dev)) {
2538 err = rdev->ops->change_mpath(&rdev->wiphy, dev, dst, next_hop);
2541 cfg80211_unlock_rdev(rdev);
2548 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
2550 struct cfg80211_registered_device *rdev;
2552 struct net_device *dev;
2554 u8 *next_hop = NULL;
2556 if (!info->attrs[NL80211_ATTR_MAC])
2559 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
2562 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
2563 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
2567 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2571 if (!rdev->ops->add_mpath) {
2576 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
2581 if (!netif_running(dev)) {
2586 err = rdev->ops->add_mpath(&rdev->wiphy, dev, dst, next_hop);
2589 cfg80211_unlock_rdev(rdev);
2597 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
2599 struct cfg80211_registered_device *rdev;
2601 struct net_device *dev;
2604 if (info->attrs[NL80211_ATTR_MAC])
2605 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
2609 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2613 if (!rdev->ops->del_mpath) {
2618 err = rdev->ops->del_mpath(&rdev->wiphy, dev, dst);
2621 cfg80211_unlock_rdev(rdev);
2629 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
2631 struct cfg80211_registered_device *rdev;
2633 struct net_device *dev;
2634 struct bss_parameters params;
2636 memset(¶ms, 0, sizeof(params));
2637 /* default to not changing parameters */
2638 params.use_cts_prot = -1;
2639 params.use_short_preamble = -1;
2640 params.use_short_slot_time = -1;
2641 params.ap_isolate = -1;
2643 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
2644 params.use_cts_prot =
2645 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
2646 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
2647 params.use_short_preamble =
2648 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
2649 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
2650 params.use_short_slot_time =
2651 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
2652 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
2653 params.basic_rates =
2654 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
2655 params.basic_rates_len =
2656 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
2658 if (info->attrs[NL80211_ATTR_AP_ISOLATE])
2659 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
2663 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2667 if (!rdev->ops->change_bss) {
2672 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2673 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
2678 err = rdev->ops->change_bss(&rdev->wiphy, dev, ¶ms);
2681 cfg80211_unlock_rdev(rdev);
2689 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
2690 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
2691 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
2692 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
2693 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
2694 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
2695 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
2698 static int parse_reg_rule(struct nlattr *tb[],
2699 struct ieee80211_reg_rule *reg_rule)
2701 struct ieee80211_freq_range *freq_range = ®_rule->freq_range;
2702 struct ieee80211_power_rule *power_rule = ®_rule->power_rule;
2704 if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
2706 if (!tb[NL80211_ATTR_FREQ_RANGE_START])
2708 if (!tb[NL80211_ATTR_FREQ_RANGE_END])
2710 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
2712 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
2715 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
2717 freq_range->start_freq_khz =
2718 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
2719 freq_range->end_freq_khz =
2720 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
2721 freq_range->max_bandwidth_khz =
2722 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
2724 power_rule->max_eirp =
2725 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
2727 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
2728 power_rule->max_antenna_gain =
2729 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
2734 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
2740 * You should only get this when cfg80211 hasn't yet initialized
2741 * completely when built-in to the kernel right between the time
2742 * window between nl80211_init() and regulatory_init(), if that is
2745 mutex_lock(&cfg80211_mutex);
2746 if (unlikely(!cfg80211_regdomain)) {
2747 mutex_unlock(&cfg80211_mutex);
2748 return -EINPROGRESS;
2750 mutex_unlock(&cfg80211_mutex);
2752 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
2755 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
2757 r = regulatory_hint_user(data);
2762 static int nl80211_get_mesh_params(struct sk_buff *skb,
2763 struct genl_info *info)
2765 struct cfg80211_registered_device *rdev;
2766 struct mesh_config cur_params;
2768 struct net_device *dev;
2770 struct nlattr *pinfoattr;
2771 struct sk_buff *msg;
2775 /* Look up our device */
2776 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2780 if (!rdev->ops->get_mesh_params) {
2785 /* Get the mesh params */
2786 err = rdev->ops->get_mesh_params(&rdev->wiphy, dev, &cur_params);
2790 /* Draw up a netlink message to send back */
2791 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2796 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
2797 NL80211_CMD_GET_MESH_PARAMS);
2799 goto nla_put_failure;
2800 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_PARAMS);
2802 goto nla_put_failure;
2803 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
2804 NLA_PUT_U16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
2805 cur_params.dot11MeshRetryTimeout);
2806 NLA_PUT_U16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
2807 cur_params.dot11MeshConfirmTimeout);
2808 NLA_PUT_U16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
2809 cur_params.dot11MeshHoldingTimeout);
2810 NLA_PUT_U16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
2811 cur_params.dot11MeshMaxPeerLinks);
2812 NLA_PUT_U8(msg, NL80211_MESHCONF_MAX_RETRIES,
2813 cur_params.dot11MeshMaxRetries);
2814 NLA_PUT_U8(msg, NL80211_MESHCONF_TTL,
2815 cur_params.dot11MeshTTL);
2816 NLA_PUT_U8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
2817 cur_params.auto_open_plinks);
2818 NLA_PUT_U8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
2819 cur_params.dot11MeshHWMPmaxPREQretries);
2820 NLA_PUT_U32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
2821 cur_params.path_refresh_time);
2822 NLA_PUT_U16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
2823 cur_params.min_discovery_timeout);
2824 NLA_PUT_U32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
2825 cur_params.dot11MeshHWMPactivePathTimeout);
2826 NLA_PUT_U16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
2827 cur_params.dot11MeshHWMPpreqMinInterval);
2828 NLA_PUT_U16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
2829 cur_params.dot11MeshHWMPnetDiameterTraversalTime);
2830 NLA_PUT_U8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
2831 cur_params.dot11MeshHWMPRootMode);
2832 nla_nest_end(msg, pinfoattr);
2833 genlmsg_end(msg, hdr);
2834 err = genlmsg_reply(msg, info);
2838 genlmsg_cancel(msg, hdr);
2843 cfg80211_unlock_rdev(rdev);
2851 #define FILL_IN_MESH_PARAM_IF_SET(table, cfg, param, mask, attr_num, nla_fn) \
2853 if (table[attr_num]) {\
2854 cfg.param = nla_fn(table[attr_num]); \
2855 mask |= (1 << (attr_num - 1)); \
2859 static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
2860 [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
2861 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
2862 [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
2863 [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
2864 [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
2865 [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
2866 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
2868 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
2869 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
2870 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
2871 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
2872 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
2873 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
2876 static int nl80211_set_mesh_params(struct sk_buff *skb, struct genl_info *info)
2880 struct cfg80211_registered_device *rdev;
2881 struct net_device *dev;
2882 struct mesh_config cfg;
2883 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
2884 struct nlattr *parent_attr;
2886 parent_attr = info->attrs[NL80211_ATTR_MESH_PARAMS];
2889 if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
2890 parent_attr, nl80211_meshconf_params_policy))
2895 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
2899 if (!rdev->ops->set_mesh_params) {
2904 /* This makes sure that there aren't more than 32 mesh config
2905 * parameters (otherwise our bitfield scheme would not work.) */
2906 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
2908 /* Fill in the params struct */
2910 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout,
2911 mask, NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16);
2912 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout,
2913 mask, NL80211_MESHCONF_CONFIRM_TIMEOUT, nla_get_u16);
2914 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout,
2915 mask, NL80211_MESHCONF_HOLDING_TIMEOUT, nla_get_u16);
2916 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks,
2917 mask, NL80211_MESHCONF_MAX_PEER_LINKS, nla_get_u16);
2918 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries,
2919 mask, NL80211_MESHCONF_MAX_RETRIES, nla_get_u8);
2920 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL,
2921 mask, NL80211_MESHCONF_TTL, nla_get_u8);
2922 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks,
2923 mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS, nla_get_u8);
2924 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries,
2925 mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
2927 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time,
2928 mask, NL80211_MESHCONF_PATH_REFRESH_TIME, nla_get_u32);
2929 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout,
2930 mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
2932 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
2933 mask, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
2935 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
2936 mask, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
2938 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
2939 dot11MeshHWMPnetDiameterTraversalTime,
2940 mask, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
2942 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
2943 dot11MeshHWMPRootMode, mask,
2944 NL80211_MESHCONF_HWMP_ROOTMODE,
2948 err = rdev->ops->set_mesh_params(&rdev->wiphy, dev, &cfg, mask);
2952 cfg80211_unlock_rdev(rdev);
2960 #undef FILL_IN_MESH_PARAM_IF_SET
2962 static int nl80211_get_reg(struct sk_buff *skb, struct genl_info *info)
2964 struct sk_buff *msg;
2966 struct nlattr *nl_reg_rules;
2970 mutex_lock(&cfg80211_mutex);
2972 if (!cfg80211_regdomain)
2975 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2981 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
2982 NL80211_CMD_GET_REG);
2984 goto nla_put_failure;
2986 NLA_PUT_STRING(msg, NL80211_ATTR_REG_ALPHA2,
2987 cfg80211_regdomain->alpha2);
2989 nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
2991 goto nla_put_failure;
2993 for (i = 0; i < cfg80211_regdomain->n_reg_rules; i++) {
2994 struct nlattr *nl_reg_rule;
2995 const struct ieee80211_reg_rule *reg_rule;
2996 const struct ieee80211_freq_range *freq_range;
2997 const struct ieee80211_power_rule *power_rule;
2999 reg_rule = &cfg80211_regdomain->reg_rules[i];
3000 freq_range = ®_rule->freq_range;
3001 power_rule = ®_rule->power_rule;
3003 nl_reg_rule = nla_nest_start(msg, i);
3005 goto nla_put_failure;
3007 NLA_PUT_U32(msg, NL80211_ATTR_REG_RULE_FLAGS,
3009 NLA_PUT_U32(msg, NL80211_ATTR_FREQ_RANGE_START,
3010 freq_range->start_freq_khz);
3011 NLA_PUT_U32(msg, NL80211_ATTR_FREQ_RANGE_END,
3012 freq_range->end_freq_khz);
3013 NLA_PUT_U32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
3014 freq_range->max_bandwidth_khz);
3015 NLA_PUT_U32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
3016 power_rule->max_antenna_gain);
3017 NLA_PUT_U32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
3018 power_rule->max_eirp);
3020 nla_nest_end(msg, nl_reg_rule);
3023 nla_nest_end(msg, nl_reg_rules);
3025 genlmsg_end(msg, hdr);
3026 err = genlmsg_reply(msg, info);
3030 genlmsg_cancel(msg, hdr);
3034 mutex_unlock(&cfg80211_mutex);
3038 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
3040 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
3041 struct nlattr *nl_reg_rule;
3042 char *alpha2 = NULL;
3043 int rem_reg_rules = 0, r = 0;
3044 u32 num_rules = 0, rule_idx = 0, size_of_regd;
3045 struct ieee80211_regdomain *rd = NULL;
3047 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
3050 if (!info->attrs[NL80211_ATTR_REG_RULES])
3053 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
3055 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
3058 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
3062 mutex_lock(&cfg80211_mutex);
3064 if (!reg_is_valid_request(alpha2)) {
3069 size_of_regd = sizeof(struct ieee80211_regdomain) +
3070 (num_rules * sizeof(struct ieee80211_reg_rule));
3072 rd = kzalloc(size_of_regd, GFP_KERNEL);
3078 rd->n_reg_rules = num_rules;
3079 rd->alpha2[0] = alpha2[0];
3080 rd->alpha2[1] = alpha2[1];
3082 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
3084 nla_parse(tb, NL80211_REG_RULE_ATTR_MAX,
3085 nla_data(nl_reg_rule), nla_len(nl_reg_rule),
3087 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
3093 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
3099 BUG_ON(rule_idx != num_rules);
3103 mutex_unlock(&cfg80211_mutex);
3108 mutex_unlock(&cfg80211_mutex);
3113 static int validate_scan_freqs(struct nlattr *freqs)
3115 struct nlattr *attr1, *attr2;
3116 int n_channels = 0, tmp1, tmp2;
3118 nla_for_each_nested(attr1, freqs, tmp1) {
3121 * Some hardware has a limited channel list for
3122 * scanning, and it is pretty much nonsensical
3123 * to scan for a channel twice, so disallow that
3124 * and don't require drivers to check that the
3125 * channel list they get isn't longer than what
3126 * they can scan, as long as they can scan all
3127 * the channels they registered at once.
3129 nla_for_each_nested(attr2, freqs, tmp2)
3130 if (attr1 != attr2 &&
3131 nla_get_u32(attr1) == nla_get_u32(attr2))
3138 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
3140 struct cfg80211_registered_device *rdev;
3141 struct net_device *dev;
3142 struct cfg80211_scan_request *request;
3143 struct cfg80211_ssid *ssid;
3144 struct ieee80211_channel *channel;
3145 struct nlattr *attr;
3146 struct wiphy *wiphy;
3147 int err, tmp, n_ssids = 0, n_channels, i;
3148 enum ieee80211_band band;
3151 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
3156 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
3160 wiphy = &rdev->wiphy;
3162 if (!rdev->ops->scan) {
3167 if (!netif_running(dev)) {
3172 if (rdev->scan_req) {
3177 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
3178 n_channels = validate_scan_freqs(
3179 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
3187 for (band = 0; band < IEEE80211_NUM_BANDS; band++)
3188 if (wiphy->bands[band])
3189 n_channels += wiphy->bands[band]->n_channels;
3192 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
3193 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
3196 if (n_ssids > wiphy->max_scan_ssids) {
3201 if (info->attrs[NL80211_ATTR_IE])
3202 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3206 if (ie_len > wiphy->max_scan_ie_len) {
3211 request = kzalloc(sizeof(*request)
3212 + sizeof(*ssid) * n_ssids
3213 + sizeof(channel) * n_channels
3214 + ie_len, GFP_KERNEL);
3221 request->ssids = (void *)&request->channels[n_channels];
3222 request->n_ssids = n_ssids;
3225 request->ie = (void *)(request->ssids + n_ssids);
3227 request->ie = (void *)(request->channels + n_channels);
3231 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
3232 /* user specified, bail out if channel not found */
3233 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
3234 struct ieee80211_channel *chan;
3236 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
3243 /* ignore disabled channels */
3244 if (chan->flags & IEEE80211_CHAN_DISABLED)
3247 request->channels[i] = chan;
3252 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
3254 if (!wiphy->bands[band])
3256 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
3257 struct ieee80211_channel *chan;
3259 chan = &wiphy->bands[band]->channels[j];
3261 if (chan->flags & IEEE80211_CHAN_DISABLED)
3264 request->channels[i] = chan;
3275 request->n_channels = i;
3278 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) {
3279 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
3280 if (request->ssids[i].ssid_len > IEEE80211_MAX_SSID_LEN) {
3284 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
3285 request->ssids[i].ssid_len = nla_len(attr);
3290 if (info->attrs[NL80211_ATTR_IE]) {
3291 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3292 memcpy((void *)request->ie,
3293 nla_data(info->attrs[NL80211_ATTR_IE]),
3298 request->wiphy = &rdev->wiphy;
3300 rdev->scan_req = request;
3301 err = rdev->ops->scan(&rdev->wiphy, dev, request);
3304 nl80211_send_scan_start(rdev, dev);
3310 rdev->scan_req = NULL;
3314 cfg80211_unlock_rdev(rdev);
3322 static int nl80211_send_bss(struct sk_buff *msg, u32 pid, u32 seq, int flags,
3323 struct cfg80211_registered_device *rdev,
3324 struct wireless_dev *wdev,
3325 struct cfg80211_internal_bss *intbss)
3327 struct cfg80211_bss *res = &intbss->pub;
3332 ASSERT_WDEV_LOCK(wdev);
3334 hdr = nl80211hdr_put(msg, pid, seq, flags,
3335 NL80211_CMD_NEW_SCAN_RESULTS);
3339 NLA_PUT_U32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation);
3340 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex);
3342 bss = nla_nest_start(msg, NL80211_ATTR_BSS);
3344 goto nla_put_failure;
3345 if (!is_zero_ether_addr(res->bssid))
3346 NLA_PUT(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid);
3347 if (res->information_elements && res->len_information_elements)
3348 NLA_PUT(msg, NL80211_BSS_INFORMATION_ELEMENTS,
3349 res->len_information_elements,
3350 res->information_elements);
3351 if (res->beacon_ies && res->len_beacon_ies &&
3352 res->beacon_ies != res->information_elements)
3353 NLA_PUT(msg, NL80211_BSS_BEACON_IES,
3354 res->len_beacon_ies, res->beacon_ies);
3356 NLA_PUT_U64(msg, NL80211_BSS_TSF, res->tsf);
3357 if (res->beacon_interval)
3358 NLA_PUT_U16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval);
3359 NLA_PUT_U16(msg, NL80211_BSS_CAPABILITY, res->capability);
3360 NLA_PUT_U32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq);
3361 NLA_PUT_U32(msg, NL80211_BSS_SEEN_MS_AGO,
3362 jiffies_to_msecs(jiffies - intbss->ts));
3364 switch (rdev->wiphy.signal_type) {
3365 case CFG80211_SIGNAL_TYPE_MBM:
3366 NLA_PUT_U32(msg, NL80211_BSS_SIGNAL_MBM, res->signal);
3368 case CFG80211_SIGNAL_TYPE_UNSPEC:
3369 NLA_PUT_U8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal);
3375 switch (wdev->iftype) {
3376 case NL80211_IFTYPE_P2P_CLIENT:
3377 case NL80211_IFTYPE_STATION:
3378 if (intbss == wdev->current_bss)
3379 NLA_PUT_U32(msg, NL80211_BSS_STATUS,
3380 NL80211_BSS_STATUS_ASSOCIATED);
3381 else for (i = 0; i < MAX_AUTH_BSSES; i++) {
3382 if (intbss != wdev->auth_bsses[i])
3384 NLA_PUT_U32(msg, NL80211_BSS_STATUS,
3385 NL80211_BSS_STATUS_AUTHENTICATED);
3389 case NL80211_IFTYPE_ADHOC:
3390 if (intbss == wdev->current_bss)
3391 NLA_PUT_U32(msg, NL80211_BSS_STATUS,
3392 NL80211_BSS_STATUS_IBSS_JOINED);
3398 nla_nest_end(msg, bss);
3400 return genlmsg_end(msg, hdr);
3403 genlmsg_cancel(msg, hdr);
3407 static int nl80211_dump_scan(struct sk_buff *skb,
3408 struct netlink_callback *cb)
3410 struct cfg80211_registered_device *rdev;
3411 struct net_device *dev;
3412 struct cfg80211_internal_bss *scan;
3413 struct wireless_dev *wdev;
3414 int ifidx = cb->args[0];
3415 int start = cb->args[1], idx = 0;
3419 ifidx = nl80211_get_ifidx(cb);
3422 cb->args[0] = ifidx;
3424 dev = dev_get_by_index(sock_net(skb->sk), ifidx);
3428 rdev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
3430 err = PTR_ERR(rdev);
3431 goto out_put_netdev;
3434 wdev = dev->ieee80211_ptr;
3437 spin_lock_bh(&rdev->bss_lock);
3438 cfg80211_bss_expire(rdev);
3440 list_for_each_entry(scan, &rdev->bss_list, list) {
3443 if (nl80211_send_bss(skb,
3444 NETLINK_CB(cb->skb).pid,
3445 cb->nlh->nlmsg_seq, NLM_F_MULTI,
3446 rdev, wdev, scan) < 0) {
3453 spin_unlock_bh(&rdev->bss_lock);
3458 cfg80211_unlock_rdev(rdev);
3465 static int nl80211_send_survey(struct sk_buff *msg, u32 pid, u32 seq,
3466 int flags, struct net_device *dev,
3467 struct survey_info *survey)
3470 struct nlattr *infoattr;
3472 /* Survey without a channel doesn't make sense */
3473 if (!survey->channel)
3476 hdr = nl80211hdr_put(msg, pid, seq, flags,
3477 NL80211_CMD_NEW_SURVEY_RESULTS);
3481 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
3483 infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
3485 goto nla_put_failure;
3487 NLA_PUT_U32(msg, NL80211_SURVEY_INFO_FREQUENCY,
3488 survey->channel->center_freq);
3489 if (survey->filled & SURVEY_INFO_NOISE_DBM)
3490 NLA_PUT_U8(msg, NL80211_SURVEY_INFO_NOISE,
3493 nla_nest_end(msg, infoattr);
3495 return genlmsg_end(msg, hdr);
3498 genlmsg_cancel(msg, hdr);
3502 static int nl80211_dump_survey(struct sk_buff *skb,
3503 struct netlink_callback *cb)
3505 struct survey_info survey;
3506 struct cfg80211_registered_device *dev;
3507 struct net_device *netdev;
3508 int ifidx = cb->args[0];
3509 int survey_idx = cb->args[1];
3513 ifidx = nl80211_get_ifidx(cb);
3516 cb->args[0] = ifidx;
3520 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
3526 dev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
3532 if (!dev->ops->dump_survey) {
3538 res = dev->ops->dump_survey(&dev->wiphy, netdev, survey_idx,
3545 if (nl80211_send_survey(skb,
3546 NETLINK_CB(cb->skb).pid,
3547 cb->nlh->nlmsg_seq, NLM_F_MULTI,
3555 cb->args[1] = survey_idx;
3558 cfg80211_unlock_rdev(dev);
3565 static bool nl80211_valid_auth_type(enum nl80211_auth_type auth_type)
3567 return auth_type <= NL80211_AUTHTYPE_MAX;
3570 static bool nl80211_valid_wpa_versions(u32 wpa_versions)
3572 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
3573 NL80211_WPA_VERSION_2));
3576 static bool nl80211_valid_akm_suite(u32 akm)
3578 return akm == WLAN_AKM_SUITE_8021X ||
3579 akm == WLAN_AKM_SUITE_PSK;
3582 static bool nl80211_valid_cipher_suite(u32 cipher)
3584 return cipher == WLAN_CIPHER_SUITE_WEP40 ||
3585 cipher == WLAN_CIPHER_SUITE_WEP104 ||
3586 cipher == WLAN_CIPHER_SUITE_TKIP ||
3587 cipher == WLAN_CIPHER_SUITE_CCMP ||
3588 cipher == WLAN_CIPHER_SUITE_AES_CMAC;
3592 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
3594 struct cfg80211_registered_device *rdev;
3595 struct net_device *dev;
3596 struct ieee80211_channel *chan;
3597 const u8 *bssid, *ssid, *ie = NULL;
3598 int err, ssid_len, ie_len = 0;
3599 enum nl80211_auth_type auth_type;
3600 struct key_parse key;
3601 bool local_state_change;
3603 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
3606 if (!info->attrs[NL80211_ATTR_MAC])
3609 if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
3612 if (!info->attrs[NL80211_ATTR_SSID])
3615 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
3618 err = nl80211_parse_key(info, &key);
3623 if (!key.p.key || !key.p.key_len)
3625 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
3626 key.p.key_len != WLAN_KEY_LEN_WEP40) &&
3627 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
3628 key.p.key_len != WLAN_KEY_LEN_WEP104))
3639 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
3646 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
3647 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
3658 if (!rdev->ops->auth) {
3663 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
3664 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
3669 if (!netif_running(dev)) {
3674 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
3675 chan = ieee80211_get_channel(&rdev->wiphy,
3676 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
3677 if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED)) {
3682 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
3683 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
3685 if (info->attrs[NL80211_ATTR_IE]) {
3686 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
3687 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3690 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
3691 if (!nl80211_valid_auth_type(auth_type)) {
3696 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
3698 err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
3699 ssid, ssid_len, ie, ie_len,
3700 key.p.key, key.p.key_len, key.idx,
3701 local_state_change);
3704 cfg80211_unlock_rdev(rdev);
3711 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
3712 struct genl_info *info,
3713 struct cfg80211_crypto_settings *settings,
3716 memset(settings, 0, sizeof(*settings));
3718 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
3720 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
3722 proto = nla_get_u16(
3723 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
3724 settings->control_port_ethertype = cpu_to_be16(proto);
3725 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
3728 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
3729 settings->control_port_no_encrypt = true;
3731 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
3733 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
3737 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
3738 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
3739 settings->n_ciphers_pairwise = len / sizeof(u32);
3741 if (len % sizeof(u32))
3744 if (settings->n_ciphers_pairwise > cipher_limit)
3747 memcpy(settings->ciphers_pairwise, data, len);
3749 for (i = 0; i < settings->n_ciphers_pairwise; i++)
3750 if (!nl80211_valid_cipher_suite(
3751 settings->ciphers_pairwise[i]))
3755 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
3756 settings->cipher_group =
3757 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
3758 if (!nl80211_valid_cipher_suite(settings->cipher_group))
3762 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
3763 settings->wpa_versions =
3764 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
3765 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
3769 if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
3773 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
3774 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
3775 settings->n_akm_suites = len / sizeof(u32);
3777 if (len % sizeof(u32))
3780 memcpy(settings->akm_suites, data, len);
3782 for (i = 0; i < settings->n_ciphers_pairwise; i++)
3783 if (!nl80211_valid_akm_suite(settings->akm_suites[i]))
3790 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
3792 struct cfg80211_registered_device *rdev;
3793 struct net_device *dev;
3794 struct cfg80211_crypto_settings crypto;
3795 struct ieee80211_channel *chan;
3796 const u8 *bssid, *ssid, *ie = NULL, *prev_bssid = NULL;
3797 int err, ssid_len, ie_len = 0;
3798 bool use_mfp = false;
3800 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
3803 if (!info->attrs[NL80211_ATTR_MAC] ||
3804 !info->attrs[NL80211_ATTR_SSID] ||
3805 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
3810 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
3814 if (!rdev->ops->assoc) {
3819 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
3820 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
3825 if (!netif_running(dev)) {
3830 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
3832 chan = ieee80211_get_channel(&rdev->wiphy,
3833 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
3834 if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED)) {
3839 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
3840 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
3842 if (info->attrs[NL80211_ATTR_IE]) {
3843 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
3844 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3847 if (info->attrs[NL80211_ATTR_USE_MFP]) {
3848 enum nl80211_mfp mfp =
3849 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
3850 if (mfp == NL80211_MFP_REQUIRED)
3852 else if (mfp != NL80211_MFP_NO) {
3858 if (info->attrs[NL80211_ATTR_PREV_BSSID])
3859 prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
3861 err = nl80211_crypto_settings(rdev, info, &crypto, 1);
3863 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid, prev_bssid,
3864 ssid, ssid_len, ie, ie_len, use_mfp,
3868 cfg80211_unlock_rdev(rdev);
3875 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
3877 struct cfg80211_registered_device *rdev;
3878 struct net_device *dev;
3879 const u8 *ie = NULL, *bssid;
3880 int err, ie_len = 0;
3882 bool local_state_change;
3884 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
3887 if (!info->attrs[NL80211_ATTR_MAC])
3890 if (!info->attrs[NL80211_ATTR_REASON_CODE])
3895 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
3899 if (!rdev->ops->deauth) {
3904 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
3905 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
3910 if (!netif_running(dev)) {
3915 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
3917 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
3918 if (reason_code == 0) {
3919 /* Reason Code 0 is reserved */
3924 if (info->attrs[NL80211_ATTR_IE]) {
3925 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
3926 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3929 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
3931 err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
3932 local_state_change);
3935 cfg80211_unlock_rdev(rdev);
3942 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
3944 struct cfg80211_registered_device *rdev;
3945 struct net_device *dev;
3946 const u8 *ie = NULL, *bssid;
3947 int err, ie_len = 0;
3949 bool local_state_change;
3951 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
3954 if (!info->attrs[NL80211_ATTR_MAC])
3957 if (!info->attrs[NL80211_ATTR_REASON_CODE])
3962 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
3966 if (!rdev->ops->disassoc) {
3971 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
3972 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
3977 if (!netif_running(dev)) {
3982 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
3984 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
3985 if (reason_code == 0) {
3986 /* Reason Code 0 is reserved */
3991 if (info->attrs[NL80211_ATTR_IE]) {
3992 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
3993 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
3996 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
3998 err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
3999 local_state_change);
4002 cfg80211_unlock_rdev(rdev);
4009 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
4011 struct cfg80211_registered_device *rdev;
4012 struct net_device *dev;
4013 struct cfg80211_ibss_params ibss;
4014 struct wiphy *wiphy;
4015 struct cfg80211_cached_keys *connkeys = NULL;
4018 memset(&ibss, 0, sizeof(ibss));
4020 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
4023 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
4024 !info->attrs[NL80211_ATTR_SSID] ||
4025 !nla_len(info->attrs[NL80211_ATTR_SSID]))
4028 ibss.beacon_interval = 100;
4030 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
4031 ibss.beacon_interval =
4032 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
4033 if (ibss.beacon_interval < 1 || ibss.beacon_interval > 10000)
4039 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4043 if (!rdev->ops->join_ibss) {
4048 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) {
4053 if (!netif_running(dev)) {
4058 wiphy = &rdev->wiphy;
4060 if (info->attrs[NL80211_ATTR_MAC])
4061 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
4062 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
4063 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
4065 if (info->attrs[NL80211_ATTR_IE]) {
4066 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
4067 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4070 ibss.channel = ieee80211_get_channel(wiphy,
4071 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
4072 if (!ibss.channel ||
4073 ibss.channel->flags & IEEE80211_CHAN_NO_IBSS ||
4074 ibss.channel->flags & IEEE80211_CHAN_DISABLED) {
4079 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
4080 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
4082 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
4083 connkeys = nl80211_parse_connkeys(rdev,
4084 info->attrs[NL80211_ATTR_KEYS]);
4085 if (IS_ERR(connkeys)) {
4086 err = PTR_ERR(connkeys);
4092 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
4094 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
4096 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
4097 struct ieee80211_supported_band *sband =
4098 wiphy->bands[ibss.channel->band];
4106 for (i = 0; i < n_rates; i++) {
4107 int rate = (rates[i] & 0x7f) * 5;
4110 for (j = 0; j < sband->n_bitrates; j++) {
4111 if (sband->bitrates[j].bitrate == rate) {
4113 ibss.basic_rates |= BIT(j);
4124 err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
4127 cfg80211_unlock_rdev(rdev);
4136 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
4138 struct cfg80211_registered_device *rdev;
4139 struct net_device *dev;
4144 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4148 if (!rdev->ops->leave_ibss) {
4153 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) {
4158 if (!netif_running(dev)) {
4163 err = cfg80211_leave_ibss(rdev, dev, false);
4166 cfg80211_unlock_rdev(rdev);
4173 #ifdef CONFIG_NL80211_TESTMODE
4174 static struct genl_multicast_group nl80211_testmode_mcgrp = {
4178 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
4180 struct cfg80211_registered_device *rdev;
4183 if (!info->attrs[NL80211_ATTR_TESTDATA])
4188 rdev = cfg80211_get_dev_from_info(info);
4190 err = PTR_ERR(rdev);
4195 if (rdev->ops->testmode_cmd) {
4196 rdev->testmode_info = info;
4197 err = rdev->ops->testmode_cmd(&rdev->wiphy,
4198 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
4199 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
4200 rdev->testmode_info = NULL;
4203 cfg80211_unlock_rdev(rdev);
4210 static struct sk_buff *
4211 __cfg80211_testmode_alloc_skb(struct cfg80211_registered_device *rdev,
4212 int approxlen, u32 pid, u32 seq, gfp_t gfp)
4214 struct sk_buff *skb;
4216 struct nlattr *data;
4218 skb = nlmsg_new(approxlen + 100, gfp);
4222 hdr = nl80211hdr_put(skb, pid, seq, 0, NL80211_CMD_TESTMODE);
4228 NLA_PUT_U32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
4229 data = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
4231 ((void **)skb->cb)[0] = rdev;
4232 ((void **)skb->cb)[1] = hdr;
4233 ((void **)skb->cb)[2] = data;
4242 struct sk_buff *cfg80211_testmode_alloc_reply_skb(struct wiphy *wiphy,
4245 struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
4247 if (WARN_ON(!rdev->testmode_info))
4250 return __cfg80211_testmode_alloc_skb(rdev, approxlen,
4251 rdev->testmode_info->snd_pid,
4252 rdev->testmode_info->snd_seq,
4255 EXPORT_SYMBOL(cfg80211_testmode_alloc_reply_skb);
4257 int cfg80211_testmode_reply(struct sk_buff *skb)
4259 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
4260 void *hdr = ((void **)skb->cb)[1];
4261 struct nlattr *data = ((void **)skb->cb)[2];
4263 if (WARN_ON(!rdev->testmode_info)) {
4268 nla_nest_end(skb, data);
4269 genlmsg_end(skb, hdr);
4270 return genlmsg_reply(skb, rdev->testmode_info);
4272 EXPORT_SYMBOL(cfg80211_testmode_reply);
4274 struct sk_buff *cfg80211_testmode_alloc_event_skb(struct wiphy *wiphy,
4275 int approxlen, gfp_t gfp)
4277 struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
4279 return __cfg80211_testmode_alloc_skb(rdev, approxlen, 0, 0, gfp);
4281 EXPORT_SYMBOL(cfg80211_testmode_alloc_event_skb);
4283 void cfg80211_testmode_event(struct sk_buff *skb, gfp_t gfp)
4285 void *hdr = ((void **)skb->cb)[1];
4286 struct nlattr *data = ((void **)skb->cb)[2];
4288 nla_nest_end(skb, data);
4289 genlmsg_end(skb, hdr);
4290 genlmsg_multicast(skb, 0, nl80211_testmode_mcgrp.id, gfp);
4292 EXPORT_SYMBOL(cfg80211_testmode_event);
4295 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
4297 struct cfg80211_registered_device *rdev;
4298 struct net_device *dev;
4299 struct cfg80211_connect_params connect;
4300 struct wiphy *wiphy;
4301 struct cfg80211_cached_keys *connkeys = NULL;
4304 memset(&connect, 0, sizeof(connect));
4306 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
4309 if (!info->attrs[NL80211_ATTR_SSID] ||
4310 !nla_len(info->attrs[NL80211_ATTR_SSID]))
4313 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
4315 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
4316 if (!nl80211_valid_auth_type(connect.auth_type))
4319 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
4321 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
4323 err = nl80211_crypto_settings(rdev, info, &connect.crypto,
4324 NL80211_MAX_NR_CIPHER_SUITES);
4329 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4333 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4334 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
4339 if (!netif_running(dev)) {
4344 wiphy = &rdev->wiphy;
4346 if (info->attrs[NL80211_ATTR_MAC])
4347 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
4348 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
4349 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
4351 if (info->attrs[NL80211_ATTR_IE]) {
4352 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
4353 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
4356 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
4358 ieee80211_get_channel(wiphy,
4359 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
4360 if (!connect.channel ||
4361 connect.channel->flags & IEEE80211_CHAN_DISABLED) {
4367 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
4368 connkeys = nl80211_parse_connkeys(rdev,
4369 info->attrs[NL80211_ATTR_KEYS]);
4370 if (IS_ERR(connkeys)) {
4371 err = PTR_ERR(connkeys);
4377 err = cfg80211_connect(rdev, dev, &connect, connkeys);
4380 cfg80211_unlock_rdev(rdev);
4389 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
4391 struct cfg80211_registered_device *rdev;
4392 struct net_device *dev;
4396 if (!info->attrs[NL80211_ATTR_REASON_CODE])
4397 reason = WLAN_REASON_DEAUTH_LEAVING;
4399 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
4406 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4410 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4411 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
4416 if (!netif_running(dev)) {
4421 err = cfg80211_disconnect(rdev, dev, reason, true);
4424 cfg80211_unlock_rdev(rdev);
4431 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
4433 struct cfg80211_registered_device *rdev;
4438 if (!info->attrs[NL80211_ATTR_PID])
4441 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
4445 rdev = cfg80211_get_dev_from_info(info);
4447 err = PTR_ERR(rdev);
4451 net = get_net_ns_by_pid(pid);
4459 /* check if anything to do */
4460 if (net_eq(wiphy_net(&rdev->wiphy), net))
4463 err = cfg80211_switch_netns(rdev, net);
4467 cfg80211_unlock_rdev(rdev);
4473 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
4475 struct cfg80211_registered_device *rdev;
4476 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
4477 struct cfg80211_pmksa *pmksa) = NULL;
4479 struct net_device *dev;
4480 struct cfg80211_pmksa pmksa;
4482 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
4484 if (!info->attrs[NL80211_ATTR_MAC])
4487 if (!info->attrs[NL80211_ATTR_PMKID])
4492 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4496 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
4497 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
4499 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4500 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
4505 switch (info->genlhdr->cmd) {
4506 case NL80211_CMD_SET_PMKSA:
4507 rdev_ops = rdev->ops->set_pmksa;
4509 case NL80211_CMD_DEL_PMKSA:
4510 rdev_ops = rdev->ops->del_pmksa;
4522 err = rdev_ops(&rdev->wiphy, dev, &pmksa);
4525 cfg80211_unlock_rdev(rdev);
4533 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
4535 struct cfg80211_registered_device *rdev;
4537 struct net_device *dev;
4541 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4545 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4546 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
4551 if (!rdev->ops->flush_pmksa) {
4556 err = rdev->ops->flush_pmksa(&rdev->wiphy, dev);
4559 cfg80211_unlock_rdev(rdev);
4568 static int nl80211_remain_on_channel(struct sk_buff *skb,
4569 struct genl_info *info)
4571 struct cfg80211_registered_device *rdev;
4572 struct net_device *dev;
4573 struct ieee80211_channel *chan;
4574 struct sk_buff *msg;
4577 enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;
4581 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
4582 !info->attrs[NL80211_ATTR_DURATION])
4585 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
4588 * We should be on that channel for at least one jiffie,
4589 * and more than 5 seconds seems excessive.
4591 if (!duration || !msecs_to_jiffies(duration) || duration > 5000)
4596 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4600 if (!rdev->ops->remain_on_channel) {
4605 if (!netif_running(dev)) {
4610 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
4611 channel_type = nla_get_u32(
4612 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
4613 if (channel_type != NL80211_CHAN_NO_HT &&
4614 channel_type != NL80211_CHAN_HT20 &&
4615 channel_type != NL80211_CHAN_HT40PLUS &&
4616 channel_type != NL80211_CHAN_HT40MINUS) {
4622 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
4623 chan = rdev_freq_to_chan(rdev, freq, channel_type);
4629 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4635 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
4636 NL80211_CMD_REMAIN_ON_CHANNEL);
4643 err = rdev->ops->remain_on_channel(&rdev->wiphy, dev, chan,
4644 channel_type, duration, &cookie);
4649 NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
4651 genlmsg_end(msg, hdr);
4652 err = genlmsg_reply(msg, info);
4660 cfg80211_unlock_rdev(rdev);
4667 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
4668 struct genl_info *info)
4670 struct cfg80211_registered_device *rdev;
4671 struct net_device *dev;
4675 if (!info->attrs[NL80211_ATTR_COOKIE])
4680 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4684 if (!rdev->ops->cancel_remain_on_channel) {
4689 if (!netif_running(dev)) {
4694 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
4696 err = rdev->ops->cancel_remain_on_channel(&rdev->wiphy, dev, cookie);
4699 cfg80211_unlock_rdev(rdev);
4706 static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
4707 u8 *rates, u8 rates_len)
4712 for (i = 0; i < rates_len; i++) {
4713 int rate = (rates[i] & 0x7f) * 5;
4715 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
4716 struct ieee80211_rate *srate =
4717 &sband->bitrates[ridx];
4718 if (rate == srate->bitrate) {
4723 if (ridx == sband->n_bitrates)
4724 return 0; /* rate not found */
4730 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
4731 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
4732 .len = NL80211_MAX_SUPP_RATES },
4735 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
4736 struct genl_info *info)
4738 struct nlattr *tb[NL80211_TXRATE_MAX + 1];
4739 struct cfg80211_registered_device *rdev;
4740 struct cfg80211_bitrate_mask mask;
4742 struct net_device *dev;
4743 struct nlattr *tx_rates;
4744 struct ieee80211_supported_band *sband;
4746 if (info->attrs[NL80211_ATTR_TX_RATES] == NULL)
4751 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4755 if (!rdev->ops->set_bitrate_mask) {
4760 memset(&mask, 0, sizeof(mask));
4761 /* Default to all rates enabled */
4762 for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
4763 sband = rdev->wiphy.bands[i];
4764 mask.control[i].legacy =
4765 sband ? (1 << sband->n_bitrates) - 1 : 0;
4769 * The nested attribute uses enum nl80211_band as the index. This maps
4770 * directly to the enum ieee80211_band values used in cfg80211.
4772 nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem)
4774 enum ieee80211_band band = nla_type(tx_rates);
4775 if (band < 0 || band >= IEEE80211_NUM_BANDS) {
4779 sband = rdev->wiphy.bands[band];
4780 if (sband == NULL) {
4784 nla_parse(tb, NL80211_TXRATE_MAX, nla_data(tx_rates),
4785 nla_len(tx_rates), nl80211_txattr_policy);
4786 if (tb[NL80211_TXRATE_LEGACY]) {
4787 mask.control[band].legacy = rateset_to_mask(
4789 nla_data(tb[NL80211_TXRATE_LEGACY]),
4790 nla_len(tb[NL80211_TXRATE_LEGACY]));
4791 if (mask.control[band].legacy == 0) {
4798 err = rdev->ops->set_bitrate_mask(&rdev->wiphy, dev, NULL, &mask);
4802 cfg80211_unlock_rdev(rdev);
4808 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
4810 struct cfg80211_registered_device *rdev;
4811 struct net_device *dev;
4812 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
4815 if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
4818 if (info->attrs[NL80211_ATTR_FRAME_TYPE])
4819 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
4823 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4827 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4828 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
4829 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
4834 /* not much point in registering if we can't reply */
4835 if (!rdev->ops->mgmt_tx) {
4840 err = cfg80211_mlme_register_mgmt(dev->ieee80211_ptr, info->snd_pid,
4842 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
4843 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
4845 cfg80211_unlock_rdev(rdev);
4852 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
4854 struct cfg80211_registered_device *rdev;
4855 struct net_device *dev;
4856 struct ieee80211_channel *chan;
4857 enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;
4858 bool channel_type_valid = false;
4863 struct sk_buff *msg;
4865 if (!info->attrs[NL80211_ATTR_FRAME] ||
4866 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
4871 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4875 if (!rdev->ops->mgmt_tx) {
4880 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
4881 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
4882 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) {
4887 if (!netif_running(dev)) {
4892 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
4893 channel_type = nla_get_u32(
4894 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
4895 if (channel_type != NL80211_CHAN_NO_HT &&
4896 channel_type != NL80211_CHAN_HT20 &&
4897 channel_type != NL80211_CHAN_HT40PLUS &&
4898 channel_type != NL80211_CHAN_HT40MINUS) {
4902 channel_type_valid = true;
4905 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
4906 chan = rdev_freq_to_chan(rdev, freq, channel_type);
4912 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4918 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
4925 err = cfg80211_mlme_mgmt_tx(rdev, dev, chan, channel_type,
4927 nla_data(info->attrs[NL80211_ATTR_FRAME]),
4928 nla_len(info->attrs[NL80211_ATTR_FRAME]),
4933 NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
4935 genlmsg_end(msg, hdr);
4936 err = genlmsg_reply(msg, info);
4944 cfg80211_unlock_rdev(rdev);
4951 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
4953 struct cfg80211_registered_device *rdev;
4954 struct wireless_dev *wdev;
4955 struct net_device *dev;
4960 if (!info->attrs[NL80211_ATTR_PS_STATE]) {
4965 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
4967 if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED) {
4974 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
4978 wdev = dev->ieee80211_ptr;
4980 if (!rdev->ops->set_power_mgmt) {
4985 state = (ps_state == NL80211_PS_ENABLED) ? true : false;
4987 if (state == wdev->ps)
4992 if (rdev->ops->set_power_mgmt(wdev->wiphy, dev, wdev->ps,
4994 /* assume this means it's off */
4998 cfg80211_unlock_rdev(rdev);
5007 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
5009 struct cfg80211_registered_device *rdev;
5010 enum nl80211_ps_state ps_state;
5011 struct wireless_dev *wdev;
5012 struct net_device *dev;
5013 struct sk_buff *msg;
5019 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
5023 wdev = dev->ieee80211_ptr;
5025 if (!rdev->ops->set_power_mgmt) {
5030 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5036 hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
5037 NL80211_CMD_GET_POWER_SAVE);
5044 ps_state = NL80211_PS_ENABLED;
5046 ps_state = NL80211_PS_DISABLED;
5048 NLA_PUT_U32(msg, NL80211_ATTR_PS_STATE, ps_state);
5050 genlmsg_end(msg, hdr);
5051 err = genlmsg_reply(msg, info);
5061 cfg80211_unlock_rdev(rdev);
5070 static struct nla_policy
5071 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] __read_mostly = {
5072 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
5073 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
5074 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
5077 static int nl80211_set_cqm_rssi(struct genl_info *info,
5078 s32 threshold, u32 hysteresis)
5080 struct cfg80211_registered_device *rdev;
5081 struct wireless_dev *wdev;
5082 struct net_device *dev;
5090 err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
5094 wdev = dev->ieee80211_ptr;
5096 if (!rdev->ops->set_cqm_rssi_config) {
5101 if (wdev->iftype != NL80211_IFTYPE_STATION &&
5102 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) {
5107 err = rdev->ops->set_cqm_rssi_config(wdev->wiphy, dev,
5108 threshold, hysteresis);
5111 cfg80211_unlock_rdev(rdev);
5118 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
5120 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
5124 cqm = info->attrs[NL80211_ATTR_CQM];
5130 err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
5131 nl80211_attr_cqm_policy);
5135 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
5136 attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
5139 threshold = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
5140 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
5141 err = nl80211_set_cqm_rssi(info, threshold, hysteresis);
5149 static struct genl_ops nl80211_ops[] = {
5151 .cmd = NL80211_CMD_GET_WIPHY,
5152 .doit = nl80211_get_wiphy,
5153 .dumpit = nl80211_dump_wiphy,
5154 .policy = nl80211_policy,
5155 /* can be retrieved by unprivileged users */
5158 .cmd = NL80211_CMD_SET_WIPHY,
5159 .doit = nl80211_set_wiphy,
5160 .policy = nl80211_policy,
5161 .flags = GENL_ADMIN_PERM,
5164 .cmd = NL80211_CMD_GET_INTERFACE,
5165 .doit = nl80211_get_interface,
5166 .dumpit = nl80211_dump_interface,
5167 .policy = nl80211_policy,
5168 /* can be retrieved by unprivileged users */
5171 .cmd = NL80211_CMD_SET_INTERFACE,
5172 .doit = nl80211_set_interface,
5173 .policy = nl80211_policy,
5174 .flags = GENL_ADMIN_PERM,
5177 .cmd = NL80211_CMD_NEW_INTERFACE,
5178 .doit = nl80211_new_interface,
5179 .policy = nl80211_policy,
5180 .flags = GENL_ADMIN_PERM,
5183 .cmd = NL80211_CMD_DEL_INTERFACE,
5184 .doit = nl80211_del_interface,
5185 .policy = nl80211_policy,
5186 .flags = GENL_ADMIN_PERM,
5189 .cmd = NL80211_CMD_GET_KEY,
5190 .doit = nl80211_get_key,
5191 .policy = nl80211_policy,
5192 .flags = GENL_ADMIN_PERM,
5195 .cmd = NL80211_CMD_SET_KEY,
5196 .doit = nl80211_set_key,
5197 .policy = nl80211_policy,
5198 .flags = GENL_ADMIN_PERM,
5201 .cmd = NL80211_CMD_NEW_KEY,
5202 .doit = nl80211_new_key,
5203 .policy = nl80211_policy,
5204 .flags = GENL_ADMIN_PERM,
5207 .cmd = NL80211_CMD_DEL_KEY,
5208 .doit = nl80211_del_key,
5209 .policy = nl80211_policy,
5210 .flags = GENL_ADMIN_PERM,
5213 .cmd = NL80211_CMD_SET_BEACON,
5214 .policy = nl80211_policy,
5215 .flags = GENL_ADMIN_PERM,
5216 .doit = nl80211_addset_beacon,
5219 .cmd = NL80211_CMD_NEW_BEACON,
5220 .policy = nl80211_policy,
5221 .flags = GENL_ADMIN_PERM,
5222 .doit = nl80211_addset_beacon,
5225 .cmd = NL80211_CMD_DEL_BEACON,
5226 .policy = nl80211_policy,
5227 .flags = GENL_ADMIN_PERM,
5228 .doit = nl80211_del_beacon,
5231 .cmd = NL80211_CMD_GET_STATION,
5232 .doit = nl80211_get_station,
5233 .dumpit = nl80211_dump_station,
5234 .policy = nl80211_policy,
5237 .cmd = NL80211_CMD_SET_STATION,
5238 .doit = nl80211_set_station,
5239 .policy = nl80211_policy,
5240 .flags = GENL_ADMIN_PERM,
5243 .cmd = NL80211_CMD_NEW_STATION,
5244 .doit = nl80211_new_station,
5245 .policy = nl80211_policy,
5246 .flags = GENL_ADMIN_PERM,
5249 .cmd = NL80211_CMD_DEL_STATION,
5250 .doit = nl80211_del_station,
5251 .policy = nl80211_policy,
5252 .flags = GENL_ADMIN_PERM,
5255 .cmd = NL80211_CMD_GET_MPATH,
5256 .doit = nl80211_get_mpath,
5257 .dumpit = nl80211_dump_mpath,
5258 .policy = nl80211_policy,
5259 .flags = GENL_ADMIN_PERM,
5262 .cmd = NL80211_CMD_SET_MPATH,
5263 .doit = nl80211_set_mpath,
5264 .policy = nl80211_policy,
5265 .flags = GENL_ADMIN_PERM,
5268 .cmd = NL80211_CMD_NEW_MPATH,
5269 .doit = nl80211_new_mpath,
5270 .policy = nl80211_policy,
5271 .flags = GENL_ADMIN_PERM,
5274 .cmd = NL80211_CMD_DEL_MPATH,
5275 .doit = nl80211_del_mpath,
5276 .policy = nl80211_policy,
5277 .flags = GENL_ADMIN_PERM,
5280 .cmd = NL80211_CMD_SET_BSS,
5281 .doit = nl80211_set_bss,
5282 .policy = nl80211_policy,
5283 .flags = GENL_ADMIN_PERM,
5286 .cmd = NL80211_CMD_GET_REG,
5287 .doit = nl80211_get_reg,
5288 .policy = nl80211_policy,
5289 /* can be retrieved by unprivileged users */
5292 .cmd = NL80211_CMD_SET_REG,
5293 .doit = nl80211_set_reg,
5294 .policy = nl80211_policy,
5295 .flags = GENL_ADMIN_PERM,
5298 .cmd = NL80211_CMD_REQ_SET_REG,
5299 .doit = nl80211_req_set_reg,
5300 .policy = nl80211_policy,
5301 .flags = GENL_ADMIN_PERM,
5304 .cmd = NL80211_CMD_GET_MESH_PARAMS,
5305 .doit = nl80211_get_mesh_params,
5306 .policy = nl80211_policy,
5307 /* can be retrieved by unprivileged users */
5310 .cmd = NL80211_CMD_SET_MESH_PARAMS,
5311 .doit = nl80211_set_mesh_params,
5312 .policy = nl80211_policy,
5313 .flags = GENL_ADMIN_PERM,
5316 .cmd = NL80211_CMD_TRIGGER_SCAN,
5317 .doit = nl80211_trigger_scan,
5318 .policy = nl80211_policy,
5319 .flags = GENL_ADMIN_PERM,
5322 .cmd = NL80211_CMD_GET_SCAN,
5323 .policy = nl80211_policy,
5324 .dumpit = nl80211_dump_scan,
5327 .cmd = NL80211_CMD_AUTHENTICATE,
5328 .doit = nl80211_authenticate,
5329 .policy = nl80211_policy,
5330 .flags = GENL_ADMIN_PERM,
5333 .cmd = NL80211_CMD_ASSOCIATE,
5334 .doit = nl80211_associate,
5335 .policy = nl80211_policy,
5336 .flags = GENL_ADMIN_PERM,
5339 .cmd = NL80211_CMD_DEAUTHENTICATE,
5340 .doit = nl80211_deauthenticate,
5341 .policy = nl80211_policy,
5342 .flags = GENL_ADMIN_PERM,
5345 .cmd = NL80211_CMD_DISASSOCIATE,
5346 .doit = nl80211_disassociate,
5347 .policy = nl80211_policy,
5348 .flags = GENL_ADMIN_PERM,
5351 .cmd = NL80211_CMD_JOIN_IBSS,
5352 .doit = nl80211_join_ibss,
5353 .policy = nl80211_policy,
5354 .flags = GENL_ADMIN_PERM,
5357 .cmd = NL80211_CMD_LEAVE_IBSS,
5358 .doit = nl80211_leave_ibss,
5359 .policy = nl80211_policy,
5360 .flags = GENL_ADMIN_PERM,
5362 #ifdef CONFIG_NL80211_TESTMODE
5364 .cmd = NL80211_CMD_TESTMODE,
5365 .doit = nl80211_testmode_do,
5366 .policy = nl80211_policy,
5367 .flags = GENL_ADMIN_PERM,
5371 .cmd = NL80211_CMD_CONNECT,
5372 .doit = nl80211_connect,
5373 .policy = nl80211_policy,
5374 .flags = GENL_ADMIN_PERM,
5377 .cmd = NL80211_CMD_DISCONNECT,
5378 .doit = nl80211_disconnect,
5379 .policy = nl80211_policy,
5380 .flags = GENL_ADMIN_PERM,
5383 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
5384 .doit = nl80211_wiphy_netns,
5385 .policy = nl80211_policy,
5386 .flags = GENL_ADMIN_PERM,
5389 .cmd = NL80211_CMD_GET_SURVEY,
5390 .policy = nl80211_policy,
5391 .dumpit = nl80211_dump_survey,
5394 .cmd = NL80211_CMD_SET_PMKSA,
5395 .doit = nl80211_setdel_pmksa,
5396 .policy = nl80211_policy,
5397 .flags = GENL_ADMIN_PERM,
5400 .cmd = NL80211_CMD_DEL_PMKSA,
5401 .doit = nl80211_setdel_pmksa,
5402 .policy = nl80211_policy,
5403 .flags = GENL_ADMIN_PERM,
5406 .cmd = NL80211_CMD_FLUSH_PMKSA,
5407 .doit = nl80211_flush_pmksa,
5408 .policy = nl80211_policy,
5409 .flags = GENL_ADMIN_PERM,
5412 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
5413 .doit = nl80211_remain_on_channel,
5414 .policy = nl80211_policy,
5415 .flags = GENL_ADMIN_PERM,
5418 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
5419 .doit = nl80211_cancel_remain_on_channel,
5420 .policy = nl80211_policy,
5421 .flags = GENL_ADMIN_PERM,
5424 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
5425 .doit = nl80211_set_tx_bitrate_mask,
5426 .policy = nl80211_policy,
5427 .flags = GENL_ADMIN_PERM,
5430 .cmd = NL80211_CMD_REGISTER_FRAME,
5431 .doit = nl80211_register_mgmt,
5432 .policy = nl80211_policy,
5433 .flags = GENL_ADMIN_PERM,
5436 .cmd = NL80211_CMD_FRAME,
5437 .doit = nl80211_tx_mgmt,
5438 .policy = nl80211_policy,
5439 .flags = GENL_ADMIN_PERM,
5442 .cmd = NL80211_CMD_SET_POWER_SAVE,
5443 .doit = nl80211_set_power_save,
5444 .policy = nl80211_policy,
5445 .flags = GENL_ADMIN_PERM,
5448 .cmd = NL80211_CMD_GET_POWER_SAVE,
5449 .doit = nl80211_get_power_save,
5450 .policy = nl80211_policy,
5451 /* can be retrieved by unprivileged users */
5454 .cmd = NL80211_CMD_SET_CQM,
5455 .doit = nl80211_set_cqm,
5456 .policy = nl80211_policy,
5457 .flags = GENL_ADMIN_PERM,
5460 .cmd = NL80211_CMD_SET_CHANNEL,
5461 .doit = nl80211_set_channel,
5462 .policy = nl80211_policy,
5463 .flags = GENL_ADMIN_PERM,
5467 static struct genl_multicast_group nl80211_mlme_mcgrp = {
5471 /* multicast groups */
5472 static struct genl_multicast_group nl80211_config_mcgrp = {
5475 static struct genl_multicast_group nl80211_scan_mcgrp = {
5478 static struct genl_multicast_group nl80211_regulatory_mcgrp = {
5479 .name = "regulatory",
5482 /* notification functions */
5484 void nl80211_notify_dev_rename(struct cfg80211_registered_device *rdev)
5486 struct sk_buff *msg;
5488 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5492 if (nl80211_send_wiphy(msg, 0, 0, 0, rdev) < 0) {
5497 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5498 nl80211_config_mcgrp.id, GFP_KERNEL);
5501 static int nl80211_add_scan_req(struct sk_buff *msg,
5502 struct cfg80211_registered_device *rdev)
5504 struct cfg80211_scan_request *req = rdev->scan_req;
5505 struct nlattr *nest;
5508 ASSERT_RDEV_LOCK(rdev);
5513 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
5515 goto nla_put_failure;
5516 for (i = 0; i < req->n_ssids; i++)
5517 NLA_PUT(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid);
5518 nla_nest_end(msg, nest);
5520 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
5522 goto nla_put_failure;
5523 for (i = 0; i < req->n_channels; i++)
5524 NLA_PUT_U32(msg, i, req->channels[i]->center_freq);
5525 nla_nest_end(msg, nest);
5528 NLA_PUT(msg, NL80211_ATTR_IE, req->ie_len, req->ie);
5535 static int nl80211_send_scan_msg(struct sk_buff *msg,
5536 struct cfg80211_registered_device *rdev,
5537 struct net_device *netdev,
5538 u32 pid, u32 seq, int flags,
5543 hdr = nl80211hdr_put(msg, pid, seq, flags, cmd);
5547 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5548 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5550 /* ignore errors and send incomplete event anyway */
5551 nl80211_add_scan_req(msg, rdev);
5553 return genlmsg_end(msg, hdr);
5556 genlmsg_cancel(msg, hdr);
5560 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
5561 struct net_device *netdev)
5563 struct sk_buff *msg;
5565 msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
5569 if (nl80211_send_scan_msg(msg, rdev, netdev, 0, 0, 0,
5570 NL80211_CMD_TRIGGER_SCAN) < 0) {
5575 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5576 nl80211_scan_mcgrp.id, GFP_KERNEL);
5579 void nl80211_send_scan_done(struct cfg80211_registered_device *rdev,
5580 struct net_device *netdev)
5582 struct sk_buff *msg;
5584 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5588 if (nl80211_send_scan_msg(msg, rdev, netdev, 0, 0, 0,
5589 NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
5594 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5595 nl80211_scan_mcgrp.id, GFP_KERNEL);
5598 void nl80211_send_scan_aborted(struct cfg80211_registered_device *rdev,
5599 struct net_device *netdev)
5601 struct sk_buff *msg;
5603 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5607 if (nl80211_send_scan_msg(msg, rdev, netdev, 0, 0, 0,
5608 NL80211_CMD_SCAN_ABORTED) < 0) {
5613 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5614 nl80211_scan_mcgrp.id, GFP_KERNEL);
5618 * This can happen on global regulatory changes or device specific settings
5619 * based on custom world regulatory domains.
5621 void nl80211_send_reg_change_event(struct regulatory_request *request)
5623 struct sk_buff *msg;
5626 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5630 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_CHANGE);
5636 /* Userspace can always count this one always being set */
5637 NLA_PUT_U8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator);
5639 if (request->alpha2[0] == '0' && request->alpha2[1] == '0')
5640 NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
5641 NL80211_REGDOM_TYPE_WORLD);
5642 else if (request->alpha2[0] == '9' && request->alpha2[1] == '9')
5643 NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
5644 NL80211_REGDOM_TYPE_CUSTOM_WORLD);
5645 else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
5647 NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
5648 NL80211_REGDOM_TYPE_INTERSECTION);
5650 NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
5651 NL80211_REGDOM_TYPE_COUNTRY);
5652 NLA_PUT_STRING(msg, NL80211_ATTR_REG_ALPHA2, request->alpha2);
5655 if (wiphy_idx_valid(request->wiphy_idx))
5656 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx);
5658 if (genlmsg_end(msg, hdr) < 0) {
5664 genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
5671 genlmsg_cancel(msg, hdr);
5675 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
5676 struct net_device *netdev,
5677 const u8 *buf, size_t len,
5678 enum nl80211_commands cmd, gfp_t gfp)
5680 struct sk_buff *msg;
5683 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
5687 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
5693 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5694 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5695 NLA_PUT(msg, NL80211_ATTR_FRAME, len, buf);
5697 if (genlmsg_end(msg, hdr) < 0) {
5702 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5703 nl80211_mlme_mcgrp.id, gfp);
5707 genlmsg_cancel(msg, hdr);
5711 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
5712 struct net_device *netdev, const u8 *buf,
5713 size_t len, gfp_t gfp)
5715 nl80211_send_mlme_event(rdev, netdev, buf, len,
5716 NL80211_CMD_AUTHENTICATE, gfp);
5719 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
5720 struct net_device *netdev, const u8 *buf,
5721 size_t len, gfp_t gfp)
5723 nl80211_send_mlme_event(rdev, netdev, buf, len,
5724 NL80211_CMD_ASSOCIATE, gfp);
5727 void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
5728 struct net_device *netdev, const u8 *buf,
5729 size_t len, gfp_t gfp)
5731 nl80211_send_mlme_event(rdev, netdev, buf, len,
5732 NL80211_CMD_DEAUTHENTICATE, gfp);
5735 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
5736 struct net_device *netdev, const u8 *buf,
5737 size_t len, gfp_t gfp)
5739 nl80211_send_mlme_event(rdev, netdev, buf, len,
5740 NL80211_CMD_DISASSOCIATE, gfp);
5743 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
5744 struct net_device *netdev, int cmd,
5745 const u8 *addr, gfp_t gfp)
5747 struct sk_buff *msg;
5750 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
5754 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
5760 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5761 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5762 NLA_PUT_FLAG(msg, NL80211_ATTR_TIMED_OUT);
5763 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, addr);
5765 if (genlmsg_end(msg, hdr) < 0) {
5770 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5771 nl80211_mlme_mcgrp.id, gfp);
5775 genlmsg_cancel(msg, hdr);
5779 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
5780 struct net_device *netdev, const u8 *addr,
5783 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
5787 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
5788 struct net_device *netdev, const u8 *addr,
5791 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
5795 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
5796 struct net_device *netdev, const u8 *bssid,
5797 const u8 *req_ie, size_t req_ie_len,
5798 const u8 *resp_ie, size_t resp_ie_len,
5799 u16 status, gfp_t gfp)
5801 struct sk_buff *msg;
5804 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
5808 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
5814 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5815 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5817 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid);
5818 NLA_PUT_U16(msg, NL80211_ATTR_STATUS_CODE, status);
5820 NLA_PUT(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie);
5822 NLA_PUT(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie);
5824 if (genlmsg_end(msg, hdr) < 0) {
5829 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5830 nl80211_mlme_mcgrp.id, gfp);
5834 genlmsg_cancel(msg, hdr);
5839 void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
5840 struct net_device *netdev, const u8 *bssid,
5841 const u8 *req_ie, size_t req_ie_len,
5842 const u8 *resp_ie, size_t resp_ie_len, gfp_t gfp)
5844 struct sk_buff *msg;
5847 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
5851 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
5857 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5858 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5859 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid);
5861 NLA_PUT(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie);
5863 NLA_PUT(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie);
5865 if (genlmsg_end(msg, hdr) < 0) {
5870 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5871 nl80211_mlme_mcgrp.id, gfp);
5875 genlmsg_cancel(msg, hdr);
5880 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
5881 struct net_device *netdev, u16 reason,
5882 const u8 *ie, size_t ie_len, bool from_ap)
5884 struct sk_buff *msg;
5887 msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
5891 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
5897 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5898 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5899 if (from_ap && reason)
5900 NLA_PUT_U16(msg, NL80211_ATTR_REASON_CODE, reason);
5902 NLA_PUT_FLAG(msg, NL80211_ATTR_DISCONNECTED_BY_AP);
5904 NLA_PUT(msg, NL80211_ATTR_IE, ie_len, ie);
5906 if (genlmsg_end(msg, hdr) < 0) {
5911 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5912 nl80211_mlme_mcgrp.id, GFP_KERNEL);
5916 genlmsg_cancel(msg, hdr);
5921 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
5922 struct net_device *netdev, const u8 *bssid,
5925 struct sk_buff *msg;
5928 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
5932 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
5938 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5939 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5940 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid);
5942 if (genlmsg_end(msg, hdr) < 0) {
5947 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5948 nl80211_mlme_mcgrp.id, gfp);
5952 genlmsg_cancel(msg, hdr);
5956 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
5957 struct net_device *netdev, const u8 *addr,
5958 enum nl80211_key_type key_type, int key_id,
5959 const u8 *tsc, gfp_t gfp)
5961 struct sk_buff *msg;
5964 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
5968 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
5974 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
5975 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
5977 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, addr);
5978 NLA_PUT_U32(msg, NL80211_ATTR_KEY_TYPE, key_type);
5979 NLA_PUT_U8(msg, NL80211_ATTR_KEY_IDX, key_id);
5981 NLA_PUT(msg, NL80211_ATTR_KEY_SEQ, 6, tsc);
5983 if (genlmsg_end(msg, hdr) < 0) {
5988 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
5989 nl80211_mlme_mcgrp.id, gfp);
5993 genlmsg_cancel(msg, hdr);
5997 void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
5998 struct ieee80211_channel *channel_before,
5999 struct ieee80211_channel *channel_after)
6001 struct sk_buff *msg;
6003 struct nlattr *nl_freq;
6005 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
6009 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
6016 * Since we are applying the beacon hint to a wiphy we know its
6017 * wiphy_idx is valid
6019 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy));
6022 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
6024 goto nla_put_failure;
6025 if (nl80211_msg_put_channel(msg, channel_before))
6026 goto nla_put_failure;
6027 nla_nest_end(msg, nl_freq);
6030 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
6032 goto nla_put_failure;
6033 if (nl80211_msg_put_channel(msg, channel_after))
6034 goto nla_put_failure;
6035 nla_nest_end(msg, nl_freq);
6037 if (genlmsg_end(msg, hdr) < 0) {
6043 genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
6050 genlmsg_cancel(msg, hdr);
6054 static void nl80211_send_remain_on_chan_event(
6055 int cmd, struct cfg80211_registered_device *rdev,
6056 struct net_device *netdev, u64 cookie,
6057 struct ieee80211_channel *chan,
6058 enum nl80211_channel_type channel_type,
6059 unsigned int duration, gfp_t gfp)
6061 struct sk_buff *msg;
6064 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
6068 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
6074 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
6075 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
6076 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq);
6077 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, channel_type);
6078 NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
6080 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL)
6081 NLA_PUT_U32(msg, NL80211_ATTR_DURATION, duration);
6083 if (genlmsg_end(msg, hdr) < 0) {
6088 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
6089 nl80211_mlme_mcgrp.id, gfp);
6093 genlmsg_cancel(msg, hdr);
6097 void nl80211_send_remain_on_channel(struct cfg80211_registered_device *rdev,
6098 struct net_device *netdev, u64 cookie,
6099 struct ieee80211_channel *chan,
6100 enum nl80211_channel_type channel_type,
6101 unsigned int duration, gfp_t gfp)
6103 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
6104 rdev, netdev, cookie, chan,
6105 channel_type, duration, gfp);
6108 void nl80211_send_remain_on_channel_cancel(
6109 struct cfg80211_registered_device *rdev, struct net_device *netdev,
6110 u64 cookie, struct ieee80211_channel *chan,
6111 enum nl80211_channel_type channel_type, gfp_t gfp)
6113 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
6114 rdev, netdev, cookie, chan,
6115 channel_type, 0, gfp);
6118 void nl80211_send_sta_event(struct cfg80211_registered_device *rdev,
6119 struct net_device *dev, const u8 *mac_addr,
6120 struct station_info *sinfo, gfp_t gfp)
6122 struct sk_buff *msg;
6124 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
6128 if (nl80211_send_station(msg, 0, 0, 0, dev, mac_addr, sinfo) < 0) {
6133 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
6134 nl80211_mlme_mcgrp.id, gfp);
6137 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
6138 struct net_device *netdev, u32 nlpid,
6139 int freq, const u8 *buf, size_t len, gfp_t gfp)
6141 struct sk_buff *msg;
6145 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
6149 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
6155 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
6156 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
6157 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FREQ, freq);
6158 NLA_PUT(msg, NL80211_ATTR_FRAME, len, buf);
6160 err = genlmsg_end(msg, hdr);
6166 err = genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlpid);
6172 genlmsg_cancel(msg, hdr);
6177 void nl80211_send_mgmt_tx_status(struct cfg80211_registered_device *rdev,
6178 struct net_device *netdev, u64 cookie,
6179 const u8 *buf, size_t len, bool ack,
6182 struct sk_buff *msg;
6185 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
6189 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
6195 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
6196 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
6197 NLA_PUT(msg, NL80211_ATTR_FRAME, len, buf);
6198 NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
6200 NLA_PUT_FLAG(msg, NL80211_ATTR_ACK);
6202 if (genlmsg_end(msg, hdr) < 0) {
6207 genlmsg_multicast(msg, 0, nl80211_mlme_mcgrp.id, gfp);
6211 genlmsg_cancel(msg, hdr);
6216 nl80211_send_cqm_rssi_notify(struct cfg80211_registered_device *rdev,
6217 struct net_device *netdev,
6218 enum nl80211_cqm_rssi_threshold_event rssi_event,
6221 struct sk_buff *msg;
6222 struct nlattr *pinfoattr;
6225 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
6229 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
6235 NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
6236 NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
6238 pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
6240 goto nla_put_failure;
6242 NLA_PUT_U32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
6245 nla_nest_end(msg, pinfoattr);
6247 if (genlmsg_end(msg, hdr) < 0) {
6252 genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
6253 nl80211_mlme_mcgrp.id, gfp);
6257 genlmsg_cancel(msg, hdr);
6261 static int nl80211_netlink_notify(struct notifier_block * nb,
6262 unsigned long state,
6265 struct netlink_notify *notify = _notify;
6266 struct cfg80211_registered_device *rdev;
6267 struct wireless_dev *wdev;
6269 if (state != NETLINK_URELEASE)
6274 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list)
6275 list_for_each_entry_rcu(wdev, &rdev->netdev_list, list)
6276 cfg80211_mlme_unregister_socket(wdev, notify->pid);
6283 static struct notifier_block nl80211_netlink_notifier = {
6284 .notifier_call = nl80211_netlink_notify,
6287 /* initialisation/exit functions */
6289 int nl80211_init(void)
6293 err = genl_register_family_with_ops(&nl80211_fam,
6294 nl80211_ops, ARRAY_SIZE(nl80211_ops));
6298 err = genl_register_mc_group(&nl80211_fam, &nl80211_config_mcgrp);
6302 err = genl_register_mc_group(&nl80211_fam, &nl80211_scan_mcgrp);
6306 err = genl_register_mc_group(&nl80211_fam, &nl80211_regulatory_mcgrp);
6310 err = genl_register_mc_group(&nl80211_fam, &nl80211_mlme_mcgrp);
6314 #ifdef CONFIG_NL80211_TESTMODE
6315 err = genl_register_mc_group(&nl80211_fam, &nl80211_testmode_mcgrp);
6320 err = netlink_register_notifier(&nl80211_netlink_notifier);
6326 genl_unregister_family(&nl80211_fam);
6330 void nl80211_exit(void)
6332 netlink_unregister_notifier(&nl80211_netlink_notifier);
6333 genl_unregister_family(&nl80211_fam);