blob: 475d1f5bbe8ffd6199220a98f63ba45843607354 [file] [log] [blame]
Johannes Berg55682962007-09-20 13:09:35 -04001/*
2 * This is the new netlink-based wireless configuration interface.
3 *
Jouni Malinen026331c2010-02-15 12:53:10 +02004 * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net>
Johannes Berg2740f0c2014-09-03 15:24:58 +03005 * Copyright 2013-2014 Intel Mobile Communications GmbH
Beni Lev0c9ca112016-02-17 20:30:00 +02006 * Copyright 2015-2016 Intel Deutschland GmbH
Johannes Berg55682962007-09-20 13:09:35 -04007 */
8
9#include <linux/if.h>
10#include <linux/module.h>
11#include <linux/err.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090012#include <linux/slab.h>
Johannes Berg55682962007-09-20 13:09:35 -040013#include <linux/list.h>
14#include <linux/if_ether.h>
15#include <linux/ieee80211.h>
16#include <linux/nl80211.h>
17#include <linux/rtnetlink.h>
18#include <linux/netlink.h>
Dan Williams0781a502018-01-29 17:03:15 -080019#include <linux/nospec.h>
Johannes Berg2a519312009-02-10 21:25:55 +010020#include <linux/etherdevice.h>
Johannes Berg463d0182009-07-14 00:33:35 +020021#include <net/net_namespace.h>
Johannes Berg55682962007-09-20 13:09:35 -040022#include <net/genetlink.h>
23#include <net/cfg80211.h>
Johannes Berg463d0182009-07-14 00:33:35 +020024#include <net/sock.h>
Johannes Berg2a0e0472013-01-23 22:57:40 +010025#include <net/inet_connection_sock.h>
Johannes Berg55682962007-09-20 13:09:35 -040026#include "core.h"
27#include "nl80211.h"
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -070028#include "reg.h"
Hila Gonene35e4d22012-06-27 17:19:42 +030029#include "rdev-ops.h"
Johannes Berg55682962007-09-20 13:09:35 -040030
Jouni Malinen5fb628e2011-08-10 23:54:35 +030031static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
32 struct genl_info *info,
33 struct cfg80211_crypto_settings *settings,
34 int cipher_limit);
35
Johannes Bergf84f7712013-11-14 17:14:45 +010036static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
Johannes Berg4c476992010-10-04 21:36:35 +020037 struct genl_info *info);
Johannes Bergf84f7712013-11-14 17:14:45 +010038static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
Johannes Berg4c476992010-10-04 21:36:35 +020039 struct genl_info *info);
40
Johannes Berg55682962007-09-20 13:09:35 -040041/* the netlink family */
42static struct genl_family nl80211_fam = {
Marcel Holtmannfb4e1562013-04-28 16:22:06 -070043 .id = GENL_ID_GENERATE, /* don't bother with a hardcoded ID */
44 .name = NL80211_GENL_NAME, /* have users key off the name instead */
45 .hdrsize = 0, /* no private header */
46 .version = 1, /* no particular meaning now */
Johannes Berg55682962007-09-20 13:09:35 -040047 .maxattr = NL80211_ATTR_MAX,
Johannes Berg463d0182009-07-14 00:33:35 +020048 .netnsok = true,
Johannes Berg4c476992010-10-04 21:36:35 +020049 .pre_doit = nl80211_pre_doit,
50 .post_doit = nl80211_post_doit,
Johannes Berg55682962007-09-20 13:09:35 -040051};
52
Johannes Berg2a94fe42013-11-19 15:19:39 +010053/* multicast groups */
54enum nl80211_multicast_groups {
55 NL80211_MCGRP_CONFIG,
56 NL80211_MCGRP_SCAN,
57 NL80211_MCGRP_REGULATORY,
58 NL80211_MCGRP_MLME,
Johannes Berg567ffc32013-12-18 14:43:31 +010059 NL80211_MCGRP_VENDOR,
Ayala Beker50bcd312016-09-20 17:31:17 +030060 NL80211_MCGRP_NAN,
Johannes Berg2a94fe42013-11-19 15:19:39 +010061 NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
62};
63
64static const struct genl_multicast_group nl80211_mcgrps[] = {
Johannes Berg71b836e2014-12-23 17:17:38 +010065 [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
66 [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
67 [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
68 [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
69 [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
Ayala Beker50bcd312016-09-20 17:31:17 +030070 [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
Johannes Berg2a94fe42013-11-19 15:19:39 +010071#ifdef CONFIG_NL80211_TESTMODE
Johannes Berg71b836e2014-12-23 17:17:38 +010072 [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
Johannes Berg2a94fe42013-11-19 15:19:39 +010073#endif
74};
75
Johannes Berg89a54e42012-06-15 14:33:17 +020076/* returns ERR_PTR values */
77static struct wireless_dev *
78__cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
Johannes Berg55682962007-09-20 13:09:35 -040079{
Johannes Berg89a54e42012-06-15 14:33:17 +020080 struct cfg80211_registered_device *rdev;
81 struct wireless_dev *result = NULL;
82 bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
83 bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
84 u64 wdev_id;
85 int wiphy_idx = -1;
86 int ifidx = -1;
Johannes Berg55682962007-09-20 13:09:35 -040087
Johannes Berg5fe231e2013-05-08 21:45:15 +020088 ASSERT_RTNL();
Johannes Berg55682962007-09-20 13:09:35 -040089
Johannes Berg89a54e42012-06-15 14:33:17 +020090 if (!have_ifidx && !have_wdev_id)
91 return ERR_PTR(-EINVAL);
Johannes Berg55682962007-09-20 13:09:35 -040092
Johannes Berg89a54e42012-06-15 14:33:17 +020093 if (have_ifidx)
94 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
95 if (have_wdev_id) {
96 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
97 wiphy_idx = wdev_id >> 32;
Johannes Berg55682962007-09-20 13:09:35 -040098 }
99
Johannes Berg89a54e42012-06-15 14:33:17 +0200100 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
101 struct wireless_dev *wdev;
102
103 if (wiphy_net(&rdev->wiphy) != netns)
104 continue;
105
106 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
107 continue;
108
Johannes Berg53873f12016-05-03 16:52:04 +0300109 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
Johannes Berg89a54e42012-06-15 14:33:17 +0200110 if (have_ifidx && wdev->netdev &&
111 wdev->netdev->ifindex == ifidx) {
112 result = wdev;
113 break;
114 }
115 if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
116 result = wdev;
117 break;
118 }
119 }
Johannes Berg89a54e42012-06-15 14:33:17 +0200120
121 if (result)
122 break;
123 }
124
125 if (result)
126 return result;
127 return ERR_PTR(-ENODEV);
Johannes Berg55682962007-09-20 13:09:35 -0400128}
129
Johannes Berga9455402012-06-15 13:32:49 +0200130static struct cfg80211_registered_device *
Johannes Berg878d9ec2012-06-15 14:18:32 +0200131__cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
Johannes Berga9455402012-06-15 13:32:49 +0200132{
Johannes Berg7fee4772012-06-15 14:09:58 +0200133 struct cfg80211_registered_device *rdev = NULL, *tmp;
134 struct net_device *netdev;
Johannes Berga9455402012-06-15 13:32:49 +0200135
Johannes Berg5fe231e2013-05-08 21:45:15 +0200136 ASSERT_RTNL();
Johannes Berga9455402012-06-15 13:32:49 +0200137
Johannes Berg878d9ec2012-06-15 14:18:32 +0200138 if (!attrs[NL80211_ATTR_WIPHY] &&
Johannes Berg89a54e42012-06-15 14:33:17 +0200139 !attrs[NL80211_ATTR_IFINDEX] &&
140 !attrs[NL80211_ATTR_WDEV])
Johannes Berg7fee4772012-06-15 14:09:58 +0200141 return ERR_PTR(-EINVAL);
142
Johannes Berg878d9ec2012-06-15 14:18:32 +0200143 if (attrs[NL80211_ATTR_WIPHY])
Johannes Berg7fee4772012-06-15 14:09:58 +0200144 rdev = cfg80211_rdev_by_wiphy_idx(
Johannes Berg878d9ec2012-06-15 14:18:32 +0200145 nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
Johannes Berga9455402012-06-15 13:32:49 +0200146
Johannes Berg89a54e42012-06-15 14:33:17 +0200147 if (attrs[NL80211_ATTR_WDEV]) {
148 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
149 struct wireless_dev *wdev;
150 bool found = false;
151
152 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
153 if (tmp) {
154 /* make sure wdev exists */
Johannes Berg53873f12016-05-03 16:52:04 +0300155 list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
Johannes Berg89a54e42012-06-15 14:33:17 +0200156 if (wdev->identifier != (u32)wdev_id)
157 continue;
158 found = true;
159 break;
160 }
Johannes Berg89a54e42012-06-15 14:33:17 +0200161
162 if (!found)
163 tmp = NULL;
164
165 if (rdev && tmp != rdev)
166 return ERR_PTR(-EINVAL);
167 rdev = tmp;
168 }
169 }
170
Johannes Berg878d9ec2012-06-15 14:18:32 +0200171 if (attrs[NL80211_ATTR_IFINDEX]) {
172 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -0700173
Ying Xue7f2b8562014-01-15 10:23:45 +0800174 netdev = __dev_get_by_index(netns, ifindex);
Johannes Berg7fee4772012-06-15 14:09:58 +0200175 if (netdev) {
176 if (netdev->ieee80211_ptr)
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800177 tmp = wiphy_to_rdev(
178 netdev->ieee80211_ptr->wiphy);
Johannes Berg7fee4772012-06-15 14:09:58 +0200179 else
180 tmp = NULL;
181
Johannes Berg7fee4772012-06-15 14:09:58 +0200182 /* not wireless device -- return error */
183 if (!tmp)
184 return ERR_PTR(-EINVAL);
185
186 /* mismatch -- return error */
187 if (rdev && tmp != rdev)
188 return ERR_PTR(-EINVAL);
189
190 rdev = tmp;
Johannes Berga9455402012-06-15 13:32:49 +0200191 }
Johannes Berga9455402012-06-15 13:32:49 +0200192 }
193
Johannes Berg4f7eff12012-06-15 14:14:22 +0200194 if (!rdev)
195 return ERR_PTR(-ENODEV);
Johannes Berga9455402012-06-15 13:32:49 +0200196
Johannes Berg4f7eff12012-06-15 14:14:22 +0200197 if (netns != wiphy_net(&rdev->wiphy))
198 return ERR_PTR(-ENODEV);
199
200 return rdev;
Johannes Berga9455402012-06-15 13:32:49 +0200201}
202
203/*
204 * This function returns a pointer to the driver
205 * that the genl_info item that is passed refers to.
Johannes Berga9455402012-06-15 13:32:49 +0200206 *
207 * The result of this can be a PTR_ERR and hence must
208 * be checked with IS_ERR() for errors.
209 */
210static struct cfg80211_registered_device *
Johannes Berg4f7eff12012-06-15 14:14:22 +0200211cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
Johannes Berga9455402012-06-15 13:32:49 +0200212{
Johannes Berg5fe231e2013-05-08 21:45:15 +0200213 return __cfg80211_rdev_from_attrs(netns, info->attrs);
Johannes Berga9455402012-06-15 13:32:49 +0200214}
215
Johannes Berga873afd2019-09-20 21:54:17 +0200216static int validate_beacon_head(const struct nlattr *attr)
217{
218 const u8 *data = nla_data(attr);
219 unsigned int len = nla_len(attr);
220 const struct element *elem;
221 const struct ieee80211_mgmt *mgmt = (void *)data;
222 unsigned int fixedlen = offsetof(struct ieee80211_mgmt,
223 u.beacon.variable);
224
225 if (len < fixedlen)
226 goto err;
227
228 if (ieee80211_hdrlen(mgmt->frame_control) !=
229 offsetof(struct ieee80211_mgmt, u.beacon))
230 goto err;
231
232 data += fixedlen;
233 len -= fixedlen;
234
235 for_each_element(elem, data, len) {
236 /* nothing */
237 }
238
239 if (for_each_element_completed(elem, data, len))
240 return 0;
241
242err:
243 return -EINVAL;
244}
245
Johannes Berg55682962007-09-20 13:09:35 -0400246/* policy for the attributes */
Luciano Coelho8cd4d452014-09-17 11:55:28 +0300247static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
Johannes Berg55682962007-09-20 13:09:35 -0400248 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
249 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
David S. Miller079e24e2009-05-26 21:15:00 -0700250 .len = 20-1 },
Jouni Malinen31888482008-10-30 16:59:24 +0200251 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
Johannes Berg3d9d1d62012-11-08 23:14:50 +0100252
Jouni Malinen72bdcf32008-11-26 16:15:24 +0200253 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
Sujith094d05d2008-12-12 11:57:43 +0530254 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
Johannes Berg3d9d1d62012-11-08 23:14:50 +0100255 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
256 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
257 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
258
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +0200259 [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
260 [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
261 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
262 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
Lukáš Turek81077e82009-12-21 22:50:47 +0100263 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
Lorenzo Bianconi3057dbf2014-09-04 23:57:40 +0200264 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
Johannes Berg55682962007-09-20 13:09:35 -0400265
266 [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
267 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
268 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
Johannes Berg41ade002007-12-19 02:03:29 +0100269
Eliad Pellere007b852011-11-24 18:13:56 +0200270 [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
271 [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
Johannes Berg41ade002007-12-19 02:03:29 +0100272
Johannes Bergb9454e82009-07-08 13:29:08 +0200273 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
Johannes Berg41ade002007-12-19 02:03:29 +0100274 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
275 .len = WLAN_MAX_KEY_LEN },
276 [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
277 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
278 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
Jouni Malinen81962262011-11-02 23:36:31 +0200279 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
Johannes Berge31b8212010-10-05 19:39:30 +0200280 [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
Johannes Berged1b6cc2007-12-19 02:03:32 +0100281
282 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
283 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
284 [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
285 .len = IEEE80211_MAX_DATA_LEN },
286 [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
287 .len = IEEE80211_MAX_DATA_LEN },
Johannes Berg5727ef12007-12-19 02:03:34 +0100288 [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
289 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
290 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
291 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
292 .len = NL80211_MAX_SUPP_RATES },
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +0100293 [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
Johannes Berg5727ef12007-12-19 02:03:34 +0100294 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
Johannes Berg0a9542e2008-10-15 11:54:04 +0200295 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +0100296 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +0800297 .len = IEEE80211_MAX_MESH_ID_LEN },
Markus Theilee303b82019-10-29 10:30:03 +0100298 [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_BINARY,
299 .len = ETH_ALEN },
Jouni Malinen9f1ba902008-08-07 20:07:01 +0300300
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -0700301 [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
302 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
303
Jouni Malinen9f1ba902008-08-07 20:07:01 +0300304 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
305 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
306 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
Jouni Malinen90c97a02008-10-30 16:59:22 +0200307 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
308 .len = NL80211_MAX_SUPP_RATES },
Helmut Schaa50b12f52010-11-19 12:40:25 +0100309 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
Jouni Malinen36aedc902008-08-25 11:58:58 +0300310
Javier Cardona24bdd9f2010-12-16 17:37:48 -0800311 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
Javier Cardona15d5dda2011-04-07 15:08:28 -0700312 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -0700313
Johannes Berg6c739412011-11-03 09:27:01 +0100314 [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
Jouni Malinen9aed3cc2009-01-13 16:03:29 +0200315
316 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
317 [NL80211_ATTR_IE] = { .type = NLA_BINARY,
318 .len = IEEE80211_MAX_DATA_LEN },
Johannes Berg2a519312009-02-10 21:25:55 +0100319 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
320 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
Jouni Malinen636a5d32009-03-19 13:39:22 +0200321
322 [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
323 .len = IEEE80211_MAX_SSID_LEN },
324 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
325 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
Johannes Berg04a773a2009-04-19 21:24:32 +0200326 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
Jouni Malinen1965c852009-04-22 21:38:25 +0300327 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
Jouni Malinendc6382c2009-05-06 22:09:37 +0300328 [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
Johannes Bergeccb8e82009-05-11 21:57:56 +0300329 [NL80211_ATTR_STA_FLAGS2] = {
330 .len = sizeof(struct nl80211_sta_flag_update),
331 },
Jouni Malinen3f77316c2009-05-11 21:57:57 +0300332 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
Johannes Bergc0692b82010-08-27 14:26:53 +0300333 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
334 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
Samuel Ortizb23aa672009-07-01 21:26:54 +0200335 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
Sergey Matyukevich4d284a72020-02-13 13:16:16 +0000336 [NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 },
Samuel Ortizb23aa672009-07-01 21:26:54 +0200337 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
338 [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
Johannes Berg463d0182009-07-14 00:33:35 +0200339 [NL80211_ATTR_PID] = { .type = NLA_U32 },
Felix Fietkau8b787642009-11-10 18:53:10 +0100340 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
Srinivas Dasari7e9e9632017-07-07 01:43:39 +0300341 [NL80211_ATTR_PMKID] = { .len = WLAN_PMKID_LEN },
Jouni Malinen9588bbd2009-12-23 13:15:41 +0100342 [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
343 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
Jouni Malinen13ae75b2009-12-29 12:59:45 +0200344 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
Jouni Malinen026331c2010-02-15 12:53:10 +0200345 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
346 .len = IEEE80211_MAX_DATA_LEN },
347 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
Kalle Valoffb9eb32010-02-17 17:58:10 +0200348 [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +0200349 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
Jouni Malinend5cdfac2010-04-04 09:37:19 +0300350 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
Felix Fietkaufd8aaaf2010-04-27 01:23:35 +0200351 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +0300352 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
353 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
Johannes Berg2e161f72010-08-12 15:38:38 +0200354 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
Bruno Randolfafe0cbf2010-11-10 12:50:50 +0900355 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
356 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
Felix Fietkau885a46d2010-11-11 15:07:22 +0100357 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
Johannes Bergf7ca38d2010-11-25 10:02:29 +0100358 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100359 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
Johannes Bergff1b6e62011-05-04 15:37:28 +0200360 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
Javier Cardona9c3990a2011-05-03 16:57:11 -0700361 [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
Jakub Kicinski0a626cd2020-03-02 21:10:57 -0800362 [NL80211_ATTR_MEASUREMENT_DURATION] = { .type = NLA_U16 },
363 [NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY] = { .type = NLA_FLAG },
Luciano Coelhobbe6ad62011-05-11 17:09:37 +0300364 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
Johannes Berge5497d72011-07-05 16:35:40 +0200365 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
Johannes Berg34850ab2011-07-18 18:08:35 +0200366 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
Jouni Malinen32e9de82011-08-10 23:53:31 +0300367 [NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
Jouni Malinen9946ecf2011-08-10 23:55:56 +0300368 [NL80211_ATTR_IE_PROBE_RESP] = { .type = NLA_BINARY,
369 .len = IEEE80211_MAX_DATA_LEN },
370 [NL80211_ATTR_IE_ASSOC_RESP] = { .type = NLA_BINARY,
371 .len = IEEE80211_MAX_DATA_LEN },
Vivek Natarajanf4b34b52011-08-29 14:23:03 +0530372 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
Luciano Coelhoa1f1c212011-08-31 16:01:48 +0300373 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
Rajkumar Manoharane9f935e2011-09-25 14:53:30 +0530374 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
Arik Nemtsov109086c2011-09-28 14:12:50 +0300375 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
376 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
377 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
378 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
379 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
Arik Nemtsov31fa97c2014-06-11 17:18:21 +0300380 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
Johannes Berge247bd902011-11-04 11:18:21 +0100381 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
Arik Nemtsov00f740e2011-11-10 11:28:56 +0200382 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
383 .len = IEEE80211_MAX_DATA_LEN },
Luis R. Rodriguez8b60b072011-10-11 10:59:02 -0700384 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
Ben Greear7e7c8922011-11-18 11:31:59 -0800385 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
386 [NL80211_ATTR_HT_CAPABILITY_MASK] = {
387 .len = NL80211_HT_CAPABILITY_LEN
388 },
Simon Wunderlich1d9d9212011-11-18 14:20:43 +0100389 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
Vasanthakumar Thiagarajan1b658f12012-03-02 15:50:02 +0530390 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
Bala Shanmugam4486ea92012-03-07 17:27:12 +0530391 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
Johannes Berg89a54e42012-06-15 14:33:17 +0200392 [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
Luis R. Rodriguez57b5ce02012-07-12 11:49:18 -0700393 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
Jouni Malinen3255b4a2016-10-27 00:41:58 +0300394 [NL80211_ATTR_AUTH_DATA] = { .type = NLA_BINARY, },
Mahesh Palivelaf461be3e2012-10-11 08:04:52 +0000395 [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
Sam Lefflered4737712012-10-11 21:03:31 -0700396 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
Johannes Berg53cabad2012-11-14 15:17:28 +0100397 [NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
398 [NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
Srinivas Dasarib68aa7d2017-07-07 01:43:41 +0300399 [NL80211_ATTR_LOCAL_MESH_POWER_MODE] = {. type = NLA_U32 },
Vasanthakumar Thiagarajan77765ea2013-01-18 11:18:45 +0530400 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
401 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
Jouni Malinen9d62a982013-02-14 21:10:13 +0200402 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
403 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
Johannes Berg3713b4e2013-02-14 16:19:38 +0100404 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
Johannes Bergee2aca32013-02-21 17:36:01 +0100405 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
406 [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
407 .len = NL80211_VHT_CAPABILITY_LEN,
408 },
Jouni Malinen355199e2013-02-27 17:14:27 +0200409 [NL80211_ATTR_MDID] = { .type = NLA_U16 },
410 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
411 .len = IEEE80211_MAX_DATA_LEN },
Jakub Kicinskid4ffeaf2020-03-02 21:10:56 -0800412 [NL80211_ATTR_CRIT_PROT_ID] = { .type = NLA_U16 },
413 [NL80211_ATTR_MAX_CRIT_PROT_DURATION] = { .type = NLA_U16 },
Jouni Malinen5e4b6f52013-05-16 20:11:08 +0300414 [NL80211_ATTR_PEER_AID] = { .type = NLA_U16 },
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +0200415 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
416 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
417 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +0300418 [NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
419 [NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
Sunil Duttc01fc9a2013-10-09 20:45:21 +0530420 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
421 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
Simon Wunderlich5336fa82013-10-07 18:41:05 +0200422 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
Marek Kwaczynski60f4a7b2013-12-03 10:04:59 +0100423 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
Johannes Bergad7e7182013-11-13 13:37:47 +0100424 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
425 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
426 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
Kyeyoon Parkfa9ffc72013-12-16 23:01:30 -0800427 [NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
428 .len = IEEE80211_QOS_MAP_LEN_MAX },
Jouni Malinen1df4a512014-01-15 00:00:47 +0200429 [NL80211_ATTR_MAC_HINT] = { .len = ETH_ALEN },
430 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
Sunil Dutt Undekaridf942e72014-02-20 16:22:09 +0530431 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
Jukka Rissanen18e5ca62014-11-13 17:25:14 +0200432 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
Andrei Otcheretianski34d22ce2014-05-09 14:11:44 +0300433 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
Assaf Kraussbab5ab72014-09-03 15:25:01 +0300434 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
Johannes Berg960d01a2014-09-09 22:55:35 +0300435 [NL80211_ATTR_TSID] = { .type = NLA_U8 },
436 [NL80211_ATTR_USER_PRIO] = { .type = NLA_U8 },
437 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
Eliad Peller18998c32014-09-10 14:07:34 +0300438 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
Jakub Kicinski85a7e732020-03-02 21:10:58 -0800439 [NL80211_ATTR_OPER_CLASS] = { .type = NLA_U8 },
Johannes Bergad2b26a2014-06-12 21:39:05 +0200440 [NL80211_ATTR_MAC_MASK] = { .len = ETH_ALEN },
Arik Nemtsov1bdd7162014-12-15 19:26:01 +0200441 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
Vadim Kochan4b681c82015-01-12 16:34:05 +0200442 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
Luciano Coelho9c748932015-01-16 16:04:09 +0200443 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
Ilan peer05050752015-03-04 00:32:06 -0500444 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
Lior David34d50512016-01-28 10:58:25 +0200445 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
Arend van Spriel38de03d2016-03-02 20:37:18 +0100446 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
Ayala Beker17b94242016-03-17 15:41:38 +0200447 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = { .type = NLA_U8 },
Aviya Erenfeldc6e6a0c2016-07-05 15:23:08 +0300448 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
449 .len = VHT_MUMIMO_GROUPS_DATA_LEN
450 },
451 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = { .len = ETH_ALEN },
Ayala Bekercb3b7d82016-09-20 17:31:13 +0300452 [NL80211_ATTR_NAN_MASTER_PREF] = { .type = NLA_U8 },
453 [NL80211_ATTR_NAN_DUAL] = { .type = NLA_U8 },
Ayala Bekera442b762016-09-20 17:31:15 +0300454 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
Jouni Malinenc9a63622016-10-27 00:42:03 +0300455 [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
456 .len = FILS_MAX_KEK_LEN },
457 [NL80211_ATTR_FILS_NONCES] = { .len = 2 * FILS_NONCE_LEN },
Michael Braund757efc2016-10-10 19:12:22 +0200458 [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
Vamsi Krishna45816392016-12-02 23:59:08 +0200459 [NL80211_ATTR_BSSID] = { .len = ETH_ALEN },
vamsi krishnaf4f1a542017-01-13 01:12:20 +0200460 [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
461 [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
462 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
463 },
Purushottam Kushwahadf935062017-01-13 01:12:21 +0200464 [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
Vidyullatha Kanchanapally36eabf62017-03-31 00:22:34 +0300465 [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
466 .len = FILS_ERP_MAX_USERNAME_LEN },
467 [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
468 .len = FILS_ERP_MAX_REALM_LEN },
469 [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
470 [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
471 .len = FILS_ERP_MAX_RRK_LEN },
472 [NL80211_ATTR_FILS_CACHE_ID] = { .len = 2 },
473 [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
Srinivas Dasarid041a1a2018-02-07 18:32:17 +0530474 [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG },
Johannes Berg55682962007-09-20 13:09:35 -0400475};
476
Johannes Berge31b8212010-10-05 19:39:30 +0200477/* policy for the key attributes */
Alexey Dobriyanb54452b2010-02-18 08:14:31 +0000478static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
Johannes Bergfffd0932009-07-08 14:22:54 +0200479 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
Johannes Bergb9454e82009-07-08 13:29:08 +0200480 [NL80211_KEY_IDX] = { .type = NLA_U8 },
481 [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
Jouni Malinen81962262011-11-02 23:36:31 +0200482 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
Johannes Bergb9454e82009-07-08 13:29:08 +0200483 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
484 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
Johannes Berge31b8212010-10-05 19:39:30 +0200485 [NL80211_KEY_TYPE] = { .type = NLA_U32 },
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100486 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
487};
488
489/* policy for the key default flags */
490static const struct nla_policy
491nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
492 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
493 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
Johannes Bergb9454e82009-07-08 13:29:08 +0200494};
495
Johannes Bergff1b6e62011-05-04 15:37:28 +0200496/* policy for WoWLAN attributes */
497static const struct nla_policy
498nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
499 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
500 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
501 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
502 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
Johannes Berg77dbbb12011-07-13 10:48:55 +0200503 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
504 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
505 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
506 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
Johannes Berg2a0e0472013-01-23 22:57:40 +0100507 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
Luciano Coelho8cd4d452014-09-17 11:55:28 +0300508 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
Johannes Berg2a0e0472013-01-23 22:57:40 +0100509};
510
511static const struct nla_policy
512nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
513 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
514 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
515 [NL80211_WOWLAN_TCP_DST_MAC] = { .len = ETH_ALEN },
516 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
517 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
518 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .len = 1 },
519 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
520 .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
521 },
522 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
523 .len = sizeof(struct nl80211_wowlan_tcp_data_token)
524 },
525 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
526 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .len = 1 },
527 [NL80211_WOWLAN_TCP_WAKE_MASK] = { .len = 1 },
Johannes Bergff1b6e62011-05-04 15:37:28 +0200528};
529
Amitkumar Karwarbe29b992013-06-28 11:51:26 -0700530/* policy for coalesce rule attributes */
531static const struct nla_policy
532nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
533 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
534 [NL80211_ATTR_COALESCE_RULE_CONDITION] = { .type = NLA_U32 },
535 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
536};
537
Johannes Berge5497d72011-07-05 16:35:40 +0200538/* policy for GTK rekey offload attributes */
539static const struct nla_policy
540nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
Vidyullatha Kanchanapally84aa3ba2017-05-25 20:20:41 +0530541 [NL80211_REKEY_DATA_KEK] = { .type = NLA_BINARY,
542 .len = FILS_MAX_KEK_LEN },
Johannes Berge5497d72011-07-05 16:35:40 +0200543 [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
544 [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
545};
546
Luciano Coelhoa1f1c212011-08-31 16:01:48 +0300547static const struct nla_policy
548nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
Johannes Berg4a4ab0d2012-06-13 11:17:11 +0200549 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
Luciano Coelhoa1f1c212011-08-31 16:01:48 +0300550 .len = IEEE80211_MAX_SSID_LEN },
Thomas Pedersen88e920b2012-06-21 11:09:54 -0700551 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
Luciano Coelhoa1f1c212011-08-31 16:01:48 +0300552};
553
Avraham Stern3b06d272015-10-12 09:51:34 +0300554static const struct nla_policy
555nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
556 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
557 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
558};
559
Arend van Spriel38de03d2016-03-02 20:37:18 +0100560static const struct nla_policy
561nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
562 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
563 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
564 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
565 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
566 },
567};
568
Ayala Bekera442b762016-09-20 17:31:15 +0300569/* policy for NAN function attributes */
570static const struct nla_policy
571nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
572 [NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
Srinivas Dasari6a90f812017-07-07 01:43:40 +0300573 [NL80211_NAN_FUNC_SERVICE_ID] = {
Ayala Bekera442b762016-09-20 17:31:15 +0300574 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
575 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
576 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
577 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
578 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
579 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
580 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = { .len = ETH_ALEN },
581 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
582 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
583 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
584 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
585 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
586 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
587 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
588 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
589 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
590};
591
592/* policy for Service Response Filter attributes */
593static const struct nla_policy
594nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
595 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
596 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
597 .len = NL80211_NAN_FUNC_SRF_MAX_LEN },
598 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
599 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
600};
601
Peng Xu4ec90fd2017-10-10 13:56:53 -0700602/* policy for packet pattern attributes */
603static const struct nla_policy
604nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
605 [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
606 [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
607 [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
608};
609
Johannes Berg97990a02013-04-19 01:02:55 +0200610static int nl80211_prepare_wdev_dump(struct sk_buff *skb,
611 struct netlink_callback *cb,
612 struct cfg80211_registered_device **rdev,
613 struct wireless_dev **wdev)
Holger Schuriga0438972009-11-11 11:30:02 +0100614{
Johannes Berg67748892010-10-04 21:14:06 +0200615 int err;
616
Johannes Berg97990a02013-04-19 01:02:55 +0200617 if (!cb->args[0]) {
618 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
619 nl80211_fam.attrbuf, nl80211_fam.maxattr,
620 nl80211_policy);
621 if (err)
Johannes Berg56769e72017-03-15 14:26:04 +0100622 return err;
Johannes Berg97990a02013-04-19 01:02:55 +0200623
624 *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk),
625 nl80211_fam.attrbuf);
Johannes Berg56769e72017-03-15 14:26:04 +0100626 if (IS_ERR(*wdev))
627 return PTR_ERR(*wdev);
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800628 *rdev = wiphy_to_rdev((*wdev)->wiphy);
Johannes Bergc319d502013-07-30 22:34:28 +0200629 /* 0 is the first index - add 1 to parse only once */
630 cb->args[0] = (*rdev)->wiphy_idx + 1;
Johannes Berg97990a02013-04-19 01:02:55 +0200631 cb->args[1] = (*wdev)->identifier;
632 } else {
Johannes Bergc319d502013-07-30 22:34:28 +0200633 /* subtract the 1 again here */
634 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
Johannes Berg97990a02013-04-19 01:02:55 +0200635 struct wireless_dev *tmp;
636
Johannes Berg56769e72017-03-15 14:26:04 +0100637 if (!wiphy)
638 return -ENODEV;
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800639 *rdev = wiphy_to_rdev(wiphy);
Johannes Berg97990a02013-04-19 01:02:55 +0200640 *wdev = NULL;
641
Johannes Berg53873f12016-05-03 16:52:04 +0300642 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
Johannes Berg97990a02013-04-19 01:02:55 +0200643 if (tmp->identifier == cb->args[1]) {
644 *wdev = tmp;
645 break;
646 }
647 }
Johannes Berg97990a02013-04-19 01:02:55 +0200648
Johannes Berg56769e72017-03-15 14:26:04 +0100649 if (!*wdev)
650 return -ENODEV;
Johannes Berg67748892010-10-04 21:14:06 +0200651 }
652
Johannes Berg67748892010-10-04 21:14:06 +0200653 return 0;
Johannes Berg67748892010-10-04 21:14:06 +0200654}
655
Johannes Bergf4a11bb2009-03-27 12:40:28 +0100656/* IE validation */
657static bool is_valid_ie_attr(const struct nlattr *attr)
658{
659 const u8 *pos;
660 int len;
661
662 if (!attr)
663 return true;
664
665 pos = nla_data(attr);
666 len = nla_len(attr);
667
668 while (len) {
669 u8 elemlen;
670
671 if (len < 2)
672 return false;
673 len -= 2;
674
675 elemlen = pos[1];
676 if (elemlen > len)
677 return false;
678
679 len -= elemlen;
680 pos += 2 + elemlen;
681 }
682
683 return true;
684}
685
Johannes Berg55682962007-09-20 13:09:35 -0400686/* message building helper */
Eric W. Biederman15e47302012-09-07 20:12:54 +0000687static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
Johannes Berg55682962007-09-20 13:09:35 -0400688 int flags, u8 cmd)
689{
690 /* since there is no private header just add the generic one */
Eric W. Biederman15e47302012-09-07 20:12:54 +0000691 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
Johannes Berg55682962007-09-20 13:09:35 -0400692}
693
Luis R. Rodriguez5dab3b82009-04-02 14:08:08 -0400694static int nl80211_msg_put_channel(struct sk_buff *msg,
Johannes Bergcdc89b92013-02-18 23:54:36 +0100695 struct ieee80211_channel *chan,
696 bool large)
Luis R. Rodriguez5dab3b82009-04-02 14:08:08 -0400697{
Rostislav Lisovyea077c12014-04-15 14:37:55 +0200698 /* Some channels must be completely excluded from the
699 * list to protect old user-space tools from breaking
700 */
701 if (!large && chan->flags &
702 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
703 return 0;
704
David S. Miller9360ffd2012-03-29 04:41:26 -0400705 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
706 chan->center_freq))
707 goto nla_put_failure;
Luis R. Rodriguez5dab3b82009-04-02 14:08:08 -0400708
David S. Miller9360ffd2012-03-29 04:41:26 -0400709 if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
710 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
711 goto nla_put_failure;
Luis R. Rodriguez8fe02e12013-10-21 19:22:25 +0200712 if (chan->flags & IEEE80211_CHAN_NO_IR) {
713 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
714 goto nla_put_failure;
715 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
716 goto nla_put_failure;
717 }
Johannes Bergcdc89b92013-02-18 23:54:36 +0100718 if (chan->flags & IEEE80211_CHAN_RADAR) {
719 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
720 goto nla_put_failure;
721 if (large) {
722 u32 time;
723
724 time = elapsed_jiffies_msecs(chan->dfs_state_entered);
725
726 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
727 chan->dfs_state))
728 goto nla_put_failure;
729 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
730 time))
731 goto nla_put_failure;
Janusz Dziedzic089027e2014-02-21 19:46:12 +0100732 if (nla_put_u32(msg,
733 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
734 chan->dfs_cac_ms))
735 goto nla_put_failure;
Johannes Bergcdc89b92013-02-18 23:54:36 +0100736 }
737 }
Luis R. Rodriguez5dab3b82009-04-02 14:08:08 -0400738
Johannes Bergfe1abaf2013-02-27 15:39:45 +0100739 if (large) {
740 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
741 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
742 goto nla_put_failure;
743 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
744 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
745 goto nla_put_failure;
746 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
747 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
748 goto nla_put_failure;
749 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
750 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
751 goto nla_put_failure;
David Spinadel570dbde2014-02-23 09:12:59 +0200752 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
753 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
754 goto nla_put_failure;
Arik Nemtsov06f207f2015-05-06 16:28:31 +0300755 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
756 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
David Spinadel570dbde2014-02-23 09:12:59 +0200757 goto nla_put_failure;
Rostislav Lisovyea077c12014-04-15 14:37:55 +0200758 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
759 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
760 goto nla_put_failure;
761 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
762 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
763 goto nla_put_failure;
Johannes Bergfe1abaf2013-02-27 15:39:45 +0100764 }
765
David S. Miller9360ffd2012-03-29 04:41:26 -0400766 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
767 DBM_TO_MBM(chan->max_power)))
768 goto nla_put_failure;
Luis R. Rodriguez5dab3b82009-04-02 14:08:08 -0400769
770 return 0;
771
772 nla_put_failure:
773 return -ENOBUFS;
774}
775
Johannes Berg55682962007-09-20 13:09:35 -0400776/* netlink command implementations */
777
Johannes Bergb9454e82009-07-08 13:29:08 +0200778struct key_parse {
779 struct key_params p;
780 int idx;
Johannes Berge31b8212010-10-05 19:39:30 +0200781 int type;
Jouni Malinena2be0702020-03-27 18:20:31 +0530782 bool def, defmgmt, defbeacon;
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100783 bool def_uni, def_multi;
Johannes Bergb9454e82009-07-08 13:29:08 +0200784};
785
786static int nl80211_parse_key_new(struct nlattr *key, struct key_parse *k)
787{
788 struct nlattr *tb[NL80211_KEY_MAX + 1];
789 int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
790 nl80211_key_policy);
791 if (err)
792 return err;
793
794 k->def = !!tb[NL80211_KEY_DEFAULT];
795 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
Jouni Malinena2be0702020-03-27 18:20:31 +0530796 k->defbeacon = !!tb[NL80211_KEY_DEFAULT_BEACON];
Johannes Bergb9454e82009-07-08 13:29:08 +0200797
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100798 if (k->def) {
799 k->def_uni = true;
800 k->def_multi = true;
801 }
Jouni Malinena2be0702020-03-27 18:20:31 +0530802 if (k->defmgmt || k->defbeacon)
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100803 k->def_multi = true;
804
Johannes Bergb9454e82009-07-08 13:29:08 +0200805 if (tb[NL80211_KEY_IDX])
806 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
807
808 if (tb[NL80211_KEY_DATA]) {
809 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
810 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
811 }
812
813 if (tb[NL80211_KEY_SEQ]) {
814 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
815 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
816 }
817
818 if (tb[NL80211_KEY_CIPHER])
819 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
820
Johannes Berge31b8212010-10-05 19:39:30 +0200821 if (tb[NL80211_KEY_TYPE]) {
822 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
823 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
824 return -EINVAL;
825 }
826
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100827 if (tb[NL80211_KEY_DEFAULT_TYPES]) {
828 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -0700829
Johannes Berg2da8f412012-01-20 13:52:37 +0100830 err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
831 tb[NL80211_KEY_DEFAULT_TYPES],
832 nl80211_key_default_policy);
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100833 if (err)
834 return err;
835
836 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
837 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
838 }
839
Johannes Bergb9454e82009-07-08 13:29:08 +0200840 return 0;
841}
842
843static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
844{
845 if (info->attrs[NL80211_ATTR_KEY_DATA]) {
846 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
847 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
848 }
849
850 if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
851 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
852 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
853 }
854
855 if (info->attrs[NL80211_ATTR_KEY_IDX])
856 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
857
858 if (info->attrs[NL80211_ATTR_KEY_CIPHER])
859 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
860
861 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
862 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
863
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100864 if (k->def) {
865 k->def_uni = true;
866 k->def_multi = true;
867 }
868 if (k->defmgmt)
869 k->def_multi = true;
870
Johannes Berge31b8212010-10-05 19:39:30 +0200871 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
872 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
873 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
874 return -EINVAL;
875 }
876
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100877 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
878 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
879 int err = nla_parse_nested(
880 kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
881 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
882 nl80211_key_default_policy);
883 if (err)
884 return err;
885
886 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
887 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
888 }
889
Johannes Bergb9454e82009-07-08 13:29:08 +0200890 return 0;
891}
892
893static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
894{
895 int err;
896
897 memset(k, 0, sizeof(*k));
898 k->idx = -1;
Johannes Berge31b8212010-10-05 19:39:30 +0200899 k->type = -1;
Johannes Bergb9454e82009-07-08 13:29:08 +0200900
901 if (info->attrs[NL80211_ATTR_KEY])
902 err = nl80211_parse_key_new(info->attrs[NL80211_ATTR_KEY], k);
903 else
904 err = nl80211_parse_key_old(info, k);
905
906 if (err)
907 return err;
908
Jouni Malinena2be0702020-03-27 18:20:31 +0530909 if ((k->def ? 1 : 0) + (k->defmgmt ? 1 : 0) +
910 (k->defbeacon ? 1 : 0) > 1)
Johannes Bergb9454e82009-07-08 13:29:08 +0200911 return -EINVAL;
912
Jouni Malinena2be0702020-03-27 18:20:31 +0530913 if (k->defmgmt || k->defbeacon) {
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100914 if (k->def_uni || !k->def_multi)
915 return -EINVAL;
916 }
917
Johannes Bergb9454e82009-07-08 13:29:08 +0200918 if (k->idx != -1) {
919 if (k->defmgmt) {
920 if (k->idx < 4 || k->idx > 5)
921 return -EINVAL;
Jouni Malinena2be0702020-03-27 18:20:31 +0530922 } else if (k->defbeacon) {
923 if (k->idx < 6 || k->idx > 7)
924 return -EINVAL;
Johannes Bergb9454e82009-07-08 13:29:08 +0200925 } else if (k->def) {
926 if (k->idx < 0 || k->idx > 3)
927 return -EINVAL;
928 } else {
Jouni Malinena2be0702020-03-27 18:20:31 +0530929 if (k->idx < 0 || k->idx > 7)
Johannes Bergb9454e82009-07-08 13:29:08 +0200930 return -EINVAL;
931 }
932 }
933
934 return 0;
935}
936
Johannes Bergfffd0932009-07-08 14:22:54 +0200937static struct cfg80211_cached_keys *
938nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
Sujith Manoharande7044e2012-10-18 10:19:28 +0530939 struct nlattr *keys, bool *no_ht)
Johannes Bergfffd0932009-07-08 14:22:54 +0200940{
941 struct key_parse parse;
942 struct nlattr *key;
943 struct cfg80211_cached_keys *result;
944 int rem, err, def = 0;
Johannes Bergf1c1f172016-09-13 17:08:23 +0200945 bool have_key = false;
946
947 nla_for_each_nested(key, keys, rem) {
948 have_key = true;
949 break;
950 }
951
952 if (!have_key)
953 return NULL;
Johannes Bergfffd0932009-07-08 14:22:54 +0200954
955 result = kzalloc(sizeof(*result), GFP_KERNEL);
956 if (!result)
957 return ERR_PTR(-ENOMEM);
958
959 result->def = -1;
Johannes Bergfffd0932009-07-08 14:22:54 +0200960
961 nla_for_each_nested(key, keys, rem) {
962 memset(&parse, 0, sizeof(parse));
963 parse.idx = -1;
964
965 err = nl80211_parse_key_new(key, &parse);
966 if (err)
967 goto error;
968 err = -EINVAL;
969 if (!parse.p.key)
970 goto error;
Johannes Berg42ee2312016-09-13 15:51:03 +0200971 if (parse.idx < 0 || parse.idx > 3)
Johannes Bergfffd0932009-07-08 14:22:54 +0200972 goto error;
973 if (parse.def) {
974 if (def)
975 goto error;
976 def = 1;
977 result->def = parse.idx;
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100978 if (!parse.def_uni || !parse.def_multi)
979 goto error;
Johannes Bergfffd0932009-07-08 14:22:54 +0200980 } else if (parse.defmgmt)
981 goto error;
982 err = cfg80211_validate_key_settings(rdev, &parse.p,
Johannes Berge31b8212010-10-05 19:39:30 +0200983 parse.idx, false, NULL);
Johannes Bergfffd0932009-07-08 14:22:54 +0200984 if (err)
985 goto error;
Johannes Berg386b1f22016-09-13 16:10:02 +0200986 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
987 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
988 err = -EINVAL;
989 goto error;
990 }
Johannes Bergfffd0932009-07-08 14:22:54 +0200991 result->params[parse.idx].cipher = parse.p.cipher;
992 result->params[parse.idx].key_len = parse.p.key_len;
993 result->params[parse.idx].key = result->data[parse.idx];
994 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
Sujith Manoharande7044e2012-10-18 10:19:28 +0530995
Johannes Berg386b1f22016-09-13 16:10:02 +0200996 /* must be WEP key if we got here */
997 if (no_ht)
998 *no_ht = true;
Johannes Bergfffd0932009-07-08 14:22:54 +0200999 }
1000
Johannes Bergf1c1f172016-09-13 17:08:23 +02001001 if (result->def < 0) {
1002 err = -EINVAL;
1003 goto error;
1004 }
1005
Johannes Bergfffd0932009-07-08 14:22:54 +02001006 return result;
1007 error:
1008 kfree(result);
1009 return ERR_PTR(err);
1010}
1011
1012static int nl80211_key_allowed(struct wireless_dev *wdev)
1013{
1014 ASSERT_WDEV_LOCK(wdev);
1015
Johannes Bergfffd0932009-07-08 14:22:54 +02001016 switch (wdev->iftype) {
1017 case NL80211_IFTYPE_AP:
1018 case NL80211_IFTYPE_AP_VLAN:
Johannes Berg074ac8d2010-09-16 14:58:22 +02001019 case NL80211_IFTYPE_P2P_GO:
Thomas Pedersenff973af2011-05-03 16:57:12 -07001020 case NL80211_IFTYPE_MESH_POINT:
Johannes Bergfffd0932009-07-08 14:22:54 +02001021 break;
1022 case NL80211_IFTYPE_ADHOC:
Johannes Bergfffd0932009-07-08 14:22:54 +02001023 case NL80211_IFTYPE_STATION:
Johannes Berg074ac8d2010-09-16 14:58:22 +02001024 case NL80211_IFTYPE_P2P_CLIENT:
Johannes Bergceca7b72013-05-16 00:55:45 +02001025 if (!wdev->current_bss)
Johannes Bergfffd0932009-07-08 14:22:54 +02001026 return -ENOLINK;
1027 break;
Johannes Bergde4fcba2014-10-31 14:16:12 +01001028 case NL80211_IFTYPE_UNSPECIFIED:
Rostislav Lisovy6e0bd6c2014-11-03 10:33:18 +01001029 case NL80211_IFTYPE_OCB:
Johannes Bergde4fcba2014-10-31 14:16:12 +01001030 case NL80211_IFTYPE_MONITOR:
Ayala Bekercb3b7d82016-09-20 17:31:13 +03001031 case NL80211_IFTYPE_NAN:
Johannes Bergde4fcba2014-10-31 14:16:12 +01001032 case NL80211_IFTYPE_P2P_DEVICE:
1033 case NL80211_IFTYPE_WDS:
1034 case NUM_NL80211_IFTYPES:
Johannes Bergfffd0932009-07-08 14:22:54 +02001035 return -EINVAL;
1036 }
1037
1038 return 0;
1039}
1040
Jouni Malinen664834d2014-01-15 00:01:44 +02001041static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
1042 struct nlattr *tb)
1043{
1044 struct ieee80211_channel *chan;
1045
1046 if (tb == NULL)
1047 return NULL;
1048 chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
1049 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
1050 return NULL;
1051 return chan;
1052}
1053
Johannes Berg7527a782011-05-13 10:58:57 +02001054static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
1055{
1056 struct nlattr *nl_modes = nla_nest_start(msg, attr);
1057 int i;
1058
1059 if (!nl_modes)
1060 goto nla_put_failure;
1061
1062 i = 0;
1063 while (ifmodes) {
David S. Miller9360ffd2012-03-29 04:41:26 -04001064 if ((ifmodes & 1) && nla_put_flag(msg, i))
1065 goto nla_put_failure;
Johannes Berg7527a782011-05-13 10:58:57 +02001066 ifmodes >>= 1;
1067 i++;
1068 }
1069
1070 nla_nest_end(msg, nl_modes);
1071 return 0;
1072
1073nla_put_failure:
1074 return -ENOBUFS;
1075}
1076
1077static int nl80211_put_iface_combinations(struct wiphy *wiphy,
Johannes Bergcdc89b92013-02-18 23:54:36 +01001078 struct sk_buff *msg,
1079 bool large)
Johannes Berg7527a782011-05-13 10:58:57 +02001080{
1081 struct nlattr *nl_combis;
1082 int i, j;
1083
1084 nl_combis = nla_nest_start(msg,
1085 NL80211_ATTR_INTERFACE_COMBINATIONS);
1086 if (!nl_combis)
1087 goto nla_put_failure;
1088
1089 for (i = 0; i < wiphy->n_iface_combinations; i++) {
1090 const struct ieee80211_iface_combination *c;
1091 struct nlattr *nl_combi, *nl_limits;
1092
1093 c = &wiphy->iface_combinations[i];
1094
1095 nl_combi = nla_nest_start(msg, i + 1);
1096 if (!nl_combi)
1097 goto nla_put_failure;
1098
1099 nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
1100 if (!nl_limits)
1101 goto nla_put_failure;
1102
1103 for (j = 0; j < c->n_limits; j++) {
1104 struct nlattr *nl_limit;
1105
1106 nl_limit = nla_nest_start(msg, j + 1);
1107 if (!nl_limit)
1108 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -04001109 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
1110 c->limits[j].max))
1111 goto nla_put_failure;
Johannes Berg7527a782011-05-13 10:58:57 +02001112 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
1113 c->limits[j].types))
1114 goto nla_put_failure;
1115 nla_nest_end(msg, nl_limit);
1116 }
1117
1118 nla_nest_end(msg, nl_limits);
1119
David S. Miller9360ffd2012-03-29 04:41:26 -04001120 if (c->beacon_int_infra_match &&
1121 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
1122 goto nla_put_failure;
1123 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
1124 c->num_different_channels) ||
1125 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
1126 c->max_interfaces))
1127 goto nla_put_failure;
Johannes Bergcdc89b92013-02-18 23:54:36 +01001128 if (large &&
Felix Fietkau8c48b502014-05-05 11:48:40 +02001129 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
1130 c->radar_detect_widths) ||
1131 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
1132 c->radar_detect_regions)))
Johannes Bergcdc89b92013-02-18 23:54:36 +01001133 goto nla_put_failure;
Purushottam Kushwahac6800ff2016-10-12 18:26:51 +05301134 if (c->beacon_int_min_gcd &&
1135 nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
1136 c->beacon_int_min_gcd))
1137 goto nla_put_failure;
Johannes Berg7527a782011-05-13 10:58:57 +02001138
1139 nla_nest_end(msg, nl_combi);
1140 }
1141
1142 nla_nest_end(msg, nl_combis);
1143
1144 return 0;
1145nla_put_failure:
1146 return -ENOBUFS;
1147}
1148
Johannes Berg3713b4e2013-02-14 16:19:38 +01001149#ifdef CONFIG_PM
Johannes Bergb56cf722013-02-20 01:02:38 +01001150static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
1151 struct sk_buff *msg)
1152{
Johannes Berg964dc9e2013-06-03 17:25:34 +02001153 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
Johannes Bergb56cf722013-02-20 01:02:38 +01001154 struct nlattr *nl_tcp;
1155
1156 if (!tcp)
1157 return 0;
1158
1159 nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
1160 if (!nl_tcp)
1161 return -ENOBUFS;
1162
1163 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1164 tcp->data_payload_max))
1165 return -ENOBUFS;
1166
1167 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1168 tcp->data_payload_max))
1169 return -ENOBUFS;
1170
1171 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
1172 return -ENOBUFS;
1173
1174 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
1175 sizeof(*tcp->tok), tcp->tok))
1176 return -ENOBUFS;
1177
1178 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
1179 tcp->data_interval_max))
1180 return -ENOBUFS;
1181
1182 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
1183 tcp->wake_payload_max))
1184 return -ENOBUFS;
1185
1186 nla_nest_end(msg, nl_tcp);
1187 return 0;
1188}
1189
Johannes Berg3713b4e2013-02-14 16:19:38 +01001190static int nl80211_send_wowlan(struct sk_buff *msg,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001191 struct cfg80211_registered_device *rdev,
Johannes Bergb56cf722013-02-20 01:02:38 +01001192 bool large)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001193{
1194 struct nlattr *nl_wowlan;
1195
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001196 if (!rdev->wiphy.wowlan)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001197 return 0;
1198
1199 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1200 if (!nl_wowlan)
1201 return -ENOBUFS;
1202
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001203 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001204 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001205 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001206 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001207 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001208 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001209 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001210 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001211 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001212 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001213 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001214 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001215 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001216 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001217 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001218 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1219 return -ENOBUFS;
1220
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001221 if (rdev->wiphy.wowlan->n_patterns) {
Amitkumar Karwar50ac6602013-06-25 19:03:56 -07001222 struct nl80211_pattern_support pat = {
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001223 .max_patterns = rdev->wiphy.wowlan->n_patterns,
1224 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
1225 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
1226 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
Johannes Berg3713b4e2013-02-14 16:19:38 +01001227 };
1228
1229 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1230 sizeof(pat), &pat))
1231 return -ENOBUFS;
1232 }
1233
Luciano Coelho75453cc2015-01-09 14:06:37 +02001234 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
1235 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
1236 rdev->wiphy.wowlan->max_nd_match_sets))
1237 return -ENOBUFS;
1238
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001239 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
Johannes Bergb56cf722013-02-20 01:02:38 +01001240 return -ENOBUFS;
1241
Johannes Berg3713b4e2013-02-14 16:19:38 +01001242 nla_nest_end(msg, nl_wowlan);
1243
1244 return 0;
1245}
1246#endif
1247
Amitkumar Karwarbe29b992013-06-28 11:51:26 -07001248static int nl80211_send_coalesce(struct sk_buff *msg,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001249 struct cfg80211_registered_device *rdev)
Amitkumar Karwarbe29b992013-06-28 11:51:26 -07001250{
1251 struct nl80211_coalesce_rule_support rule;
1252
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001253 if (!rdev->wiphy.coalesce)
Amitkumar Karwarbe29b992013-06-28 11:51:26 -07001254 return 0;
1255
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001256 rule.max_rules = rdev->wiphy.coalesce->n_rules;
1257 rule.max_delay = rdev->wiphy.coalesce->max_delay;
1258 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
1259 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
1260 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
1261 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
Amitkumar Karwarbe29b992013-06-28 11:51:26 -07001262
1263 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
1264 return -ENOBUFS;
1265
1266 return 0;
1267}
1268
Johannes Berg3713b4e2013-02-14 16:19:38 +01001269static int nl80211_send_band_rateinfo(struct sk_buff *msg,
1270 struct ieee80211_supported_band *sband)
1271{
1272 struct nlattr *nl_rates, *nl_rate;
1273 struct ieee80211_rate *rate;
1274 int i;
1275
1276 /* add HT info */
1277 if (sband->ht_cap.ht_supported &&
1278 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
1279 sizeof(sband->ht_cap.mcs),
1280 &sband->ht_cap.mcs) ||
1281 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
1282 sband->ht_cap.cap) ||
1283 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1284 sband->ht_cap.ampdu_factor) ||
1285 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1286 sband->ht_cap.ampdu_density)))
1287 return -ENOBUFS;
1288
1289 /* add VHT info */
1290 if (sband->vht_cap.vht_supported &&
1291 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1292 sizeof(sband->vht_cap.vht_mcs),
1293 &sband->vht_cap.vht_mcs) ||
1294 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1295 sband->vht_cap.cap)))
1296 return -ENOBUFS;
1297
1298 /* add bitrates */
1299 nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
1300 if (!nl_rates)
1301 return -ENOBUFS;
1302
1303 for (i = 0; i < sband->n_bitrates; i++) {
1304 nl_rate = nla_nest_start(msg, i);
1305 if (!nl_rate)
1306 return -ENOBUFS;
1307
1308 rate = &sband->bitrates[i];
1309 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1310 rate->bitrate))
1311 return -ENOBUFS;
1312 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1313 nla_put_flag(msg,
1314 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1315 return -ENOBUFS;
1316
1317 nla_nest_end(msg, nl_rate);
1318 }
1319
1320 nla_nest_end(msg, nl_rates);
1321
1322 return 0;
1323}
1324
1325static int
1326nl80211_send_mgmt_stypes(struct sk_buff *msg,
1327 const struct ieee80211_txrx_stypes *mgmt_stypes)
1328{
1329 u16 stypes;
1330 struct nlattr *nl_ftypes, *nl_ifs;
1331 enum nl80211_iftype ift;
1332 int i;
1333
1334 if (!mgmt_stypes)
1335 return 0;
1336
1337 nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
1338 if (!nl_ifs)
1339 return -ENOBUFS;
1340
1341 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1342 nl_ftypes = nla_nest_start(msg, ift);
1343 if (!nl_ftypes)
1344 return -ENOBUFS;
1345 i = 0;
1346 stypes = mgmt_stypes[ift].tx;
1347 while (stypes) {
1348 if ((stypes & 1) &&
1349 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1350 (i << 4) | IEEE80211_FTYPE_MGMT))
1351 return -ENOBUFS;
1352 stypes >>= 1;
1353 i++;
1354 }
1355 nla_nest_end(msg, nl_ftypes);
1356 }
1357
1358 nla_nest_end(msg, nl_ifs);
1359
1360 nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
1361 if (!nl_ifs)
1362 return -ENOBUFS;
1363
1364 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1365 nl_ftypes = nla_nest_start(msg, ift);
1366 if (!nl_ftypes)
1367 return -ENOBUFS;
1368 i = 0;
1369 stypes = mgmt_stypes[ift].rx;
1370 while (stypes) {
1371 if ((stypes & 1) &&
1372 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1373 (i << 4) | IEEE80211_FTYPE_MGMT))
1374 return -ENOBUFS;
1375 stypes >>= 1;
1376 i++;
1377 }
1378 nla_nest_end(msg, nl_ftypes);
1379 }
1380 nla_nest_end(msg, nl_ifs);
1381
1382 return 0;
1383}
1384
Veerendranath Jakkam4db91792020-02-29 23:00:13 +05301385static int
1386nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev,
1387 struct sk_buff *msg)
1388{
1389 int i;
1390 struct nlattr *nested, *nested_akms;
1391 const struct wiphy_iftype_akm_suites *iftype_akms;
1392
1393 if (!rdev->wiphy.num_iftype_akm_suites ||
1394 !rdev->wiphy.iftype_akm_suites)
1395 return 0;
1396
1397 nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES);
1398 if (!nested)
1399 return -ENOBUFS;
1400
1401 for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) {
1402 nested_akms = nla_nest_start(msg, i + 1);
1403 if (!nested_akms)
1404 return -ENOBUFS;
1405
1406 iftype_akms = &rdev->wiphy.iftype_akm_suites[i];
1407
1408 if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES,
1409 iftype_akms->iftypes_mask))
1410 return -ENOBUFS;
1411
1412 if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES,
1413 sizeof(u32) * iftype_akms->n_akm_suites,
1414 iftype_akms->akm_suites)) {
1415 return -ENOBUFS;
1416 }
1417 nla_nest_end(msg, nested_akms);
1418 }
1419
1420 nla_nest_end(msg, nested);
1421
1422 return 0;
1423}
1424
Johannes Berg86e8cf92013-06-19 10:57:22 +02001425struct nl80211_dump_wiphy_state {
1426 s64 filter_wiphy;
1427 long start;
Kanchanapally, Vidyullatha019ae3a2016-05-16 10:41:04 +05301428 long split_start, band_start, chan_start, capa_start;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001429 bool split;
1430};
1431
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001432static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
Johannes Berg3bb20552014-05-26 13:52:25 +02001433 enum nl80211_commands cmd,
Johannes Berg3713b4e2013-02-14 16:19:38 +01001434 struct sk_buff *msg, u32 portid, u32 seq,
Johannes Berg86e8cf92013-06-19 10:57:22 +02001435 int flags, struct nl80211_dump_wiphy_state *state)
Johannes Berg55682962007-09-20 13:09:35 -04001436{
1437 void *hdr;
Johannes Bergee688b002008-01-24 19:38:39 +01001438 struct nlattr *nl_bands, *nl_band;
1439 struct nlattr *nl_freqs, *nl_freq;
Johannes Berg8fdc6212009-03-14 09:34:01 +01001440 struct nlattr *nl_cmds;
Johannes Berg57fbcce2016-04-12 15:56:15 +02001441 enum nl80211_band band;
Johannes Bergee688b002008-01-24 19:38:39 +01001442 struct ieee80211_channel *chan;
Johannes Bergee688b002008-01-24 19:38:39 +01001443 int i;
Johannes Berg2e161f72010-08-12 15:38:38 +02001444 const struct ieee80211_txrx_stypes *mgmt_stypes =
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001445 rdev->wiphy.mgmt_stypes;
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001446 u32 features;
Johannes Berg55682962007-09-20 13:09:35 -04001447
Johannes Berg3bb20552014-05-26 13:52:25 +02001448 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
Johannes Berg55682962007-09-20 13:09:35 -04001449 if (!hdr)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001450 return -ENOBUFS;
1451
Johannes Berg86e8cf92013-06-19 10:57:22 +02001452 if (WARN_ON(!state))
1453 return -EINVAL;
Johannes Berg55682962007-09-20 13:09:35 -04001454
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001455 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001456 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001457 wiphy_name(&rdev->wiphy)) ||
David S. Miller9360ffd2012-03-29 04:41:26 -04001458 nla_put_u32(msg, NL80211_ATTR_GENERATION,
Johannes Berg3713b4e2013-02-14 16:19:38 +01001459 cfg80211_rdev_list_generation))
David S. Miller9360ffd2012-03-29 04:41:26 -04001460 goto nla_put_failure;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02001461
Johannes Berg3bb20552014-05-26 13:52:25 +02001462 if (cmd != NL80211_CMD_NEW_WIPHY)
1463 goto finish;
1464
Johannes Berg86e8cf92013-06-19 10:57:22 +02001465 switch (state->split_start) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001466 case 0:
1467 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001468 rdev->wiphy.retry_short) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001469 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001470 rdev->wiphy.retry_long) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001471 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001472 rdev->wiphy.frag_threshold) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001473 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001474 rdev->wiphy.rts_threshold) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001475 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001476 rdev->wiphy.coverage_class) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001477 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001478 rdev->wiphy.max_scan_ssids) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001479 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001480 rdev->wiphy.max_sched_scan_ssids) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001481 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001482 rdev->wiphy.max_scan_ie_len) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001483 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001484 rdev->wiphy.max_sched_scan_ie_len) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001485 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
Avraham Stern3b06d272015-10-12 09:51:34 +03001486 rdev->wiphy.max_match_sets) ||
1487 nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
1488 rdev->wiphy.max_sched_scan_plans) ||
1489 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
1490 rdev->wiphy.max_sched_scan_plan_interval) ||
1491 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
1492 rdev->wiphy.max_sched_scan_plan_iterations))
Johannes Bergee688b002008-01-24 19:38:39 +01001493 goto nla_put_failure;
1494
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001495 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001496 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
1497 goto nla_put_failure;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001498 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001499 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
1500 goto nla_put_failure;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001501 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001502 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
1503 goto nla_put_failure;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001504 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001505 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
1506 goto nla_put_failure;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001507 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001508 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
1509 goto nla_put_failure;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001510 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001511 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
David S. Miller9360ffd2012-03-29 04:41:26 -04001512 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001513 state->split_start++;
1514 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001515 break;
1516 case 1:
1517 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001518 sizeof(u32) * rdev->wiphy.n_cipher_suites,
1519 rdev->wiphy.cipher_suites))
Mahesh Palivelabf0c111e2012-06-22 07:27:46 +00001520 goto nla_put_failure;
1521
Johannes Berg3713b4e2013-02-14 16:19:38 +01001522 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001523 rdev->wiphy.max_num_pmkids))
Johannes Bergee688b002008-01-24 19:38:39 +01001524 goto nla_put_failure;
1525
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001526 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001527 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
1528 goto nla_put_failure;
Johannes Bergee688b002008-01-24 19:38:39 +01001529
Johannes Berg3713b4e2013-02-14 16:19:38 +01001530 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001531 rdev->wiphy.available_antennas_tx) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001532 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001533 rdev->wiphy.available_antennas_rx))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001534 goto nla_put_failure;
Johannes Bergee688b002008-01-24 19:38:39 +01001535
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001536 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001537 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001538 rdev->wiphy.probe_resp_offload))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001539 goto nla_put_failure;
Jouni Malinene2f367f262008-11-21 19:01:30 +02001540
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001541 if ((rdev->wiphy.available_antennas_tx ||
1542 rdev->wiphy.available_antennas_rx) &&
1543 rdev->ops->get_antenna) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001544 u32 tx_ant = 0, rx_ant = 0;
1545 int res;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07001546
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001547 res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
Johannes Berg3713b4e2013-02-14 16:19:38 +01001548 if (!res) {
1549 if (nla_put_u32(msg,
1550 NL80211_ATTR_WIPHY_ANTENNA_TX,
1551 tx_ant) ||
1552 nla_put_u32(msg,
1553 NL80211_ATTR_WIPHY_ANTENNA_RX,
1554 rx_ant))
1555 goto nla_put_failure;
1556 }
Johannes Bergee688b002008-01-24 19:38:39 +01001557 }
1558
Johannes Berg86e8cf92013-06-19 10:57:22 +02001559 state->split_start++;
1560 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001561 break;
1562 case 2:
1563 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001564 rdev->wiphy.interface_modes))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001565 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001566 state->split_start++;
1567 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001568 break;
1569 case 3:
1570 nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
1571 if (!nl_bands)
Johannes Bergee688b002008-01-24 19:38:39 +01001572 goto nla_put_failure;
1573
Johannes Berg86e8cf92013-06-19 10:57:22 +02001574 for (band = state->band_start;
Johannes Berg57fbcce2016-04-12 15:56:15 +02001575 band < NUM_NL80211_BANDS; band++) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001576 struct ieee80211_supported_band *sband;
1577
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001578 sband = rdev->wiphy.bands[band];
Johannes Berg3713b4e2013-02-14 16:19:38 +01001579
1580 if (!sband)
1581 continue;
1582
1583 nl_band = nla_nest_start(msg, band);
1584 if (!nl_band)
Johannes Bergee688b002008-01-24 19:38:39 +01001585 goto nla_put_failure;
1586
Johannes Berg86e8cf92013-06-19 10:57:22 +02001587 switch (state->chan_start) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001588 case 0:
1589 if (nl80211_send_band_rateinfo(msg, sband))
1590 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001591 state->chan_start++;
1592 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001593 break;
1594 default:
1595 /* add frequencies */
1596 nl_freqs = nla_nest_start(
1597 msg, NL80211_BAND_ATTR_FREQS);
1598 if (!nl_freqs)
1599 goto nla_put_failure;
Johannes Bergee688b002008-01-24 19:38:39 +01001600
Johannes Berg86e8cf92013-06-19 10:57:22 +02001601 for (i = state->chan_start - 1;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001602 i < sband->n_channels;
1603 i++) {
1604 nl_freq = nla_nest_start(msg, i);
1605 if (!nl_freq)
1606 goto nla_put_failure;
1607
1608 chan = &sband->channels[i];
1609
Johannes Berg86e8cf92013-06-19 10:57:22 +02001610 if (nl80211_msg_put_channel(
1611 msg, chan,
1612 state->split))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001613 goto nla_put_failure;
1614
1615 nla_nest_end(msg, nl_freq);
Johannes Berg86e8cf92013-06-19 10:57:22 +02001616 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001617 break;
1618 }
1619 if (i < sband->n_channels)
Johannes Berg86e8cf92013-06-19 10:57:22 +02001620 state->chan_start = i + 2;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001621 else
Johannes Berg86e8cf92013-06-19 10:57:22 +02001622 state->chan_start = 0;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001623 nla_nest_end(msg, nl_freqs);
1624 }
1625
1626 nla_nest_end(msg, nl_band);
1627
Johannes Berg86e8cf92013-06-19 10:57:22 +02001628 if (state->split) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001629 /* start again here */
Johannes Berg86e8cf92013-06-19 10:57:22 +02001630 if (state->chan_start)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001631 band--;
1632 break;
1633 }
Johannes Bergee688b002008-01-24 19:38:39 +01001634 }
Johannes Berg3713b4e2013-02-14 16:19:38 +01001635 nla_nest_end(msg, nl_bands);
Johannes Bergee688b002008-01-24 19:38:39 +01001636
Johannes Berg57fbcce2016-04-12 15:56:15 +02001637 if (band < NUM_NL80211_BANDS)
Johannes Berg86e8cf92013-06-19 10:57:22 +02001638 state->band_start = band + 1;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001639 else
Johannes Berg86e8cf92013-06-19 10:57:22 +02001640 state->band_start = 0;
Johannes Bergee688b002008-01-24 19:38:39 +01001641
Johannes Berg3713b4e2013-02-14 16:19:38 +01001642 /* if bands & channels are done, continue outside */
Johannes Berg86e8cf92013-06-19 10:57:22 +02001643 if (state->band_start == 0 && state->chan_start == 0)
1644 state->split_start++;
1645 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001646 break;
1647 case 4:
1648 nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
1649 if (!nl_cmds)
David S. Miller9360ffd2012-03-29 04:41:26 -04001650 goto nla_put_failure;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001651
1652 i = 0;
1653#define CMD(op, n) \
1654 do { \
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001655 if (rdev->ops->op) { \
Johannes Berg3713b4e2013-02-14 16:19:38 +01001656 i++; \
1657 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
1658 goto nla_put_failure; \
1659 } \
1660 } while (0)
1661
1662 CMD(add_virtual_intf, NEW_INTERFACE);
1663 CMD(change_virtual_intf, SET_INTERFACE);
1664 CMD(add_key, NEW_KEY);
1665 CMD(start_ap, START_AP);
1666 CMD(add_station, NEW_STATION);
1667 CMD(add_mpath, NEW_MPATH);
1668 CMD(update_mesh_config, SET_MESH_CONFIG);
1669 CMD(change_bss, SET_BSS);
1670 CMD(auth, AUTHENTICATE);
1671 CMD(assoc, ASSOCIATE);
1672 CMD(deauth, DEAUTHENTICATE);
1673 CMD(disassoc, DISASSOCIATE);
1674 CMD(join_ibss, JOIN_IBSS);
1675 CMD(join_mesh, JOIN_MESH);
1676 CMD(set_pmksa, SET_PMKSA);
1677 CMD(del_pmksa, DEL_PMKSA);
1678 CMD(flush_pmksa, FLUSH_PMKSA);
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001679 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001680 CMD(remain_on_channel, REMAIN_ON_CHANNEL);
1681 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
1682 CMD(mgmt_tx, FRAME);
1683 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001684 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001685 i++;
1686 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
1687 goto nla_put_failure;
1688 }
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001689 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
1690 rdev->ops->join_mesh) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001691 i++;
1692 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1693 goto nla_put_failure;
1694 }
1695 CMD(set_wds_peer, SET_WDS_PEER);
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001696 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001697 CMD(tdls_mgmt, TDLS_MGMT);
1698 CMD(tdls_oper, TDLS_OPER);
1699 }
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001700 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001701 CMD(sched_scan_start, START_SCHED_SCAN);
1702 CMD(probe_client, PROBE_CLIENT);
1703 CMD(set_noack_map, SET_NOACK_MAP);
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001704 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001705 i++;
1706 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1707 goto nla_put_failure;
1708 }
1709 CMD(start_p2p_device, START_P2P_DEVICE);
1710 CMD(set_mcast_rate, SET_MCAST_RATE);
Johannes Berg02df00e2014-06-10 14:06:25 +02001711#ifdef CONFIG_NL80211_TESTMODE
1712 CMD(testmode_cmd, TESTMODE);
1713#endif
Johannes Berg86e8cf92013-06-19 10:57:22 +02001714 if (state->split) {
Arend van Spriel5de17982013-04-18 15:49:00 +02001715 CMD(crit_proto_start, CRIT_PROTOCOL_START);
1716 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001717 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02001718 CMD(channel_switch, CHANNEL_SWITCH);
Johannes Berg02df00e2014-06-10 14:06:25 +02001719 CMD(set_qos_map, SET_QOS_MAP);
Johannes Berg723e73a2014-10-22 09:25:06 +02001720 if (rdev->wiphy.features &
1721 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
Johannes Berg960d01a2014-09-09 22:55:35 +03001722 CMD(add_tx_ts, ADD_TX_TS);
Michael Braund757efc2016-10-10 19:12:22 +02001723 CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
vamsi krishna30da4e82016-10-27 16:51:11 +03001724 CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
Matthew Wang83fcc242019-08-22 10:48:06 -07001725 CMD(update_ft_ies, UPDATE_FT_IES);
Arend van Spriel5de17982013-04-18 15:49:00 +02001726 }
Johannes Berg02df00e2014-06-10 14:06:25 +02001727 /* add into the if now */
Johannes Berg8fdc6212009-03-14 09:34:01 +01001728#undef CMD
Samuel Ortizb23aa672009-07-01 21:26:54 +02001729
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001730 if (rdev->ops->connect || rdev->ops->auth) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001731 i++;
1732 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
Johannes Berg2e161f72010-08-12 15:38:38 +02001733 goto nla_put_failure;
Johannes Berg2e161f72010-08-12 15:38:38 +02001734 }
1735
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001736 if (rdev->ops->disconnect || rdev->ops->deauth) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001737 i++;
1738 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1739 goto nla_put_failure;
1740 }
Johannes Berg74b70a42010-08-24 12:15:53 +02001741
Johannes Berg3713b4e2013-02-14 16:19:38 +01001742 nla_nest_end(msg, nl_cmds);
Johannes Berg86e8cf92013-06-19 10:57:22 +02001743 state->split_start++;
1744 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001745 break;
1746 case 5:
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001747 if (rdev->ops->remain_on_channel &&
1748 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001749 nla_put_u32(msg,
1750 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001751 rdev->wiphy.max_remain_on_channel_duration))
Johannes Berg2e161f72010-08-12 15:38:38 +02001752 goto nla_put_failure;
1753
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001754 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001755 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
1756 goto nla_put_failure;
Johannes Berg2e161f72010-08-12 15:38:38 +02001757
Johannes Berg3713b4e2013-02-14 16:19:38 +01001758 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
1759 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001760 state->split_start++;
1761 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001762 break;
1763 case 6:
Johannes Bergdfb89c52012-06-27 09:23:48 +02001764#ifdef CONFIG_PM
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001765 if (nl80211_send_wowlan(msg, rdev, state->split))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001766 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001767 state->split_start++;
1768 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001769 break;
1770#else
Johannes Berg86e8cf92013-06-19 10:57:22 +02001771 state->split_start++;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001772#endif
1773 case 7:
1774 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001775 rdev->wiphy.software_iftypes))
Johannes Bergff1b6e62011-05-04 15:37:28 +02001776 goto nla_put_failure;
1777
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001778 if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
Johannes Berg86e8cf92013-06-19 10:57:22 +02001779 state->split))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001780 goto nla_put_failure;
Johannes Bergff1b6e62011-05-04 15:37:28 +02001781
Johannes Berg86e8cf92013-06-19 10:57:22 +02001782 state->split_start++;
1783 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001784 break;
1785 case 8:
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001786 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001787 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001788 rdev->wiphy.ap_sme_capa))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001789 goto nla_put_failure;
1790
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001791 features = rdev->wiphy.features;
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001792 /*
1793 * We can only add the per-channel limit information if the
1794 * dump is split, otherwise it makes it too big. Therefore
1795 * only advertise it in that case.
1796 */
Johannes Berg86e8cf92013-06-19 10:57:22 +02001797 if (state->split)
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001798 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
1799 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001800 goto nla_put_failure;
1801
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001802 if (rdev->wiphy.ht_capa_mod_mask &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001803 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001804 sizeof(*rdev->wiphy.ht_capa_mod_mask),
1805 rdev->wiphy.ht_capa_mod_mask))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001806 goto nla_put_failure;
1807
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001808 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
1809 rdev->wiphy.max_acl_mac_addrs &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001810 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001811 rdev->wiphy.max_acl_mac_addrs))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001812 goto nla_put_failure;
1813
1814 /*
1815 * Any information below this point is only available to
1816 * applications that can deal with it being split. This
1817 * helps ensure that newly added capabilities don't break
1818 * older tools by overrunning their buffers.
1819 *
1820 * We still increment split_start so that in the split
1821 * case we'll continue with more data in the next round,
1822 * but break unconditionally so unsplit data stops here.
1823 */
Johannes Berg86e8cf92013-06-19 10:57:22 +02001824 state->split_start++;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001825 break;
1826 case 9:
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001827 if (rdev->wiphy.extended_capabilities &&
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001828 (nla_put(msg, NL80211_ATTR_EXT_CAPA,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001829 rdev->wiphy.extended_capabilities_len,
1830 rdev->wiphy.extended_capabilities) ||
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001831 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001832 rdev->wiphy.extended_capabilities_len,
1833 rdev->wiphy.extended_capabilities_mask)))
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001834 goto nla_put_failure;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001835
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001836 if (rdev->wiphy.vht_capa_mod_mask &&
Johannes Bergee2aca32013-02-21 17:36:01 +01001837 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001838 sizeof(*rdev->wiphy.vht_capa_mod_mask),
1839 rdev->wiphy.vht_capa_mod_mask))
Johannes Bergee2aca32013-02-21 17:36:01 +01001840 goto nla_put_failure;
1841
Amitkumar Karwarbe29b992013-06-28 11:51:26 -07001842 state->split_start++;
1843 break;
1844 case 10:
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001845 if (nl80211_send_coalesce(msg, rdev))
Amitkumar Karwarbe29b992013-06-28 11:51:26 -07001846 goto nla_put_failure;
1847
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001848 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
Felix Fietkau01e0daa2013-11-09 14:57:54 +01001849 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
1850 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
1851 goto nla_put_failure;
Jouni Malinenb43504c2014-01-15 00:01:08 +02001852
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001853 if (rdev->wiphy.max_ap_assoc_sta &&
Jouni Malinenb43504c2014-01-15 00:01:08 +02001854 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001855 rdev->wiphy.max_ap_assoc_sta))
Jouni Malinenb43504c2014-01-15 00:01:08 +02001856 goto nla_put_failure;
1857
Johannes Bergad7e7182013-11-13 13:37:47 +01001858 state->split_start++;
1859 break;
1860 case 11:
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001861 if (rdev->wiphy.n_vendor_commands) {
Johannes Berg567ffc32013-12-18 14:43:31 +01001862 const struct nl80211_vendor_cmd_info *info;
1863 struct nlattr *nested;
Johannes Bergad7e7182013-11-13 13:37:47 +01001864
Johannes Berg567ffc32013-12-18 14:43:31 +01001865 nested = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA);
1866 if (!nested)
Johannes Bergad7e7182013-11-13 13:37:47 +01001867 goto nla_put_failure;
Johannes Berg567ffc32013-12-18 14:43:31 +01001868
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001869 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
1870 info = &rdev->wiphy.vendor_commands[i].info;
Johannes Berg567ffc32013-12-18 14:43:31 +01001871 if (nla_put(msg, i + 1, sizeof(*info), info))
1872 goto nla_put_failure;
1873 }
1874 nla_nest_end(msg, nested);
1875 }
1876
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001877 if (rdev->wiphy.n_vendor_events) {
Johannes Berg567ffc32013-12-18 14:43:31 +01001878 const struct nl80211_vendor_cmd_info *info;
1879 struct nlattr *nested;
1880
1881 nested = nla_nest_start(msg,
1882 NL80211_ATTR_VENDOR_EVENTS);
1883 if (!nested)
1884 goto nla_put_failure;
1885
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001886 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
1887 info = &rdev->wiphy.vendor_events[i];
Johannes Berg567ffc32013-12-18 14:43:31 +01001888 if (nla_put(msg, i + 1, sizeof(*info), info))
1889 goto nla_put_failure;
1890 }
1891 nla_nest_end(msg, nested);
1892 }
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03001893 state->split_start++;
1894 break;
1895 case 12:
1896 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
1897 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
1898 rdev->wiphy.max_num_csa_counters))
1899 goto nla_put_failure;
Felix Fietkau01e0daa2013-11-09 14:57:54 +01001900
Arik Nemtsov1bdd7162014-12-15 19:26:01 +02001901 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
1902 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
1903 goto nla_put_failure;
1904
Gautam Kumar Shuklad75bb062014-12-23 16:55:19 +01001905 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
1906 sizeof(rdev->wiphy.ext_features),
1907 rdev->wiphy.ext_features))
1908 goto nla_put_failure;
1909
Arend van Spriel38de03d2016-03-02 20:37:18 +01001910 if (rdev->wiphy.bss_select_support) {
1911 struct nlattr *nested;
1912 u32 bss_select_support = rdev->wiphy.bss_select_support;
1913
1914 nested = nla_nest_start(msg, NL80211_ATTR_BSS_SELECT);
1915 if (!nested)
1916 goto nla_put_failure;
1917
1918 i = 0;
1919 while (bss_select_support) {
1920 if ((bss_select_support & 1) &&
1921 nla_put_flag(msg, i))
1922 goto nla_put_failure;
1923 i++;
1924 bss_select_support >>= 1;
1925 }
1926 nla_nest_end(msg, nested);
1927 }
1928
Kanchanapally, Vidyullatha019ae3a2016-05-16 10:41:04 +05301929 state->split_start++;
1930 break;
1931 case 13:
1932 if (rdev->wiphy.num_iftype_ext_capab &&
1933 rdev->wiphy.iftype_ext_capab) {
1934 struct nlattr *nested_ext_capab, *nested;
1935
1936 nested = nla_nest_start(msg,
1937 NL80211_ATTR_IFTYPE_EXT_CAPA);
1938 if (!nested)
1939 goto nla_put_failure;
1940
1941 for (i = state->capa_start;
1942 i < rdev->wiphy.num_iftype_ext_capab; i++) {
1943 const struct wiphy_iftype_ext_capab *capab;
1944
1945 capab = &rdev->wiphy.iftype_ext_capab[i];
1946
1947 nested_ext_capab = nla_nest_start(msg, i);
1948 if (!nested_ext_capab ||
1949 nla_put_u32(msg, NL80211_ATTR_IFTYPE,
1950 capab->iftype) ||
1951 nla_put(msg, NL80211_ATTR_EXT_CAPA,
1952 capab->extended_capabilities_len,
1953 capab->extended_capabilities) ||
1954 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1955 capab->extended_capabilities_len,
1956 capab->extended_capabilities_mask))
1957 goto nla_put_failure;
1958
1959 nla_nest_end(msg, nested_ext_capab);
1960 if (state->split)
1961 break;
1962 }
1963 nla_nest_end(msg, nested);
1964 if (i < rdev->wiphy.num_iftype_ext_capab) {
1965 state->capa_start = i + 1;
1966 break;
1967 }
1968 }
1969
Veerendranath Jakkam4db91792020-02-29 23:00:13 +05301970 state->split_start++;
1971 break;
1972 case 14:
1973
1974 if (nl80211_put_iftype_akm_suites(rdev, msg))
1975 goto nla_put_failure;
1976
Johannes Berg3713b4e2013-02-14 16:19:38 +01001977 /* done */
Johannes Berg86e8cf92013-06-19 10:57:22 +02001978 state->split_start = 0;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001979 break;
Johannes Bergff1b6e62011-05-04 15:37:28 +02001980 }
Johannes Berg3bb20552014-05-26 13:52:25 +02001981 finish:
Johannes Berg053c0952015-01-16 22:09:00 +01001982 genlmsg_end(msg, hdr);
1983 return 0;
Johannes Berg55682962007-09-20 13:09:35 -04001984
1985 nla_put_failure:
Thomas Grafbc3ed282008-06-03 16:36:54 -07001986 genlmsg_cancel(msg, hdr);
1987 return -EMSGSIZE;
Johannes Berg55682962007-09-20 13:09:35 -04001988}
1989
Johannes Berg86e8cf92013-06-19 10:57:22 +02001990static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
1991 struct netlink_callback *cb,
1992 struct nl80211_dump_wiphy_state *state)
1993{
1994 struct nlattr **tb = nl80211_fam.attrbuf;
1995 int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
1996 tb, nl80211_fam.maxattr, nl80211_policy);
1997 /* ignore parse errors for backward compatibility */
1998 if (ret)
1999 return 0;
2000
2001 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
2002 if (tb[NL80211_ATTR_WIPHY])
2003 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
2004 if (tb[NL80211_ATTR_WDEV])
2005 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
2006 if (tb[NL80211_ATTR_IFINDEX]) {
2007 struct net_device *netdev;
2008 struct cfg80211_registered_device *rdev;
2009 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
2010
Ying Xue7f2b8562014-01-15 10:23:45 +08002011 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
Johannes Berg86e8cf92013-06-19 10:57:22 +02002012 if (!netdev)
2013 return -ENODEV;
2014 if (netdev->ieee80211_ptr) {
Zhao, Gangf26cbf42014-04-21 12:53:03 +08002015 rdev = wiphy_to_rdev(
Johannes Berg86e8cf92013-06-19 10:57:22 +02002016 netdev->ieee80211_ptr->wiphy);
2017 state->filter_wiphy = rdev->wiphy_idx;
2018 }
Johannes Berg86e8cf92013-06-19 10:57:22 +02002019 }
2020
2021 return 0;
2022}
2023
Johannes Berg55682962007-09-20 13:09:35 -04002024static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
2025{
Johannes Berg645e77d2013-03-01 14:03:49 +01002026 int idx = 0, ret;
Johannes Berg86e8cf92013-06-19 10:57:22 +02002027 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
Zhao, Gang1b8ec872014-04-21 12:53:02 +08002028 struct cfg80211_registered_device *rdev;
Johannes Berg3a5a4232013-06-19 10:09:57 +02002029
Johannes Berg5fe231e2013-05-08 21:45:15 +02002030 rtnl_lock();
Johannes Berg86e8cf92013-06-19 10:57:22 +02002031 if (!state) {
2032 state = kzalloc(sizeof(*state), GFP_KERNEL);
John W. Linville57ed5cd2013-06-28 13:18:21 -04002033 if (!state) {
2034 rtnl_unlock();
Johannes Berg86e8cf92013-06-19 10:57:22 +02002035 return -ENOMEM;
Johannes Berg3713b4e2013-02-14 16:19:38 +01002036 }
Johannes Berg86e8cf92013-06-19 10:57:22 +02002037 state->filter_wiphy = -1;
2038 ret = nl80211_dump_wiphy_parse(skb, cb, state);
2039 if (ret) {
2040 kfree(state);
2041 rtnl_unlock();
2042 return ret;
Johannes Berg3713b4e2013-02-14 16:19:38 +01002043 }
Johannes Berg86e8cf92013-06-19 10:57:22 +02002044 cb->args[0] = (long)state;
Johannes Berg3713b4e2013-02-14 16:19:38 +01002045 }
2046
Zhao, Gang1b8ec872014-04-21 12:53:02 +08002047 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2048 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
Johannes Berg463d0182009-07-14 00:33:35 +02002049 continue;
Johannes Berg86e8cf92013-06-19 10:57:22 +02002050 if (++idx <= state->start)
Johannes Berg55682962007-09-20 13:09:35 -04002051 continue;
Johannes Berg86e8cf92013-06-19 10:57:22 +02002052 if (state->filter_wiphy != -1 &&
Zhao, Gang1b8ec872014-04-21 12:53:02 +08002053 state->filter_wiphy != rdev->wiphy_idx)
Johannes Berg3713b4e2013-02-14 16:19:38 +01002054 continue;
2055 /* attempt to fit multiple wiphy data chunks into the skb */
2056 do {
Johannes Berg3bb20552014-05-26 13:52:25 +02002057 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
2058 skb,
Johannes Berg3713b4e2013-02-14 16:19:38 +01002059 NETLINK_CB(cb->skb).portid,
2060 cb->nlh->nlmsg_seq,
Johannes Berg86e8cf92013-06-19 10:57:22 +02002061 NLM_F_MULTI, state);
Johannes Berg3713b4e2013-02-14 16:19:38 +01002062 if (ret < 0) {
2063 /*
2064 * If sending the wiphy data didn't fit (ENOBUFS
2065 * or EMSGSIZE returned), this SKB is still
2066 * empty (so it's not too big because another
2067 * wiphy dataset is already in the skb) and
2068 * we've not tried to adjust the dump allocation
2069 * yet ... then adjust the alloc size to be
2070 * bigger, and return 1 but with the empty skb.
2071 * This results in an empty message being RX'ed
2072 * in userspace, but that is ignored.
2073 *
2074 * We can then retry with the larger buffer.
2075 */
2076 if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
Pontus Fuchsf12cb282014-01-16 15:00:40 +01002077 !skb->len && !state->split &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01002078 cb->min_dump_alloc < 4096) {
2079 cb->min_dump_alloc = 4096;
Pontus Fuchsf12cb282014-01-16 15:00:40 +01002080 state->split_start = 0;
David S. Millerd98cae64e2013-06-19 16:49:39 -07002081 rtnl_unlock();
Johannes Berg3713b4e2013-02-14 16:19:38 +01002082 return 1;
2083 }
2084 idx--;
2085 break;
Johannes Berg645e77d2013-03-01 14:03:49 +01002086 }
Johannes Berg86e8cf92013-06-19 10:57:22 +02002087 } while (state->split_start > 0);
Johannes Berg3713b4e2013-02-14 16:19:38 +01002088 break;
Johannes Berg55682962007-09-20 13:09:35 -04002089 }
Johannes Berg5fe231e2013-05-08 21:45:15 +02002090 rtnl_unlock();
Johannes Berg55682962007-09-20 13:09:35 -04002091
Johannes Berg86e8cf92013-06-19 10:57:22 +02002092 state->start = idx;
Johannes Berg55682962007-09-20 13:09:35 -04002093
2094 return skb->len;
2095}
2096
Johannes Berg86e8cf92013-06-19 10:57:22 +02002097static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
2098{
2099 kfree((void *)cb->args[0]);
2100 return 0;
2101}
2102
Johannes Berg55682962007-09-20 13:09:35 -04002103static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
2104{
2105 struct sk_buff *msg;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08002106 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg86e8cf92013-06-19 10:57:22 +02002107 struct nl80211_dump_wiphy_state state = {};
Johannes Berg55682962007-09-20 13:09:35 -04002108
Johannes Berg645e77d2013-03-01 14:03:49 +01002109 msg = nlmsg_new(4096, GFP_KERNEL);
Johannes Berg55682962007-09-20 13:09:35 -04002110 if (!msg)
Johannes Berg4c476992010-10-04 21:36:35 +02002111 return -ENOMEM;
Johannes Berg55682962007-09-20 13:09:35 -04002112
Johannes Berg3bb20552014-05-26 13:52:25 +02002113 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
2114 info->snd_portid, info->snd_seq, 0,
Johannes Berg86e8cf92013-06-19 10:57:22 +02002115 &state) < 0) {
Johannes Berg4c476992010-10-04 21:36:35 +02002116 nlmsg_free(msg);
2117 return -ENOBUFS;
2118 }
Johannes Berg55682962007-09-20 13:09:35 -04002119
Johannes Berg134e6372009-07-10 09:51:34 +00002120 return genlmsg_reply(msg, info);
Johannes Berg55682962007-09-20 13:09:35 -04002121}
2122
Jouni Malinen31888482008-10-30 16:59:24 +02002123static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
2124 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
2125 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
2126 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
2127 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
2128 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
2129};
2130
2131static int parse_txq_params(struct nlattr *tb[],
2132 struct ieee80211_txq_params *txq_params)
2133{
Dan Williams0781a502018-01-29 17:03:15 -08002134 u8 ac;
2135
Johannes Berga3304b02012-03-28 11:04:24 +02002136 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
Jouni Malinen31888482008-10-30 16:59:24 +02002137 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
2138 !tb[NL80211_TXQ_ATTR_AIFS])
2139 return -EINVAL;
2140
Dan Williams0781a502018-01-29 17:03:15 -08002141 ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
Jouni Malinen31888482008-10-30 16:59:24 +02002142 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
2143 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
2144 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
2145 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
2146
Dan Williams0781a502018-01-29 17:03:15 -08002147 if (ac >= NL80211_NUM_ACS)
Johannes Berga3304b02012-03-28 11:04:24 +02002148 return -EINVAL;
Dan Williams0781a502018-01-29 17:03:15 -08002149 txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS);
Jouni Malinen31888482008-10-30 16:59:24 +02002150 return 0;
2151}
2152
Johannes Bergf444de02010-05-05 15:25:02 +02002153static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
2154{
2155 /*
Johannes Bergcc1d2802012-05-16 23:50:20 +02002156 * You can only set the channel explicitly for WDS interfaces,
2157 * all others have their channel managed via their respective
2158 * "establish a connection" command (connect, join, ...)
2159 *
2160 * For AP/GO and mesh mode, the channel can be set with the
2161 * channel userspace API, but is only stored and passed to the
2162 * low-level driver when the AP starts or the mesh is joined.
2163 * This is for backward compatibility, userspace can also give
2164 * the channel in the start-ap or join-mesh commands instead.
Johannes Bergf444de02010-05-05 15:25:02 +02002165 *
2166 * Monitors are special as they are normally slaved to
Johannes Berge8c9bd52012-06-06 08:18:22 +02002167 * whatever else is going on, so they have their own special
2168 * operation to set the monitor channel if possible.
Johannes Bergf444de02010-05-05 15:25:02 +02002169 */
2170 return !wdev ||
2171 wdev->iftype == NL80211_IFTYPE_AP ||
Johannes Bergf444de02010-05-05 15:25:02 +02002172 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
Johannes Berg074ac8d2010-09-16 14:58:22 +02002173 wdev->iftype == NL80211_IFTYPE_MONITOR ||
2174 wdev->iftype == NL80211_IFTYPE_P2P_GO;
Johannes Bergf444de02010-05-05 15:25:02 +02002175}
2176
Johannes Berg683b6d32012-11-08 21:25:48 +01002177static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
2178 struct genl_info *info,
2179 struct cfg80211_chan_def *chandef)
2180{
Mahesh Paliveladbeca2e2012-11-29 14:11:07 +05302181 u32 control_freq;
Johannes Berg683b6d32012-11-08 21:25:48 +01002182
2183 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
2184 return -EINVAL;
2185
2186 control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
2187
Johannes Bergeec7ef32019-09-23 13:51:16 +02002188 memset(chandef, 0, sizeof(*chandef));
2189
Johannes Berg683b6d32012-11-08 21:25:48 +01002190 chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002191 chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
2192 chandef->center_freq1 = control_freq;
2193 chandef->center_freq2 = 0;
Johannes Berg683b6d32012-11-08 21:25:48 +01002194
2195 /* Primary channel not allowed */
2196 if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
2197 return -EINVAL;
2198
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002199 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
2200 enum nl80211_channel_type chantype;
Johannes Berg683b6d32012-11-08 21:25:48 +01002201
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002202 chantype = nla_get_u32(
2203 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
2204
2205 switch (chantype) {
2206 case NL80211_CHAN_NO_HT:
2207 case NL80211_CHAN_HT20:
2208 case NL80211_CHAN_HT40PLUS:
2209 case NL80211_CHAN_HT40MINUS:
2210 cfg80211_chandef_create(chandef, chandef->chan,
2211 chantype);
2212 break;
2213 default:
Johannes Berg683b6d32012-11-08 21:25:48 +01002214 return -EINVAL;
Johannes Berg683b6d32012-11-08 21:25:48 +01002215 }
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002216 } else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
2217 chandef->width =
2218 nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
2219 if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
2220 chandef->center_freq1 =
2221 nla_get_u32(
2222 info->attrs[NL80211_ATTR_CENTER_FREQ1]);
2223 if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
2224 chandef->center_freq2 =
2225 nla_get_u32(
2226 info->attrs[NL80211_ATTR_CENTER_FREQ2]);
2227 }
2228
Johannes Berg9f5e8f62012-11-22 16:59:45 +01002229 if (!cfg80211_chandef_valid(chandef))
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002230 return -EINVAL;
2231
Johannes Berg9f5e8f62012-11-22 16:59:45 +01002232 if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
2233 IEEE80211_CHAN_DISABLED))
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002234 return -EINVAL;
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002235
Simon Wunderlich2f301ab2013-05-16 13:00:28 +02002236 if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
2237 chandef->width == NL80211_CHAN_WIDTH_10) &&
2238 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ))
2239 return -EINVAL;
2240
Johannes Berg683b6d32012-11-08 21:25:48 +01002241 return 0;
2242}
2243
Johannes Bergf444de02010-05-05 15:25:02 +02002244static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
Jouni Malinene16821b2014-04-28 11:22:08 +03002245 struct net_device *dev,
Johannes Bergf444de02010-05-05 15:25:02 +02002246 struct genl_info *info)
2247{
Johannes Berg683b6d32012-11-08 21:25:48 +01002248 struct cfg80211_chan_def chandef;
Johannes Bergf444de02010-05-05 15:25:02 +02002249 int result;
Johannes Berge8c9bd52012-06-06 08:18:22 +02002250 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
Jouni Malinene16821b2014-04-28 11:22:08 +03002251 struct wireless_dev *wdev = NULL;
Johannes Berge8c9bd52012-06-06 08:18:22 +02002252
Jouni Malinene16821b2014-04-28 11:22:08 +03002253 if (dev)
2254 wdev = dev->ieee80211_ptr;
Johannes Bergf444de02010-05-05 15:25:02 +02002255 if (!nl80211_can_set_dev_channel(wdev))
2256 return -EOPNOTSUPP;
Jouni Malinene16821b2014-04-28 11:22:08 +03002257 if (wdev)
2258 iftype = wdev->iftype;
Johannes Bergf444de02010-05-05 15:25:02 +02002259
Johannes Berg683b6d32012-11-08 21:25:48 +01002260 result = nl80211_parse_chandef(rdev, info, &chandef);
2261 if (result)
2262 return result;
Johannes Bergf444de02010-05-05 15:25:02 +02002263
Johannes Berge8c9bd52012-06-06 08:18:22 +02002264 switch (iftype) {
Johannes Bergaa430da2012-05-16 23:50:18 +02002265 case NL80211_IFTYPE_AP:
2266 case NL80211_IFTYPE_P2P_GO:
Arik Nemtsov923b3522015-07-08 15:41:44 +03002267 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
2268 iftype)) {
Johannes Bergaa430da2012-05-16 23:50:18 +02002269 result = -EINVAL;
2270 break;
2271 }
Jouni Malinene16821b2014-04-28 11:22:08 +03002272 if (wdev->beacon_interval) {
2273 if (!dev || !rdev->ops->set_ap_chanwidth ||
2274 !(rdev->wiphy.features &
2275 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
2276 result = -EBUSY;
2277 break;
2278 }
2279
2280 /* Only allow dynamic channel width changes */
2281 if (chandef.chan != wdev->preset_chandef.chan) {
2282 result = -EBUSY;
2283 break;
2284 }
2285 result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
2286 if (result)
2287 break;
2288 }
Johannes Berg683b6d32012-11-08 21:25:48 +01002289 wdev->preset_chandef = chandef;
Johannes Bergaa430da2012-05-16 23:50:18 +02002290 result = 0;
2291 break;
Johannes Bergcc1d2802012-05-16 23:50:20 +02002292 case NL80211_IFTYPE_MESH_POINT:
Johannes Berg683b6d32012-11-08 21:25:48 +01002293 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
Johannes Bergcc1d2802012-05-16 23:50:20 +02002294 break;
Johannes Berge8c9bd52012-06-06 08:18:22 +02002295 case NL80211_IFTYPE_MONITOR:
Johannes Berg683b6d32012-11-08 21:25:48 +01002296 result = cfg80211_set_monitor_channel(rdev, &chandef);
Johannes Berge8c9bd52012-06-06 08:18:22 +02002297 break;
Johannes Bergaa430da2012-05-16 23:50:18 +02002298 default:
Johannes Berge8c9bd52012-06-06 08:18:22 +02002299 result = -EINVAL;
Johannes Bergf444de02010-05-05 15:25:02 +02002300 }
Johannes Bergf444de02010-05-05 15:25:02 +02002301
2302 return result;
2303}
2304
2305static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
2306{
Johannes Berg4c476992010-10-04 21:36:35 +02002307 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2308 struct net_device *netdev = info->user_ptr[1];
Johannes Bergf444de02010-05-05 15:25:02 +02002309
Jouni Malinene16821b2014-04-28 11:22:08 +03002310 return __nl80211_set_channel(rdev, netdev, info);
Johannes Bergf444de02010-05-05 15:25:02 +02002311}
2312
Bill Jordane8347eb2010-10-01 13:54:28 -04002313static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
2314{
Johannes Berg43b19952010-10-07 13:10:30 +02002315 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2316 struct net_device *dev = info->user_ptr[1];
2317 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Berg388ac772010-10-07 13:11:09 +02002318 const u8 *bssid;
Bill Jordane8347eb2010-10-01 13:54:28 -04002319
2320 if (!info->attrs[NL80211_ATTR_MAC])
2321 return -EINVAL;
2322
Johannes Berg43b19952010-10-07 13:10:30 +02002323 if (netif_running(dev))
2324 return -EBUSY;
Bill Jordane8347eb2010-10-01 13:54:28 -04002325
Johannes Berg43b19952010-10-07 13:10:30 +02002326 if (!rdev->ops->set_wds_peer)
2327 return -EOPNOTSUPP;
Bill Jordane8347eb2010-10-01 13:54:28 -04002328
Johannes Berg43b19952010-10-07 13:10:30 +02002329 if (wdev->iftype != NL80211_IFTYPE_WDS)
2330 return -EOPNOTSUPP;
Bill Jordane8347eb2010-10-01 13:54:28 -04002331
2332 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Hila Gonene35e4d22012-06-27 17:19:42 +03002333 return rdev_set_wds_peer(rdev, dev, bssid);
Bill Jordane8347eb2010-10-01 13:54:28 -04002334}
2335
Johannes Berg55682962007-09-20 13:09:35 -04002336static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
2337{
2338 struct cfg80211_registered_device *rdev;
Johannes Bergf444de02010-05-05 15:25:02 +02002339 struct net_device *netdev = NULL;
2340 struct wireless_dev *wdev;
Bill Jordana1e567c2010-09-10 11:22:32 -04002341 int result = 0, rem_txq_params = 0;
Jouni Malinen31888482008-10-30 16:59:24 +02002342 struct nlattr *nl_txq_params;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002343 u32 changed;
2344 u8 retry_short = 0, retry_long = 0;
2345 u32 frag_threshold = 0, rts_threshold = 0;
Lukáš Turek81077e82009-12-21 22:50:47 +01002346 u8 coverage_class = 0;
Johannes Berg55682962007-09-20 13:09:35 -04002347
Johannes Berg5fe231e2013-05-08 21:45:15 +02002348 ASSERT_RTNL();
2349
Johannes Bergf444de02010-05-05 15:25:02 +02002350 /*
2351 * Try to find the wiphy and netdev. Normally this
2352 * function shouldn't need the netdev, but this is
2353 * done for backward compatibility -- previously
2354 * setting the channel was done per wiphy, but now
2355 * it is per netdev. Previous userland like hostapd
2356 * also passed a netdev to set_wiphy, so that it is
2357 * possible to let that go to the right netdev!
2358 */
Johannes Berg4bbf4d52009-03-24 09:35:46 +01002359
Johannes Bergf444de02010-05-05 15:25:02 +02002360 if (info->attrs[NL80211_ATTR_IFINDEX]) {
2361 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
2362
Ying Xue7f2b8562014-01-15 10:23:45 +08002363 netdev = __dev_get_by_index(genl_info_net(info), ifindex);
Johannes Berg5fe231e2013-05-08 21:45:15 +02002364 if (netdev && netdev->ieee80211_ptr)
Zhao, Gangf26cbf42014-04-21 12:53:03 +08002365 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
Johannes Berg5fe231e2013-05-08 21:45:15 +02002366 else
Johannes Bergf444de02010-05-05 15:25:02 +02002367 netdev = NULL;
Johannes Berg4bbf4d52009-03-24 09:35:46 +01002368 }
2369
Johannes Bergf444de02010-05-05 15:25:02 +02002370 if (!netdev) {
Johannes Berg878d9ec2012-06-15 14:18:32 +02002371 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
2372 info->attrs);
Johannes Berg5fe231e2013-05-08 21:45:15 +02002373 if (IS_ERR(rdev))
Johannes Berg4c476992010-10-04 21:36:35 +02002374 return PTR_ERR(rdev);
Johannes Bergf444de02010-05-05 15:25:02 +02002375 wdev = NULL;
2376 netdev = NULL;
2377 result = 0;
Johannes Berg71fe96b2012-10-24 10:04:58 +02002378 } else
Johannes Bergf444de02010-05-05 15:25:02 +02002379 wdev = netdev->ieee80211_ptr;
Johannes Bergf444de02010-05-05 15:25:02 +02002380
2381 /*
2382 * end workaround code, by now the rdev is available
2383 * and locked, and wdev may or may not be NULL.
2384 */
Johannes Berg4bbf4d52009-03-24 09:35:46 +01002385
2386 if (info->attrs[NL80211_ATTR_WIPHY_NAME])
Jouni Malinen31888482008-10-30 16:59:24 +02002387 result = cfg80211_dev_rename(
2388 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
Johannes Berg4bbf4d52009-03-24 09:35:46 +01002389
Johannes Berg4bbf4d52009-03-24 09:35:46 +01002390 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002391 return result;
Johannes Berg55682962007-09-20 13:09:35 -04002392
Jouni Malinen31888482008-10-30 16:59:24 +02002393 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
2394 struct ieee80211_txq_params txq_params;
2395 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
2396
Ying Xue7f2b8562014-01-15 10:23:45 +08002397 if (!rdev->ops->set_txq_params)
2398 return -EOPNOTSUPP;
Jouni Malinen31888482008-10-30 16:59:24 +02002399
Ying Xue7f2b8562014-01-15 10:23:45 +08002400 if (!netdev)
2401 return -EINVAL;
Eliad Pellerf70f01c2011-09-25 20:06:53 +03002402
Johannes Berg133a3ff2011-11-03 14:50:13 +01002403 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
Ying Xue7f2b8562014-01-15 10:23:45 +08002404 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2405 return -EINVAL;
Johannes Berg133a3ff2011-11-03 14:50:13 +01002406
Ying Xue7f2b8562014-01-15 10:23:45 +08002407 if (!netif_running(netdev))
2408 return -ENETDOWN;
Johannes Berg2b5f8b02012-04-02 10:51:55 +02002409
Jouni Malinen31888482008-10-30 16:59:24 +02002410 nla_for_each_nested(nl_txq_params,
2411 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
2412 rem_txq_params) {
Johannes Bergae811e22014-01-24 10:17:47 +01002413 result = nla_parse(tb, NL80211_TXQ_ATTR_MAX,
2414 nla_data(nl_txq_params),
2415 nla_len(nl_txq_params),
2416 txq_params_policy);
2417 if (result)
2418 return result;
Jouni Malinen31888482008-10-30 16:59:24 +02002419 result = parse_txq_params(tb, &txq_params);
2420 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002421 return result;
Jouni Malinen31888482008-10-30 16:59:24 +02002422
Hila Gonene35e4d22012-06-27 17:19:42 +03002423 result = rdev_set_txq_params(rdev, netdev,
2424 &txq_params);
Jouni Malinen31888482008-10-30 16:59:24 +02002425 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002426 return result;
Jouni Malinen31888482008-10-30 16:59:24 +02002427 }
2428 }
2429
Jouni Malinen72bdcf32008-11-26 16:15:24 +02002430 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
Jouni Malinene16821b2014-04-28 11:22:08 +03002431 result = __nl80211_set_channel(
2432 rdev,
2433 nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
2434 info);
Jouni Malinen72bdcf32008-11-26 16:15:24 +02002435 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002436 return result;
Jouni Malinen72bdcf32008-11-26 16:15:24 +02002437 }
2438
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002439 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
Johannes Bergc8442112012-10-24 10:17:18 +02002440 struct wireless_dev *txp_wdev = wdev;
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002441 enum nl80211_tx_power_setting type;
2442 int idx, mbm = 0;
2443
Johannes Bergc8442112012-10-24 10:17:18 +02002444 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
2445 txp_wdev = NULL;
2446
Ying Xue7f2b8562014-01-15 10:23:45 +08002447 if (!rdev->ops->set_tx_power)
2448 return -EOPNOTSUPP;
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002449
2450 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
2451 type = nla_get_u32(info->attrs[idx]);
2452
2453 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
Ying Xue7f2b8562014-01-15 10:23:45 +08002454 (type != NL80211_TX_POWER_AUTOMATIC))
2455 return -EINVAL;
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002456
2457 if (type != NL80211_TX_POWER_AUTOMATIC) {
2458 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
2459 mbm = nla_get_u32(info->attrs[idx]);
2460 }
2461
Johannes Bergc8442112012-10-24 10:17:18 +02002462 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002463 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002464 return result;
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002465 }
2466
Bruno Randolfafe0cbf2010-11-10 12:50:50 +09002467 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
2468 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
2469 u32 tx_ant, rx_ant;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07002470
Bruno Randolf7f531e02010-12-16 11:30:22 +09002471 if ((!rdev->wiphy.available_antennas_tx &&
2472 !rdev->wiphy.available_antennas_rx) ||
Ying Xue7f2b8562014-01-15 10:23:45 +08002473 !rdev->ops->set_antenna)
2474 return -EOPNOTSUPP;
Bruno Randolfafe0cbf2010-11-10 12:50:50 +09002475
2476 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
2477 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
2478
Bruno Randolfa7ffac92010-12-08 13:59:24 +09002479 /* reject antenna configurations which don't match the
Bruno Randolf7f531e02010-12-16 11:30:22 +09002480 * available antenna masks, except for the "all" mask */
2481 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
Ying Xue7f2b8562014-01-15 10:23:45 +08002482 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
2483 return -EINVAL;
Bruno Randolfa7ffac92010-12-08 13:59:24 +09002484
Bruno Randolf7f531e02010-12-16 11:30:22 +09002485 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
2486 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
Bruno Randolfa7ffac92010-12-08 13:59:24 +09002487
Hila Gonene35e4d22012-06-27 17:19:42 +03002488 result = rdev_set_antenna(rdev, tx_ant, rx_ant);
Bruno Randolfafe0cbf2010-11-10 12:50:50 +09002489 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002490 return result;
Bruno Randolfafe0cbf2010-11-10 12:50:50 +09002491 }
2492
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002493 changed = 0;
2494
2495 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
2496 retry_short = nla_get_u8(
2497 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
Ying Xue7f2b8562014-01-15 10:23:45 +08002498 if (retry_short == 0)
2499 return -EINVAL;
2500
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002501 changed |= WIPHY_PARAM_RETRY_SHORT;
2502 }
2503
2504 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
2505 retry_long = nla_get_u8(
2506 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
Ying Xue7f2b8562014-01-15 10:23:45 +08002507 if (retry_long == 0)
2508 return -EINVAL;
2509
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002510 changed |= WIPHY_PARAM_RETRY_LONG;
2511 }
2512
2513 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
2514 frag_threshold = nla_get_u32(
2515 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
Ying Xue7f2b8562014-01-15 10:23:45 +08002516 if (frag_threshold < 256)
2517 return -EINVAL;
2518
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002519 if (frag_threshold != (u32) -1) {
2520 /*
2521 * Fragments (apart from the last one) are required to
2522 * have even length. Make the fragmentation code
2523 * simpler by stripping LSB should someone try to use
2524 * odd threshold value.
2525 */
2526 frag_threshold &= ~0x1;
2527 }
2528 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
2529 }
2530
2531 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
2532 rts_threshold = nla_get_u32(
2533 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
2534 changed |= WIPHY_PARAM_RTS_THRESHOLD;
2535 }
2536
Lukáš Turek81077e82009-12-21 22:50:47 +01002537 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
Lorenzo Bianconi3057dbf2014-09-04 23:57:40 +02002538 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
2539 return -EINVAL;
2540
Lukáš Turek81077e82009-12-21 22:50:47 +01002541 coverage_class = nla_get_u8(
2542 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
2543 changed |= WIPHY_PARAM_COVERAGE_CLASS;
2544 }
2545
Lorenzo Bianconi3057dbf2014-09-04 23:57:40 +02002546 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
2547 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
2548 return -EOPNOTSUPP;
2549
2550 changed |= WIPHY_PARAM_DYN_ACK;
2551 }
2552
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002553 if (changed) {
2554 u8 old_retry_short, old_retry_long;
2555 u32 old_frag_threshold, old_rts_threshold;
Lukáš Turek81077e82009-12-21 22:50:47 +01002556 u8 old_coverage_class;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002557
Ying Xue7f2b8562014-01-15 10:23:45 +08002558 if (!rdev->ops->set_wiphy_params)
2559 return -EOPNOTSUPP;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002560
2561 old_retry_short = rdev->wiphy.retry_short;
2562 old_retry_long = rdev->wiphy.retry_long;
2563 old_frag_threshold = rdev->wiphy.frag_threshold;
2564 old_rts_threshold = rdev->wiphy.rts_threshold;
Lukáš Turek81077e82009-12-21 22:50:47 +01002565 old_coverage_class = rdev->wiphy.coverage_class;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002566
2567 if (changed & WIPHY_PARAM_RETRY_SHORT)
2568 rdev->wiphy.retry_short = retry_short;
2569 if (changed & WIPHY_PARAM_RETRY_LONG)
2570 rdev->wiphy.retry_long = retry_long;
2571 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
2572 rdev->wiphy.frag_threshold = frag_threshold;
2573 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
2574 rdev->wiphy.rts_threshold = rts_threshold;
Lukáš Turek81077e82009-12-21 22:50:47 +01002575 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
2576 rdev->wiphy.coverage_class = coverage_class;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002577
Hila Gonene35e4d22012-06-27 17:19:42 +03002578 result = rdev_set_wiphy_params(rdev, changed);
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002579 if (result) {
2580 rdev->wiphy.retry_short = old_retry_short;
2581 rdev->wiphy.retry_long = old_retry_long;
2582 rdev->wiphy.frag_threshold = old_frag_threshold;
2583 rdev->wiphy.rts_threshold = old_rts_threshold;
Lukáš Turek81077e82009-12-21 22:50:47 +01002584 rdev->wiphy.coverage_class = old_coverage_class;
Michal Kazior9189ee32015-08-03 10:55:24 +02002585 return result;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002586 }
2587 }
Ying Xue7f2b8562014-01-15 10:23:45 +08002588 return 0;
Johannes Berg55682962007-09-20 13:09:35 -04002589}
2590
Johannes Berg71bbc992012-06-15 15:30:18 +02002591static inline u64 wdev_id(struct wireless_dev *wdev)
2592{
2593 return (u64)wdev->identifier |
Zhao, Gangf26cbf42014-04-21 12:53:03 +08002594 ((u64)wiphy_to_rdev(wdev->wiphy)->wiphy_idx << 32);
Johannes Berg71bbc992012-06-15 15:30:18 +02002595}
Johannes Berg55682962007-09-20 13:09:35 -04002596
Johannes Berg683b6d32012-11-08 21:25:48 +01002597static int nl80211_send_chandef(struct sk_buff *msg,
Janusz Dziedzicd2859df2013-11-06 13:55:51 +01002598 const struct cfg80211_chan_def *chandef)
Johannes Berg683b6d32012-11-08 21:25:48 +01002599{
Johannes Berg601555c2014-11-27 17:26:56 +01002600 if (WARN_ON(!cfg80211_chandef_valid(chandef)))
2601 return -EINVAL;
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002602
Johannes Berg683b6d32012-11-08 21:25:48 +01002603 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
2604 chandef->chan->center_freq))
2605 return -ENOBUFS;
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002606 switch (chandef->width) {
2607 case NL80211_CHAN_WIDTH_20_NOHT:
2608 case NL80211_CHAN_WIDTH_20:
2609 case NL80211_CHAN_WIDTH_40:
2610 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
2611 cfg80211_get_chandef_type(chandef)))
2612 return -ENOBUFS;
2613 break;
2614 default:
2615 break;
2616 }
2617 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
2618 return -ENOBUFS;
2619 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
2620 return -ENOBUFS;
2621 if (chandef->center_freq2 &&
2622 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
Johannes Berg683b6d32012-11-08 21:25:48 +01002623 return -ENOBUFS;
2624 return 0;
2625}
2626
Eric W. Biederman15e47302012-09-07 20:12:54 +00002627static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
Johannes Bergd7264052009-04-19 16:23:20 +02002628 struct cfg80211_registered_device *rdev,
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02002629 struct wireless_dev *wdev, bool removal)
Johannes Berg55682962007-09-20 13:09:35 -04002630{
Johannes Berg72fb2ab2012-06-15 17:52:47 +02002631 struct net_device *dev = wdev->netdev;
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02002632 u8 cmd = NL80211_CMD_NEW_INTERFACE;
Johannes Berg55682962007-09-20 13:09:35 -04002633 void *hdr;
2634
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02002635 if (removal)
2636 cmd = NL80211_CMD_DEL_INTERFACE;
2637
2638 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
Johannes Berg55682962007-09-20 13:09:35 -04002639 if (!hdr)
2640 return -1;
2641
Johannes Berg72fb2ab2012-06-15 17:52:47 +02002642 if (dev &&
2643 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
Johannes Berg98104fde2012-06-16 00:19:54 +02002644 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
Johannes Berg72fb2ab2012-06-15 17:52:47 +02002645 goto nla_put_failure;
2646
2647 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
2648 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02002649 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
2650 NL80211_ATTR_PAD) ||
Johannes Berg98104fde2012-06-16 00:19:54 +02002651 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
David S. Miller9360ffd2012-03-29 04:41:26 -04002652 nla_put_u32(msg, NL80211_ATTR_GENERATION,
2653 rdev->devlist_generation ^
2654 (cfg80211_rdev_list_generation << 2)))
2655 goto nla_put_failure;
Johannes Bergf5ea9122009-08-07 16:17:38 +02002656
Johannes Berg5b7ccaf2012-07-12 19:45:08 +02002657 if (rdev->ops->get_channel) {
Johannes Berg683b6d32012-11-08 21:25:48 +01002658 int ret;
Johannes Bergeec7ef32019-09-23 13:51:16 +02002659 struct cfg80211_chan_def chandef = {};
Johannes Berg5b7ccaf2012-07-12 19:45:08 +02002660
Johannes Berg683b6d32012-11-08 21:25:48 +01002661 ret = rdev_get_channel(rdev, wdev, &chandef);
2662 if (ret == 0) {
2663 if (nl80211_send_chandef(msg, &chandef))
2664 goto nla_put_failure;
2665 }
Pontus Fuchsd91df0e2012-04-03 16:39:58 +02002666 }
2667
Rafał Miłeckid55d0d52015-08-31 22:59:38 +02002668 if (rdev->ops->get_tx_power) {
2669 int dbm, ret;
2670
2671 ret = rdev_get_tx_power(rdev, wdev, &dbm);
2672 if (ret == 0 &&
2673 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
2674 DBM_TO_MBM(dbm)))
2675 goto nla_put_failure;
2676 }
2677
Antonio Quartullib84e7a02012-11-07 12:52:20 +01002678 if (wdev->ssid_len) {
2679 if (nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
2680 goto nla_put_failure;
2681 }
2682
Johannes Berg053c0952015-01-16 22:09:00 +01002683 genlmsg_end(msg, hdr);
2684 return 0;
Johannes Berg55682962007-09-20 13:09:35 -04002685
2686 nla_put_failure:
Thomas Grafbc3ed282008-06-03 16:36:54 -07002687 genlmsg_cancel(msg, hdr);
2688 return -EMSGSIZE;
Johannes Berg55682962007-09-20 13:09:35 -04002689}
2690
2691static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
2692{
2693 int wp_idx = 0;
2694 int if_idx = 0;
2695 int wp_start = cb->args[0];
2696 int if_start = cb->args[1];
Denis Kenziorb7fb44d2016-08-03 17:02:15 -05002697 int filter_wiphy = -1;
Johannes Bergf5ea9122009-08-07 16:17:38 +02002698 struct cfg80211_registered_device *rdev;
Johannes Berg55682962007-09-20 13:09:35 -04002699 struct wireless_dev *wdev;
Johannes Berg56769e72017-03-15 14:26:04 +01002700 int ret;
Johannes Berg55682962007-09-20 13:09:35 -04002701
Johannes Berg5fe231e2013-05-08 21:45:15 +02002702 rtnl_lock();
Denis Kenziorb7fb44d2016-08-03 17:02:15 -05002703 if (!cb->args[2]) {
2704 struct nl80211_dump_wiphy_state state = {
2705 .filter_wiphy = -1,
2706 };
Denis Kenziorb7fb44d2016-08-03 17:02:15 -05002707
2708 ret = nl80211_dump_wiphy_parse(skb, cb, &state);
2709 if (ret)
Johannes Berg56769e72017-03-15 14:26:04 +01002710 goto out_unlock;
Denis Kenziorb7fb44d2016-08-03 17:02:15 -05002711
2712 filter_wiphy = state.filter_wiphy;
2713
2714 /*
2715 * if filtering, set cb->args[2] to +1 since 0 is the default
2716 * value needed to determine that parsing is necessary.
2717 */
2718 if (filter_wiphy >= 0)
2719 cb->args[2] = filter_wiphy + 1;
2720 else
2721 cb->args[2] = -1;
2722 } else if (cb->args[2] > 0) {
2723 filter_wiphy = cb->args[2] - 1;
2724 }
2725
Johannes Bergf5ea9122009-08-07 16:17:38 +02002726 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2727 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
Johannes Berg463d0182009-07-14 00:33:35 +02002728 continue;
Johannes Bergbba95fe2008-07-29 13:22:51 +02002729 if (wp_idx < wp_start) {
2730 wp_idx++;
Johannes Berg55682962007-09-20 13:09:35 -04002731 continue;
Johannes Bergbba95fe2008-07-29 13:22:51 +02002732 }
Denis Kenziorb7fb44d2016-08-03 17:02:15 -05002733
2734 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
2735 continue;
2736
Johannes Berg55682962007-09-20 13:09:35 -04002737 if_idx = 0;
2738
Johannes Berg53873f12016-05-03 16:52:04 +03002739 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
Johannes Bergbba95fe2008-07-29 13:22:51 +02002740 if (if_idx < if_start) {
2741 if_idx++;
Johannes Berg55682962007-09-20 13:09:35 -04002742 continue;
Johannes Bergbba95fe2008-07-29 13:22:51 +02002743 }
Eric W. Biederman15e47302012-09-07 20:12:54 +00002744 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
Johannes Berg55682962007-09-20 13:09:35 -04002745 cb->nlh->nlmsg_seq, NLM_F_MULTI,
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02002746 rdev, wdev, false) < 0) {
Johannes Bergbba95fe2008-07-29 13:22:51 +02002747 goto out;
2748 }
2749 if_idx++;
Johannes Berg55682962007-09-20 13:09:35 -04002750 }
Johannes Bergbba95fe2008-07-29 13:22:51 +02002751
2752 wp_idx++;
Johannes Berg55682962007-09-20 13:09:35 -04002753 }
Johannes Bergbba95fe2008-07-29 13:22:51 +02002754 out:
Johannes Berg55682962007-09-20 13:09:35 -04002755 cb->args[0] = wp_idx;
2756 cb->args[1] = if_idx;
2757
Johannes Berg56769e72017-03-15 14:26:04 +01002758 ret = skb->len;
2759 out_unlock:
2760 rtnl_unlock();
2761
2762 return ret;
Johannes Berg55682962007-09-20 13:09:35 -04002763}
2764
2765static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
2766{
2767 struct sk_buff *msg;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08002768 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg72fb2ab2012-06-15 17:52:47 +02002769 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg55682962007-09-20 13:09:35 -04002770
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -07002771 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg55682962007-09-20 13:09:35 -04002772 if (!msg)
Johannes Berg4c476992010-10-04 21:36:35 +02002773 return -ENOMEM;
Johannes Berg55682962007-09-20 13:09:35 -04002774
Eric W. Biederman15e47302012-09-07 20:12:54 +00002775 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02002776 rdev, wdev, false) < 0) {
Johannes Berg4c476992010-10-04 21:36:35 +02002777 nlmsg_free(msg);
2778 return -ENOBUFS;
2779 }
Johannes Berg55682962007-09-20 13:09:35 -04002780
Johannes Berg134e6372009-07-10 09:51:34 +00002781 return genlmsg_reply(msg, info);
Johannes Berg55682962007-09-20 13:09:35 -04002782}
2783
Michael Wu66f7ac52008-01-31 19:48:22 +01002784static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
2785 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
2786 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
2787 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
2788 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
2789 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
Felix Fietkaue057d3c2013-05-28 13:01:52 +02002790 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
Michael Wu66f7ac52008-01-31 19:48:22 +01002791};
2792
2793static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
2794{
2795 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
2796 int flag;
2797
2798 *mntrflags = 0;
2799
2800 if (!nla)
2801 return -EINVAL;
2802
2803 if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX,
2804 nla, mntr_flags_policy))
2805 return -EINVAL;
2806
2807 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
2808 if (flags[flag])
2809 *mntrflags |= (1<<flag);
2810
2811 return 0;
2812}
2813
Johannes Berg9bc383d2009-11-19 11:55:19 +01002814static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002815 struct net_device *netdev, u8 use_4addr,
2816 enum nl80211_iftype iftype)
Johannes Berg9bc383d2009-11-19 11:55:19 +01002817{
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002818 if (!use_4addr) {
Jiri Pirkof350a0a82010-06-15 06:50:45 +00002819 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002820 return -EBUSY;
Johannes Berg9bc383d2009-11-19 11:55:19 +01002821 return 0;
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002822 }
Johannes Berg9bc383d2009-11-19 11:55:19 +01002823
2824 switch (iftype) {
2825 case NL80211_IFTYPE_AP_VLAN:
2826 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
2827 return 0;
2828 break;
2829 case NL80211_IFTYPE_STATION:
2830 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
2831 return 0;
2832 break;
2833 default:
2834 break;
2835 }
2836
2837 return -EOPNOTSUPP;
2838}
2839
Johannes Berg55682962007-09-20 13:09:35 -04002840static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
2841{
Johannes Berg4c476992010-10-04 21:36:35 +02002842 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01002843 struct vif_params params;
Johannes Berge36d56b2009-06-09 21:04:43 +02002844 int err;
Johannes Berg04a773a2009-04-19 21:24:32 +02002845 enum nl80211_iftype otype, ntype;
Johannes Berg4c476992010-10-04 21:36:35 +02002846 struct net_device *dev = info->user_ptr[1];
Johannes Berg92ffe052008-09-16 20:39:36 +02002847 u32 _flags, *flags = NULL;
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002848 bool change = false;
Johannes Berg55682962007-09-20 13:09:35 -04002849
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01002850 memset(&params, 0, sizeof(params));
2851
Johannes Berg04a773a2009-04-19 21:24:32 +02002852 otype = ntype = dev->ieee80211_ptr->iftype;
Johannes Berg55682962007-09-20 13:09:35 -04002853
Johannes Berg723b0382008-09-16 20:22:09 +02002854 if (info->attrs[NL80211_ATTR_IFTYPE]) {
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002855 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
Johannes Berg04a773a2009-04-19 21:24:32 +02002856 if (otype != ntype)
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002857 change = true;
Johannes Berg4c476992010-10-04 21:36:35 +02002858 if (ntype > NL80211_IFTYPE_MAX)
2859 return -EINVAL;
Johannes Berg723b0382008-09-16 20:22:09 +02002860 }
2861
Johannes Berg92ffe052008-09-16 20:39:36 +02002862 if (info->attrs[NL80211_ATTR_MESH_ID]) {
Johannes Berg29cbe682010-12-03 09:20:44 +01002863 struct wireless_dev *wdev = dev->ieee80211_ptr;
2864
Johannes Berg4c476992010-10-04 21:36:35 +02002865 if (ntype != NL80211_IFTYPE_MESH_POINT)
2866 return -EINVAL;
Johannes Berg29cbe682010-12-03 09:20:44 +01002867 if (netif_running(dev))
2868 return -EBUSY;
2869
2870 wdev_lock(wdev);
2871 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2872 IEEE80211_MAX_MESH_ID_LEN);
2873 wdev->mesh_id_up_len =
2874 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2875 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2876 wdev->mesh_id_up_len);
2877 wdev_unlock(wdev);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01002878 }
2879
Felix Fietkau8b787642009-11-10 18:53:10 +01002880 if (info->attrs[NL80211_ATTR_4ADDR]) {
2881 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2882 change = true;
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002883 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
Johannes Berg9bc383d2009-11-19 11:55:19 +01002884 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02002885 return err;
Felix Fietkau8b787642009-11-10 18:53:10 +01002886 } else {
2887 params.use_4addr = -1;
2888 }
2889
Johannes Berg92ffe052008-09-16 20:39:36 +02002890 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
Johannes Berg4c476992010-10-04 21:36:35 +02002891 if (ntype != NL80211_IFTYPE_MONITOR)
2892 return -EINVAL;
Johannes Berg92ffe052008-09-16 20:39:36 +02002893 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
2894 &_flags);
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002895 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02002896 return err;
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002897
2898 flags = &_flags;
2899 change = true;
Johannes Berg92ffe052008-09-16 20:39:36 +02002900 }
Johannes Berg3b858752009-03-12 09:55:09 +01002901
Aviya Erenfeldc6e6a0c2016-07-05 15:23:08 +03002902 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
2903 const u8 *mumimo_groups;
2904 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2905
2906 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2907 return -EOPNOTSUPP;
2908
2909 mumimo_groups =
2910 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
2911
2912 /* bits 0 and 63 are reserved and must be zero */
2913 if ((mumimo_groups[0] & BIT(7)) ||
2914 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(0)))
2915 return -EINVAL;
2916
2917 memcpy(params.vht_mumimo_groups, mumimo_groups,
2918 VHT_MUMIMO_GROUPS_DATA_LEN);
2919 change = true;
2920 }
2921
2922 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
2923 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2924
2925 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2926 return -EOPNOTSUPP;
2927
2928 nla_memcpy(params.macaddr,
2929 info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR],
2930 ETH_ALEN);
2931 change = true;
2932 }
2933
Luciano Coelho18003292013-08-29 13:26:57 +03002934 if (flags && (*flags & MONITOR_FLAG_ACTIVE) &&
Felix Fietkaue057d3c2013-05-28 13:01:52 +02002935 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
2936 return -EOPNOTSUPP;
2937
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002938 if (change)
Johannes Berg3d54d252009-08-21 14:51:05 +02002939 err = cfg80211_change_iface(rdev, dev, ntype, flags, &params);
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002940 else
2941 err = 0;
Johannes Berg60719ff2008-09-16 14:55:09 +02002942
Johannes Berg9bc383d2009-11-19 11:55:19 +01002943 if (!err && params.use_4addr != -1)
2944 dev->ieee80211_ptr->use_4addr = params.use_4addr;
2945
Johannes Berg55682962007-09-20 13:09:35 -04002946 return err;
2947}
2948
2949static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
2950{
Johannes Berg4c476992010-10-04 21:36:35 +02002951 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01002952 struct vif_params params;
Johannes Berg84efbb82012-06-16 00:00:26 +02002953 struct wireless_dev *wdev;
Denis Kenzior896ff062016-08-03 16:58:33 -05002954 struct sk_buff *msg;
Johannes Berg55682962007-09-20 13:09:35 -04002955 int err;
2956 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
Michael Wu66f7ac52008-01-31 19:48:22 +01002957 u32 flags;
Johannes Berg55682962007-09-20 13:09:35 -04002958
Johannes Berg78f22b62014-03-24 17:57:27 +01002959 /* to avoid failing a new interface creation due to pending removal */
2960 cfg80211_destroy_ifaces(rdev);
2961
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01002962 memset(&params, 0, sizeof(params));
2963
Johannes Berg55682962007-09-20 13:09:35 -04002964 if (!info->attrs[NL80211_ATTR_IFNAME])
2965 return -EINVAL;
2966
2967 if (info->attrs[NL80211_ATTR_IFTYPE]) {
2968 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2969 if (type > NL80211_IFTYPE_MAX)
2970 return -EINVAL;
2971 }
2972
Johannes Berg79c97e92009-07-07 03:56:12 +02002973 if (!rdev->ops->add_virtual_intf ||
Johannes Berg4c476992010-10-04 21:36:35 +02002974 !(rdev->wiphy.interface_modes & (1 << type)))
2975 return -EOPNOTSUPP;
Johannes Berg55682962007-09-20 13:09:35 -04002976
Ayala Bekercb3b7d82016-09-20 17:31:13 +03002977 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
Ben Greeare8f479b2014-10-22 12:23:05 -07002978 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
2979 info->attrs[NL80211_ATTR_MAC]) {
Arend van Spriel1c18f142013-01-08 10:17:27 +01002980 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
2981 ETH_ALEN);
2982 if (!is_valid_ether_addr(params.macaddr))
2983 return -EADDRNOTAVAIL;
2984 }
2985
Johannes Berg9bc383d2009-11-19 11:55:19 +01002986 if (info->attrs[NL80211_ATTR_4ADDR]) {
Felix Fietkau8b787642009-11-10 18:53:10 +01002987 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002988 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
Johannes Berg9bc383d2009-11-19 11:55:19 +01002989 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02002990 return err;
Johannes Berg9bc383d2009-11-19 11:55:19 +01002991 }
Felix Fietkau8b787642009-11-10 18:53:10 +01002992
Michael Wu66f7ac52008-01-31 19:48:22 +01002993 err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
2994 info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
2995 &flags);
Felix Fietkaue057d3c2013-05-28 13:01:52 +02002996
Luciano Coelho18003292013-08-29 13:26:57 +03002997 if (!err && (flags & MONITOR_FLAG_ACTIVE) &&
Felix Fietkaue057d3c2013-05-28 13:01:52 +02002998 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
2999 return -EOPNOTSUPP;
3000
Johannes Berga18c7192015-02-24 10:56:42 +01003001 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3002 if (!msg)
3003 return -ENOMEM;
3004
Hila Gonene35e4d22012-06-27 17:19:42 +03003005 wdev = rdev_add_virtual_intf(rdev,
3006 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
Tom Gundersen6bab2e192015-03-18 11:13:39 +01003007 NET_NAME_USER, type, err ? NULL : &flags,
3008 &params);
Rafał Miłeckid687cbb2014-11-14 18:43:28 +01003009 if (WARN_ON(!wdev)) {
3010 nlmsg_free(msg);
3011 return -EPROTO;
3012 } else if (IS_ERR(wdev)) {
Johannes Berg1c90f9d2012-06-16 00:05:37 +02003013 nlmsg_free(msg);
Johannes Berg84efbb82012-06-16 00:00:26 +02003014 return PTR_ERR(wdev);
Johannes Berg1c90f9d2012-06-16 00:05:37 +02003015 }
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01003016
Jukka Rissanen18e5ca62014-11-13 17:25:14 +02003017 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
Johannes Berg78f22b62014-03-24 17:57:27 +01003018 wdev->owner_nlportid = info->snd_portid;
3019
Johannes Berg98104fde2012-06-16 00:19:54 +02003020 switch (type) {
3021 case NL80211_IFTYPE_MESH_POINT:
3022 if (!info->attrs[NL80211_ATTR_MESH_ID])
3023 break;
Johannes Berg29cbe682010-12-03 09:20:44 +01003024 wdev_lock(wdev);
3025 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
3026 IEEE80211_MAX_MESH_ID_LEN);
3027 wdev->mesh_id_up_len =
3028 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
3029 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
3030 wdev->mesh_id_up_len);
3031 wdev_unlock(wdev);
Johannes Berg98104fde2012-06-16 00:19:54 +02003032 break;
Ayala Bekercb3b7d82016-09-20 17:31:13 +03003033 case NL80211_IFTYPE_NAN:
Johannes Berg98104fde2012-06-16 00:19:54 +02003034 case NL80211_IFTYPE_P2P_DEVICE:
3035 /*
Ayala Bekercb3b7d82016-09-20 17:31:13 +03003036 * P2P Device and NAN do not have a netdev, so don't go
Johannes Berg98104fde2012-06-16 00:19:54 +02003037 * through the netdev notifier and must be added here
3038 */
3039 mutex_init(&wdev->mtx);
3040 INIT_LIST_HEAD(&wdev->event_list);
3041 spin_lock_init(&wdev->event_lock);
3042 INIT_LIST_HEAD(&wdev->mgmt_registrations);
3043 spin_lock_init(&wdev->mgmt_registrations_lock);
3044
Johannes Berg98104fde2012-06-16 00:19:54 +02003045 wdev->identifier = ++rdev->wdev_id;
Johannes Berg53873f12016-05-03 16:52:04 +03003046 list_add_rcu(&wdev->list, &rdev->wiphy.wdev_list);
Johannes Berg98104fde2012-06-16 00:19:54 +02003047 rdev->devlist_generation++;
Johannes Berg98104fde2012-06-16 00:19:54 +02003048 break;
3049 default:
3050 break;
Johannes Berg29cbe682010-12-03 09:20:44 +01003051 }
3052
Eric W. Biederman15e47302012-09-07 20:12:54 +00003053 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02003054 rdev, wdev, false) < 0) {
Johannes Berg1c90f9d2012-06-16 00:05:37 +02003055 nlmsg_free(msg);
3056 return -ENOBUFS;
3057 }
3058
Denis Kenzior896ff062016-08-03 16:58:33 -05003059 /*
3060 * For wdevs which have no associated netdev object (e.g. of type
3061 * NL80211_IFTYPE_P2P_DEVICE), emit the NEW_INTERFACE event here.
3062 * For all other types, the event will be generated from the
3063 * netdev notifier
3064 */
3065 if (!wdev->netdev)
3066 nl80211_notify_iface(rdev, wdev, NL80211_CMD_NEW_INTERFACE);
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02003067
Johannes Berg1c90f9d2012-06-16 00:05:37 +02003068 return genlmsg_reply(msg, info);
Johannes Berg55682962007-09-20 13:09:35 -04003069}
3070
3071static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
3072{
Johannes Berg4c476992010-10-04 21:36:35 +02003073 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg84efbb82012-06-16 00:00:26 +02003074 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg55682962007-09-20 13:09:35 -04003075
Johannes Berg4c476992010-10-04 21:36:35 +02003076 if (!rdev->ops->del_virtual_intf)
3077 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01003078
Johannes Berg84efbb82012-06-16 00:00:26 +02003079 /*
3080 * If we remove a wireless device without a netdev then clear
3081 * user_ptr[1] so that nl80211_post_doit won't dereference it
3082 * to check if it needs to do dev_put(). Otherwise it crashes
3083 * since the wdev has been freed, unlike with a netdev where
3084 * we need the dev_put() for the netdev to really be freed.
3085 */
3086 if (!wdev->netdev)
3087 info->user_ptr[1] = NULL;
3088
Denis Kenzior7f8ed012016-08-03 16:58:35 -05003089 return rdev_del_virtual_intf(rdev, wdev);
Johannes Berg55682962007-09-20 13:09:35 -04003090}
3091
Simon Wunderlich1d9d9212011-11-18 14:20:43 +01003092static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
3093{
3094 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3095 struct net_device *dev = info->user_ptr[1];
3096 u16 noack_map;
3097
3098 if (!info->attrs[NL80211_ATTR_NOACK_MAP])
3099 return -EINVAL;
3100
3101 if (!rdev->ops->set_noack_map)
3102 return -EOPNOTSUPP;
3103
3104 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
3105
Hila Gonene35e4d22012-06-27 17:19:42 +03003106 return rdev_set_noack_map(rdev, dev, noack_map);
Simon Wunderlich1d9d9212011-11-18 14:20:43 +01003107}
3108
Johannes Berg41ade002007-12-19 02:03:29 +01003109struct get_key_cookie {
3110 struct sk_buff *msg;
3111 int error;
Johannes Bergb9454e82009-07-08 13:29:08 +02003112 int idx;
Johannes Berg41ade002007-12-19 02:03:29 +01003113};
3114
3115static void get_key_callback(void *c, struct key_params *params)
3116{
Johannes Bergb9454e82009-07-08 13:29:08 +02003117 struct nlattr *key;
Johannes Berg41ade002007-12-19 02:03:29 +01003118 struct get_key_cookie *cookie = c;
3119
David S. Miller9360ffd2012-03-29 04:41:26 -04003120 if ((params->key &&
3121 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
3122 params->key_len, params->key)) ||
3123 (params->seq &&
3124 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
3125 params->seq_len, params->seq)) ||
3126 (params->cipher &&
3127 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
3128 params->cipher)))
3129 goto nla_put_failure;
Johannes Berg41ade002007-12-19 02:03:29 +01003130
Johannes Bergb9454e82009-07-08 13:29:08 +02003131 key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
3132 if (!key)
3133 goto nla_put_failure;
3134
David S. Miller9360ffd2012-03-29 04:41:26 -04003135 if ((params->key &&
3136 nla_put(cookie->msg, NL80211_KEY_DATA,
3137 params->key_len, params->key)) ||
3138 (params->seq &&
3139 nla_put(cookie->msg, NL80211_KEY_SEQ,
3140 params->seq_len, params->seq)) ||
3141 (params->cipher &&
3142 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
3143 params->cipher)))
3144 goto nla_put_failure;
Johannes Bergb9454e82009-07-08 13:29:08 +02003145
Andrew Zaborowski594bc9a2018-09-24 18:10:22 +02003146 if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx))
David S. Miller9360ffd2012-03-29 04:41:26 -04003147 goto nla_put_failure;
Johannes Bergb9454e82009-07-08 13:29:08 +02003148
3149 nla_nest_end(cookie->msg, key);
3150
Johannes Berg41ade002007-12-19 02:03:29 +01003151 return;
3152 nla_put_failure:
3153 cookie->error = 1;
3154}
3155
3156static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
3157{
Johannes Berg4c476992010-10-04 21:36:35 +02003158 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg41ade002007-12-19 02:03:29 +01003159 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02003160 struct net_device *dev = info->user_ptr[1];
Johannes Berg41ade002007-12-19 02:03:29 +01003161 u8 key_idx = 0;
Johannes Berge31b8212010-10-05 19:39:30 +02003162 const u8 *mac_addr = NULL;
3163 bool pairwise;
Johannes Berg41ade002007-12-19 02:03:29 +01003164 struct get_key_cookie cookie = {
3165 .error = 0,
3166 };
3167 void *hdr;
3168 struct sk_buff *msg;
3169
Jouni Malinena2be0702020-03-27 18:20:31 +05303170 if (info->attrs[NL80211_ATTR_KEY_IDX]) {
Johannes Berg41ade002007-12-19 02:03:29 +01003171 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
Jouni Malinena2be0702020-03-27 18:20:31 +05303172 if (key_idx > 5 &&
3173 !wiphy_ext_feature_isset(&rdev->wiphy,
3174 NL80211_EXT_FEATURE_BEACON_PROTECTION))
3175 return -EINVAL;
3176 }
Johannes Berg41ade002007-12-19 02:03:29 +01003177
Jouni Malinena2be0702020-03-27 18:20:31 +05303178 if (key_idx > 7)
Johannes Berg41ade002007-12-19 02:03:29 +01003179 return -EINVAL;
3180
3181 if (info->attrs[NL80211_ATTR_MAC])
3182 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3183
Johannes Berge31b8212010-10-05 19:39:30 +02003184 pairwise = !!mac_addr;
3185 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
3186 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07003187
Johannes Berge31b8212010-10-05 19:39:30 +02003188 if (kt >= NUM_NL80211_KEYTYPES)
3189 return -EINVAL;
3190 if (kt != NL80211_KEYTYPE_GROUP &&
3191 kt != NL80211_KEYTYPE_PAIRWISE)
3192 return -EINVAL;
3193 pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
3194 }
3195
Johannes Berg4c476992010-10-04 21:36:35 +02003196 if (!rdev->ops->get_key)
3197 return -EOPNOTSUPP;
Johannes Berg41ade002007-12-19 02:03:29 +01003198
Johannes Berg0fa7b392015-01-23 11:10:12 +01003199 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3200 return -ENOENT;
3201
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -07003202 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg4c476992010-10-04 21:36:35 +02003203 if (!msg)
3204 return -ENOMEM;
Johannes Berg41ade002007-12-19 02:03:29 +01003205
Eric W. Biederman15e47302012-09-07 20:12:54 +00003206 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Johannes Berg41ade002007-12-19 02:03:29 +01003207 NL80211_CMD_NEW_KEY);
Dan Carpentercb35fba2013-08-14 14:50:01 +03003208 if (!hdr)
Johannes Berg9fe271a2013-10-25 11:15:12 +02003209 goto nla_put_failure;
Johannes Berg41ade002007-12-19 02:03:29 +01003210
3211 cookie.msg = msg;
Johannes Bergb9454e82009-07-08 13:29:08 +02003212 cookie.idx = key_idx;
Johannes Berg41ade002007-12-19 02:03:29 +01003213
David S. Miller9360ffd2012-03-29 04:41:26 -04003214 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3215 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
3216 goto nla_put_failure;
3217 if (mac_addr &&
3218 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
3219 goto nla_put_failure;
Johannes Berg41ade002007-12-19 02:03:29 +01003220
Hila Gonene35e4d22012-06-27 17:19:42 +03003221 err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
3222 get_key_callback);
Johannes Berg41ade002007-12-19 02:03:29 +01003223
3224 if (err)
Niko Jokinen6c95e2a2009-07-15 11:00:53 +03003225 goto free_msg;
Johannes Berg41ade002007-12-19 02:03:29 +01003226
3227 if (cookie.error)
3228 goto nla_put_failure;
3229
3230 genlmsg_end(msg, hdr);
Johannes Berg4c476992010-10-04 21:36:35 +02003231 return genlmsg_reply(msg, info);
Johannes Berg41ade002007-12-19 02:03:29 +01003232
3233 nla_put_failure:
3234 err = -ENOBUFS;
Niko Jokinen6c95e2a2009-07-15 11:00:53 +03003235 free_msg:
Johannes Berg41ade002007-12-19 02:03:29 +01003236 nlmsg_free(msg);
Johannes Berg41ade002007-12-19 02:03:29 +01003237 return err;
3238}
3239
3240static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
3241{
Johannes Berg4c476992010-10-04 21:36:35 +02003242 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Bergb9454e82009-07-08 13:29:08 +02003243 struct key_parse key;
Johannes Berg41ade002007-12-19 02:03:29 +01003244 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02003245 struct net_device *dev = info->user_ptr[1];
Johannes Berg41ade002007-12-19 02:03:29 +01003246
Johannes Bergb9454e82009-07-08 13:29:08 +02003247 err = nl80211_parse_key(info, &key);
3248 if (err)
3249 return err;
3250
3251 if (key.idx < 0)
Johannes Berg41ade002007-12-19 02:03:29 +01003252 return -EINVAL;
3253
Johannes Bergb9454e82009-07-08 13:29:08 +02003254 /* only support setting default key */
Jouni Malinena2be0702020-03-27 18:20:31 +05303255 if (!key.def && !key.defmgmt && !key.defbeacon)
Johannes Berg41ade002007-12-19 02:03:29 +01003256 return -EINVAL;
3257
Johannes Bergfffd0932009-07-08 14:22:54 +02003258 wdev_lock(dev->ieee80211_ptr);
Johannes Bergdbd2fd62010-12-09 19:58:59 +01003259
3260 if (key.def) {
3261 if (!rdev->ops->set_default_key) {
3262 err = -EOPNOTSUPP;
3263 goto out;
3264 }
3265
3266 err = nl80211_key_allowed(dev->ieee80211_ptr);
3267 if (err)
3268 goto out;
3269
Hila Gonene35e4d22012-06-27 17:19:42 +03003270 err = rdev_set_default_key(rdev, dev, key.idx,
Johannes Bergdbd2fd62010-12-09 19:58:59 +01003271 key.def_uni, key.def_multi);
3272
3273 if (err)
3274 goto out;
Johannes Bergfffd0932009-07-08 14:22:54 +02003275
Johannes Berg3d23e342009-09-29 23:27:28 +02003276#ifdef CONFIG_CFG80211_WEXT
Johannes Bergdbd2fd62010-12-09 19:58:59 +01003277 dev->ieee80211_ptr->wext.default_key = key.idx;
Johannes Berg08645122009-05-11 13:54:58 +02003278#endif
Jouni Malinena2be0702020-03-27 18:20:31 +05303279 } else if (key.defbeacon) {
3280 if (key.def_uni || !key.def_multi) {
3281 err = -EINVAL;
3282 goto out;
3283 }
3284
3285 if (!rdev->ops->set_default_beacon_key) {
3286 err = -EOPNOTSUPP;
3287 goto out;
3288 }
3289
3290 err = nl80211_key_allowed(dev->ieee80211_ptr);
3291 if (err)
3292 goto out;
3293
3294 err = rdev_set_default_beacon_key(rdev, dev, key.idx);
3295 if (err)
3296 goto out;
Johannes Bergdbd2fd62010-12-09 19:58:59 +01003297 } else {
3298 if (key.def_uni || !key.def_multi) {
3299 err = -EINVAL;
3300 goto out;
3301 }
3302
3303 if (!rdev->ops->set_default_mgmt_key) {
3304 err = -EOPNOTSUPP;
3305 goto out;
3306 }
3307
3308 err = nl80211_key_allowed(dev->ieee80211_ptr);
3309 if (err)
3310 goto out;
3311
Hila Gonene35e4d22012-06-27 17:19:42 +03003312 err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
Johannes Bergdbd2fd62010-12-09 19:58:59 +01003313 if (err)
3314 goto out;
3315
3316#ifdef CONFIG_CFG80211_WEXT
3317 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
3318#endif
3319 }
3320
3321 out:
Johannes Bergfffd0932009-07-08 14:22:54 +02003322 wdev_unlock(dev->ieee80211_ptr);
Johannes Berg41ade002007-12-19 02:03:29 +01003323
Johannes Berg41ade002007-12-19 02:03:29 +01003324 return err;
3325}
3326
3327static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
3328{
Johannes Berg4c476992010-10-04 21:36:35 +02003329 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Bergfffd0932009-07-08 14:22:54 +02003330 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02003331 struct net_device *dev = info->user_ptr[1];
Johannes Bergb9454e82009-07-08 13:29:08 +02003332 struct key_parse key;
Johannes Berge31b8212010-10-05 19:39:30 +02003333 const u8 *mac_addr = NULL;
Johannes Berg41ade002007-12-19 02:03:29 +01003334
Johannes Bergb9454e82009-07-08 13:29:08 +02003335 err = nl80211_parse_key(info, &key);
3336 if (err)
3337 return err;
Johannes Berg41ade002007-12-19 02:03:29 +01003338
Johannes Bergb9454e82009-07-08 13:29:08 +02003339 if (!key.p.key)
Johannes Berg41ade002007-12-19 02:03:29 +01003340 return -EINVAL;
3341
Johannes Berg41ade002007-12-19 02:03:29 +01003342 if (info->attrs[NL80211_ATTR_MAC])
3343 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3344
Johannes Berge31b8212010-10-05 19:39:30 +02003345 if (key.type == -1) {
3346 if (mac_addr)
3347 key.type = NL80211_KEYTYPE_PAIRWISE;
3348 else
3349 key.type = NL80211_KEYTYPE_GROUP;
3350 }
3351
3352 /* for now */
3353 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3354 key.type != NL80211_KEYTYPE_GROUP)
3355 return -EINVAL;
3356
Johannes Berg4c476992010-10-04 21:36:35 +02003357 if (!rdev->ops->add_key)
3358 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01003359
Johannes Berge31b8212010-10-05 19:39:30 +02003360 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
3361 key.type == NL80211_KEYTYPE_PAIRWISE,
3362 mac_addr))
Johannes Berg4c476992010-10-04 21:36:35 +02003363 return -EINVAL;
Johannes Bergfffd0932009-07-08 14:22:54 +02003364
3365 wdev_lock(dev->ieee80211_ptr);
3366 err = nl80211_key_allowed(dev->ieee80211_ptr);
3367 if (!err)
Hila Gonene35e4d22012-06-27 17:19:42 +03003368 err = rdev_add_key(rdev, dev, key.idx,
3369 key.type == NL80211_KEYTYPE_PAIRWISE,
3370 mac_addr, &key.p);
Johannes Bergfffd0932009-07-08 14:22:54 +02003371 wdev_unlock(dev->ieee80211_ptr);
Johannes Berg41ade002007-12-19 02:03:29 +01003372
Johannes Berg41ade002007-12-19 02:03:29 +01003373 return err;
3374}
3375
3376static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
3377{
Johannes Berg4c476992010-10-04 21:36:35 +02003378 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg41ade002007-12-19 02:03:29 +01003379 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02003380 struct net_device *dev = info->user_ptr[1];
Johannes Berg41ade002007-12-19 02:03:29 +01003381 u8 *mac_addr = NULL;
Johannes Bergb9454e82009-07-08 13:29:08 +02003382 struct key_parse key;
Johannes Berg41ade002007-12-19 02:03:29 +01003383
Johannes Bergb9454e82009-07-08 13:29:08 +02003384 err = nl80211_parse_key(info, &key);
3385 if (err)
3386 return err;
Johannes Berg41ade002007-12-19 02:03:29 +01003387
3388 if (info->attrs[NL80211_ATTR_MAC])
3389 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3390
Johannes Berge31b8212010-10-05 19:39:30 +02003391 if (key.type == -1) {
3392 if (mac_addr)
3393 key.type = NL80211_KEYTYPE_PAIRWISE;
3394 else
3395 key.type = NL80211_KEYTYPE_GROUP;
3396 }
3397
3398 /* for now */
3399 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3400 key.type != NL80211_KEYTYPE_GROUP)
3401 return -EINVAL;
3402
Johannes Berg4c476992010-10-04 21:36:35 +02003403 if (!rdev->ops->del_key)
3404 return -EOPNOTSUPP;
Johannes Berg41ade002007-12-19 02:03:29 +01003405
Johannes Bergfffd0932009-07-08 14:22:54 +02003406 wdev_lock(dev->ieee80211_ptr);
3407 err = nl80211_key_allowed(dev->ieee80211_ptr);
Johannes Berge31b8212010-10-05 19:39:30 +02003408
Johannes Berg0fa7b392015-01-23 11:10:12 +01003409 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
Johannes Berge31b8212010-10-05 19:39:30 +02003410 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3411 err = -ENOENT;
3412
Johannes Bergfffd0932009-07-08 14:22:54 +02003413 if (!err)
Hila Gonene35e4d22012-06-27 17:19:42 +03003414 err = rdev_del_key(rdev, dev, key.idx,
3415 key.type == NL80211_KEYTYPE_PAIRWISE,
3416 mac_addr);
Johannes Berg41ade002007-12-19 02:03:29 +01003417
Johannes Berg3d23e342009-09-29 23:27:28 +02003418#ifdef CONFIG_CFG80211_WEXT
Johannes Berg08645122009-05-11 13:54:58 +02003419 if (!err) {
Johannes Bergb9454e82009-07-08 13:29:08 +02003420 if (key.idx == dev->ieee80211_ptr->wext.default_key)
Johannes Berg08645122009-05-11 13:54:58 +02003421 dev->ieee80211_ptr->wext.default_key = -1;
Johannes Bergb9454e82009-07-08 13:29:08 +02003422 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
Johannes Berg08645122009-05-11 13:54:58 +02003423 dev->ieee80211_ptr->wext.default_mgmt_key = -1;
3424 }
3425#endif
Johannes Bergfffd0932009-07-08 14:22:54 +02003426 wdev_unlock(dev->ieee80211_ptr);
Johannes Berg08645122009-05-11 13:54:58 +02003427
Johannes Berg41ade002007-12-19 02:03:29 +01003428 return err;
3429}
3430
Vasanthakumar Thiagarajan77765ea2013-01-18 11:18:45 +05303431/* This function returns an error or the number of nested attributes */
3432static int validate_acl_mac_addrs(struct nlattr *nl_attr)
3433{
3434 struct nlattr *attr;
3435 int n_entries = 0, tmp;
3436
3437 nla_for_each_nested(attr, nl_attr, tmp) {
3438 if (nla_len(attr) != ETH_ALEN)
3439 return -EINVAL;
3440
3441 n_entries++;
3442 }
3443
3444 return n_entries;
3445}
3446
3447/*
3448 * This function parses ACL information and allocates memory for ACL data.
3449 * On successful return, the calling function is responsible to free the
3450 * ACL buffer returned by this function.
3451 */
3452static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
3453 struct genl_info *info)
3454{
3455 enum nl80211_acl_policy acl_policy;
3456 struct nlattr *attr;
3457 struct cfg80211_acl_data *acl;
3458 int i = 0, n_entries, tmp;
3459
3460 if (!wiphy->max_acl_mac_addrs)
3461 return ERR_PTR(-EOPNOTSUPP);
3462
3463 if (!info->attrs[NL80211_ATTR_ACL_POLICY])
3464 return ERR_PTR(-EINVAL);
3465
3466 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
3467 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
3468 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
3469 return ERR_PTR(-EINVAL);
3470
3471 if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
3472 return ERR_PTR(-EINVAL);
3473
3474 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
3475 if (n_entries < 0)
3476 return ERR_PTR(n_entries);
3477
3478 if (n_entries > wiphy->max_acl_mac_addrs)
3479 return ERR_PTR(-ENOTSUPP);
3480
3481 acl = kzalloc(sizeof(*acl) + (sizeof(struct mac_address) * n_entries),
3482 GFP_KERNEL);
3483 if (!acl)
3484 return ERR_PTR(-ENOMEM);
3485
3486 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
3487 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
3488 i++;
3489 }
3490
3491 acl->n_acl_entries = n_entries;
3492 acl->acl_policy = acl_policy;
3493
3494 return acl;
3495}
3496
3497static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
3498{
3499 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3500 struct net_device *dev = info->user_ptr[1];
3501 struct cfg80211_acl_data *acl;
3502 int err;
3503
3504 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3505 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3506 return -EOPNOTSUPP;
3507
3508 if (!dev->ieee80211_ptr->beacon_interval)
3509 return -EINVAL;
3510
3511 acl = parse_acl_data(&rdev->wiphy, info);
3512 if (IS_ERR(acl))
3513 return PTR_ERR(acl);
3514
3515 err = rdev_set_mac_acl(rdev, dev, acl);
3516
3517 kfree(acl);
3518
3519 return err;
3520}
3521
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303522static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
3523 u8 *rates, u8 rates_len)
3524{
3525 u8 i;
3526 u32 mask = 0;
3527
3528 for (i = 0; i < rates_len; i++) {
3529 int rate = (rates[i] & 0x7f) * 5;
3530 int ridx;
3531
3532 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
3533 struct ieee80211_rate *srate =
3534 &sband->bitrates[ridx];
3535 if (rate == srate->bitrate) {
3536 mask |= 1 << ridx;
3537 break;
3538 }
3539 }
3540 if (ridx == sband->n_bitrates)
3541 return 0; /* rate not found */
3542 }
3543
3544 return mask;
3545}
3546
3547static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
3548 u8 *rates, u8 rates_len,
3549 u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
3550{
3551 u8 i;
3552
3553 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
3554
3555 for (i = 0; i < rates_len; i++) {
3556 int ridx, rbit;
3557
3558 ridx = rates[i] / 8;
3559 rbit = BIT(rates[i] % 8);
3560
3561 /* check validity */
3562 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
3563 return false;
3564
3565 /* check availability */
Masashi Honma6e93cd92018-09-25 11:15:00 +09003566 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN);
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303567 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
3568 mcs[ridx] |= rbit;
3569 else
3570 return false;
3571 }
3572
3573 return true;
3574}
3575
3576static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
3577{
3578 u16 mcs_mask = 0;
3579
3580 switch (vht_mcs_map) {
3581 case IEEE80211_VHT_MCS_NOT_SUPPORTED:
3582 break;
3583 case IEEE80211_VHT_MCS_SUPPORT_0_7:
3584 mcs_mask = 0x00FF;
3585 break;
3586 case IEEE80211_VHT_MCS_SUPPORT_0_8:
3587 mcs_mask = 0x01FF;
3588 break;
3589 case IEEE80211_VHT_MCS_SUPPORT_0_9:
3590 mcs_mask = 0x03FF;
3591 break;
3592 default:
3593 break;
3594 }
3595
3596 return mcs_mask;
3597}
3598
3599static void vht_build_mcs_mask(u16 vht_mcs_map,
3600 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
3601{
3602 u8 nss;
3603
3604 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
3605 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
3606 vht_mcs_map >>= 2;
3607 }
3608}
3609
3610static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
3611 struct nl80211_txrate_vht *txrate,
3612 u16 mcs[NL80211_VHT_NSS_MAX])
3613{
3614 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3615 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
3616 u8 i;
3617
3618 if (!sband->vht_cap.vht_supported)
3619 return false;
3620
3621 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
3622
3623 /* Build vht_mcs_mask from VHT capabilities */
3624 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
3625
3626 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
3627 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
3628 mcs[i] = txrate->mcs[i];
3629 else
3630 return false;
3631 }
3632
3633 return true;
3634}
3635
3636static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
3637 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
3638 .len = NL80211_MAX_SUPP_RATES },
3639 [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
3640 .len = NL80211_MAX_SUPP_HT_RATES },
3641 [NL80211_TXRATE_VHT] = { .len = sizeof(struct nl80211_txrate_vht)},
3642 [NL80211_TXRATE_GI] = { .type = NLA_U8 },
3643};
3644
3645static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
3646 struct cfg80211_bitrate_mask *mask)
3647{
3648 struct nlattr *tb[NL80211_TXRATE_MAX + 1];
3649 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3650 int rem, i;
3651 struct nlattr *tx_rates;
3652 struct ieee80211_supported_band *sband;
3653 u16 vht_tx_mcs_map;
3654
3655 memset(mask, 0, sizeof(*mask));
3656 /* Default to all rates enabled */
3657 for (i = 0; i < NUM_NL80211_BANDS; i++) {
3658 sband = rdev->wiphy.bands[i];
3659
3660 if (!sband)
3661 continue;
3662
3663 mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
3664 memcpy(mask->control[i].ht_mcs,
3665 sband->ht_cap.mcs.rx_mask,
3666 sizeof(mask->control[i].ht_mcs));
3667
3668 if (!sband->vht_cap.vht_supported)
3669 continue;
3670
3671 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3672 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
3673 }
3674
3675 /* if no rates are given set it back to the defaults */
3676 if (!info->attrs[NL80211_ATTR_TX_RATES])
3677 goto out;
3678
3679 /* The nested attribute uses enum nl80211_band as the index. This maps
3680 * directly to the enum nl80211_band values used in cfg80211.
3681 */
3682 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
3683 nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
3684 enum nl80211_band band = nla_type(tx_rates);
3685 int err;
3686
3687 if (band < 0 || band >= NUM_NL80211_BANDS)
3688 return -EINVAL;
3689 sband = rdev->wiphy.bands[band];
3690 if (sband == NULL)
3691 return -EINVAL;
3692 err = nla_parse(tb, NL80211_TXRATE_MAX, nla_data(tx_rates),
3693 nla_len(tx_rates), nl80211_txattr_policy);
3694 if (err)
3695 return err;
3696 if (tb[NL80211_TXRATE_LEGACY]) {
3697 mask->control[band].legacy = rateset_to_mask(
3698 sband,
3699 nla_data(tb[NL80211_TXRATE_LEGACY]),
3700 nla_len(tb[NL80211_TXRATE_LEGACY]));
3701 if ((mask->control[band].legacy == 0) &&
3702 nla_len(tb[NL80211_TXRATE_LEGACY]))
3703 return -EINVAL;
3704 }
3705 if (tb[NL80211_TXRATE_HT]) {
3706 if (!ht_rateset_to_mask(
3707 sband,
3708 nla_data(tb[NL80211_TXRATE_HT]),
3709 nla_len(tb[NL80211_TXRATE_HT]),
3710 mask->control[band].ht_mcs))
3711 return -EINVAL;
3712 }
3713 if (tb[NL80211_TXRATE_VHT]) {
3714 if (!vht_set_mcs_mask(
3715 sband,
3716 nla_data(tb[NL80211_TXRATE_VHT]),
3717 mask->control[band].vht_mcs))
3718 return -EINVAL;
3719 }
3720 if (tb[NL80211_TXRATE_GI]) {
3721 mask->control[band].gi =
3722 nla_get_u8(tb[NL80211_TXRATE_GI]);
3723 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
3724 return -EINVAL;
3725 }
3726
3727 if (mask->control[band].legacy == 0) {
3728 /* don't allow empty legacy rates if HT or VHT
3729 * are not even supported.
3730 */
3731 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
3732 rdev->wiphy.bands[band]->vht_cap.vht_supported))
3733 return -EINVAL;
3734
3735 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
3736 if (mask->control[band].ht_mcs[i])
3737 goto out;
3738
3739 for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
3740 if (mask->control[band].vht_mcs[i])
3741 goto out;
3742
3743 /* legacy and mcs rates may not be both empty */
3744 return -EINVAL;
3745 }
3746 }
3747
3748out:
3749 return 0;
3750}
3751
Johannes Berg8564e382016-09-19 09:44:44 +02003752static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
3753 enum nl80211_band band,
3754 struct cfg80211_bitrate_mask *beacon_rate)
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303755{
Johannes Berg8564e382016-09-19 09:44:44 +02003756 u32 count_ht, count_vht, i;
3757 u32 rate = beacon_rate->control[band].legacy;
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303758
3759 /* Allow only one rate */
3760 if (hweight32(rate) > 1)
3761 return -EINVAL;
3762
3763 count_ht = 0;
3764 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
Johannes Berg8564e382016-09-19 09:44:44 +02003765 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303766 return -EINVAL;
Johannes Berg8564e382016-09-19 09:44:44 +02003767 } else if (beacon_rate->control[band].ht_mcs[i]) {
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303768 count_ht++;
3769 if (count_ht > 1)
3770 return -EINVAL;
3771 }
3772 if (count_ht && rate)
3773 return -EINVAL;
3774 }
3775
3776 count_vht = 0;
3777 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
Johannes Berg8564e382016-09-19 09:44:44 +02003778 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303779 return -EINVAL;
Johannes Berg8564e382016-09-19 09:44:44 +02003780 } else if (beacon_rate->control[band].vht_mcs[i]) {
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303781 count_vht++;
3782 if (count_vht > 1)
3783 return -EINVAL;
3784 }
3785 if (count_vht && rate)
3786 return -EINVAL;
3787 }
3788
3789 if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
3790 return -EINVAL;
3791
Johannes Berg8564e382016-09-19 09:44:44 +02003792 if (rate &&
3793 !wiphy_ext_feature_isset(&rdev->wiphy,
3794 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
3795 return -EINVAL;
3796 if (count_ht &&
3797 !wiphy_ext_feature_isset(&rdev->wiphy,
3798 NL80211_EXT_FEATURE_BEACON_RATE_HT))
3799 return -EINVAL;
3800 if (count_vht &&
3801 !wiphy_ext_feature_isset(&rdev->wiphy,
3802 NL80211_EXT_FEATURE_BEACON_RATE_VHT))
3803 return -EINVAL;
3804
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303805 return 0;
3806}
3807
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003808static int nl80211_parse_beacon(struct nlattr *attrs[],
Johannes Berg88600202012-02-13 15:17:18 +01003809 struct cfg80211_beacon_data *bcn)
Johannes Berged1b6cc2007-12-19 02:03:32 +01003810{
Johannes Berg88600202012-02-13 15:17:18 +01003811 bool haveinfo = false;
Johannes Berged1b6cc2007-12-19 02:03:32 +01003812
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003813 if (!is_valid_ie_attr(attrs[NL80211_ATTR_BEACON_TAIL]) ||
3814 !is_valid_ie_attr(attrs[NL80211_ATTR_IE]) ||
3815 !is_valid_ie_attr(attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
3816 !is_valid_ie_attr(attrs[NL80211_ATTR_IE_ASSOC_RESP]))
Johannes Bergf4a11bb2009-03-27 12:40:28 +01003817 return -EINVAL;
3818
Johannes Berg88600202012-02-13 15:17:18 +01003819 memset(bcn, 0, sizeof(*bcn));
Johannes Berged1b6cc2007-12-19 02:03:32 +01003820
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003821 if (attrs[NL80211_ATTR_BEACON_HEAD]) {
Johannes Berga873afd2019-09-20 21:54:17 +02003822 int ret = validate_beacon_head(attrs[NL80211_ATTR_BEACON_HEAD]);
3823
3824 if (ret)
3825 return ret;
3826
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003827 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
3828 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
Johannes Berg88600202012-02-13 15:17:18 +01003829 if (!bcn->head_len)
3830 return -EINVAL;
3831 haveinfo = true;
Johannes Berged1b6cc2007-12-19 02:03:32 +01003832 }
3833
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003834 if (attrs[NL80211_ATTR_BEACON_TAIL]) {
3835 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
3836 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
Johannes Berg88600202012-02-13 15:17:18 +01003837 haveinfo = true;
Johannes Berged1b6cc2007-12-19 02:03:32 +01003838 }
3839
Johannes Berg4c476992010-10-04 21:36:35 +02003840 if (!haveinfo)
3841 return -EINVAL;
Johannes Berged1b6cc2007-12-19 02:03:32 +01003842
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003843 if (attrs[NL80211_ATTR_IE]) {
3844 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
3845 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
Jouni Malinen9946ecf2011-08-10 23:55:56 +03003846 }
3847
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003848 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
Johannes Berg88600202012-02-13 15:17:18 +01003849 bcn->proberesp_ies =
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003850 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
Johannes Berg88600202012-02-13 15:17:18 +01003851 bcn->proberesp_ies_len =
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003852 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
Jouni Malinen9946ecf2011-08-10 23:55:56 +03003853 }
3854
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003855 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
Johannes Berg88600202012-02-13 15:17:18 +01003856 bcn->assocresp_ies =
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003857 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
Johannes Berg88600202012-02-13 15:17:18 +01003858 bcn->assocresp_ies_len =
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003859 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
Jouni Malinen9946ecf2011-08-10 23:55:56 +03003860 }
3861
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003862 if (attrs[NL80211_ATTR_PROBE_RESP]) {
3863 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
3864 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
Arik Nemtsov00f740e2011-11-10 11:28:56 +02003865 }
3866
Johannes Berg88600202012-02-13 15:17:18 +01003867 return 0;
3868}
3869
Felix Fietkau46c1dd02012-06-19 02:50:57 +02003870static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
3871 struct cfg80211_ap_settings *params)
3872{
3873 struct wireless_dev *wdev;
3874 bool ret = false;
3875
Johannes Berg53873f12016-05-03 16:52:04 +03003876 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
Felix Fietkau46c1dd02012-06-19 02:50:57 +02003877 if (wdev->iftype != NL80211_IFTYPE_AP &&
3878 wdev->iftype != NL80211_IFTYPE_P2P_GO)
3879 continue;
3880
Johannes Berg683b6d32012-11-08 21:25:48 +01003881 if (!wdev->preset_chandef.chan)
Felix Fietkau46c1dd02012-06-19 02:50:57 +02003882 continue;
3883
Johannes Berg683b6d32012-11-08 21:25:48 +01003884 params->chandef = wdev->preset_chandef;
Felix Fietkau46c1dd02012-06-19 02:50:57 +02003885 ret = true;
3886 break;
3887 }
3888
Felix Fietkau46c1dd02012-06-19 02:50:57 +02003889 return ret;
3890}
3891
Jouni Malinene39e5b52012-09-30 19:29:39 +03003892static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
3893 enum nl80211_auth_type auth_type,
3894 enum nl80211_commands cmd)
3895{
3896 if (auth_type > NL80211_AUTHTYPE_MAX)
3897 return false;
3898
3899 switch (cmd) {
3900 case NL80211_CMD_AUTHENTICATE:
3901 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
3902 auth_type == NL80211_AUTHTYPE_SAE)
3903 return false;
Jouni Malinene20f90f2016-10-27 00:42:02 +03003904 if (!wiphy_ext_feature_isset(&rdev->wiphy,
3905 NL80211_EXT_FEATURE_FILS_STA) &&
3906 (auth_type == NL80211_AUTHTYPE_FILS_SK ||
3907 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3908 auth_type == NL80211_AUTHTYPE_FILS_PK))
3909 return false;
Jouni Malinene39e5b52012-09-30 19:29:39 +03003910 return true;
3911 case NL80211_CMD_CONNECT:
Srinivas Dasari6fe0e6f2018-01-25 17:13:39 +02003912 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
3913 auth_type == NL80211_AUTHTYPE_SAE)
Vidyullatha Kanchanapally36eabf62017-03-31 00:22:34 +03003914 return false;
Srinivas Dasari6fe0e6f2018-01-25 17:13:39 +02003915
Vidyullatha Kanchanapally36eabf62017-03-31 00:22:34 +03003916 /* FILS with SK PFS or PK not supported yet */
3917 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3918 auth_type == NL80211_AUTHTYPE_FILS_PK)
3919 return false;
3920 if (!wiphy_ext_feature_isset(
3921 &rdev->wiphy,
3922 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
3923 auth_type == NL80211_AUTHTYPE_FILS_SK)
3924 return false;
3925 return true;
Jouni Malinene39e5b52012-09-30 19:29:39 +03003926 case NL80211_CMD_START_AP:
3927 /* SAE not supported yet */
3928 if (auth_type == NL80211_AUTHTYPE_SAE)
3929 return false;
Jouni Malinene20f90f2016-10-27 00:42:02 +03003930 /* FILS not supported yet */
3931 if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
3932 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3933 auth_type == NL80211_AUTHTYPE_FILS_PK)
3934 return false;
Jouni Malinene39e5b52012-09-30 19:29:39 +03003935 return true;
3936 default:
3937 return false;
3938 }
3939}
3940
Johannes Berg88600202012-02-13 15:17:18 +01003941static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
3942{
3943 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3944 struct net_device *dev = info->user_ptr[1];
3945 struct wireless_dev *wdev = dev->ieee80211_ptr;
3946 struct cfg80211_ap_settings params;
3947 int err;
3948
3949 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3950 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3951 return -EOPNOTSUPP;
3952
3953 if (!rdev->ops->start_ap)
3954 return -EOPNOTSUPP;
3955
3956 if (wdev->beacon_interval)
3957 return -EALREADY;
3958
3959 memset(&params, 0, sizeof(params));
3960
3961 /* these are required for START_AP */
3962 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
3963 !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
3964 !info->attrs[NL80211_ATTR_BEACON_HEAD])
3965 return -EINVAL;
3966
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003967 err = nl80211_parse_beacon(info->attrs, &params.beacon);
Johannes Berg88600202012-02-13 15:17:18 +01003968 if (err)
3969 return err;
3970
3971 params.beacon_interval =
3972 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
3973 params.dtim_period =
3974 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
3975
Purushottam Kushwahac6800ff2016-10-12 18:26:51 +05303976 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
3977 params.beacon_interval);
Johannes Berg88600202012-02-13 15:17:18 +01003978 if (err)
3979 return err;
3980
3981 /*
3982 * In theory, some of these attributes should be required here
3983 * but since they were not used when the command was originally
3984 * added, keep them optional for old user space programs to let
3985 * them continue to work with drivers that do not need the
3986 * additional information -- drivers must check!
3987 */
3988 if (info->attrs[NL80211_ATTR_SSID]) {
3989 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
3990 params.ssid_len =
3991 nla_len(info->attrs[NL80211_ATTR_SSID]);
3992 if (params.ssid_len == 0 ||
3993 params.ssid_len > IEEE80211_MAX_SSID_LEN)
3994 return -EINVAL;
3995 }
3996
3997 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
3998 params.hidden_ssid = nla_get_u32(
3999 info->attrs[NL80211_ATTR_HIDDEN_SSID]);
4000 if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
4001 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
4002 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
4003 return -EINVAL;
4004 }
4005
4006 params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
4007
4008 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
4009 params.auth_type = nla_get_u32(
4010 info->attrs[NL80211_ATTR_AUTH_TYPE]);
Jouni Malinene39e5b52012-09-30 19:29:39 +03004011 if (!nl80211_valid_auth_type(rdev, params.auth_type,
4012 NL80211_CMD_START_AP))
Johannes Berg88600202012-02-13 15:17:18 +01004013 return -EINVAL;
4014 } else
4015 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
4016
4017 err = nl80211_crypto_settings(rdev, info, &params.crypto,
4018 NL80211_MAX_NR_CIPHER_SUITES);
4019 if (err)
4020 return err;
4021
Vasanthakumar Thiagarajan1b658f12012-03-02 15:50:02 +05304022 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
4023 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
4024 return -EOPNOTSUPP;
4025 params.inactivity_timeout = nla_get_u16(
4026 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
4027 }
4028
Johannes Berg53cabad2012-11-14 15:17:28 +01004029 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
4030 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4031 return -EINVAL;
4032 params.p2p_ctwindow =
4033 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
4034 if (params.p2p_ctwindow > 127)
4035 return -EINVAL;
4036 if (params.p2p_ctwindow != 0 &&
4037 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
4038 return -EINVAL;
4039 }
4040
4041 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
4042 u8 tmp;
4043
4044 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4045 return -EINVAL;
4046 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
4047 if (tmp > 1)
4048 return -EINVAL;
4049 params.p2p_opp_ps = tmp;
4050 if (params.p2p_opp_ps != 0 &&
4051 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
4052 return -EINVAL;
4053 }
4054
Johannes Bergaa430da2012-05-16 23:50:18 +02004055 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
Johannes Berg683b6d32012-11-08 21:25:48 +01004056 err = nl80211_parse_chandef(rdev, info, &params.chandef);
4057 if (err)
4058 return err;
4059 } else if (wdev->preset_chandef.chan) {
4060 params.chandef = wdev->preset_chandef;
Felix Fietkau46c1dd02012-06-19 02:50:57 +02004061 } else if (!nl80211_get_ap_channel(rdev, &params))
Johannes Bergaa430da2012-05-16 23:50:18 +02004062 return -EINVAL;
4063
Arik Nemtsov923b3522015-07-08 15:41:44 +03004064 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
4065 wdev->iftype))
Johannes Bergaa430da2012-05-16 23:50:18 +02004066 return -EINVAL;
4067
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05304068 if (info->attrs[NL80211_ATTR_TX_RATES]) {
4069 err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
4070 if (err)
4071 return err;
4072
Johannes Berg8564e382016-09-19 09:44:44 +02004073 err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
4074 &params.beacon_rate);
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05304075 if (err)
4076 return err;
4077 }
4078
Eliad Peller18998c32014-09-10 14:07:34 +03004079 if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
4080 params.smps_mode =
4081 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
4082 switch (params.smps_mode) {
4083 case NL80211_SMPS_OFF:
4084 break;
4085 case NL80211_SMPS_STATIC:
4086 if (!(rdev->wiphy.features &
4087 NL80211_FEATURE_STATIC_SMPS))
4088 return -EINVAL;
4089 break;
4090 case NL80211_SMPS_DYNAMIC:
4091 if (!(rdev->wiphy.features &
4092 NL80211_FEATURE_DYNAMIC_SMPS))
4093 return -EINVAL;
4094 break;
4095 default:
4096 return -EINVAL;
4097 }
4098 } else {
4099 params.smps_mode = NL80211_SMPS_OFF;
4100 }
4101
Purushottam Kushwaha6e8ef842016-07-05 13:44:51 +05304102 params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
4103 if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
4104 return -EOPNOTSUPP;
4105
Ola Olsson4baf6be2015-10-29 07:04:58 +01004106 if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
4107 params.acl = parse_acl_data(&rdev->wiphy, info);
4108 if (IS_ERR(params.acl))
4109 return PTR_ERR(params.acl);
4110 }
4111
Srinivas Dasari0c095552019-08-12 13:08:43 +05304112 if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])
4113 params.flags |= AP_SETTINGS_EXTERNAL_AUTH_SUPPORT;
4114
Simon Wunderlichc56589e2013-11-21 18:19:49 +01004115 wdev_lock(wdev);
Hila Gonene35e4d22012-06-27 17:19:42 +03004116 err = rdev_start_ap(rdev, dev, &params);
Felix Fietkau46c1dd02012-06-19 02:50:57 +02004117 if (!err) {
Johannes Berg683b6d32012-11-08 21:25:48 +01004118 wdev->preset_chandef = params.chandef;
Johannes Berg88600202012-02-13 15:17:18 +01004119 wdev->beacon_interval = params.beacon_interval;
Michal Kazior9e0e2962014-01-29 14:22:27 +01004120 wdev->chandef = params.chandef;
Antonio Quartulli06e191e2012-11-07 12:52:19 +01004121 wdev->ssid_len = params.ssid_len;
4122 memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
Felix Fietkau46c1dd02012-06-19 02:50:57 +02004123 }
Simon Wunderlichc56589e2013-11-21 18:19:49 +01004124 wdev_unlock(wdev);
Vasanthakumar Thiagarajan77765ea2013-01-18 11:18:45 +05304125
4126 kfree(params.acl);
4127
Johannes Berg56d18932011-05-09 18:41:15 +02004128 return err;
Johannes Berged1b6cc2007-12-19 02:03:32 +01004129}
4130
Johannes Berg88600202012-02-13 15:17:18 +01004131static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
4132{
4133 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4134 struct net_device *dev = info->user_ptr[1];
4135 struct wireless_dev *wdev = dev->ieee80211_ptr;
4136 struct cfg80211_beacon_data params;
4137 int err;
4138
4139 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4140 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4141 return -EOPNOTSUPP;
4142
4143 if (!rdev->ops->change_beacon)
4144 return -EOPNOTSUPP;
4145
4146 if (!wdev->beacon_interval)
4147 return -EINVAL;
4148
Simon Wunderlicha1193be2013-06-14 14:15:19 +02004149 err = nl80211_parse_beacon(info->attrs, &params);
Johannes Berg88600202012-02-13 15:17:18 +01004150 if (err)
4151 return err;
4152
Simon Wunderlichc56589e2013-11-21 18:19:49 +01004153 wdev_lock(wdev);
4154 err = rdev_change_beacon(rdev, dev, &params);
4155 wdev_unlock(wdev);
4156
4157 return err;
Johannes Berg88600202012-02-13 15:17:18 +01004158}
4159
4160static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
Johannes Berged1b6cc2007-12-19 02:03:32 +01004161{
Johannes Berg4c476992010-10-04 21:36:35 +02004162 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4163 struct net_device *dev = info->user_ptr[1];
Johannes Berged1b6cc2007-12-19 02:03:32 +01004164
Ilan Peer7c8d5e02014-02-25 15:33:38 +02004165 return cfg80211_stop_ap(rdev, dev, false);
Johannes Berged1b6cc2007-12-19 02:03:32 +01004166}
4167
Johannes Berg5727ef12007-12-19 02:03:34 +01004168static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
4169 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
4170 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
4171 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
Jouni Malinen0e467242009-05-11 21:57:55 +03004172 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
Javier Cardonab39c48f2011-04-07 15:08:30 -07004173 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
Johannes Bergd83023d2011-12-14 09:29:15 +01004174 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
Johannes Berg5727ef12007-12-19 02:03:34 +01004175};
4176
Johannes Bergeccb8e82009-05-11 21:57:56 +03004177static int parse_station_flags(struct genl_info *info,
Johannes Bergbdd3ae32012-01-02 13:30:03 +01004178 enum nl80211_iftype iftype,
Johannes Bergeccb8e82009-05-11 21:57:56 +03004179 struct station_parameters *params)
Johannes Berg5727ef12007-12-19 02:03:34 +01004180{
4181 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
Johannes Bergeccb8e82009-05-11 21:57:56 +03004182 struct nlattr *nla;
Johannes Berg5727ef12007-12-19 02:03:34 +01004183 int flag;
4184
Johannes Bergeccb8e82009-05-11 21:57:56 +03004185 /*
4186 * Try parsing the new attribute first so userspace
4187 * can specify both for older kernels.
4188 */
4189 nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
4190 if (nla) {
4191 struct nl80211_sta_flag_update *sta_flags;
Johannes Berg5727ef12007-12-19 02:03:34 +01004192
Johannes Bergeccb8e82009-05-11 21:57:56 +03004193 sta_flags = nla_data(nla);
4194 params->sta_flags_mask = sta_flags->mask;
4195 params->sta_flags_set = sta_flags->set;
Johannes Berg77ee7c82013-02-15 00:48:33 +01004196 params->sta_flags_set &= params->sta_flags_mask;
Johannes Bergeccb8e82009-05-11 21:57:56 +03004197 if ((params->sta_flags_mask |
4198 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
4199 return -EINVAL;
4200 return 0;
4201 }
4202
4203 /* if present, parse the old attribute */
4204
4205 nla = info->attrs[NL80211_ATTR_STA_FLAGS];
Johannes Berg5727ef12007-12-19 02:03:34 +01004206 if (!nla)
4207 return 0;
4208
4209 if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX,
4210 nla, sta_flags_policy))
4211 return -EINVAL;
4212
Johannes Bergbdd3ae32012-01-02 13:30:03 +01004213 /*
4214 * Only allow certain flags for interface types so that
4215 * other attributes are silently ignored. Remember that
4216 * this is backward compatibility code with old userspace
4217 * and shouldn't be hit in other cases anyway.
4218 */
4219 switch (iftype) {
4220 case NL80211_IFTYPE_AP:
4221 case NL80211_IFTYPE_AP_VLAN:
4222 case NL80211_IFTYPE_P2P_GO:
4223 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4224 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4225 BIT(NL80211_STA_FLAG_WME) |
4226 BIT(NL80211_STA_FLAG_MFP);
4227 break;
4228 case NL80211_IFTYPE_P2P_CLIENT:
4229 case NL80211_IFTYPE_STATION:
4230 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4231 BIT(NL80211_STA_FLAG_TDLS_PEER);
4232 break;
4233 case NL80211_IFTYPE_MESH_POINT:
4234 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4235 BIT(NL80211_STA_FLAG_MFP) |
4236 BIT(NL80211_STA_FLAG_AUTHORIZED);
Bernd Edlinger4fd08972018-07-08 09:57:22 +00004237 break;
Johannes Bergbdd3ae32012-01-02 13:30:03 +01004238 default:
4239 return -EINVAL;
4240 }
Johannes Berg5727ef12007-12-19 02:03:34 +01004241
Johannes Berg3383b5a2012-05-10 20:14:43 +02004242 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
4243 if (flags[flag]) {
Johannes Bergeccb8e82009-05-11 21:57:56 +03004244 params->sta_flags_set |= (1<<flag);
Johannes Berg5727ef12007-12-19 02:03:34 +01004245
Johannes Berg3383b5a2012-05-10 20:14:43 +02004246 /* no longer support new API additions in old API */
4247 if (flag > NL80211_STA_FLAG_MAX_OLD_API)
4248 return -EINVAL;
4249 }
4250 }
4251
Johannes Berg5727ef12007-12-19 02:03:34 +01004252 return 0;
4253}
4254
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004255static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
4256 int attr)
4257{
4258 struct nlattr *rate;
Vladimir Kondratiev8eb41c82012-07-05 14:25:49 +03004259 u32 bitrate;
4260 u16 bitrate_compat;
Matthias Kaehlcke7164cb72017-04-17 15:59:52 -07004261 enum nl80211_rate_info rate_flg;
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004262
4263 rate = nla_nest_start(msg, attr);
4264 if (!rate)
Johannes Bergdb9c64c2012-11-09 14:56:41 +01004265 return false;
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004266
4267 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
4268 bitrate = cfg80211_calculate_bitrate(info);
Vladimir Kondratiev8eb41c82012-07-05 14:25:49 +03004269 /* report 16-bit bitrate only if we can */
4270 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
Johannes Bergdb9c64c2012-11-09 14:56:41 +01004271 if (bitrate > 0 &&
4272 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
4273 return false;
4274 if (bitrate_compat > 0 &&
4275 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
4276 return false;
4277
Johannes Bergb51f3be2015-01-15 16:14:02 +01004278 switch (info->bw) {
4279 case RATE_INFO_BW_5:
4280 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
4281 break;
4282 case RATE_INFO_BW_10:
4283 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
4284 break;
4285 default:
4286 WARN_ON(1);
4287 /* fall through */
4288 case RATE_INFO_BW_20:
4289 rate_flg = 0;
4290 break;
4291 case RATE_INFO_BW_40:
4292 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
4293 break;
4294 case RATE_INFO_BW_80:
4295 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
4296 break;
4297 case RATE_INFO_BW_160:
4298 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
4299 break;
4300 }
4301
4302 if (rate_flg && nla_put_flag(msg, rate_flg))
4303 return false;
4304
Johannes Bergdb9c64c2012-11-09 14:56:41 +01004305 if (info->flags & RATE_INFO_FLAGS_MCS) {
4306 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
4307 return false;
Johannes Bergdb9c64c2012-11-09 14:56:41 +01004308 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4309 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4310 return false;
4311 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
4312 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
4313 return false;
4314 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
4315 return false;
Johannes Bergdb9c64c2012-11-09 14:56:41 +01004316 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4317 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4318 return false;
4319 }
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004320
4321 nla_nest_end(msg, rate);
4322 return true;
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004323}
4324
Felix Fietkau119363c2013-04-22 16:29:30 +02004325static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
4326 int id)
4327{
4328 void *attr;
4329 int i = 0;
4330
4331 if (!mask)
4332 return true;
4333
4334 attr = nla_nest_start(msg, id);
4335 if (!attr)
4336 return false;
4337
4338 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
4339 if (!(mask & BIT(i)))
4340 continue;
4341
4342 if (nla_put_u8(msg, i, signal[i]))
4343 return false;
4344 }
4345
4346 nla_nest_end(msg, attr);
4347
4348 return true;
4349}
4350
Johannes Bergcf5ead82014-11-14 17:14:00 +01004351static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
4352 u32 seq, int flags,
John W. Linville66266b32012-03-15 13:25:41 -04004353 struct cfg80211_registered_device *rdev,
4354 struct net_device *dev,
Johannes Berg98b62182009-12-23 13:15:44 +01004355 const u8 *mac_addr, struct station_info *sinfo)
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004356{
4357 void *hdr;
Paul Stewartf4263c92011-03-31 09:25:41 -07004358 struct nlattr *sinfoattr, *bss_param;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004359
Johannes Bergcf5ead82014-11-14 17:14:00 +01004360 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004361 if (!hdr)
4362 return -1;
4363
David S. Miller9360ffd2012-03-29 04:41:26 -04004364 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
4365 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
4366 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
4367 goto nla_put_failure;
Johannes Bergf5ea9122009-08-07 16:17:38 +02004368
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004369 sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
4370 if (!sinfoattr)
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004371 goto nla_put_failure;
Johannes Berg319090b2014-11-17 14:08:11 +01004372
4373#define PUT_SINFO(attr, memb, type) do { \
Johannes Bergd686b922016-04-26 09:54:11 +02004374 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \
Mohammed Shafi Shajakhan739960f2016-04-07 19:59:34 +05304375 if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
Johannes Berg319090b2014-11-17 14:08:11 +01004376 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \
4377 sinfo->memb)) \
4378 goto nla_put_failure; \
4379 } while (0)
Johannes Bergd686b922016-04-26 09:54:11 +02004380#define PUT_SINFO_U64(attr, memb) do { \
4381 if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
4382 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \
4383 sinfo->memb, NL80211_STA_INFO_PAD)) \
4384 goto nla_put_failure; \
4385 } while (0)
Johannes Berg319090b2014-11-17 14:08:11 +01004386
4387 PUT_SINFO(CONNECTED_TIME, connected_time, u32);
4388 PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
4389
4390 if (sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES) |
4391 BIT(NL80211_STA_INFO_RX_BYTES64)) &&
David S. Miller9360ffd2012-03-29 04:41:26 -04004392 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
Vladimir Kondratiev42745e02013-02-04 13:53:11 +02004393 (u32)sinfo->rx_bytes))
4394 goto nla_put_failure;
Johannes Berg319090b2014-11-17 14:08:11 +01004395
4396 if (sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES) |
4397 BIT(NL80211_STA_INFO_TX_BYTES64)) &&
Vladimir Kondratiev42745e02013-02-04 13:53:11 +02004398 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
4399 (u32)sinfo->tx_bytes))
4400 goto nla_put_failure;
Johannes Berg319090b2014-11-17 14:08:11 +01004401
Johannes Bergd686b922016-04-26 09:54:11 +02004402 PUT_SINFO_U64(RX_BYTES64, rx_bytes);
4403 PUT_SINFO_U64(TX_BYTES64, tx_bytes);
Johannes Berg319090b2014-11-17 14:08:11 +01004404 PUT_SINFO(LLID, llid, u16);
4405 PUT_SINFO(PLID, plid, u16);
4406 PUT_SINFO(PLINK_STATE, plink_state, u8);
Johannes Bergd686b922016-04-26 09:54:11 +02004407 PUT_SINFO_U64(RX_DURATION, rx_duration);
Johannes Berg319090b2014-11-17 14:08:11 +01004408
John W. Linville66266b32012-03-15 13:25:41 -04004409 switch (rdev->wiphy.signal_type) {
4410 case CFG80211_SIGNAL_TYPE_MBM:
Johannes Berg319090b2014-11-17 14:08:11 +01004411 PUT_SINFO(SIGNAL, signal, u8);
4412 PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
John W. Linville66266b32012-03-15 13:25:41 -04004413 break;
4414 default:
4415 break;
4416 }
Johannes Berg319090b2014-11-17 14:08:11 +01004417 if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL)) {
Felix Fietkau119363c2013-04-22 16:29:30 +02004418 if (!nl80211_put_signal(msg, sinfo->chains,
4419 sinfo->chain_signal,
4420 NL80211_STA_INFO_CHAIN_SIGNAL))
4421 goto nla_put_failure;
4422 }
Johannes Berg319090b2014-11-17 14:08:11 +01004423 if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
Felix Fietkau119363c2013-04-22 16:29:30 +02004424 if (!nl80211_put_signal(msg, sinfo->chains,
4425 sinfo->chain_signal_avg,
4426 NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
4427 goto nla_put_failure;
4428 }
Johannes Berg319090b2014-11-17 14:08:11 +01004429 if (sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE)) {
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004430 if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
4431 NL80211_STA_INFO_TX_BITRATE))
Henning Rogge420e7fa2008-12-11 22:04:19 +01004432 goto nla_put_failure;
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004433 }
Johannes Berg319090b2014-11-17 14:08:11 +01004434 if (sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE)) {
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004435 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
4436 NL80211_STA_INFO_RX_BITRATE))
4437 goto nla_put_failure;
Henning Rogge420e7fa2008-12-11 22:04:19 +01004438 }
Johannes Berg319090b2014-11-17 14:08:11 +01004439
4440 PUT_SINFO(RX_PACKETS, rx_packets, u32);
4441 PUT_SINFO(TX_PACKETS, tx_packets, u32);
4442 PUT_SINFO(TX_RETRIES, tx_retries, u32);
4443 PUT_SINFO(TX_FAILED, tx_failed, u32);
4444 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
4445 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
4446 PUT_SINFO(LOCAL_PM, local_pm, u32);
4447 PUT_SINFO(PEER_PM, peer_pm, u32);
4448 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
4449
4450 if (sinfo->filled & BIT(NL80211_STA_INFO_BSS_PARAM)) {
Paul Stewartf4263c92011-03-31 09:25:41 -07004451 bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
4452 if (!bss_param)
4453 goto nla_put_failure;
4454
David S. Miller9360ffd2012-03-29 04:41:26 -04004455 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
4456 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
4457 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
4458 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
4459 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
4460 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
4461 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
4462 sinfo->bss_param.dtim_period) ||
4463 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
4464 sinfo->bss_param.beacon_interval))
4465 goto nla_put_failure;
Paul Stewartf4263c92011-03-31 09:25:41 -07004466
4467 nla_nest_end(msg, bss_param);
4468 }
Johannes Berg319090b2014-11-17 14:08:11 +01004469 if ((sinfo->filled & BIT(NL80211_STA_INFO_STA_FLAGS)) &&
David S. Miller9360ffd2012-03-29 04:41:26 -04004470 nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
4471 sizeof(struct nl80211_sta_flag_update),
4472 &sinfo->sta_flags))
4473 goto nla_put_failure;
Johannes Berg319090b2014-11-17 14:08:11 +01004474
Johannes Bergd686b922016-04-26 09:54:11 +02004475 PUT_SINFO_U64(T_OFFSET, t_offset);
4476 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
4477 PUT_SINFO_U64(BEACON_RX, rx_beacon);
Johannes Berga76b1942014-11-17 14:12:22 +01004478 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
Johannes Berg319090b2014-11-17 14:08:11 +01004479
4480#undef PUT_SINFO
Johannes Bergd686b922016-04-26 09:54:11 +02004481#undef PUT_SINFO_U64
Johannes Berg6de39802014-12-19 12:34:00 +01004482
4483 if (sinfo->filled & BIT(NL80211_STA_INFO_TID_STATS)) {
4484 struct nlattr *tidsattr;
4485 int tid;
4486
4487 tidsattr = nla_nest_start(msg, NL80211_STA_INFO_TID_STATS);
4488 if (!tidsattr)
4489 goto nla_put_failure;
4490
4491 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
4492 struct cfg80211_tid_stats *tidstats;
4493 struct nlattr *tidattr;
4494
4495 tidstats = &sinfo->pertid[tid];
4496
4497 if (!tidstats->filled)
4498 continue;
4499
4500 tidattr = nla_nest_start(msg, tid + 1);
4501 if (!tidattr)
4502 goto nla_put_failure;
4503
Johannes Bergd686b922016-04-26 09:54:11 +02004504#define PUT_TIDVAL_U64(attr, memb) do { \
Johannes Berg6de39802014-12-19 12:34:00 +01004505 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \
Johannes Bergd686b922016-04-26 09:54:11 +02004506 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \
4507 tidstats->memb, NL80211_TID_STATS_PAD)) \
Johannes Berg6de39802014-12-19 12:34:00 +01004508 goto nla_put_failure; \
4509 } while (0)
4510
Johannes Bergd686b922016-04-26 09:54:11 +02004511 PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
4512 PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
4513 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
4514 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
Johannes Berg6de39802014-12-19 12:34:00 +01004515
Johannes Bergd686b922016-04-26 09:54:11 +02004516#undef PUT_TIDVAL_U64
Johannes Berg6de39802014-12-19 12:34:00 +01004517 nla_nest_end(msg, tidattr);
4518 }
4519
4520 nla_nest_end(msg, tidsattr);
4521 }
4522
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004523 nla_nest_end(msg, sinfoattr);
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004524
Johannes Berg319090b2014-11-17 14:08:11 +01004525 if (sinfo->assoc_req_ies_len &&
David S. Miller9360ffd2012-03-29 04:41:26 -04004526 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
4527 sinfo->assoc_req_ies))
4528 goto nla_put_failure;
Jouni Malinen50d3dfb2011-08-08 12:11:52 +03004529
Johannes Berg053c0952015-01-16 22:09:00 +01004530 genlmsg_end(msg, hdr);
4531 return 0;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004532
4533 nla_put_failure:
Thomas Grafbc3ed282008-06-03 16:36:54 -07004534 genlmsg_cancel(msg, hdr);
4535 return -EMSGSIZE;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004536}
4537
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004538static int nl80211_dump_station(struct sk_buff *skb,
Johannes Bergbba95fe2008-07-29 13:22:51 +02004539 struct netlink_callback *cb)
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004540{
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004541 struct station_info sinfo;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08004542 struct cfg80211_registered_device *rdev;
Johannes Berg97990a02013-04-19 01:02:55 +02004543 struct wireless_dev *wdev;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004544 u8 mac_addr[ETH_ALEN];
Johannes Berg97990a02013-04-19 01:02:55 +02004545 int sta_idx = cb->args[2];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004546 int err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004547
Johannes Berg56769e72017-03-15 14:26:04 +01004548 rtnl_lock();
Zhao, Gang1b8ec872014-04-21 12:53:02 +08004549 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
Johannes Berg67748892010-10-04 21:14:06 +02004550 if (err)
Johannes Berg56769e72017-03-15 14:26:04 +01004551 goto out_err;
Johannes Bergbba95fe2008-07-29 13:22:51 +02004552
Johannes Berg97990a02013-04-19 01:02:55 +02004553 if (!wdev->netdev) {
4554 err = -EINVAL;
4555 goto out_err;
4556 }
4557
Zhao, Gang1b8ec872014-04-21 12:53:02 +08004558 if (!rdev->ops->dump_station) {
Jouni Malineneec60b02009-03-20 21:21:19 +02004559 err = -EOPNOTSUPP;
Johannes Bergbba95fe2008-07-29 13:22:51 +02004560 goto out_err;
4561 }
4562
Johannes Bergbba95fe2008-07-29 13:22:51 +02004563 while (1) {
Jouni Malinenf612ced2011-08-11 11:46:22 +03004564 memset(&sinfo, 0, sizeof(sinfo));
Zhao, Gang1b8ec872014-04-21 12:53:02 +08004565 err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
Hila Gonene35e4d22012-06-27 17:19:42 +03004566 mac_addr, &sinfo);
Johannes Bergbba95fe2008-07-29 13:22:51 +02004567 if (err == -ENOENT)
4568 break;
4569 if (err)
Johannes Berg3b858752009-03-12 09:55:09 +01004570 goto out_err;
Johannes Bergbba95fe2008-07-29 13:22:51 +02004571
Johannes Bergcf5ead82014-11-14 17:14:00 +01004572 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
Eric W. Biederman15e47302012-09-07 20:12:54 +00004573 NETLINK_CB(cb->skb).portid,
Johannes Bergbba95fe2008-07-29 13:22:51 +02004574 cb->nlh->nlmsg_seq, NLM_F_MULTI,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08004575 rdev, wdev->netdev, mac_addr,
Johannes Bergbba95fe2008-07-29 13:22:51 +02004576 &sinfo) < 0)
4577 goto out;
4578
4579 sta_idx++;
4580 }
4581
Johannes Bergbba95fe2008-07-29 13:22:51 +02004582 out:
Johannes Berg97990a02013-04-19 01:02:55 +02004583 cb->args[2] = sta_idx;
Johannes Bergbba95fe2008-07-29 13:22:51 +02004584 err = skb->len;
Johannes Bergbba95fe2008-07-29 13:22:51 +02004585 out_err:
Johannes Berg56769e72017-03-15 14:26:04 +01004586 rtnl_unlock();
Johannes Bergbba95fe2008-07-29 13:22:51 +02004587
4588 return err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004589}
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004590
Johannes Berg5727ef12007-12-19 02:03:34 +01004591static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
4592{
Johannes Berg4c476992010-10-04 21:36:35 +02004593 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4594 struct net_device *dev = info->user_ptr[1];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004595 struct station_info sinfo;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004596 struct sk_buff *msg;
4597 u8 *mac_addr = NULL;
Johannes Berg4c476992010-10-04 21:36:35 +02004598 int err;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004599
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004600 memset(&sinfo, 0, sizeof(sinfo));
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004601
4602 if (!info->attrs[NL80211_ATTR_MAC])
4603 return -EINVAL;
4604
4605 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4606
Johannes Berg4c476992010-10-04 21:36:35 +02004607 if (!rdev->ops->get_station)
4608 return -EOPNOTSUPP;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004609
Hila Gonene35e4d22012-06-27 17:19:42 +03004610 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004611 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02004612 return err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004613
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -07004614 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004615 if (!msg)
Johannes Berg4c476992010-10-04 21:36:35 +02004616 return -ENOMEM;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004617
Johannes Bergcf5ead82014-11-14 17:14:00 +01004618 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
4619 info->snd_portid, info->snd_seq, 0,
John W. Linville66266b32012-03-15 13:25:41 -04004620 rdev, dev, mac_addr, &sinfo) < 0) {
Johannes Berg4c476992010-10-04 21:36:35 +02004621 nlmsg_free(msg);
4622 return -ENOBUFS;
4623 }
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004624
Johannes Berg4c476992010-10-04 21:36:35 +02004625 return genlmsg_reply(msg, info);
Johannes Berg5727ef12007-12-19 02:03:34 +01004626}
4627
Johannes Berg77ee7c82013-02-15 00:48:33 +01004628int cfg80211_check_station_change(struct wiphy *wiphy,
4629 struct station_parameters *params,
4630 enum cfg80211_station_type statype)
4631{
Ayala Bekere4208422015-10-23 11:20:06 +03004632 if (params->listen_interval != -1 &&
4633 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
Johannes Berg77ee7c82013-02-15 00:48:33 +01004634 return -EINVAL;
Ayala Bekere4208422015-10-23 11:20:06 +03004635
Ayala Beker17b94242016-03-17 15:41:38 +02004636 if (params->support_p2p_ps != -1 &&
4637 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4638 return -EINVAL;
4639
Arik Nemtsovc72e1142014-07-17 17:14:29 +03004640 if (params->aid &&
Ayala Bekere4208422015-10-23 11:20:06 +03004641 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
4642 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
Johannes Berg77ee7c82013-02-15 00:48:33 +01004643 return -EINVAL;
4644
4645 /* When you run into this, adjust the code below for the new flag */
4646 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
4647
4648 switch (statype) {
Thomas Pederseneef941e2013-03-04 13:06:11 -08004649 case CFG80211_STA_MESH_PEER_KERNEL:
4650 case CFG80211_STA_MESH_PEER_USER:
Johannes Berg77ee7c82013-02-15 00:48:33 +01004651 /*
4652 * No ignoring the TDLS flag here -- the userspace mesh
4653 * code doesn't have the bug of including TDLS in the
4654 * mask everywhere.
4655 */
4656 if (params->sta_flags_mask &
4657 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4658 BIT(NL80211_STA_FLAG_MFP) |
4659 BIT(NL80211_STA_FLAG_AUTHORIZED)))
4660 return -EINVAL;
4661 break;
4662 case CFG80211_STA_TDLS_PEER_SETUP:
4663 case CFG80211_STA_TDLS_PEER_ACTIVE:
4664 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
4665 return -EINVAL;
4666 /* ignore since it can't change */
4667 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4668 break;
4669 default:
4670 /* disallow mesh-specific things */
4671 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
4672 return -EINVAL;
4673 if (params->local_pm)
4674 return -EINVAL;
4675 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4676 return -EINVAL;
4677 }
4678
4679 if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4680 statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
4681 /* TDLS can't be set, ... */
4682 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
4683 return -EINVAL;
4684 /*
4685 * ... but don't bother the driver with it. This works around
4686 * a hostapd/wpa_supplicant issue -- it always includes the
4687 * TLDS_PEER flag in the mask even for AP mode.
4688 */
4689 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4690 }
4691
Ayala Beker47edb112015-09-21 15:49:53 +03004692 if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4693 statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
Johannes Berg77ee7c82013-02-15 00:48:33 +01004694 /* reject other things that can't change */
4695 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
4696 return -EINVAL;
4697 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
4698 return -EINVAL;
4699 if (params->supported_rates)
4700 return -EINVAL;
4701 if (params->ext_capab || params->ht_capa || params->vht_capa)
4702 return -EINVAL;
4703 }
4704
Ayala Beker47edb112015-09-21 15:49:53 +03004705 if (statype != CFG80211_STA_AP_CLIENT &&
4706 statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
Johannes Berg77ee7c82013-02-15 00:48:33 +01004707 if (params->vlan)
4708 return -EINVAL;
4709 }
4710
4711 switch (statype) {
4712 case CFG80211_STA_AP_MLME_CLIENT:
4713 /* Use this only for authorizing/unauthorizing a station */
4714 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
4715 return -EOPNOTSUPP;
4716 break;
4717 case CFG80211_STA_AP_CLIENT:
Ayala Beker47edb112015-09-21 15:49:53 +03004718 case CFG80211_STA_AP_CLIENT_UNASSOC:
Johannes Berg77ee7c82013-02-15 00:48:33 +01004719 /* accept only the listed bits */
4720 if (params->sta_flags_mask &
4721 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4722 BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4723 BIT(NL80211_STA_FLAG_ASSOCIATED) |
4724 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4725 BIT(NL80211_STA_FLAG_WME) |
4726 BIT(NL80211_STA_FLAG_MFP)))
4727 return -EINVAL;
4728
4729 /* but authenticated/associated only if driver handles it */
4730 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
4731 params->sta_flags_mask &
4732 (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4733 BIT(NL80211_STA_FLAG_ASSOCIATED)))
4734 return -EINVAL;
4735 break;
4736 case CFG80211_STA_IBSS:
4737 case CFG80211_STA_AP_STA:
4738 /* reject any changes other than AUTHORIZED */
4739 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
4740 return -EINVAL;
4741 break;
4742 case CFG80211_STA_TDLS_PEER_SETUP:
4743 /* reject any changes other than AUTHORIZED or WME */
4744 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4745 BIT(NL80211_STA_FLAG_WME)))
4746 return -EINVAL;
4747 /* force (at least) rates when authorizing */
4748 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
4749 !params->supported_rates)
4750 return -EINVAL;
4751 break;
4752 case CFG80211_STA_TDLS_PEER_ACTIVE:
4753 /* reject any changes */
4754 return -EINVAL;
Thomas Pederseneef941e2013-03-04 13:06:11 -08004755 case CFG80211_STA_MESH_PEER_KERNEL:
Johannes Berg77ee7c82013-02-15 00:48:33 +01004756 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4757 return -EINVAL;
4758 break;
Thomas Pederseneef941e2013-03-04 13:06:11 -08004759 case CFG80211_STA_MESH_PEER_USER:
Chun-Yeow Yeoh42925042015-04-18 01:30:02 +08004760 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
4761 params->plink_action != NL80211_PLINK_ACTION_BLOCK)
Johannes Berg77ee7c82013-02-15 00:48:33 +01004762 return -EINVAL;
4763 break;
4764 }
4765
4766 return 0;
4767}
4768EXPORT_SYMBOL(cfg80211_check_station_change);
4769
Johannes Berg5727ef12007-12-19 02:03:34 +01004770/*
Felix Fietkauc258d2d2009-11-11 17:23:31 +01004771 * Get vlan interface making sure it is running and on the right wiphy.
Johannes Berg5727ef12007-12-19 02:03:34 +01004772 */
Johannes Berg80b99892011-11-18 16:23:01 +01004773static struct net_device *get_vlan(struct genl_info *info,
4774 struct cfg80211_registered_device *rdev)
Johannes Berg5727ef12007-12-19 02:03:34 +01004775{
Johannes Berg463d0182009-07-14 00:33:35 +02004776 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
Johannes Berg80b99892011-11-18 16:23:01 +01004777 struct net_device *v;
4778 int ret;
Johannes Berg5727ef12007-12-19 02:03:34 +01004779
Johannes Berg80b99892011-11-18 16:23:01 +01004780 if (!vlanattr)
4781 return NULL;
4782
4783 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
4784 if (!v)
4785 return ERR_PTR(-ENODEV);
4786
4787 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
4788 ret = -EINVAL;
4789 goto error;
Johannes Berg5727ef12007-12-19 02:03:34 +01004790 }
Johannes Berg80b99892011-11-18 16:23:01 +01004791
Johannes Berg77ee7c82013-02-15 00:48:33 +01004792 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
4793 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4794 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
4795 ret = -EINVAL;
4796 goto error;
4797 }
4798
Johannes Berg80b99892011-11-18 16:23:01 +01004799 if (!netif_running(v)) {
4800 ret = -ENETDOWN;
4801 goto error;
4802 }
4803
4804 return v;
4805 error:
4806 dev_put(v);
4807 return ERR_PTR(ret);
Johannes Berg5727ef12007-12-19 02:03:34 +01004808}
4809
Johannes Berg94e860f2014-01-20 23:58:15 +01004810static const struct nla_policy
4811nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
Jouni Malinendf881292013-02-14 21:10:54 +02004812 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
4813 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
4814};
4815
Johannes Bergff276692013-02-15 00:09:01 +01004816static int nl80211_parse_sta_wme(struct genl_info *info,
4817 struct station_parameters *params)
Jouni Malinendf881292013-02-14 21:10:54 +02004818{
Jouni Malinendf881292013-02-14 21:10:54 +02004819 struct nlattr *tb[NL80211_STA_WME_MAX + 1];
4820 struct nlattr *nla;
4821 int err;
4822
Jouni Malinendf881292013-02-14 21:10:54 +02004823 /* parse WME attributes if present */
4824 if (!info->attrs[NL80211_ATTR_STA_WME])
4825 return 0;
4826
4827 nla = info->attrs[NL80211_ATTR_STA_WME];
4828 err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
4829 nl80211_sta_wme_policy);
4830 if (err)
4831 return err;
4832
4833 if (tb[NL80211_STA_WME_UAPSD_QUEUES])
4834 params->uapsd_queues = nla_get_u8(
4835 tb[NL80211_STA_WME_UAPSD_QUEUES]);
4836 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
4837 return -EINVAL;
4838
4839 if (tb[NL80211_STA_WME_MAX_SP])
4840 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
4841
4842 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
4843 return -EINVAL;
4844
4845 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
4846
4847 return 0;
4848}
4849
Sunil Duttc01fc9a2013-10-09 20:45:21 +05304850static int nl80211_parse_sta_channel_info(struct genl_info *info,
4851 struct station_parameters *params)
4852{
4853 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
4854 params->supported_channels =
4855 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4856 params->supported_channels_len =
4857 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4858 /*
4859 * Need to include at least one (first channel, number of
4860 * channels) tuple for each subband, and must have proper
4861 * tuples for the rest of the data as well.
4862 */
4863 if (params->supported_channels_len < 2)
4864 return -EINVAL;
4865 if (params->supported_channels_len % 2)
4866 return -EINVAL;
4867 }
4868
4869 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
4870 params->supported_oper_classes =
4871 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4872 params->supported_oper_classes_len =
4873 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4874 /*
4875 * The value of the Length field of the Supported Operating
4876 * Classes element is between 2 and 253.
4877 */
4878 if (params->supported_oper_classes_len < 2 ||
4879 params->supported_oper_classes_len > 253)
4880 return -EINVAL;
4881 }
4882 return 0;
4883}
4884
Johannes Bergff276692013-02-15 00:09:01 +01004885static int nl80211_set_station_tdls(struct genl_info *info,
4886 struct station_parameters *params)
4887{
Sunil Duttc01fc9a2013-10-09 20:45:21 +05304888 int err;
Johannes Bergff276692013-02-15 00:09:01 +01004889 /* Dummy STA entry gets updated once the peer capabilities are known */
Jouni Malinen5e4b6f52013-05-16 20:11:08 +03004890 if (info->attrs[NL80211_ATTR_PEER_AID])
4891 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
Johannes Bergff276692013-02-15 00:09:01 +01004892 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
4893 params->ht_capa =
4894 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
4895 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
4896 params->vht_capa =
4897 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
4898
Sunil Duttc01fc9a2013-10-09 20:45:21 +05304899 err = nl80211_parse_sta_channel_info(info, params);
4900 if (err)
4901 return err;
4902
Johannes Bergff276692013-02-15 00:09:01 +01004903 return nl80211_parse_sta_wme(info, params);
4904}
4905
Johannes Berg5727ef12007-12-19 02:03:34 +01004906static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
4907{
Johannes Berg4c476992010-10-04 21:36:35 +02004908 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg4c476992010-10-04 21:36:35 +02004909 struct net_device *dev = info->user_ptr[1];
Johannes Berg5727ef12007-12-19 02:03:34 +01004910 struct station_parameters params;
Johannes Berg77ee7c82013-02-15 00:48:33 +01004911 u8 *mac_addr;
4912 int err;
Johannes Berg5727ef12007-12-19 02:03:34 +01004913
4914 memset(&params, 0, sizeof(params));
4915
Johannes Berg77ee7c82013-02-15 00:48:33 +01004916 if (!rdev->ops->change_station)
4917 return -EOPNOTSUPP;
4918
Ayala Bekere4208422015-10-23 11:20:06 +03004919 /*
4920 * AID and listen_interval properties can be set only for unassociated
4921 * station. Include these parameters here and will check them in
4922 * cfg80211_check_station_change().
4923 */
Ayala Bekera9bc31e2015-11-26 16:26:12 +01004924 if (info->attrs[NL80211_ATTR_STA_AID])
4925 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
Ayala Bekere4208422015-10-23 11:20:06 +03004926
4927 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
4928 params.listen_interval =
4929 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
4930 else
4931 params.listen_interval = -1;
Johannes Berg5727ef12007-12-19 02:03:34 +01004932
Ayala Beker17b94242016-03-17 15:41:38 +02004933 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
4934 u8 tmp;
4935
4936 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
4937 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
4938 return -EINVAL;
4939
4940 params.support_p2p_ps = tmp;
4941 } else {
4942 params.support_p2p_ps = -1;
4943 }
4944
Johannes Berg5727ef12007-12-19 02:03:34 +01004945 if (!info->attrs[NL80211_ATTR_MAC])
4946 return -EINVAL;
4947
4948 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4949
4950 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
4951 params.supported_rates =
4952 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4953 params.supported_rates_len =
4954 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4955 }
4956
Jouni Malinen9d62a982013-02-14 21:10:13 +02004957 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
4958 params.capability =
4959 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
4960 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
4961 }
4962
4963 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
4964 params.ext_capab =
4965 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4966 params.ext_capab_len =
4967 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4968 }
4969
Johannes Bergbdd3ae32012-01-02 13:30:03 +01004970 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
Johannes Berg5727ef12007-12-19 02:03:34 +01004971 return -EINVAL;
4972
Johannes Bergf8bacc22013-02-14 23:27:01 +01004973 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004974 params.plink_action =
Johannes Bergf8bacc22013-02-14 23:27:01 +01004975 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
4976 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
4977 return -EINVAL;
4978 }
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004979
Johannes Bergf8bacc22013-02-14 23:27:01 +01004980 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
Javier Cardona9c3990a2011-05-03 16:57:11 -07004981 params.plink_state =
Johannes Bergf8bacc22013-02-14 23:27:01 +01004982 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
4983 if (params.plink_state >= NUM_NL80211_PLINK_STATES)
4984 return -EINVAL;
Masashi Honma7d27a0b2016-07-01 10:19:34 +09004985 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) {
4986 params.peer_aid = nla_get_u16(
4987 info->attrs[NL80211_ATTR_MESH_PEER_AID]);
4988 if (params.peer_aid > IEEE80211_MAX_AID)
4989 return -EINVAL;
4990 }
Johannes Bergf8bacc22013-02-14 23:27:01 +01004991 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
4992 }
Javier Cardona9c3990a2011-05-03 16:57:11 -07004993
Marco Porsch3b1c5a52013-01-07 16:04:52 +01004994 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) {
4995 enum nl80211_mesh_power_mode pm = nla_get_u32(
4996 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
4997
4998 if (pm <= NL80211_MESH_POWER_UNKNOWN ||
4999 pm > NL80211_MESH_POWER_MAX)
5000 return -EINVAL;
5001
5002 params.local_pm = pm;
5003 }
5004
Johannes Berg77ee7c82013-02-15 00:48:33 +01005005 /* Include parameters for TDLS peer (will check later) */
5006 err = nl80211_set_station_tdls(info, &params);
5007 if (err)
5008 return err;
5009
5010 params.vlan = get_vlan(info, rdev);
5011 if (IS_ERR(params.vlan))
5012 return PTR_ERR(params.vlan);
5013
Johannes Berga97f4422009-06-18 17:23:43 +02005014 switch (dev->ieee80211_ptr->iftype) {
5015 case NL80211_IFTYPE_AP:
5016 case NL80211_IFTYPE_AP_VLAN:
Johannes Berg074ac8d2010-09-16 14:58:22 +02005017 case NL80211_IFTYPE_P2P_GO:
Johannes Berg074ac8d2010-09-16 14:58:22 +02005018 case NL80211_IFTYPE_P2P_CLIENT:
Johannes Berga97f4422009-06-18 17:23:43 +02005019 case NL80211_IFTYPE_STATION:
Antonio Quartulli267335d2012-01-31 20:25:47 +01005020 case NL80211_IFTYPE_ADHOC:
Johannes Berga97f4422009-06-18 17:23:43 +02005021 case NL80211_IFTYPE_MESH_POINT:
Johannes Berga97f4422009-06-18 17:23:43 +02005022 break;
5023 default:
Johannes Berg77ee7c82013-02-15 00:48:33 +01005024 err = -EOPNOTSUPP;
5025 goto out_put_vlan;
Johannes Berg034d6552009-05-27 10:35:29 +02005026 }
5027
Johannes Berg77ee7c82013-02-15 00:48:33 +01005028 /* driver will call cfg80211_check_station_change() */
Hila Gonene35e4d22012-06-27 17:19:42 +03005029 err = rdev_change_station(rdev, dev, mac_addr, &params);
Johannes Berg5727ef12007-12-19 02:03:34 +01005030
Johannes Berg77ee7c82013-02-15 00:48:33 +01005031 out_put_vlan:
Johannes Berg5727ef12007-12-19 02:03:34 +01005032 if (params.vlan)
5033 dev_put(params.vlan);
Johannes Berg3b858752009-03-12 09:55:09 +01005034
Johannes Berg5727ef12007-12-19 02:03:34 +01005035 return err;
5036}
5037
5038static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
5039{
Johannes Berg4c476992010-10-04 21:36:35 +02005040 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg5727ef12007-12-19 02:03:34 +01005041 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02005042 struct net_device *dev = info->user_ptr[1];
Johannes Berg5727ef12007-12-19 02:03:34 +01005043 struct station_parameters params;
5044 u8 *mac_addr = NULL;
Johannes Bergbda95eb2015-11-26 16:26:13 +01005045 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5046 BIT(NL80211_STA_FLAG_ASSOCIATED);
Johannes Berg5727ef12007-12-19 02:03:34 +01005047
5048 memset(&params, 0, sizeof(params));
5049
Johannes Berg984c3112013-02-14 23:43:25 +01005050 if (!rdev->ops->add_station)
5051 return -EOPNOTSUPP;
5052
Johannes Berg5727ef12007-12-19 02:03:34 +01005053 if (!info->attrs[NL80211_ATTR_MAC])
5054 return -EINVAL;
5055
Johannes Berg5727ef12007-12-19 02:03:34 +01005056 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
5057 return -EINVAL;
5058
5059 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
5060 return -EINVAL;
5061
Jouni Malinen5e4b6f52013-05-16 20:11:08 +03005062 if (!info->attrs[NL80211_ATTR_STA_AID] &&
5063 !info->attrs[NL80211_ATTR_PEER_AID])
Thadeu Lima de Souza Cascardo0e956c12010-02-12 12:34:50 -02005064 return -EINVAL;
5065
Johannes Berg5727ef12007-12-19 02:03:34 +01005066 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5067 params.supported_rates =
5068 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5069 params.supported_rates_len =
5070 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5071 params.listen_interval =
5072 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
Johannes Berg51b50fb2009-05-24 16:42:30 +02005073
Ayala Beker17b94242016-03-17 15:41:38 +02005074 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
5075 u8 tmp;
5076
5077 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
5078 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
5079 return -EINVAL;
5080
5081 params.support_p2p_ps = tmp;
5082 } else {
5083 /*
5084 * if not specified, assume it's supported for P2P GO interface,
5085 * and is NOT supported for AP interface
5086 */
5087 params.support_p2p_ps =
5088 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
5089 }
5090
Jouni Malinen3d124ea2013-05-27 18:24:02 +03005091 if (info->attrs[NL80211_ATTR_PEER_AID])
Jouni Malinen5e4b6f52013-05-16 20:11:08 +03005092 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
Jouni Malinen3d124ea2013-05-27 18:24:02 +03005093 else
5094 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
Thadeu Lima de Souza Cascardo0e956c12010-02-12 12:34:50 -02005095 if (!params.aid || params.aid > IEEE80211_MAX_AID)
5096 return -EINVAL;
Johannes Berg51b50fb2009-05-24 16:42:30 +02005097
Jouni Malinen9d62a982013-02-14 21:10:13 +02005098 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
5099 params.capability =
5100 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5101 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5102 }
5103
5104 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5105 params.ext_capab =
5106 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5107 params.ext_capab_len =
5108 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5109 }
5110
Jouni Malinen36aedc902008-08-25 11:58:58 +03005111 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
5112 params.ht_capa =
5113 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
Johannes Berg5727ef12007-12-19 02:03:34 +01005114
Mahesh Palivelaf461be3e2012-10-11 08:04:52 +00005115 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
5116 params.vht_capa =
5117 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
5118
Marek Kwaczynski60f4a7b2013-12-03 10:04:59 +01005119 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5120 params.opmode_notif_used = true;
5121 params.opmode_notif =
5122 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5123 }
5124
Johannes Bergf8bacc22013-02-14 23:27:01 +01005125 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
Javier Cardona96b78df2011-04-07 15:08:33 -07005126 params.plink_action =
Johannes Bergf8bacc22013-02-14 23:27:01 +01005127 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
5128 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
5129 return -EINVAL;
5130 }
Javier Cardona96b78df2011-04-07 15:08:33 -07005131
Sunil Duttc01fc9a2013-10-09 20:45:21 +05305132 err = nl80211_parse_sta_channel_info(info, &params);
5133 if (err)
5134 return err;
5135
Johannes Bergff276692013-02-15 00:09:01 +01005136 err = nl80211_parse_sta_wme(info, &params);
5137 if (err)
5138 return err;
Johannes Bergbdd90d52011-12-14 12:20:27 +01005139
Johannes Bergbdd3ae32012-01-02 13:30:03 +01005140 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
Johannes Berg5727ef12007-12-19 02:03:34 +01005141 return -EINVAL;
5142
Johannes Berg496fcc22015-03-12 08:53:27 +02005143 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
5144 * as userspace might just pass through the capabilities from the IEs
5145 * directly, rather than enforcing this restriction and returning an
5146 * error in this case.
5147 */
5148 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
5149 params.ht_capa = NULL;
5150 params.vht_capa = NULL;
5151 }
5152
Johannes Berg77ee7c82013-02-15 00:48:33 +01005153 /* When you run into this, adjust the code below for the new flag */
5154 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
5155
Johannes Bergbdd90d52011-12-14 12:20:27 +01005156 switch (dev->ieee80211_ptr->iftype) {
5157 case NL80211_IFTYPE_AP:
5158 case NL80211_IFTYPE_AP_VLAN:
5159 case NL80211_IFTYPE_P2P_GO:
Johannes Berg984c3112013-02-14 23:43:25 +01005160 /* ignore WME attributes if iface/sta is not capable */
5161 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
5162 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
5163 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
Eliad Pellerc75786c2011-08-23 14:37:46 +03005164
Johannes Bergbdd90d52011-12-14 12:20:27 +01005165 /* TDLS peers cannot be added */
Jouni Malinen3d124ea2013-05-27 18:24:02 +03005166 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5167 info->attrs[NL80211_ATTR_PEER_AID])
Johannes Berg4319e192011-09-07 11:50:48 +02005168 return -EINVAL;
Johannes Bergbdd90d52011-12-14 12:20:27 +01005169 /* but don't bother the driver with it */
5170 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
Eliad Pellerc75786c2011-08-23 14:37:46 +03005171
Johannes Bergd582cff2012-10-26 17:53:44 +02005172 /* allow authenticated/associated only if driver handles it */
5173 if (!(rdev->wiphy.features &
5174 NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
Johannes Bergbda95eb2015-11-26 16:26:13 +01005175 params.sta_flags_mask & auth_assoc)
Johannes Bergd582cff2012-10-26 17:53:44 +02005176 return -EINVAL;
5177
Johannes Bergbda95eb2015-11-26 16:26:13 +01005178 /* Older userspace, or userspace wanting to be compatible with
5179 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
5180 * and assoc flags in the mask, but assumes the station will be
5181 * added as associated anyway since this was the required driver
5182 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
5183 * introduced.
5184 * In order to not bother drivers with this quirk in the API
5185 * set the flags in both the mask and set for new stations in
5186 * this case.
5187 */
5188 if (!(params.sta_flags_mask & auth_assoc)) {
5189 params.sta_flags_mask |= auth_assoc;
5190 params.sta_flags_set |= auth_assoc;
5191 }
5192
Johannes Bergbdd90d52011-12-14 12:20:27 +01005193 /* must be last in here for error handling */
5194 params.vlan = get_vlan(info, rdev);
5195 if (IS_ERR(params.vlan))
5196 return PTR_ERR(params.vlan);
5197 break;
5198 case NL80211_IFTYPE_MESH_POINT:
Johannes Berg984c3112013-02-14 23:43:25 +01005199 /* ignore uAPSD data */
5200 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5201
Johannes Bergd582cff2012-10-26 17:53:44 +02005202 /* associated is disallowed */
5203 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
5204 return -EINVAL;
Johannes Bergbdd90d52011-12-14 12:20:27 +01005205 /* TDLS peers cannot be added */
Jouni Malinen3d124ea2013-05-27 18:24:02 +03005206 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5207 info->attrs[NL80211_ATTR_PEER_AID])
Johannes Berg4319e192011-09-07 11:50:48 +02005208 return -EINVAL;
Johannes Bergbdd90d52011-12-14 12:20:27 +01005209 break;
5210 case NL80211_IFTYPE_STATION:
Johannes Berg93d08f02013-03-04 09:29:46 +01005211 case NL80211_IFTYPE_P2P_CLIENT:
Johannes Berg984c3112013-02-14 23:43:25 +01005212 /* ignore uAPSD data */
5213 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5214
Johannes Berg77ee7c82013-02-15 00:48:33 +01005215 /* these are disallowed */
5216 if (params.sta_flags_mask &
5217 (BIT(NL80211_STA_FLAG_ASSOCIATED) |
5218 BIT(NL80211_STA_FLAG_AUTHENTICATED)))
Johannes Bergd582cff2012-10-26 17:53:44 +02005219 return -EINVAL;
Johannes Bergbdd90d52011-12-14 12:20:27 +01005220 /* Only TDLS peers can be added */
5221 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
5222 return -EINVAL;
5223 /* Can only add if TDLS ... */
5224 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
5225 return -EOPNOTSUPP;
5226 /* ... with external setup is supported */
5227 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
5228 return -EOPNOTSUPP;
Johannes Berg77ee7c82013-02-15 00:48:33 +01005229 /*
5230 * Older wpa_supplicant versions always mark the TDLS peer
5231 * as authorized, but it shouldn't yet be.
5232 */
5233 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
Johannes Bergbdd90d52011-12-14 12:20:27 +01005234 break;
5235 default:
5236 return -EOPNOTSUPP;
Eliad Pellerc75786c2011-08-23 14:37:46 +03005237 }
5238
Johannes Bergbdd90d52011-12-14 12:20:27 +01005239 /* be aware of params.vlan when changing code here */
Johannes Berg5727ef12007-12-19 02:03:34 +01005240
Hila Gonene35e4d22012-06-27 17:19:42 +03005241 err = rdev_add_station(rdev, dev, mac_addr, &params);
Johannes Berg5727ef12007-12-19 02:03:34 +01005242
Johannes Berg5727ef12007-12-19 02:03:34 +01005243 if (params.vlan)
5244 dev_put(params.vlan);
Johannes Berg5727ef12007-12-19 02:03:34 +01005245 return err;
5246}
5247
5248static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
5249{
Johannes Berg4c476992010-10-04 21:36:35 +02005250 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5251 struct net_device *dev = info->user_ptr[1];
Jouni Malinen89c771e2014-10-10 20:52:40 +03005252 struct station_del_parameters params;
5253
5254 memset(&params, 0, sizeof(params));
Johannes Berg5727ef12007-12-19 02:03:34 +01005255
5256 if (info->attrs[NL80211_ATTR_MAC])
Jouni Malinen89c771e2014-10-10 20:52:40 +03005257 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
Johannes Berg5727ef12007-12-19 02:03:34 +01005258
Johannes Berge80cf852009-05-11 14:43:13 +02005259 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
Marco Porschd5d9de02010-03-30 10:00:16 +02005260 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
Johannes Berg074ac8d2010-09-16 14:58:22 +02005261 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
Johannes Berg4c476992010-10-04 21:36:35 +02005262 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5263 return -EINVAL;
Johannes Berge80cf852009-05-11 14:43:13 +02005264
Johannes Berg4c476992010-10-04 21:36:35 +02005265 if (!rdev->ops->del_station)
5266 return -EOPNOTSUPP;
Johannes Berg5727ef12007-12-19 02:03:34 +01005267
Jouni Malinen98856862014-10-20 13:20:45 +03005268 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
5269 params.subtype =
5270 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
5271 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
5272 params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
5273 return -EINVAL;
5274 } else {
5275 /* Default to Deauthentication frame */
5276 params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
5277 }
5278
5279 if (info->attrs[NL80211_ATTR_REASON_CODE]) {
5280 params.reason_code =
5281 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5282 if (params.reason_code == 0)
5283 return -EINVAL; /* 0 is reserved */
5284 } else {
5285 /* Default to reason code 2 */
5286 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
5287 }
5288
Jouni Malinen89c771e2014-10-10 20:52:40 +03005289 return rdev_del_station(rdev, dev, &params);
Johannes Berg5727ef12007-12-19 02:03:34 +01005290}
5291
Eric W. Biederman15e47302012-09-07 20:12:54 +00005292static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005293 int flags, struct net_device *dev,
5294 u8 *dst, u8 *next_hop,
5295 struct mpath_info *pinfo)
5296{
5297 void *hdr;
5298 struct nlattr *pinfoattr;
5299
Henning Rogge1ef4c852014-11-04 16:14:58 +01005300 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005301 if (!hdr)
5302 return -1;
5303
David S. Miller9360ffd2012-03-29 04:41:26 -04005304 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5305 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
5306 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
5307 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
5308 goto nla_put_failure;
Johannes Bergf5ea9122009-08-07 16:17:38 +02005309
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005310 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
5311 if (!pinfoattr)
5312 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -04005313 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
5314 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
5315 pinfo->frame_qlen))
5316 goto nla_put_failure;
5317 if (((pinfo->filled & MPATH_INFO_SN) &&
5318 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
5319 ((pinfo->filled & MPATH_INFO_METRIC) &&
5320 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
5321 pinfo->metric)) ||
5322 ((pinfo->filled & MPATH_INFO_EXPTIME) &&
5323 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
5324 pinfo->exptime)) ||
5325 ((pinfo->filled & MPATH_INFO_FLAGS) &&
5326 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
5327 pinfo->flags)) ||
5328 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
5329 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
5330 pinfo->discovery_timeout)) ||
5331 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
5332 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
5333 pinfo->discovery_retries)))
5334 goto nla_put_failure;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005335
5336 nla_nest_end(msg, pinfoattr);
5337
Johannes Berg053c0952015-01-16 22:09:00 +01005338 genlmsg_end(msg, hdr);
5339 return 0;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005340
5341 nla_put_failure:
Thomas Grafbc3ed282008-06-03 16:36:54 -07005342 genlmsg_cancel(msg, hdr);
5343 return -EMSGSIZE;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005344}
5345
5346static int nl80211_dump_mpath(struct sk_buff *skb,
Johannes Bergbba95fe2008-07-29 13:22:51 +02005347 struct netlink_callback *cb)
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005348{
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005349 struct mpath_info pinfo;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08005350 struct cfg80211_registered_device *rdev;
Johannes Berg97990a02013-04-19 01:02:55 +02005351 struct wireless_dev *wdev;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005352 u8 dst[ETH_ALEN];
5353 u8 next_hop[ETH_ALEN];
Johannes Berg97990a02013-04-19 01:02:55 +02005354 int path_idx = cb->args[2];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005355 int err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005356
Johannes Berg56769e72017-03-15 14:26:04 +01005357 rtnl_lock();
Zhao, Gang1b8ec872014-04-21 12:53:02 +08005358 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
Johannes Berg67748892010-10-04 21:14:06 +02005359 if (err)
Johannes Berg56769e72017-03-15 14:26:04 +01005360 goto out_err;
Johannes Bergbba95fe2008-07-29 13:22:51 +02005361
Zhao, Gang1b8ec872014-04-21 12:53:02 +08005362 if (!rdev->ops->dump_mpath) {
Jouni Malineneec60b02009-03-20 21:21:19 +02005363 err = -EOPNOTSUPP;
Johannes Bergbba95fe2008-07-29 13:22:51 +02005364 goto out_err;
5365 }
5366
Johannes Berg97990a02013-04-19 01:02:55 +02005367 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
Jouni Malineneec60b02009-03-20 21:21:19 +02005368 err = -EOPNOTSUPP;
Roel Kluin0448b5f2009-08-22 21:15:49 +02005369 goto out_err;
Jouni Malineneec60b02009-03-20 21:21:19 +02005370 }
5371
Johannes Bergbba95fe2008-07-29 13:22:51 +02005372 while (1) {
Zhao, Gang1b8ec872014-04-21 12:53:02 +08005373 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
Johannes Berg97990a02013-04-19 01:02:55 +02005374 next_hop, &pinfo);
Johannes Bergbba95fe2008-07-29 13:22:51 +02005375 if (err == -ENOENT)
5376 break;
5377 if (err)
Johannes Berg3b858752009-03-12 09:55:09 +01005378 goto out_err;
Johannes Bergbba95fe2008-07-29 13:22:51 +02005379
Eric W. Biederman15e47302012-09-07 20:12:54 +00005380 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
Johannes Bergbba95fe2008-07-29 13:22:51 +02005381 cb->nlh->nlmsg_seq, NLM_F_MULTI,
Johannes Berg97990a02013-04-19 01:02:55 +02005382 wdev->netdev, dst, next_hop,
Johannes Bergbba95fe2008-07-29 13:22:51 +02005383 &pinfo) < 0)
5384 goto out;
5385
5386 path_idx++;
5387 }
5388
Johannes Bergbba95fe2008-07-29 13:22:51 +02005389 out:
Johannes Berg97990a02013-04-19 01:02:55 +02005390 cb->args[2] = path_idx;
Johannes Bergbba95fe2008-07-29 13:22:51 +02005391 err = skb->len;
Johannes Bergbba95fe2008-07-29 13:22:51 +02005392 out_err:
Johannes Berg56769e72017-03-15 14:26:04 +01005393 rtnl_unlock();
Johannes Bergbba95fe2008-07-29 13:22:51 +02005394 return err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005395}
5396
5397static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
5398{
Johannes Berg4c476992010-10-04 21:36:35 +02005399 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005400 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02005401 struct net_device *dev = info->user_ptr[1];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005402 struct mpath_info pinfo;
5403 struct sk_buff *msg;
5404 u8 *dst = NULL;
5405 u8 next_hop[ETH_ALEN];
5406
5407 memset(&pinfo, 0, sizeof(pinfo));
5408
5409 if (!info->attrs[NL80211_ATTR_MAC])
5410 return -EINVAL;
5411
5412 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5413
Johannes Berg4c476992010-10-04 21:36:35 +02005414 if (!rdev->ops->get_mpath)
5415 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01005416
Johannes Berg4c476992010-10-04 21:36:35 +02005417 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5418 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02005419
Hila Gonene35e4d22012-06-27 17:19:42 +03005420 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005421 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02005422 return err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005423
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -07005424 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005425 if (!msg)
Johannes Berg4c476992010-10-04 21:36:35 +02005426 return -ENOMEM;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005427
Eric W. Biederman15e47302012-09-07 20:12:54 +00005428 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
Johannes Berg4c476992010-10-04 21:36:35 +02005429 dev, dst, next_hop, &pinfo) < 0) {
5430 nlmsg_free(msg);
5431 return -ENOBUFS;
5432 }
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005433
Johannes Berg4c476992010-10-04 21:36:35 +02005434 return genlmsg_reply(msg, info);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005435}
5436
5437static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
5438{
Johannes Berg4c476992010-10-04 21:36:35 +02005439 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5440 struct net_device *dev = info->user_ptr[1];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005441 u8 *dst = NULL;
5442 u8 *next_hop = NULL;
5443
5444 if (!info->attrs[NL80211_ATTR_MAC])
5445 return -EINVAL;
5446
5447 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5448 return -EINVAL;
5449
5450 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5451 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5452
Johannes Berg4c476992010-10-04 21:36:35 +02005453 if (!rdev->ops->change_mpath)
5454 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01005455
Johannes Berg4c476992010-10-04 21:36:35 +02005456 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5457 return -EOPNOTSUPP;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005458
Hila Gonene35e4d22012-06-27 17:19:42 +03005459 return rdev_change_mpath(rdev, dev, dst, next_hop);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005460}
Johannes Berg4c476992010-10-04 21:36:35 +02005461
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005462static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
5463{
Johannes Berg4c476992010-10-04 21:36:35 +02005464 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5465 struct net_device *dev = info->user_ptr[1];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005466 u8 *dst = NULL;
5467 u8 *next_hop = NULL;
5468
5469 if (!info->attrs[NL80211_ATTR_MAC])
5470 return -EINVAL;
5471
5472 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5473 return -EINVAL;
5474
5475 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5476 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5477
Johannes Berg4c476992010-10-04 21:36:35 +02005478 if (!rdev->ops->add_mpath)
5479 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01005480
Johannes Berg4c476992010-10-04 21:36:35 +02005481 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5482 return -EOPNOTSUPP;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005483
Hila Gonene35e4d22012-06-27 17:19:42 +03005484 return rdev_add_mpath(rdev, dev, dst, next_hop);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005485}
5486
5487static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
5488{
Johannes Berg4c476992010-10-04 21:36:35 +02005489 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5490 struct net_device *dev = info->user_ptr[1];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005491 u8 *dst = NULL;
5492
5493 if (info->attrs[NL80211_ATTR_MAC])
5494 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5495
Johannes Berg4c476992010-10-04 21:36:35 +02005496 if (!rdev->ops->del_mpath)
5497 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01005498
Miaoqing Pan2f153002019-09-26 16:16:50 +08005499 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5500 return -EOPNOTSUPP;
5501
Hila Gonene35e4d22012-06-27 17:19:42 +03005502 return rdev_del_mpath(rdev, dev, dst);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005503}
5504
Henning Rogge66be7d22014-09-12 08:58:49 +02005505static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
5506{
5507 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5508 int err;
5509 struct net_device *dev = info->user_ptr[1];
5510 struct mpath_info pinfo;
5511 struct sk_buff *msg;
5512 u8 *dst = NULL;
5513 u8 mpp[ETH_ALEN];
5514
5515 memset(&pinfo, 0, sizeof(pinfo));
5516
5517 if (!info->attrs[NL80211_ATTR_MAC])
5518 return -EINVAL;
5519
5520 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5521
5522 if (!rdev->ops->get_mpp)
5523 return -EOPNOTSUPP;
5524
5525 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5526 return -EOPNOTSUPP;
5527
5528 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
5529 if (err)
5530 return err;
5531
5532 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5533 if (!msg)
5534 return -ENOMEM;
5535
5536 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
5537 dev, dst, mpp, &pinfo) < 0) {
5538 nlmsg_free(msg);
5539 return -ENOBUFS;
5540 }
5541
5542 return genlmsg_reply(msg, info);
5543}
5544
5545static int nl80211_dump_mpp(struct sk_buff *skb,
5546 struct netlink_callback *cb)
5547{
5548 struct mpath_info pinfo;
5549 struct cfg80211_registered_device *rdev;
5550 struct wireless_dev *wdev;
5551 u8 dst[ETH_ALEN];
5552 u8 mpp[ETH_ALEN];
5553 int path_idx = cb->args[2];
5554 int err;
5555
Johannes Berg56769e72017-03-15 14:26:04 +01005556 rtnl_lock();
Henning Rogge66be7d22014-09-12 08:58:49 +02005557 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
5558 if (err)
Johannes Berg56769e72017-03-15 14:26:04 +01005559 goto out_err;
Henning Rogge66be7d22014-09-12 08:58:49 +02005560
5561 if (!rdev->ops->dump_mpp) {
5562 err = -EOPNOTSUPP;
5563 goto out_err;
5564 }
5565
5566 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5567 err = -EOPNOTSUPP;
5568 goto out_err;
5569 }
5570
5571 while (1) {
5572 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
5573 mpp, &pinfo);
5574 if (err == -ENOENT)
5575 break;
5576 if (err)
5577 goto out_err;
5578
5579 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
5580 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5581 wdev->netdev, dst, mpp,
5582 &pinfo) < 0)
5583 goto out;
5584
5585 path_idx++;
5586 }
5587
5588 out:
5589 cb->args[2] = path_idx;
5590 err = skb->len;
5591 out_err:
Johannes Berg56769e72017-03-15 14:26:04 +01005592 rtnl_unlock();
Henning Rogge66be7d22014-09-12 08:58:49 +02005593 return err;
5594}
5595
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005596static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
5597{
Johannes Berg4c476992010-10-04 21:36:35 +02005598 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5599 struct net_device *dev = info->user_ptr[1];
Simon Wunderlichc56589e2013-11-21 18:19:49 +01005600 struct wireless_dev *wdev = dev->ieee80211_ptr;
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005601 struct bss_parameters params;
Simon Wunderlichc56589e2013-11-21 18:19:49 +01005602 int err;
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005603
5604 memset(&params, 0, sizeof(params));
5605 /* default to not changing parameters */
5606 params.use_cts_prot = -1;
5607 params.use_short_preamble = -1;
5608 params.use_short_slot_time = -1;
Felix Fietkaufd8aaaf2010-04-27 01:23:35 +02005609 params.ap_isolate = -1;
Helmut Schaa50b12f52010-11-19 12:40:25 +01005610 params.ht_opmode = -1;
Johannes Berg53cabad2012-11-14 15:17:28 +01005611 params.p2p_ctwindow = -1;
5612 params.p2p_opp_ps = -1;
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005613
5614 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
5615 params.use_cts_prot =
5616 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
5617 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
5618 params.use_short_preamble =
5619 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
5620 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
5621 params.use_short_slot_time =
5622 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
Jouni Malinen90c97a02008-10-30 16:59:22 +02005623 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
5624 params.basic_rates =
5625 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5626 params.basic_rates_len =
5627 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5628 }
Felix Fietkaufd8aaaf2010-04-27 01:23:35 +02005629 if (info->attrs[NL80211_ATTR_AP_ISOLATE])
5630 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
Helmut Schaa50b12f52010-11-19 12:40:25 +01005631 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
5632 params.ht_opmode =
5633 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005634
Johannes Berg53cabad2012-11-14 15:17:28 +01005635 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
5636 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5637 return -EINVAL;
5638 params.p2p_ctwindow =
5639 nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
5640 if (params.p2p_ctwindow < 0)
5641 return -EINVAL;
5642 if (params.p2p_ctwindow != 0 &&
5643 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
5644 return -EINVAL;
5645 }
5646
5647 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
5648 u8 tmp;
5649
5650 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5651 return -EINVAL;
5652 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
5653 if (tmp > 1)
5654 return -EINVAL;
5655 params.p2p_opp_ps = tmp;
5656 if (params.p2p_opp_ps &&
5657 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
5658 return -EINVAL;
5659 }
5660
Johannes Berg4c476992010-10-04 21:36:35 +02005661 if (!rdev->ops->change_bss)
5662 return -EOPNOTSUPP;
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005663
Johannes Berg074ac8d2010-09-16 14:58:22 +02005664 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
Johannes Berg4c476992010-10-04 21:36:35 +02005665 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5666 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02005667
Simon Wunderlichc56589e2013-11-21 18:19:49 +01005668 wdev_lock(wdev);
5669 err = rdev_change_bss(rdev, dev, &params);
5670 wdev_unlock(wdev);
5671
5672 return err;
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005673}
5674
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07005675static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
5676{
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07005677 char *data = NULL;
Ilan peer05050752015-03-04 00:32:06 -05005678 bool is_indoor;
Luis R. Rodriguez57b5ce02012-07-12 11:49:18 -07005679 enum nl80211_user_reg_hint_type user_reg_hint_type;
Ilan peer05050752015-03-04 00:32:06 -05005680 u32 owner_nlportid;
5681
Luis R. Rodriguez80778f12009-02-21 00:04:22 -05005682 /*
5683 * You should only get this when cfg80211 hasn't yet initialized
5684 * completely when built-in to the kernel right between the time
5685 * window between nl80211_init() and regulatory_init(), if that is
5686 * even possible.
5687 */
Johannes Berg458f4f92012-12-06 15:47:38 +01005688 if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
Luis R. Rodriguezfe33eb32009-02-21 00:04:30 -05005689 return -EINPROGRESS;
Luis R. Rodriguez80778f12009-02-21 00:04:22 -05005690
Luis R. Rodriguez57b5ce02012-07-12 11:49:18 -07005691 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
5692 user_reg_hint_type =
5693 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
5694 else
5695 user_reg_hint_type = NL80211_USER_REG_HINT_USER;
5696
5697 switch (user_reg_hint_type) {
5698 case NL80211_USER_REG_HINT_USER:
5699 case NL80211_USER_REG_HINT_CELL_BASE:
Ilan Peer52616f22014-02-25 16:26:00 +02005700 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
5701 return -EINVAL;
5702
5703 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
5704 return regulatory_hint_user(data, user_reg_hint_type);
5705 case NL80211_USER_REG_HINT_INDOOR:
Ilan peer05050752015-03-04 00:32:06 -05005706 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
5707 owner_nlportid = info->snd_portid;
5708 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
5709 } else {
5710 owner_nlportid = 0;
5711 is_indoor = true;
5712 }
5713
5714 return regulatory_hint_indoor(is_indoor, owner_nlportid);
Luis R. Rodriguez57b5ce02012-07-12 11:49:18 -07005715 default:
5716 return -EINVAL;
5717 }
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07005718}
5719
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005720static int nl80211_get_mesh_config(struct sk_buff *skb,
Johannes Berg29cbe682010-12-03 09:20:44 +01005721 struct genl_info *info)
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005722{
Johannes Berg4c476992010-10-04 21:36:35 +02005723 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg4c476992010-10-04 21:36:35 +02005724 struct net_device *dev = info->user_ptr[1];
Johannes Berg29cbe682010-12-03 09:20:44 +01005725 struct wireless_dev *wdev = dev->ieee80211_ptr;
5726 struct mesh_config cur_params;
5727 int err = 0;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005728 void *hdr;
5729 struct nlattr *pinfoattr;
5730 struct sk_buff *msg;
5731
Johannes Berg29cbe682010-12-03 09:20:44 +01005732 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
5733 return -EOPNOTSUPP;
5734
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005735 if (!rdev->ops->get_mesh_config)
Johannes Berg4c476992010-10-04 21:36:35 +02005736 return -EOPNOTSUPP;
Jouni Malinenf3f92582009-03-20 17:57:36 +02005737
Johannes Berg29cbe682010-12-03 09:20:44 +01005738 wdev_lock(wdev);
5739 /* If not connected, get default parameters */
5740 if (!wdev->mesh_id_len)
5741 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
5742 else
Hila Gonene35e4d22012-06-27 17:19:42 +03005743 err = rdev_get_mesh_config(rdev, dev, &cur_params);
Johannes Berg29cbe682010-12-03 09:20:44 +01005744 wdev_unlock(wdev);
5745
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005746 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02005747 return err;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005748
5749 /* Draw up a netlink message to send back */
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -07005750 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg4c476992010-10-04 21:36:35 +02005751 if (!msg)
5752 return -ENOMEM;
Eric W. Biederman15e47302012-09-07 20:12:54 +00005753 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005754 NL80211_CMD_GET_MESH_CONFIG);
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005755 if (!hdr)
Julia Lawallefe1cf02011-01-28 15:17:11 +01005756 goto out;
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005757 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005758 if (!pinfoattr)
5759 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -04005760 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5761 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
5762 cur_params.dot11MeshRetryTimeout) ||
5763 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
5764 cur_params.dot11MeshConfirmTimeout) ||
5765 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
5766 cur_params.dot11MeshHoldingTimeout) ||
5767 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
5768 cur_params.dot11MeshMaxPeerLinks) ||
5769 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
5770 cur_params.dot11MeshMaxRetries) ||
5771 nla_put_u8(msg, NL80211_MESHCONF_TTL,
5772 cur_params.dot11MeshTTL) ||
5773 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
5774 cur_params.element_ttl) ||
5775 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
5776 cur_params.auto_open_plinks) ||
John W. Linville7eab0f62012-04-12 14:25:14 -04005777 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
5778 cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
David S. Miller9360ffd2012-03-29 04:41:26 -04005779 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
5780 cur_params.dot11MeshHWMPmaxPREQretries) ||
5781 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
5782 cur_params.path_refresh_time) ||
5783 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
5784 cur_params.min_discovery_timeout) ||
5785 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
5786 cur_params.dot11MeshHWMPactivePathTimeout) ||
5787 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
5788 cur_params.dot11MeshHWMPpreqMinInterval) ||
5789 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
5790 cur_params.dot11MeshHWMPperrMinInterval) ||
5791 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
5792 cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
5793 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
5794 cur_params.dot11MeshHWMPRootMode) ||
5795 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
5796 cur_params.dot11MeshHWMPRannInterval) ||
5797 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
5798 cur_params.dot11MeshGateAnnouncementProtocol) ||
5799 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
5800 cur_params.dot11MeshForwarding) ||
5801 nla_put_u32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
Ashok Nagarajan70c33ea2012-04-30 14:20:32 -07005802 cur_params.rssi_threshold) ||
5803 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
Chun-Yeow Yeohac1073a2012-06-14 02:06:06 +08005804 cur_params.ht_opmode) ||
5805 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
5806 cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
5807 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
Chun-Yeow Yeoh728b19e2012-06-14 02:06:10 +08005808 cur_params.dot11MeshHWMProotInterval) ||
5809 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
Marco Porsch3b1c5a52013-01-07 16:04:52 +01005810 cur_params.dot11MeshHWMPconfirmationInterval) ||
5811 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
5812 cur_params.power_mode) ||
5813 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
Colleen Twitty8e7c0532013-06-03 09:53:39 -07005814 cur_params.dot11MeshAwakeWindowDuration) ||
5815 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
5816 cur_params.plink_timeout))
David S. Miller9360ffd2012-03-29 04:41:26 -04005817 goto nla_put_failure;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005818 nla_nest_end(msg, pinfoattr);
5819 genlmsg_end(msg, hdr);
Johannes Berg4c476992010-10-04 21:36:35 +02005820 return genlmsg_reply(msg, info);
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005821
Johannes Berg3b858752009-03-12 09:55:09 +01005822 nla_put_failure:
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005823 genlmsg_cancel(msg, hdr);
Julia Lawallefe1cf02011-01-28 15:17:11 +01005824 out:
Yuri Ershovd080e272010-06-29 15:08:07 +04005825 nlmsg_free(msg);
Johannes Berg4c476992010-10-04 21:36:35 +02005826 return -ENOBUFS;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005827}
5828
Alexey Dobriyanb54452b2010-02-18 08:14:31 +00005829static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005830 [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
5831 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
5832 [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
5833 [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
5834 [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
5835 [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
Javier Cardona45904f22010-12-03 09:20:40 +01005836 [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005837 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
Javier Cardonad299a1f2012-03-31 11:31:33 -07005838 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005839 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
5840 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
5841 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
5842 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
5843 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
Thomas Pedersendca7e942011-11-24 17:15:24 -08005844 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005845 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
Javier Cardona699403d2011-08-09 16:45:09 -07005846 [NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
Javier Cardona0507e152011-08-09 16:45:10 -07005847 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
Javier Cardona16dd7262011-08-09 16:45:11 -07005848 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
Chun-Yeow Yeoh94f90652012-01-21 01:02:16 +08005849 [NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005850 [NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
5851 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
Chun-Yeow Yeohac1073a2012-06-14 02:06:06 +08005852 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
5853 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
Chun-Yeow Yeoh728b19e2012-06-14 02:06:10 +08005854 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
Marco Porsch3b1c5a52013-01-07 16:04:52 +01005855 [NL80211_MESHCONF_POWER_MODE] = { .type = NLA_U32 },
5856 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
Colleen Twitty8e7c0532013-06-03 09:53:39 -07005857 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005858};
5859
Javier Cardonac80d5452010-12-16 17:37:49 -08005860static const struct nla_policy
5861 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
Javier Cardonad299a1f2012-03-31 11:31:33 -07005862 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
Javier Cardonac80d5452010-12-16 17:37:49 -08005863 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
5864 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
Javier Cardona15d5dda2011-04-07 15:08:28 -07005865 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
Colleen Twitty6e16d902013-05-08 11:45:59 -07005866 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
Thomas Pedersenbb2798d2013-03-04 13:06:10 -08005867 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
Javier Cardona581a8b02011-04-07 15:08:27 -07005868 [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005869 .len = IEEE80211_MAX_DATA_LEN },
Javier Cardonab130e5c2011-05-03 16:57:07 -07005870 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
Javier Cardonac80d5452010-12-16 17:37:49 -08005871};
5872
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005873static int nl80211_check_bool(const struct nlattr *nla, u8 min, u8 max, bool *out)
5874{
5875 u8 val = nla_get_u8(nla);
5876 if (val < min || val > max)
5877 return -EINVAL;
5878 *out = val;
5879 return 0;
5880}
5881
5882static int nl80211_check_u8(const struct nlattr *nla, u8 min, u8 max, u8 *out)
5883{
5884 u8 val = nla_get_u8(nla);
5885 if (val < min || val > max)
5886 return -EINVAL;
5887 *out = val;
5888 return 0;
5889}
5890
5891static int nl80211_check_u16(const struct nlattr *nla, u16 min, u16 max, u16 *out)
5892{
5893 u16 val = nla_get_u16(nla);
5894 if (val < min || val > max)
5895 return -EINVAL;
5896 *out = val;
5897 return 0;
5898}
5899
5900static int nl80211_check_u32(const struct nlattr *nla, u32 min, u32 max, u32 *out)
5901{
5902 u32 val = nla_get_u32(nla);
5903 if (val < min || val > max)
5904 return -EINVAL;
5905 *out = val;
5906 return 0;
5907}
5908
5909static int nl80211_check_s32(const struct nlattr *nla, s32 min, s32 max, s32 *out)
5910{
5911 s32 val = nla_get_s32(nla);
5912 if (val < min || val > max)
5913 return -EINVAL;
5914 *out = val;
5915 return 0;
5916}
5917
Johannes Bergff9a71a2016-08-11 14:59:53 +02005918static int nl80211_check_power_mode(const struct nlattr *nla,
5919 enum nl80211_mesh_power_mode min,
5920 enum nl80211_mesh_power_mode max,
5921 enum nl80211_mesh_power_mode *out)
5922{
5923 u32 val = nla_get_u32(nla);
5924 if (val < min || val > max)
5925 return -EINVAL;
5926 *out = val;
5927 return 0;
5928}
5929
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005930static int nl80211_parse_mesh_config(struct genl_info *info,
Johannes Bergbd90fdc2010-12-03 09:20:43 +01005931 struct mesh_config *cfg,
5932 u32 *mask_out)
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005933{
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005934 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
Johannes Bergbd90fdc2010-12-03 09:20:43 +01005935 u32 mask = 0;
Masashi Honma97572352016-08-03 10:07:44 +09005936 u16 ht_opmode;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005937
Marco Porschea54fba2013-01-07 16:04:48 +01005938#define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, min, max, mask, attr, fn) \
5939do { \
5940 if (tb[attr]) { \
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005941 if (fn(tb[attr], min, max, &cfg->param)) \
Marco Porschea54fba2013-01-07 16:04:48 +01005942 return -EINVAL; \
Marco Porschea54fba2013-01-07 16:04:48 +01005943 mask |= (1 << (attr - 1)); \
5944 } \
5945} while (0)
Johannes Bergbd90fdc2010-12-03 09:20:43 +01005946
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005947 if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005948 return -EINVAL;
5949 if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005950 info->attrs[NL80211_ATTR_MESH_CONFIG],
Johannes Bergbd90fdc2010-12-03 09:20:43 +01005951 nl80211_meshconf_params_policy))
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005952 return -EINVAL;
5953
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005954 /* This makes sure that there aren't more than 32 mesh config
5955 * parameters (otherwise our bitfield scheme would not work.) */
5956 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
5957
5958 /* Fill in the params struct */
Marco Porschea54fba2013-01-07 16:04:48 +01005959 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, 1, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005960 mask, NL80211_MESHCONF_RETRY_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005961 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01005962 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, 1, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005963 mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005964 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01005965 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, 1, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005966 mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005967 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01005968 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, 0, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005969 mask, NL80211_MESHCONF_MAX_PEER_LINKS,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005970 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01005971 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, 0, 16,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005972 mask, NL80211_MESHCONF_MAX_RETRIES,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005973 nl80211_check_u8);
Marco Porschea54fba2013-01-07 16:04:48 +01005974 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, 1, 255,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005975 mask, NL80211_MESHCONF_TTL, nl80211_check_u8);
Marco Porschea54fba2013-01-07 16:04:48 +01005976 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, 1, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005977 mask, NL80211_MESHCONF_ELEMENT_TTL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005978 nl80211_check_u8);
Marco Porschea54fba2013-01-07 16:04:48 +01005979 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, 0, 1,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005980 mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005981 nl80211_check_bool);
Marco Porschea54fba2013-01-07 16:04:48 +01005982 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
5983 1, 255, mask,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005984 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005985 nl80211_check_u32);
Marco Porschea54fba2013-01-07 16:04:48 +01005986 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, 0, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005987 mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005988 nl80211_check_u8);
Marco Porschea54fba2013-01-07 16:04:48 +01005989 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, 1, 65535,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005990 mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005991 nl80211_check_u32);
Marco Porschea54fba2013-01-07 16:04:48 +01005992 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, 1, 65535,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005993 mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005994 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01005995 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
5996 1, 65535, mask,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005997 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005998 nl80211_check_u32);
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005999 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
Marco Porschea54fba2013-01-07 16:04:48 +01006000 1, 65535, mask,
6001 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006002 nl80211_check_u16);
Thomas Pedersendca7e942011-11-24 17:15:24 -08006003 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
Marco Porschea54fba2013-01-07 16:04:48 +01006004 1, 65535, mask,
6005 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006006 nl80211_check_u16);
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07006007 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
Marco Porschea54fba2013-01-07 16:04:48 +01006008 dot11MeshHWMPnetDiameterTraversalTime,
6009 1, 65535, mask,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006010 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006011 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01006012 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, 0, 4,
6013 mask, NL80211_MESHCONF_HWMP_ROOTMODE,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006014 nl80211_check_u8);
Marco Porschea54fba2013-01-07 16:04:48 +01006015 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, 1, 65535,
6016 mask, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006017 nl80211_check_u16);
Rui Paulo63c57232009-11-09 23:46:57 +00006018 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
Marco Porschea54fba2013-01-07 16:04:48 +01006019 dot11MeshGateAnnouncementProtocol, 0, 1,
6020 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006021 nl80211_check_bool);
Marco Porschea54fba2013-01-07 16:04:48 +01006022 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, 0, 1,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006023 mask, NL80211_MESHCONF_FORWARDING,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006024 nl80211_check_bool);
Chun-Yeow Yeoh83374fe2013-07-11 18:24:03 +08006025 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, -255, 0,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006026 mask, NL80211_MESHCONF_RSSI_THRESHOLD,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006027 nl80211_check_s32);
Masashi Honma97572352016-08-03 10:07:44 +09006028 /*
6029 * Check HT operation mode based on
Bob Copeland15a78792018-06-24 21:10:49 -04006030 * IEEE 802.11-2016 9.4.2.57 HT Operation element.
Masashi Honma97572352016-08-03 10:07:44 +09006031 */
6032 if (tb[NL80211_MESHCONF_HT_OPMODE]) {
6033 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
6034
6035 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
6036 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
6037 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
6038 return -EINVAL;
6039
Bob Copeland15a78792018-06-24 21:10:49 -04006040 /* NON_HT_STA bit is reserved, but some programs set it */
6041 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT;
Masashi Honma97572352016-08-03 10:07:44 +09006042
Masashi Honma97572352016-08-03 10:07:44 +09006043 cfg->ht_opmode = ht_opmode;
Masashi Honmaf9bd7912017-01-26 08:56:13 +09006044 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
Masashi Honma97572352016-08-03 10:07:44 +09006045 }
Chun-Yeow Yeohac1073a2012-06-14 02:06:06 +08006046 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
Marco Porschea54fba2013-01-07 16:04:48 +01006047 1, 65535, mask,
Chun-Yeow Yeohac1073a2012-06-14 02:06:06 +08006048 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006049 nl80211_check_u32);
Marco Porschea54fba2013-01-07 16:04:48 +01006050 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, 1, 65535,
Chun-Yeow Yeohac1073a2012-06-14 02:06:06 +08006051 mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006052 nl80211_check_u16);
Chun-Yeow Yeoh728b19e2012-06-14 02:06:10 +08006053 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
Marco Porschea54fba2013-01-07 16:04:48 +01006054 dot11MeshHWMPconfirmationInterval,
6055 1, 65535, mask,
Chun-Yeow Yeoh728b19e2012-06-14 02:06:10 +08006056 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006057 nl80211_check_u16);
Marco Porsch3b1c5a52013-01-07 16:04:52 +01006058 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode,
6059 NL80211_MESH_POWER_ACTIVE,
6060 NL80211_MESH_POWER_MAX,
6061 mask, NL80211_MESHCONF_POWER_MODE,
Johannes Bergff9a71a2016-08-11 14:59:53 +02006062 nl80211_check_power_mode);
Marco Porsch3b1c5a52013-01-07 16:04:52 +01006063 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration,
6064 0, 65535, mask,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006065 NL80211_MESHCONF_AWAKE_WINDOW, nl80211_check_u16);
Masashi Honma31f909a2015-02-24 22:42:16 +09006066 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, 0, 0xffffffff,
Colleen Twitty8e7c0532013-06-03 09:53:39 -07006067 mask, NL80211_MESHCONF_PLINK_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006068 nl80211_check_u32);
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006069 if (mask_out)
6070 *mask_out = mask;
Javier Cardonac80d5452010-12-16 17:37:49 -08006071
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006072 return 0;
6073
6074#undef FILL_IN_MESH_PARAM_IF_SET
6075}
6076
Javier Cardonac80d5452010-12-16 17:37:49 -08006077static int nl80211_parse_mesh_setup(struct genl_info *info,
6078 struct mesh_setup *setup)
6079{
Thomas Pedersenbb2798d2013-03-04 13:06:10 -08006080 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Javier Cardonac80d5452010-12-16 17:37:49 -08006081 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
6082
6083 if (!info->attrs[NL80211_ATTR_MESH_SETUP])
6084 return -EINVAL;
6085 if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
6086 info->attrs[NL80211_ATTR_MESH_SETUP],
6087 nl80211_mesh_setup_params_policy))
6088 return -EINVAL;
6089
Javier Cardonad299a1f2012-03-31 11:31:33 -07006090 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
6091 setup->sync_method =
6092 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
6093 IEEE80211_SYNC_METHOD_VENDOR :
6094 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
6095
Javier Cardonac80d5452010-12-16 17:37:49 -08006096 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
6097 setup->path_sel_proto =
6098 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
6099 IEEE80211_PATH_PROTOCOL_VENDOR :
6100 IEEE80211_PATH_PROTOCOL_HWMP;
6101
6102 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
6103 setup->path_metric =
6104 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
6105 IEEE80211_PATH_METRIC_VENDOR :
6106 IEEE80211_PATH_METRIC_AIRTIME;
6107
Javier Cardona581a8b02011-04-07 15:08:27 -07006108 if (tb[NL80211_MESH_SETUP_IE]) {
Javier Cardonac80d5452010-12-16 17:37:49 -08006109 struct nlattr *ieattr =
Javier Cardona581a8b02011-04-07 15:08:27 -07006110 tb[NL80211_MESH_SETUP_IE];
Javier Cardonac80d5452010-12-16 17:37:49 -08006111 if (!is_valid_ie_attr(ieattr))
6112 return -EINVAL;
Javier Cardona581a8b02011-04-07 15:08:27 -07006113 setup->ie = nla_data(ieattr);
6114 setup->ie_len = nla_len(ieattr);
Javier Cardonac80d5452010-12-16 17:37:49 -08006115 }
Thomas Pedersenbb2798d2013-03-04 13:06:10 -08006116 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
6117 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
6118 return -EINVAL;
6119 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
Javier Cardonab130e5c2011-05-03 16:57:07 -07006120 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
6121 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
Thomas Pedersenbb2798d2013-03-04 13:06:10 -08006122 if (setup->is_secure)
6123 setup->user_mpm = true;
Javier Cardonac80d5452010-12-16 17:37:49 -08006124
Colleen Twitty6e16d902013-05-08 11:45:59 -07006125 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
6126 if (!setup->user_mpm)
6127 return -EINVAL;
6128 setup->auth_id =
6129 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
6130 }
6131
Javier Cardonac80d5452010-12-16 17:37:49 -08006132 return 0;
6133}
6134
Javier Cardona24bdd9f2010-12-16 17:37:48 -08006135static int nl80211_update_mesh_config(struct sk_buff *skb,
Johannes Berg29cbe682010-12-03 09:20:44 +01006136 struct genl_info *info)
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006137{
6138 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6139 struct net_device *dev = info->user_ptr[1];
Johannes Berg29cbe682010-12-03 09:20:44 +01006140 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006141 struct mesh_config cfg;
6142 u32 mask;
6143 int err;
6144
Johannes Berg29cbe682010-12-03 09:20:44 +01006145 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
6146 return -EOPNOTSUPP;
6147
Javier Cardona24bdd9f2010-12-16 17:37:48 -08006148 if (!rdev->ops->update_mesh_config)
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006149 return -EOPNOTSUPP;
6150
Javier Cardona24bdd9f2010-12-16 17:37:48 -08006151 err = nl80211_parse_mesh_config(info, &cfg, &mask);
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006152 if (err)
6153 return err;
6154
Johannes Berg29cbe682010-12-03 09:20:44 +01006155 wdev_lock(wdev);
6156 if (!wdev->mesh_id_len)
6157 err = -ENOLINK;
6158
6159 if (!err)
Hila Gonene35e4d22012-06-27 17:19:42 +03006160 err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
Johannes Berg29cbe682010-12-03 09:20:44 +01006161
6162 wdev_unlock(wdev);
6163
6164 return err;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07006165}
6166
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006167static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
6168 struct sk_buff *msg)
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006169{
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006170 struct nlattr *nl_reg_rules;
6171 unsigned int i;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006172
Johannes Berg458f4f92012-12-06 15:47:38 +01006173 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
6174 (regdom->dfs_region &&
6175 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006176 goto nla_put_failure;
Johannes Berg458f4f92012-12-06 15:47:38 +01006177
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006178 nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
6179 if (!nl_reg_rules)
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006180 goto nla_put_failure;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006181
Johannes Berg458f4f92012-12-06 15:47:38 +01006182 for (i = 0; i < regdom->n_reg_rules; i++) {
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006183 struct nlattr *nl_reg_rule;
6184 const struct ieee80211_reg_rule *reg_rule;
6185 const struct ieee80211_freq_range *freq_range;
6186 const struct ieee80211_power_rule *power_rule;
Janusz Dziedzic97524822014-01-30 09:52:20 +01006187 unsigned int max_bandwidth_khz;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006188
Johannes Berg458f4f92012-12-06 15:47:38 +01006189 reg_rule = &regdom->reg_rules[i];
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006190 freq_range = &reg_rule->freq_range;
6191 power_rule = &reg_rule->power_rule;
6192
6193 nl_reg_rule = nla_nest_start(msg, i);
6194 if (!nl_reg_rule)
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006195 goto nla_put_failure;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006196
Janusz Dziedzic97524822014-01-30 09:52:20 +01006197 max_bandwidth_khz = freq_range->max_bandwidth_khz;
6198 if (!max_bandwidth_khz)
6199 max_bandwidth_khz = reg_get_max_bandwidth(regdom,
6200 reg_rule);
6201
David S. Miller9360ffd2012-03-29 04:41:26 -04006202 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
6203 reg_rule->flags) ||
6204 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
6205 freq_range->start_freq_khz) ||
6206 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
6207 freq_range->end_freq_khz) ||
6208 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
Janusz Dziedzic97524822014-01-30 09:52:20 +01006209 max_bandwidth_khz) ||
David S. Miller9360ffd2012-03-29 04:41:26 -04006210 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
6211 power_rule->max_antenna_gain) ||
6212 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
Janusz Dziedzic089027e2014-02-21 19:46:12 +01006213 power_rule->max_eirp) ||
6214 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
6215 reg_rule->dfs_cac_ms))
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006216 goto nla_put_failure;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006217
6218 nla_nest_end(msg, nl_reg_rule);
6219 }
6220
6221 nla_nest_end(msg, nl_reg_rules);
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006222 return 0;
6223
6224nla_put_failure:
6225 return -EMSGSIZE;
6226}
6227
6228static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
6229{
6230 const struct ieee80211_regdomain *regdom = NULL;
6231 struct cfg80211_registered_device *rdev;
6232 struct wiphy *wiphy = NULL;
6233 struct sk_buff *msg;
6234 void *hdr;
6235
6236 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6237 if (!msg)
6238 return -ENOBUFS;
6239
6240 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6241 NL80211_CMD_GET_REG);
6242 if (!hdr)
6243 goto put_failure;
6244
6245 if (info->attrs[NL80211_ATTR_WIPHY]) {
Arik Nemtsov1bdd7162014-12-15 19:26:01 +02006246 bool self_managed;
6247
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006248 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
6249 if (IS_ERR(rdev)) {
6250 nlmsg_free(msg);
6251 return PTR_ERR(rdev);
6252 }
6253
6254 wiphy = &rdev->wiphy;
Arik Nemtsov1bdd7162014-12-15 19:26:01 +02006255 self_managed = wiphy->regulatory_flags &
6256 REGULATORY_WIPHY_SELF_MANAGED;
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006257 regdom = get_wiphy_regdom(wiphy);
6258
Arik Nemtsov1bdd7162014-12-15 19:26:01 +02006259 /* a self-managed-reg device must have a private regdom */
6260 if (WARN_ON(!regdom && self_managed)) {
6261 nlmsg_free(msg);
6262 return -EINVAL;
6263 }
6264
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006265 if (regdom &&
6266 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6267 goto nla_put_failure;
6268 }
6269
6270 if (!wiphy && reg_last_request_cell_base() &&
6271 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6272 NL80211_USER_REG_HINT_CELL_BASE))
6273 goto nla_put_failure;
6274
6275 rcu_read_lock();
6276
6277 if (!regdom)
6278 regdom = rcu_dereference(cfg80211_regdomain);
6279
6280 if (nl80211_put_regdom(regdom, msg))
6281 goto nla_put_failure_rcu;
6282
6283 rcu_read_unlock();
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006284
6285 genlmsg_end(msg, hdr);
Johannes Berg5fe231e2013-05-08 21:45:15 +02006286 return genlmsg_reply(msg, info);
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006287
Johannes Berg458f4f92012-12-06 15:47:38 +01006288nla_put_failure_rcu:
6289 rcu_read_unlock();
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006290nla_put_failure:
6291 genlmsg_cancel(msg, hdr);
Julia Lawallefe1cf02011-01-28 15:17:11 +01006292put_failure:
Yuri Ershovd080e272010-06-29 15:08:07 +04006293 nlmsg_free(msg);
Johannes Berg5fe231e2013-05-08 21:45:15 +02006294 return -EMSGSIZE;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006295}
6296
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006297static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
6298 u32 seq, int flags, struct wiphy *wiphy,
6299 const struct ieee80211_regdomain *regdom)
6300{
6301 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
6302 NL80211_CMD_GET_REG);
6303
6304 if (!hdr)
6305 return -1;
6306
6307 genl_dump_check_consistent(cb, hdr, &nl80211_fam);
6308
6309 if (nl80211_put_regdom(regdom, msg))
6310 goto nla_put_failure;
6311
6312 if (!wiphy && reg_last_request_cell_base() &&
6313 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6314 NL80211_USER_REG_HINT_CELL_BASE))
6315 goto nla_put_failure;
6316
6317 if (wiphy &&
6318 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6319 goto nla_put_failure;
6320
Arik Nemtsov1bdd7162014-12-15 19:26:01 +02006321 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
6322 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
6323 goto nla_put_failure;
6324
Johannes Berg053c0952015-01-16 22:09:00 +01006325 genlmsg_end(msg, hdr);
6326 return 0;
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006327
6328nla_put_failure:
6329 genlmsg_cancel(msg, hdr);
6330 return -EMSGSIZE;
6331}
6332
6333static int nl80211_get_reg_dump(struct sk_buff *skb,
6334 struct netlink_callback *cb)
6335{
6336 const struct ieee80211_regdomain *regdom = NULL;
6337 struct cfg80211_registered_device *rdev;
6338 int err, reg_idx, start = cb->args[2];
6339
6340 rtnl_lock();
6341
6342 if (cfg80211_regdomain && start == 0) {
6343 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6344 NLM_F_MULTI, NULL,
6345 rtnl_dereference(cfg80211_regdomain));
6346 if (err < 0)
6347 goto out_err;
6348 }
6349
6350 /* the global regdom is idx 0 */
6351 reg_idx = 1;
6352 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
6353 regdom = get_wiphy_regdom(&rdev->wiphy);
6354 if (!regdom)
6355 continue;
6356
6357 if (++reg_idx <= start)
6358 continue;
6359
6360 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6361 NLM_F_MULTI, &rdev->wiphy, regdom);
6362 if (err < 0) {
6363 reg_idx--;
6364 break;
6365 }
6366 }
6367
6368 cb->args[2] = reg_idx;
6369 err = skb->len;
6370out_err:
6371 rtnl_unlock();
6372 return err;
6373}
6374
Johannes Bergb6863032015-10-15 09:25:18 +02006375#ifdef CONFIG_CFG80211_CRDA_SUPPORT
6376static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
6377 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
6378 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
6379 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
6380 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
6381 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
6382 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
6383 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 },
6384};
6385
6386static int parse_reg_rule(struct nlattr *tb[],
6387 struct ieee80211_reg_rule *reg_rule)
6388{
6389 struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
6390 struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
6391
6392 if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
6393 return -EINVAL;
6394 if (!tb[NL80211_ATTR_FREQ_RANGE_START])
6395 return -EINVAL;
6396 if (!tb[NL80211_ATTR_FREQ_RANGE_END])
6397 return -EINVAL;
6398 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
6399 return -EINVAL;
6400 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
6401 return -EINVAL;
6402
6403 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
6404
6405 freq_range->start_freq_khz =
6406 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
6407 freq_range->end_freq_khz =
6408 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
6409 freq_range->max_bandwidth_khz =
6410 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
6411
6412 power_rule->max_eirp =
6413 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
6414
6415 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
6416 power_rule->max_antenna_gain =
6417 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
6418
6419 if (tb[NL80211_ATTR_DFS_CAC_TIME])
6420 reg_rule->dfs_cac_ms =
6421 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
6422
6423 return 0;
6424}
6425
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006426static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
6427{
6428 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
6429 struct nlattr *nl_reg_rule;
Johannes Bergea372c52014-11-28 14:54:31 +01006430 char *alpha2;
6431 int rem_reg_rules, r;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006432 u32 num_rules = 0, rule_idx = 0, size_of_regd;
Luis R. Rodriguez4c7d3982013-11-13 18:54:02 +01006433 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
Johannes Bergea372c52014-11-28 14:54:31 +01006434 struct ieee80211_regdomain *rd;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006435
6436 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
6437 return -EINVAL;
6438
6439 if (!info->attrs[NL80211_ATTR_REG_RULES])
6440 return -EINVAL;
6441
6442 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
6443
Luis R. Rodriguez8b60b072011-10-11 10:59:02 -07006444 if (info->attrs[NL80211_ATTR_DFS_REGION])
6445 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
6446
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006447 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
Johannes Berg1a919312012-12-03 17:21:11 +01006448 rem_reg_rules) {
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006449 num_rules++;
6450 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
Luis R. Rodriguez4776c6e2009-05-13 17:04:39 -04006451 return -EINVAL;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006452 }
6453
Luis R. Rodrigueze4387682013-11-05 09:18:01 -08006454 if (!reg_is_valid_request(alpha2))
6455 return -EINVAL;
6456
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006457 size_of_regd = sizeof(struct ieee80211_regdomain) +
Johannes Berg1a919312012-12-03 17:21:11 +01006458 num_rules * sizeof(struct ieee80211_reg_rule);
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006459
6460 rd = kzalloc(size_of_regd, GFP_KERNEL);
Johannes Berg6913b492012-12-04 00:48:59 +01006461 if (!rd)
6462 return -ENOMEM;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006463
6464 rd->n_reg_rules = num_rules;
6465 rd->alpha2[0] = alpha2[0];
6466 rd->alpha2[1] = alpha2[1];
6467
Luis R. Rodriguez8b60b072011-10-11 10:59:02 -07006468 /*
6469 * Disable DFS master mode if the DFS region was
6470 * not supported or known on this kernel.
6471 */
6472 if (reg_supported_dfs_region(dfs_region))
6473 rd->dfs_region = dfs_region;
6474
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006475 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
Johannes Berg1a919312012-12-03 17:21:11 +01006476 rem_reg_rules) {
Johannes Bergae811e22014-01-24 10:17:47 +01006477 r = nla_parse(tb, NL80211_REG_RULE_ATTR_MAX,
6478 nla_data(nl_reg_rule), nla_len(nl_reg_rule),
6479 reg_rule_policy);
6480 if (r)
6481 goto bad_reg;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006482 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
6483 if (r)
6484 goto bad_reg;
6485
6486 rule_idx++;
6487
Luis R. Rodriguezd0e18f82009-05-13 17:04:40 -04006488 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
6489 r = -EINVAL;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006490 goto bad_reg;
Luis R. Rodriguezd0e18f82009-05-13 17:04:40 -04006491 }
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006492 }
6493
Johannes Berg06627992016-06-09 10:40:09 +02006494 /* set_regdom takes ownership of rd */
6495 return set_regdom(rd, REGD_SOURCE_CRDA);
Johannes Bergd2372b32008-10-24 20:32:20 +02006496 bad_reg:
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006497 kfree(rd);
Luis R. Rodriguezd0e18f82009-05-13 17:04:40 -04006498 return r;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006499}
Johannes Bergb6863032015-10-15 09:25:18 +02006500#endif /* CONFIG_CFG80211_CRDA_SUPPORT */
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006501
Johannes Berg83f5e2c2009-06-17 17:41:49 +02006502static int validate_scan_freqs(struct nlattr *freqs)
6503{
6504 struct nlattr *attr1, *attr2;
6505 int n_channels = 0, tmp1, tmp2;
6506
Srinivas Dasarie4712902017-07-07 01:43:42 +03006507 nla_for_each_nested(attr1, freqs, tmp1)
6508 if (nla_len(attr1) != sizeof(u32))
6509 return 0;
6510
Johannes Berg83f5e2c2009-06-17 17:41:49 +02006511 nla_for_each_nested(attr1, freqs, tmp1) {
6512 n_channels++;
6513 /*
6514 * Some hardware has a limited channel list for
6515 * scanning, and it is pretty much nonsensical
6516 * to scan for a channel twice, so disallow that
6517 * and don't require drivers to check that the
6518 * channel list they get isn't longer than what
6519 * they can scan, as long as they can scan all
6520 * the channels they registered at once.
6521 */
6522 nla_for_each_nested(attr2, freqs, tmp2)
6523 if (attr1 != attr2 &&
6524 nla_get_u32(attr1) == nla_get_u32(attr2))
6525 return 0;
6526 }
6527
6528 return n_channels;
6529}
6530
Johannes Berg57fbcce2016-04-12 15:56:15 +02006531static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
Arend van Spriel38de03d2016-03-02 20:37:18 +01006532{
Johannes Berg57fbcce2016-04-12 15:56:15 +02006533 return b < NUM_NL80211_BANDS && wiphy->bands[b];
Arend van Spriel38de03d2016-03-02 20:37:18 +01006534}
6535
6536static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
6537 struct cfg80211_bss_selection *bss_select)
6538{
6539 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
6540 struct nlattr *nest;
6541 int err;
6542 bool found = false;
6543 int i;
6544
6545 /* only process one nested attribute */
6546 nest = nla_data(nla);
6547 if (!nla_ok(nest, nla_len(nest)))
6548 return -EINVAL;
6549
6550 err = nla_parse(attr, NL80211_BSS_SELECT_ATTR_MAX, nla_data(nest),
6551 nla_len(nest), nl80211_bss_select_policy);
6552 if (err)
6553 return err;
6554
6555 /* only one attribute may be given */
6556 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
6557 if (attr[i]) {
6558 if (found)
6559 return -EINVAL;
6560 found = true;
6561 }
6562 }
6563
6564 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
6565
6566 if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
6567 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
6568
6569 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
6570 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
6571 bss_select->param.band_pref =
6572 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
6573 if (!is_band_valid(wiphy, bss_select->param.band_pref))
6574 return -EINVAL;
6575 }
6576
6577 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
6578 struct nl80211_bss_select_rssi_adjust *adj_param;
6579
6580 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
6581 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
6582 bss_select->param.adjust.band = adj_param->band;
6583 bss_select->param.adjust.delta = adj_param->delta;
6584 if (!is_band_valid(wiphy, bss_select->param.adjust.band))
6585 return -EINVAL;
6586 }
6587
6588 /* user-space did not provide behaviour attribute */
6589 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
6590 return -EINVAL;
6591
6592 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
6593 return -EINVAL;
6594
6595 return 0;
6596}
6597
Johannes Bergad2b26a2014-06-12 21:39:05 +02006598static int nl80211_parse_random_mac(struct nlattr **attrs,
6599 u8 *mac_addr, u8 *mac_addr_mask)
6600{
6601 int i;
6602
6603 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
Joe Perchesd2beae12015-03-02 19:54:58 -08006604 eth_zero_addr(mac_addr);
6605 eth_zero_addr(mac_addr_mask);
Johannes Bergad2b26a2014-06-12 21:39:05 +02006606 mac_addr[0] = 0x2;
6607 mac_addr_mask[0] = 0x3;
6608
6609 return 0;
6610 }
6611
6612 /* need both or none */
6613 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
6614 return -EINVAL;
6615
6616 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
6617 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
6618
6619 /* don't allow or configure an mcast address */
6620 if (!is_multicast_ether_addr(mac_addr_mask) ||
6621 is_multicast_ether_addr(mac_addr))
6622 return -EINVAL;
6623
6624 /*
6625 * allow users to pass a MAC address that has bits set outside
6626 * of the mask, but don't bother drivers with having to deal
6627 * with such bits
6628 */
6629 for (i = 0; i < ETH_ALEN; i++)
6630 mac_addr[i] &= mac_addr_mask[i];
6631
6632 return 0;
6633}
6634
Johannes Berg2a519312009-02-10 21:25:55 +01006635static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
6636{
Johannes Berg4c476992010-10-04 21:36:35 +02006637 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Bergfd014282012-06-18 19:17:03 +02006638 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg2a519312009-02-10 21:25:55 +01006639 struct cfg80211_scan_request *request;
Johannes Berg2a519312009-02-10 21:25:55 +01006640 struct nlattr *attr;
6641 struct wiphy *wiphy;
Johannes Berg83f5e2c2009-06-17 17:41:49 +02006642 int err, tmp, n_ssids = 0, n_channels, i;
Jouni Malinen70692ad2009-02-16 19:39:13 +02006643 size_t ie_len;
Johannes Berg2a519312009-02-10 21:25:55 +01006644
Johannes Bergf4a11bb2009-03-27 12:40:28 +01006645 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
6646 return -EINVAL;
6647
Johannes Berg79c97e92009-07-07 03:56:12 +02006648 wiphy = &rdev->wiphy;
Johannes Berg2a519312009-02-10 21:25:55 +01006649
Ayala Bekercb3b7d82016-09-20 17:31:13 +03006650 if (wdev->iftype == NL80211_IFTYPE_NAN)
6651 return -EOPNOTSUPP;
6652
Johannes Berg4c476992010-10-04 21:36:35 +02006653 if (!rdev->ops->scan)
6654 return -EOPNOTSUPP;
Johannes Berg2a519312009-02-10 21:25:55 +01006655
Johannes Bergf9d15d12014-01-22 11:14:19 +02006656 if (rdev->scan_req || rdev->scan_msg) {
Johannes Bergf9f47522013-03-19 15:04:07 +01006657 err = -EBUSY;
6658 goto unlock;
6659 }
Johannes Berg2a519312009-02-10 21:25:55 +01006660
6661 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
Johannes Berg83f5e2c2009-06-17 17:41:49 +02006662 n_channels = validate_scan_freqs(
6663 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
Johannes Bergf9f47522013-03-19 15:04:07 +01006664 if (!n_channels) {
6665 err = -EINVAL;
6666 goto unlock;
6667 }
Johannes Berg2a519312009-02-10 21:25:55 +01006668 } else {
Ilan Peerbdfbec22014-01-09 11:37:23 +02006669 n_channels = ieee80211_get_num_supported_channels(wiphy);
Johannes Berg2a519312009-02-10 21:25:55 +01006670 }
6671
6672 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
6673 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
6674 n_ssids++;
6675
Johannes Bergf9f47522013-03-19 15:04:07 +01006676 if (n_ssids > wiphy->max_scan_ssids) {
6677 err = -EINVAL;
6678 goto unlock;
6679 }
Johannes Berg2a519312009-02-10 21:25:55 +01006680
Jouni Malinen70692ad2009-02-16 19:39:13 +02006681 if (info->attrs[NL80211_ATTR_IE])
6682 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
6683 else
6684 ie_len = 0;
6685
Johannes Bergf9f47522013-03-19 15:04:07 +01006686 if (ie_len > wiphy->max_scan_ie_len) {
6687 err = -EINVAL;
6688 goto unlock;
6689 }
Johannes Berg18a83652009-03-31 12:12:05 +02006690
Johannes Berg2a519312009-02-10 21:25:55 +01006691 request = kzalloc(sizeof(*request)
Luciano Coelhoa2cd43c2011-05-18 11:42:03 +03006692 + sizeof(*request->ssids) * n_ssids
6693 + sizeof(*request->channels) * n_channels
Jouni Malinen70692ad2009-02-16 19:39:13 +02006694 + ie_len, GFP_KERNEL);
Johannes Bergf9f47522013-03-19 15:04:07 +01006695 if (!request) {
6696 err = -ENOMEM;
6697 goto unlock;
6698 }
Johannes Berg2a519312009-02-10 21:25:55 +01006699
Johannes Berg2a519312009-02-10 21:25:55 +01006700 if (n_ssids)
Johannes Berg5ba63532009-08-07 17:54:07 +02006701 request->ssids = (void *)&request->channels[n_channels];
Johannes Berg2a519312009-02-10 21:25:55 +01006702 request->n_ssids = n_ssids;
Jouni Malinen70692ad2009-02-16 19:39:13 +02006703 if (ie_len) {
Johannes Berg13874e42015-01-23 11:25:20 +01006704 if (n_ssids)
Jouni Malinen70692ad2009-02-16 19:39:13 +02006705 request->ie = (void *)(request->ssids + n_ssids);
6706 else
6707 request->ie = (void *)(request->channels + n_channels);
6708 }
Johannes Berg2a519312009-02-10 21:25:55 +01006709
Johannes Berg584991d2009-11-02 13:32:03 +01006710 i = 0;
Johannes Berg2a519312009-02-10 21:25:55 +01006711 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6712 /* user specified, bail out if channel not found */
Johannes Berg2a519312009-02-10 21:25:55 +01006713 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
Johannes Berg584991d2009-11-02 13:32:03 +01006714 struct ieee80211_channel *chan;
6715
6716 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
6717
6718 if (!chan) {
Johannes Berg2a519312009-02-10 21:25:55 +01006719 err = -EINVAL;
6720 goto out_free;
6721 }
Johannes Berg584991d2009-11-02 13:32:03 +01006722
6723 /* ignore disabled channels */
6724 if (chan->flags & IEEE80211_CHAN_DISABLED)
6725 continue;
6726
6727 request->channels[i] = chan;
Johannes Berg2a519312009-02-10 21:25:55 +01006728 i++;
6729 }
6730 } else {
Johannes Berg57fbcce2016-04-12 15:56:15 +02006731 enum nl80211_band band;
Johannes Berg34850ab2011-07-18 18:08:35 +02006732
Johannes Berg2a519312009-02-10 21:25:55 +01006733 /* all channels */
Johannes Berg57fbcce2016-04-12 15:56:15 +02006734 for (band = 0; band < NUM_NL80211_BANDS; band++) {
Johannes Berg2a519312009-02-10 21:25:55 +01006735 int j;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07006736
Johannes Berg2a519312009-02-10 21:25:55 +01006737 if (!wiphy->bands[band])
6738 continue;
6739 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
Johannes Berg584991d2009-11-02 13:32:03 +01006740 struct ieee80211_channel *chan;
6741
6742 chan = &wiphy->bands[band]->channels[j];
6743
6744 if (chan->flags & IEEE80211_CHAN_DISABLED)
6745 continue;
6746
6747 request->channels[i] = chan;
Johannes Berg2a519312009-02-10 21:25:55 +01006748 i++;
6749 }
6750 }
6751 }
6752
Johannes Berg584991d2009-11-02 13:32:03 +01006753 if (!i) {
6754 err = -EINVAL;
6755 goto out_free;
6756 }
6757
6758 request->n_channels = i;
6759
Johannes Berg2a519312009-02-10 21:25:55 +01006760 i = 0;
Johannes Berg13874e42015-01-23 11:25:20 +01006761 if (n_ssids) {
Johannes Berg2a519312009-02-10 21:25:55 +01006762 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
Luciano Coelho57a27e12011-06-07 20:42:26 +03006763 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
Johannes Berg2a519312009-02-10 21:25:55 +01006764 err = -EINVAL;
6765 goto out_free;
6766 }
Luciano Coelho57a27e12011-06-07 20:42:26 +03006767 request->ssids[i].ssid_len = nla_len(attr);
Johannes Berg2a519312009-02-10 21:25:55 +01006768 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
Johannes Berg2a519312009-02-10 21:25:55 +01006769 i++;
6770 }
6771 }
6772
Jouni Malinen70692ad2009-02-16 19:39:13 +02006773 if (info->attrs[NL80211_ATTR_IE]) {
6774 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
Johannes Bergde95a542009-04-01 11:58:36 +02006775 memcpy((void *)request->ie,
6776 nla_data(info->attrs[NL80211_ATTR_IE]),
Jouni Malinen70692ad2009-02-16 19:39:13 +02006777 request->ie_len);
6778 }
6779
Johannes Berg57fbcce2016-04-12 15:56:15 +02006780 for (i = 0; i < NUM_NL80211_BANDS; i++)
Johannes Berga401d2b2011-07-20 00:52:16 +02006781 if (wiphy->bands[i])
6782 request->rates[i] =
6783 (1 << wiphy->bands[i]->n_bitrates) - 1;
Johannes Berg34850ab2011-07-18 18:08:35 +02006784
6785 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
6786 nla_for_each_nested(attr,
6787 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
6788 tmp) {
Johannes Berg57fbcce2016-04-12 15:56:15 +02006789 enum nl80211_band band = nla_type(attr);
Johannes Berg34850ab2011-07-18 18:08:35 +02006790
Johannes Berg57fbcce2016-04-12 15:56:15 +02006791 if (band < 0 || band >= NUM_NL80211_BANDS) {
Johannes Berg34850ab2011-07-18 18:08:35 +02006792 err = -EINVAL;
6793 goto out_free;
6794 }
Felix Fietkau1b09cd82013-11-20 19:40:41 +01006795
6796 if (!wiphy->bands[band])
6797 continue;
6798
Johannes Berg34850ab2011-07-18 18:08:35 +02006799 err = ieee80211_get_ratemask(wiphy->bands[band],
6800 nla_data(attr),
6801 nla_len(attr),
6802 &request->rates[band]);
6803 if (err)
6804 goto out_free;
6805 }
6806 }
6807
Avraham Stern1d762502016-07-05 17:10:13 +03006808 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
6809 if (!wiphy_ext_feature_isset(wiphy,
6810 NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
6811 err = -EOPNOTSUPP;
6812 goto out_free;
6813 }
6814
6815 request->duration =
6816 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
6817 request->duration_mandatory =
6818 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
6819 }
6820
Sam Leffler46856bb2012-10-11 21:03:32 -07006821 if (info->attrs[NL80211_ATTR_SCAN_FLAGS]) {
Sam Lefflered4737712012-10-11 21:03:31 -07006822 request->flags = nla_get_u32(
6823 info->attrs[NL80211_ATTR_SCAN_FLAGS]);
Srinivas Dasaridf7d3c62018-01-17 16:44:16 +05306824 if (((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
6825 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
6826 ((request->flags & NL80211_SCAN_FLAG_LOW_SPAN) &&
6827 !wiphy_ext_feature_isset(wiphy,
6828 NL80211_EXT_FEATURE_LOW_SPAN_SCAN)) ||
6829 ((request->flags & NL80211_SCAN_FLAG_LOW_POWER) &&
6830 !wiphy_ext_feature_isset(wiphy,
6831 NL80211_EXT_FEATURE_LOW_POWER_SCAN)) ||
6832 ((request->flags & NL80211_SCAN_FLAG_HIGH_ACCURACY) &&
6833 !wiphy_ext_feature_isset(wiphy,
6834 NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN))) {
Sam Leffler46856bb2012-10-11 21:03:32 -07006835 err = -EOPNOTSUPP;
6836 goto out_free;
6837 }
Johannes Bergad2b26a2014-06-12 21:39:05 +02006838
6839 if (request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
6840 if (!(wiphy->features &
6841 NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR)) {
6842 err = -EOPNOTSUPP;
6843 goto out_free;
6844 }
6845
6846 if (wdev->current_bss) {
6847 err = -EOPNOTSUPP;
6848 goto out_free;
6849 }
6850
6851 err = nl80211_parse_random_mac(info->attrs,
6852 request->mac_addr,
6853 request->mac_addr_mask);
6854 if (err)
6855 goto out_free;
6856 }
Sam Leffler46856bb2012-10-11 21:03:32 -07006857 }
Sam Lefflered4737712012-10-11 21:03:31 -07006858
Rajkumar Manoharane9f935e2011-09-25 14:53:30 +05306859 request->no_cck =
6860 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
6861
Vamsi Krishna45816392016-12-02 23:59:08 +02006862 /* Initial implementation used NL80211_ATTR_MAC to set the specific
6863 * BSSID to scan for. This was problematic because that same attribute
6864 * was already used for another purpose (local random MAC address). The
6865 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
6866 * compatibility with older userspace components, also use the
6867 * NL80211_ATTR_MAC value here if it can be determined to be used for
6868 * the specific BSSID use case instead of the random MAC address
6869 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
6870 */
6871 if (info->attrs[NL80211_ATTR_BSSID])
6872 memcpy(request->bssid,
6873 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
6874 else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
6875 info->attrs[NL80211_ATTR_MAC])
Jouni Malinen818965d2016-02-26 22:12:47 +02006876 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
6877 ETH_ALEN);
6878 else
6879 eth_broadcast_addr(request->bssid);
6880
Johannes Bergfd014282012-06-18 19:17:03 +02006881 request->wdev = wdev;
Johannes Berg79c97e92009-07-07 03:56:12 +02006882 request->wiphy = &rdev->wiphy;
Sam Leffler15d60302012-10-11 21:03:34 -07006883 request->scan_start = jiffies;
Johannes Berg2a519312009-02-10 21:25:55 +01006884
Johannes Berg79c97e92009-07-07 03:56:12 +02006885 rdev->scan_req = request;
Hila Gonene35e4d22012-06-27 17:19:42 +03006886 err = rdev_scan(rdev, request);
Johannes Berg2a519312009-02-10 21:25:55 +01006887
Johannes Berg463d0182009-07-14 00:33:35 +02006888 if (!err) {
Johannes Bergfd014282012-06-18 19:17:03 +02006889 nl80211_send_scan_start(rdev, wdev);
6890 if (wdev->netdev)
6891 dev_hold(wdev->netdev);
Johannes Berg4c476992010-10-04 21:36:35 +02006892 } else {
Johannes Berg2a519312009-02-10 21:25:55 +01006893 out_free:
Johannes Berg79c97e92009-07-07 03:56:12 +02006894 rdev->scan_req = NULL;
Johannes Berg2a519312009-02-10 21:25:55 +01006895 kfree(request);
6896 }
Johannes Berg3b858752009-03-12 09:55:09 +01006897
Johannes Bergf9f47522013-03-19 15:04:07 +01006898 unlock:
Johannes Berg2a519312009-02-10 21:25:55 +01006899 return err;
6900}
6901
Vidyullatha Kanchanapally91d3ab42015-10-30 19:14:49 +05306902static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
6903{
6904 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6905 struct wireless_dev *wdev = info->user_ptr[1];
6906
6907 if (!rdev->ops->abort_scan)
6908 return -EOPNOTSUPP;
6909
6910 if (rdev->scan_msg)
6911 return 0;
6912
6913 if (!rdev->scan_req)
6914 return -ENOENT;
6915
6916 rdev_abort_scan(rdev, wdev);
6917 return 0;
6918}
6919
Avraham Stern3b06d272015-10-12 09:51:34 +03006920static int
6921nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
6922 struct cfg80211_sched_scan_request *request,
6923 struct nlattr **attrs)
6924{
6925 int tmp, err, i = 0;
6926 struct nlattr *attr;
6927
6928 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
6929 u32 interval;
6930
6931 /*
6932 * If scan plans are not specified,
6933 * %NL80211_ATTR_SCHED_SCAN_INTERVAL must be specified. In this
6934 * case one scan plan will be set with the specified scan
6935 * interval and infinite number of iterations.
6936 */
6937 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
6938 return -EINVAL;
6939
6940 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
6941 if (!interval)
6942 return -EINVAL;
6943
6944 request->scan_plans[0].interval =
6945 DIV_ROUND_UP(interval, MSEC_PER_SEC);
6946 if (!request->scan_plans[0].interval)
6947 return -EINVAL;
6948
6949 if (request->scan_plans[0].interval >
6950 wiphy->max_sched_scan_plan_interval)
6951 request->scan_plans[0].interval =
6952 wiphy->max_sched_scan_plan_interval;
6953
6954 return 0;
6955 }
6956
6957 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
6958 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
6959
6960 if (WARN_ON(i >= n_plans))
6961 return -EINVAL;
6962
6963 err = nla_parse(plan, NL80211_SCHED_SCAN_PLAN_MAX,
6964 nla_data(attr), nla_len(attr),
6965 nl80211_plan_policy);
6966 if (err)
6967 return err;
6968
6969 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
6970 return -EINVAL;
6971
6972 request->scan_plans[i].interval =
6973 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
6974 if (!request->scan_plans[i].interval ||
6975 request->scan_plans[i].interval >
6976 wiphy->max_sched_scan_plan_interval)
6977 return -EINVAL;
6978
6979 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
6980 request->scan_plans[i].iterations =
6981 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
6982 if (!request->scan_plans[i].iterations ||
6983 (request->scan_plans[i].iterations >
6984 wiphy->max_sched_scan_plan_iterations))
6985 return -EINVAL;
6986 } else if (i < n_plans - 1) {
6987 /*
6988 * All scan plans but the last one must specify
6989 * a finite number of iterations
6990 */
6991 return -EINVAL;
6992 }
6993
6994 i++;
6995 }
6996
6997 /*
6998 * The last scan plan must not specify the number of
6999 * iterations, it is supposed to run infinitely
7000 */
7001 if (request->scan_plans[n_plans - 1].iterations)
7002 return -EINVAL;
7003
7004 return 0;
7005}
7006
Luciano Coelho256da022014-11-10 16:13:46 +02007007static struct cfg80211_sched_scan_request *
Johannes Bergad2b26a2014-06-12 21:39:05 +02007008nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
Luciano Coelho256da022014-11-10 16:13:46 +02007009 struct nlattr **attrs)
Luciano Coelho807f8a82011-05-11 17:09:35 +03007010{
7011 struct cfg80211_sched_scan_request *request;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007012 struct nlattr *attr;
Avraham Stern3b06d272015-10-12 09:51:34 +03007013 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
Johannes Berg57fbcce2016-04-12 15:56:15 +02007014 enum nl80211_band band;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007015 size_t ie_len;
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007016 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
Johannes Bergea73cbc2014-01-24 10:53:53 +01007017 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007018
Luciano Coelho256da022014-11-10 16:13:46 +02007019 if (!is_valid_ie_attr(attrs[NL80211_ATTR_IE]))
7020 return ERR_PTR(-EINVAL);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007021
Luciano Coelho256da022014-11-10 16:13:46 +02007022 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
Luciano Coelho807f8a82011-05-11 17:09:35 +03007023 n_channels = validate_scan_freqs(
Luciano Coelho256da022014-11-10 16:13:46 +02007024 attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007025 if (!n_channels)
Luciano Coelho256da022014-11-10 16:13:46 +02007026 return ERR_PTR(-EINVAL);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007027 } else {
Ilan Peerbdfbec22014-01-09 11:37:23 +02007028 n_channels = ieee80211_get_num_supported_channels(wiphy);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007029 }
7030
Luciano Coelho256da022014-11-10 16:13:46 +02007031 if (attrs[NL80211_ATTR_SCAN_SSIDS])
7032 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
Luciano Coelho807f8a82011-05-11 17:09:35 +03007033 tmp)
7034 n_ssids++;
7035
Luciano Coelho93b6aa62011-07-13 14:57:28 +03007036 if (n_ssids > wiphy->max_sched_scan_ssids)
Luciano Coelho256da022014-11-10 16:13:46 +02007037 return ERR_PTR(-EINVAL);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007038
Johannes Bergea73cbc2014-01-24 10:53:53 +01007039 /*
7040 * First, count the number of 'real' matchsets. Due to an issue with
7041 * the old implementation, matchsets containing only the RSSI attribute
7042 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
7043 * RSSI for all matchsets, rather than their own matchset for reporting
7044 * all APs with a strong RSSI. This is needed to be compatible with
7045 * older userspace that treated a matchset with only the RSSI as the
7046 * global RSSI for all other matchsets - if there are other matchsets.
7047 */
Luciano Coelho256da022014-11-10 16:13:46 +02007048 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007049 nla_for_each_nested(attr,
Luciano Coelho256da022014-11-10 16:13:46 +02007050 attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
Johannes Bergea73cbc2014-01-24 10:53:53 +01007051 tmp) {
7052 struct nlattr *rssi;
7053
7054 err = nla_parse(tb, NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7055 nla_data(attr), nla_len(attr),
7056 nl80211_match_policy);
7057 if (err)
Luciano Coelho256da022014-11-10 16:13:46 +02007058 return ERR_PTR(err);
Johannes Bergea73cbc2014-01-24 10:53:53 +01007059 /* add other standalone attributes here */
7060 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]) {
7061 n_match_sets++;
7062 continue;
7063 }
7064 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7065 if (rssi)
7066 default_match_rssi = nla_get_s32(rssi);
7067 }
7068 }
7069
7070 /* However, if there's no other matchset, add the RSSI one */
7071 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
7072 n_match_sets = 1;
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007073
7074 if (n_match_sets > wiphy->max_match_sets)
Luciano Coelho256da022014-11-10 16:13:46 +02007075 return ERR_PTR(-EINVAL);
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007076
Luciano Coelho256da022014-11-10 16:13:46 +02007077 if (attrs[NL80211_ATTR_IE])
7078 ie_len = nla_len(attrs[NL80211_ATTR_IE]);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007079 else
7080 ie_len = 0;
7081
Luciano Coelho5a865ba2011-07-13 14:57:29 +03007082 if (ie_len > wiphy->max_sched_scan_ie_len)
Luciano Coelho256da022014-11-10 16:13:46 +02007083 return ERR_PTR(-EINVAL);
Luciano Coelhoc10841c2011-06-30 08:32:41 +03007084
Avraham Stern3b06d272015-10-12 09:51:34 +03007085 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7086 /*
7087 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
7088 * each scan plan already specifies its own interval
7089 */
7090 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7091 return ERR_PTR(-EINVAL);
7092
7093 nla_for_each_nested(attr,
7094 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
7095 n_plans++;
7096 } else {
7097 /*
7098 * The scan interval attribute is kept for backward
7099 * compatibility. If no scan plans are specified and sched scan
7100 * interval is specified, one scan plan will be set with this
7101 * scan interval and infinite number of iterations.
7102 */
7103 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7104 return ERR_PTR(-EINVAL);
7105
7106 n_plans = 1;
7107 }
7108
7109 if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
7110 return ERR_PTR(-EINVAL);
7111
vamsi krishnaf4f1a542017-01-13 01:12:20 +02007112 if (!wiphy_ext_feature_isset(
7113 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
7114 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
7115 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
7116 return ERR_PTR(-EINVAL);
7117
Luciano Coelho807f8a82011-05-11 17:09:35 +03007118 request = kzalloc(sizeof(*request)
Luciano Coelhoa2cd43c2011-05-18 11:42:03 +03007119 + sizeof(*request->ssids) * n_ssids
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007120 + sizeof(*request->match_sets) * n_match_sets
Avraham Stern3b06d272015-10-12 09:51:34 +03007121 + sizeof(*request->scan_plans) * n_plans
Luciano Coelhoa2cd43c2011-05-18 11:42:03 +03007122 + sizeof(*request->channels) * n_channels
Luciano Coelho807f8a82011-05-11 17:09:35 +03007123 + ie_len, GFP_KERNEL);
Luciano Coelho256da022014-11-10 16:13:46 +02007124 if (!request)
7125 return ERR_PTR(-ENOMEM);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007126
7127 if (n_ssids)
7128 request->ssids = (void *)&request->channels[n_channels];
7129 request->n_ssids = n_ssids;
7130 if (ie_len) {
Johannes Berg13874e42015-01-23 11:25:20 +01007131 if (n_ssids)
Luciano Coelho807f8a82011-05-11 17:09:35 +03007132 request->ie = (void *)(request->ssids + n_ssids);
7133 else
7134 request->ie = (void *)(request->channels + n_channels);
7135 }
7136
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007137 if (n_match_sets) {
7138 if (request->ie)
7139 request->match_sets = (void *)(request->ie + ie_len);
Johannes Berg13874e42015-01-23 11:25:20 +01007140 else if (n_ssids)
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007141 request->match_sets =
7142 (void *)(request->ssids + n_ssids);
7143 else
7144 request->match_sets =
7145 (void *)(request->channels + n_channels);
7146 }
7147 request->n_match_sets = n_match_sets;
7148
Avraham Stern3b06d272015-10-12 09:51:34 +03007149 if (n_match_sets)
7150 request->scan_plans = (void *)(request->match_sets +
7151 n_match_sets);
7152 else if (request->ie)
7153 request->scan_plans = (void *)(request->ie + ie_len);
7154 else if (n_ssids)
7155 request->scan_plans = (void *)(request->ssids + n_ssids);
7156 else
7157 request->scan_plans = (void *)(request->channels + n_channels);
7158
7159 request->n_scan_plans = n_plans;
7160
Luciano Coelho807f8a82011-05-11 17:09:35 +03007161 i = 0;
Luciano Coelho256da022014-11-10 16:13:46 +02007162 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
Luciano Coelho807f8a82011-05-11 17:09:35 +03007163 /* user specified, bail out if channel not found */
7164 nla_for_each_nested(attr,
Luciano Coelho256da022014-11-10 16:13:46 +02007165 attrs[NL80211_ATTR_SCAN_FREQUENCIES],
Luciano Coelho807f8a82011-05-11 17:09:35 +03007166 tmp) {
7167 struct ieee80211_channel *chan;
7168
7169 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
7170
7171 if (!chan) {
7172 err = -EINVAL;
7173 goto out_free;
7174 }
7175
7176 /* ignore disabled channels */
7177 if (chan->flags & IEEE80211_CHAN_DISABLED)
7178 continue;
7179
7180 request->channels[i] = chan;
7181 i++;
7182 }
7183 } else {
7184 /* all channels */
Johannes Berg57fbcce2016-04-12 15:56:15 +02007185 for (band = 0; band < NUM_NL80211_BANDS; band++) {
Luciano Coelho807f8a82011-05-11 17:09:35 +03007186 int j;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07007187
Luciano Coelho807f8a82011-05-11 17:09:35 +03007188 if (!wiphy->bands[band])
7189 continue;
7190 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
7191 struct ieee80211_channel *chan;
7192
7193 chan = &wiphy->bands[band]->channels[j];
7194
7195 if (chan->flags & IEEE80211_CHAN_DISABLED)
7196 continue;
7197
7198 request->channels[i] = chan;
7199 i++;
7200 }
7201 }
7202 }
7203
7204 if (!i) {
7205 err = -EINVAL;
7206 goto out_free;
7207 }
7208
7209 request->n_channels = i;
7210
7211 i = 0;
Johannes Berg13874e42015-01-23 11:25:20 +01007212 if (n_ssids) {
Luciano Coelho256da022014-11-10 16:13:46 +02007213 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
Luciano Coelho807f8a82011-05-11 17:09:35 +03007214 tmp) {
Luciano Coelho57a27e12011-06-07 20:42:26 +03007215 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
Luciano Coelho807f8a82011-05-11 17:09:35 +03007216 err = -EINVAL;
7217 goto out_free;
7218 }
Luciano Coelho57a27e12011-06-07 20:42:26 +03007219 request->ssids[i].ssid_len = nla_len(attr);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007220 memcpy(request->ssids[i].ssid, nla_data(attr),
7221 nla_len(attr));
Luciano Coelho807f8a82011-05-11 17:09:35 +03007222 i++;
7223 }
7224 }
7225
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007226 i = 0;
Luciano Coelho256da022014-11-10 16:13:46 +02007227 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007228 nla_for_each_nested(attr,
Luciano Coelho256da022014-11-10 16:13:46 +02007229 attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007230 tmp) {
Thomas Pedersen88e920b2012-06-21 11:09:54 -07007231 struct nlattr *ssid, *rssi;
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007232
Johannes Bergae811e22014-01-24 10:17:47 +01007233 err = nla_parse(tb, NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7234 nla_data(attr), nla_len(attr),
7235 nl80211_match_policy);
7236 if (err)
7237 goto out_free;
Johannes Berg4a4ab0d2012-06-13 11:17:11 +02007238 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007239 if (ssid) {
Johannes Bergea73cbc2014-01-24 10:53:53 +01007240 if (WARN_ON(i >= n_match_sets)) {
7241 /* this indicates a programming error,
7242 * the loop above should have verified
7243 * things properly
7244 */
7245 err = -EINVAL;
7246 goto out_free;
7247 }
7248
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007249 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
7250 err = -EINVAL;
7251 goto out_free;
7252 }
7253 memcpy(request->match_sets[i].ssid.ssid,
7254 nla_data(ssid), nla_len(ssid));
7255 request->match_sets[i].ssid.ssid_len =
7256 nla_len(ssid);
Kirtika Ruchandani56ab3642016-05-29 19:54:10 -07007257 /* special attribute - old implementation w/a */
Johannes Bergea73cbc2014-01-24 10:53:53 +01007258 request->match_sets[i].rssi_thold =
7259 default_match_rssi;
7260 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7261 if (rssi)
7262 request->match_sets[i].rssi_thold =
7263 nla_get_s32(rssi);
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007264 }
7265 i++;
7266 }
Johannes Bergea73cbc2014-01-24 10:53:53 +01007267
7268 /* there was no other matchset, so the RSSI one is alone */
Luciano Coelhof89f46c2014-12-01 11:32:09 +02007269 if (i == 0 && n_match_sets)
Johannes Bergea73cbc2014-01-24 10:53:53 +01007270 request->match_sets[0].rssi_thold = default_match_rssi;
7271
7272 request->min_rssi_thold = INT_MAX;
7273 for (i = 0; i < n_match_sets; i++)
7274 request->min_rssi_thold =
7275 min(request->match_sets[i].rssi_thold,
7276 request->min_rssi_thold);
7277 } else {
7278 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007279 }
7280
Johannes Berg9900e482014-02-04 21:01:25 +01007281 if (ie_len) {
7282 request->ie_len = ie_len;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007283 memcpy((void *)request->ie,
Luciano Coelho256da022014-11-10 16:13:46 +02007284 nla_data(attrs[NL80211_ATTR_IE]),
Luciano Coelho807f8a82011-05-11 17:09:35 +03007285 request->ie_len);
7286 }
7287
Luciano Coelho256da022014-11-10 16:13:46 +02007288 if (attrs[NL80211_ATTR_SCAN_FLAGS]) {
Sam Lefflered4737712012-10-11 21:03:31 -07007289 request->flags = nla_get_u32(
Luciano Coelho256da022014-11-10 16:13:46 +02007290 attrs[NL80211_ATTR_SCAN_FLAGS]);
Johannes Berg00c3a6e2013-10-26 17:14:38 +02007291 if ((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
7292 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) {
Sam Leffler46856bb2012-10-11 21:03:32 -07007293 err = -EOPNOTSUPP;
7294 goto out_free;
7295 }
Johannes Bergad2b26a2014-06-12 21:39:05 +02007296
7297 if (request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
7298 u32 flg = NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR;
7299
7300 if (!wdev) /* must be net-detect */
7301 flg = NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
7302
7303 if (!(wiphy->features & flg)) {
7304 err = -EOPNOTSUPP;
7305 goto out_free;
7306 }
7307
7308 if (wdev && wdev->current_bss) {
7309 err = -EOPNOTSUPP;
7310 goto out_free;
7311 }
7312
7313 err = nl80211_parse_random_mac(attrs, request->mac_addr,
7314 request->mac_addr_mask);
7315 if (err)
7316 goto out_free;
7317 }
Sam Leffler46856bb2012-10-11 21:03:32 -07007318 }
Sam Lefflered4737712012-10-11 21:03:31 -07007319
Luciano Coelho9c748932015-01-16 16:04:09 +02007320 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
7321 request->delay =
7322 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
7323
vamsi krishnaf4f1a542017-01-13 01:12:20 +02007324 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
7325 request->relative_rssi = nla_get_s8(
7326 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
7327 request->relative_rssi_set = true;
7328 }
7329
7330 if (request->relative_rssi_set &&
7331 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
7332 struct nl80211_bss_select_rssi_adjust *rssi_adjust;
7333
7334 rssi_adjust = nla_data(
7335 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
7336 request->rssi_adjust.band = rssi_adjust->band;
7337 request->rssi_adjust.delta = rssi_adjust->delta;
7338 if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
7339 err = -EINVAL;
7340 goto out_free;
7341 }
7342 }
7343
Avraham Stern3b06d272015-10-12 09:51:34 +03007344 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
7345 if (err)
7346 goto out_free;
7347
Sam Leffler15d60302012-10-11 21:03:34 -07007348 request->scan_start = jiffies;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007349
Luciano Coelho256da022014-11-10 16:13:46 +02007350 return request;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007351
7352out_free:
7353 kfree(request);
Luciano Coelho256da022014-11-10 16:13:46 +02007354 return ERR_PTR(err);
7355}
7356
7357static int nl80211_start_sched_scan(struct sk_buff *skb,
7358 struct genl_info *info)
7359{
7360 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7361 struct net_device *dev = info->user_ptr[1];
Johannes Bergad2b26a2014-06-12 21:39:05 +02007362 struct wireless_dev *wdev = dev->ieee80211_ptr;
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007363 struct cfg80211_sched_scan_request *sched_scan_req;
Luciano Coelho256da022014-11-10 16:13:46 +02007364 int err;
7365
7366 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
7367 !rdev->ops->sched_scan_start)
7368 return -EOPNOTSUPP;
7369
7370 if (rdev->sched_scan_req)
7371 return -EINPROGRESS;
7372
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007373 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
7374 info->attrs);
7375
7376 err = PTR_ERR_OR_ZERO(sched_scan_req);
Luciano Coelho256da022014-11-10 16:13:46 +02007377 if (err)
7378 goto out_err;
7379
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007380 err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
Luciano Coelho256da022014-11-10 16:13:46 +02007381 if (err)
7382 goto out_free;
7383
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007384 sched_scan_req->dev = dev;
7385 sched_scan_req->wiphy = &rdev->wiphy;
7386
Jukka Rissanen93a1e862014-12-15 13:25:39 +02007387 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
7388 sched_scan_req->owner_nlportid = info->snd_portid;
7389
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007390 rcu_assign_pointer(rdev->sched_scan_req, sched_scan_req);
Luciano Coelho256da022014-11-10 16:13:46 +02007391
7392 nl80211_send_sched_scan(rdev, dev,
7393 NL80211_CMD_START_SCHED_SCAN);
7394 return 0;
7395
7396out_free:
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007397 kfree(sched_scan_req);
Luciano Coelho256da022014-11-10 16:13:46 +02007398out_err:
Luciano Coelho807f8a82011-05-11 17:09:35 +03007399 return err;
7400}
7401
7402static int nl80211_stop_sched_scan(struct sk_buff *skb,
7403 struct genl_info *info)
7404{
7405 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7406
7407 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
7408 !rdev->ops->sched_scan_stop)
7409 return -EOPNOTSUPP;
7410
Johannes Berg5fe231e2013-05-08 21:45:15 +02007411 return __cfg80211_stop_sched_scan(rdev, false);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007412}
7413
Simon Wunderlich04f39042013-02-08 18:16:19 +01007414static int nl80211_start_radar_detection(struct sk_buff *skb,
7415 struct genl_info *info)
7416{
7417 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7418 struct net_device *dev = info->user_ptr[1];
7419 struct wireless_dev *wdev = dev->ieee80211_ptr;
7420 struct cfg80211_chan_def chandef;
Luis R. Rodriguez55f74352013-11-25 20:56:10 +01007421 enum nl80211_dfs_regions dfs_region;
Janusz Dziedzic31559f32014-02-21 19:46:13 +01007422 unsigned int cac_time_ms;
Simon Wunderlich04f39042013-02-08 18:16:19 +01007423 int err;
7424
Luis R. Rodriguez55f74352013-11-25 20:56:10 +01007425 dfs_region = reg_get_dfs_region(wdev->wiphy);
7426 if (dfs_region == NL80211_DFS_UNSET)
7427 return -EINVAL;
7428
Simon Wunderlich04f39042013-02-08 18:16:19 +01007429 err = nl80211_parse_chandef(rdev, info, &chandef);
7430 if (err)
7431 return err;
7432
Simon Wunderlichff311bc2013-09-03 19:43:18 +02007433 if (netif_carrier_ok(dev))
7434 return -EBUSY;
7435
Amar Singhal42839af2014-03-19 18:36:58 -07007436 if (rdev->wiphy.flags & WIPHY_FLAG_DFS_OFFLOAD)
7437 return -EOPNOTSUPP;
7438
Simon Wunderlich04f39042013-02-08 18:16:19 +01007439 if (wdev->cac_started)
7440 return -EBUSY;
7441
Luciano Coelho2beb6dab2014-02-18 11:40:36 +02007442 err = cfg80211_chandef_dfs_required(wdev->wiphy, &chandef,
Luciano Coelho00ec75f2014-05-15 13:05:39 +03007443 wdev->iftype);
Simon Wunderlich04f39042013-02-08 18:16:19 +01007444 if (err < 0)
7445 return err;
7446
7447 if (err == 0)
7448 return -EINVAL;
7449
Janusz Dziedzicfe7c3a12013-11-05 14:48:48 +01007450 if (!cfg80211_chandef_dfs_usable(wdev->wiphy, &chandef))
Simon Wunderlich04f39042013-02-08 18:16:19 +01007451 return -EINVAL;
7452
7453 if (!rdev->ops->start_radar_detection)
7454 return -EOPNOTSUPP;
7455
Janusz Dziedzic31559f32014-02-21 19:46:13 +01007456 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
7457 if (WARN_ON(!cac_time_ms))
7458 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
7459
Ilan Peera1056b12015-10-22 22:27:46 +03007460 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
Simon Wunderlich04f39042013-02-08 18:16:19 +01007461 if (!err) {
Michal Kazior9e0e2962014-01-29 14:22:27 +01007462 wdev->chandef = chandef;
Simon Wunderlich04f39042013-02-08 18:16:19 +01007463 wdev->cac_started = true;
7464 wdev->cac_start_time = jiffies;
Janusz Dziedzic31559f32014-02-21 19:46:13 +01007465 wdev->cac_time_ms = cac_time_ms;
Simon Wunderlich04f39042013-02-08 18:16:19 +01007466 }
Simon Wunderlich04f39042013-02-08 18:16:19 +01007467 return err;
7468}
7469
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007470static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
7471{
7472 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7473 struct net_device *dev = info->user_ptr[1];
7474 struct wireless_dev *wdev = dev->ieee80211_ptr;
7475 struct cfg80211_csa_settings params;
7476 /* csa_attrs is defined static to avoid waste of stack size - this
7477 * function is called under RTNL lock, so this should not be a problem.
7478 */
7479 static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007480 int err;
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007481 bool need_new_beacon = false;
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007482 int len, i;
Luciano Coelho252e07c2014-10-08 09:48:34 +03007483 u32 cs_count;
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007484
7485 if (!rdev->ops->channel_switch ||
7486 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
7487 return -EOPNOTSUPP;
7488
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007489 switch (dev->ieee80211_ptr->iftype) {
7490 case NL80211_IFTYPE_AP:
7491 case NL80211_IFTYPE_P2P_GO:
7492 need_new_beacon = true;
7493
7494 /* useless if AP is not running */
7495 if (!wdev->beacon_interval)
Johannes Berg1ff79df2014-01-22 10:05:27 +01007496 return -ENOTCONN;
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007497 break;
7498 case NL80211_IFTYPE_ADHOC:
Johannes Berg1ff79df2014-01-22 10:05:27 +01007499 if (!wdev->ssid_len)
7500 return -ENOTCONN;
7501 break;
Chun-Yeow Yeohc6da6742013-10-14 19:08:28 -07007502 case NL80211_IFTYPE_MESH_POINT:
Johannes Berg1ff79df2014-01-22 10:05:27 +01007503 if (!wdev->mesh_id_len)
7504 return -ENOTCONN;
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007505 break;
7506 default:
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007507 return -EOPNOTSUPP;
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007508 }
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007509
7510 memset(&params, 0, sizeof(params));
7511
7512 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
7513 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
7514 return -EINVAL;
7515
7516 /* only important for AP, IBSS and mesh create IEs internally */
Andrei Otcheretianskid0a361a2013-10-17 10:52:17 +02007517 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007518 return -EINVAL;
7519
Luciano Coelho252e07c2014-10-08 09:48:34 +03007520 /* Even though the attribute is u32, the specification says
7521 * u8, so let's make sure we don't overflow.
7522 */
7523 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
7524 if (cs_count > 255)
7525 return -EINVAL;
7526
7527 params.count = cs_count;
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007528
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007529 if (!need_new_beacon)
7530 goto skip_beacons;
7531
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007532 err = nl80211_parse_beacon(info->attrs, &params.beacon_after);
7533 if (err)
7534 return err;
7535
7536 err = nla_parse_nested(csa_attrs, NL80211_ATTR_MAX,
7537 info->attrs[NL80211_ATTR_CSA_IES],
7538 nl80211_policy);
7539 if (err)
7540 return err;
7541
7542 err = nl80211_parse_beacon(csa_attrs, &params.beacon_csa);
7543 if (err)
7544 return err;
7545
7546 if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
7547 return -EINVAL;
7548
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007549 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7550 if (!len || (len % sizeof(u16)))
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007551 return -EINVAL;
7552
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007553 params.n_counter_offsets_beacon = len / sizeof(u16);
7554 if (rdev->wiphy.max_num_csa_counters &&
7555 (params.n_counter_offsets_beacon >
7556 rdev->wiphy.max_num_csa_counters))
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007557 return -EINVAL;
7558
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007559 params.counter_offsets_beacon =
7560 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7561
7562 /* sanity checks - counters should fit and be the same */
7563 for (i = 0; i < params.n_counter_offsets_beacon; i++) {
7564 u16 offset = params.counter_offsets_beacon[i];
7565
7566 if (offset >= params.beacon_csa.tail_len)
7567 return -EINVAL;
7568
7569 if (params.beacon_csa.tail[offset] != params.count)
7570 return -EINVAL;
7571 }
7572
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007573 if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007574 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7575 if (!len || (len % sizeof(u16)))
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007576 return -EINVAL;
7577
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007578 params.n_counter_offsets_presp = len / sizeof(u16);
7579 if (rdev->wiphy.max_num_csa_counters &&
Johannes Bergad5987b2016-09-13 15:53:55 +02007580 (params.n_counter_offsets_presp >
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007581 rdev->wiphy.max_num_csa_counters))
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007582 return -EINVAL;
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007583
7584 params.counter_offsets_presp =
7585 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7586
7587 /* sanity checks - counters should fit and be the same */
7588 for (i = 0; i < params.n_counter_offsets_presp; i++) {
7589 u16 offset = params.counter_offsets_presp[i];
7590
7591 if (offset >= params.beacon_csa.probe_resp_len)
7592 return -EINVAL;
7593
7594 if (params.beacon_csa.probe_resp[offset] !=
7595 params.count)
7596 return -EINVAL;
7597 }
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007598 }
7599
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007600skip_beacons:
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007601 err = nl80211_parse_chandef(rdev, info, &params.chandef);
7602 if (err)
7603 return err;
7604
Arik Nemtsov923b3522015-07-08 15:41:44 +03007605 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
7606 wdev->iftype))
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007607 return -EINVAL;
7608
Luciano Coelho2beb6dab2014-02-18 11:40:36 +02007609 err = cfg80211_chandef_dfs_required(wdev->wiphy,
7610 &params.chandef,
7611 wdev->iftype);
7612 if (err < 0)
7613 return err;
7614
Fabian Frederickdcc6c2f2014-10-25 17:57:35 +02007615 if (err > 0)
Luciano Coelho2beb6dab2014-02-18 11:40:36 +02007616 params.radar_required = true;
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007617
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007618 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
7619 params.block_tx = true;
7620
Simon Wunderlichc56589e2013-11-21 18:19:49 +01007621 wdev_lock(wdev);
7622 err = rdev_channel_switch(rdev, dev, &params);
7623 wdev_unlock(wdev);
7624
7625 return err;
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007626}
7627
Johannes Berg9720bb32011-06-21 09:45:33 +02007628static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
7629 u32 seq, int flags,
Johannes Berg2a519312009-02-10 21:25:55 +01007630 struct cfg80211_registered_device *rdev,
Johannes Berg48ab9052009-07-10 18:42:31 +02007631 struct wireless_dev *wdev,
7632 struct cfg80211_internal_bss *intbss)
Johannes Berg2a519312009-02-10 21:25:55 +01007633{
Johannes Berg48ab9052009-07-10 18:42:31 +02007634 struct cfg80211_bss *res = &intbss->pub;
Johannes Berg9caf0362012-11-29 01:25:20 +01007635 const struct cfg80211_bss_ies *ies;
Johannes Berg2a519312009-02-10 21:25:55 +01007636 void *hdr;
7637 struct nlattr *bss;
Johannes Berg48ab9052009-07-10 18:42:31 +02007638
7639 ASSERT_WDEV_LOCK(wdev);
Johannes Berg2a519312009-02-10 21:25:55 +01007640
Eric W. Biederman15e47302012-09-07 20:12:54 +00007641 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
Johannes Berg2a519312009-02-10 21:25:55 +01007642 NL80211_CMD_NEW_SCAN_RESULTS);
7643 if (!hdr)
7644 return -1;
7645
Johannes Berg9720bb32011-06-21 09:45:33 +02007646 genl_dump_check_consistent(cb, hdr, &nl80211_fam);
7647
Johannes Berg97990a02013-04-19 01:02:55 +02007648 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
7649 goto nla_put_failure;
7650 if (wdev->netdev &&
David S. Miller9360ffd2012-03-29 04:41:26 -04007651 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
7652 goto nla_put_failure;
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007653 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
7654 NL80211_ATTR_PAD))
Johannes Berg97990a02013-04-19 01:02:55 +02007655 goto nla_put_failure;
Johannes Berg2a519312009-02-10 21:25:55 +01007656
7657 bss = nla_nest_start(msg, NL80211_ATTR_BSS);
7658 if (!bss)
7659 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -04007660 if ((!is_zero_ether_addr(res->bssid) &&
Johannes Berg9caf0362012-11-29 01:25:20 +01007661 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
David S. Miller9360ffd2012-03-29 04:41:26 -04007662 goto nla_put_failure;
Johannes Berg9caf0362012-11-29 01:25:20 +01007663
7664 rcu_read_lock();
Johannes Berg0e227082014-08-12 20:34:30 +02007665 /* indicate whether we have probe response data or not */
7666 if (rcu_access_pointer(res->proberesp_ies) &&
7667 nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
7668 goto fail_unlock_rcu;
7669
7670 /* this pointer prefers to be pointed to probe response data
7671 * but is always valid
7672 */
Johannes Berg9caf0362012-11-29 01:25:20 +01007673 ies = rcu_dereference(res->ies);
Johannes Berg8cef2c92013-02-05 16:54:31 +01007674 if (ies) {
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007675 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
7676 NL80211_BSS_PAD))
Johannes Berg8cef2c92013-02-05 16:54:31 +01007677 goto fail_unlock_rcu;
Johannes Berg8cef2c92013-02-05 16:54:31 +01007678 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
7679 ies->len, ies->data))
7680 goto fail_unlock_rcu;
Johannes Berg9caf0362012-11-29 01:25:20 +01007681 }
Johannes Berg0e227082014-08-12 20:34:30 +02007682
7683 /* and this pointer is always (unless driver didn't know) beacon data */
Johannes Berg9caf0362012-11-29 01:25:20 +01007684 ies = rcu_dereference(res->beacon_ies);
Johannes Berg0e227082014-08-12 20:34:30 +02007685 if (ies && ies->from_beacon) {
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007686 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
7687 NL80211_BSS_PAD))
Johannes Berg8cef2c92013-02-05 16:54:31 +01007688 goto fail_unlock_rcu;
7689 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
7690 ies->len, ies->data))
7691 goto fail_unlock_rcu;
Johannes Berg9caf0362012-11-29 01:25:20 +01007692 }
7693 rcu_read_unlock();
7694
David S. Miller9360ffd2012-03-29 04:41:26 -04007695 if (res->beacon_interval &&
7696 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
7697 goto nla_put_failure;
7698 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
7699 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
Simon Wunderlichdcd6eac2013-07-08 16:55:49 +02007700 nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
David S. Miller9360ffd2012-03-29 04:41:26 -04007701 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
7702 jiffies_to_msecs(jiffies - intbss->ts)))
7703 goto nla_put_failure;
Johannes Berg2a519312009-02-10 21:25:55 +01007704
Avraham Stern1d762502016-07-05 17:10:13 +03007705 if (intbss->parent_tsf &&
7706 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
7707 intbss->parent_tsf, NL80211_BSS_PAD) ||
7708 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
7709 intbss->parent_bssid)))
7710 goto nla_put_failure;
7711
Dmitry Shmidt6e19bc42015-10-07 11:32:53 +02007712 if (intbss->ts_boottime &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007713 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
7714 intbss->ts_boottime, NL80211_BSS_PAD))
Dmitry Shmidt6e19bc42015-10-07 11:32:53 +02007715 goto nla_put_failure;
7716
Sunil Dutt0c868482017-12-13 19:51:36 +02007717 if (!nl80211_put_signal(msg, intbss->pub.chains,
7718 intbss->pub.chain_signal,
7719 NL80211_BSS_CHAIN_SIGNAL))
7720 goto nla_put_failure;
7721
Johannes Berg77965c92009-02-18 18:45:06 +01007722 switch (rdev->wiphy.signal_type) {
Johannes Berg2a519312009-02-10 21:25:55 +01007723 case CFG80211_SIGNAL_TYPE_MBM:
David S. Miller9360ffd2012-03-29 04:41:26 -04007724 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
7725 goto nla_put_failure;
Johannes Berg2a519312009-02-10 21:25:55 +01007726 break;
7727 case CFG80211_SIGNAL_TYPE_UNSPEC:
David S. Miller9360ffd2012-03-29 04:41:26 -04007728 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
7729 goto nla_put_failure;
Johannes Berg2a519312009-02-10 21:25:55 +01007730 break;
7731 default:
7732 break;
7733 }
7734
Johannes Berg48ab9052009-07-10 18:42:31 +02007735 switch (wdev->iftype) {
Johannes Berg074ac8d2010-09-16 14:58:22 +02007736 case NL80211_IFTYPE_P2P_CLIENT:
Johannes Berg48ab9052009-07-10 18:42:31 +02007737 case NL80211_IFTYPE_STATION:
David S. Miller9360ffd2012-03-29 04:41:26 -04007738 if (intbss == wdev->current_bss &&
7739 nla_put_u32(msg, NL80211_BSS_STATUS,
7740 NL80211_BSS_STATUS_ASSOCIATED))
7741 goto nla_put_failure;
Johannes Berg48ab9052009-07-10 18:42:31 +02007742 break;
7743 case NL80211_IFTYPE_ADHOC:
David S. Miller9360ffd2012-03-29 04:41:26 -04007744 if (intbss == wdev->current_bss &&
7745 nla_put_u32(msg, NL80211_BSS_STATUS,
7746 NL80211_BSS_STATUS_IBSS_JOINED))
7747 goto nla_put_failure;
Johannes Berg48ab9052009-07-10 18:42:31 +02007748 break;
7749 default:
7750 break;
7751 }
7752
Johannes Berg2a519312009-02-10 21:25:55 +01007753 nla_nest_end(msg, bss);
7754
Johannes Berg053c0952015-01-16 22:09:00 +01007755 genlmsg_end(msg, hdr);
7756 return 0;
Johannes Berg2a519312009-02-10 21:25:55 +01007757
Johannes Berg8cef2c92013-02-05 16:54:31 +01007758 fail_unlock_rcu:
7759 rcu_read_unlock();
Johannes Berg2a519312009-02-10 21:25:55 +01007760 nla_put_failure:
7761 genlmsg_cancel(msg, hdr);
7762 return -EMSGSIZE;
7763}
7764
Johannes Berg97990a02013-04-19 01:02:55 +02007765static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
Johannes Berg2a519312009-02-10 21:25:55 +01007766{
Johannes Berg48ab9052009-07-10 18:42:31 +02007767 struct cfg80211_registered_device *rdev;
Johannes Berg2a519312009-02-10 21:25:55 +01007768 struct cfg80211_internal_bss *scan;
Johannes Berg48ab9052009-07-10 18:42:31 +02007769 struct wireless_dev *wdev;
Johannes Berg97990a02013-04-19 01:02:55 +02007770 int start = cb->args[2], idx = 0;
Johannes Berg2a519312009-02-10 21:25:55 +01007771 int err;
7772
Johannes Berg56769e72017-03-15 14:26:04 +01007773 rtnl_lock();
Johannes Berg97990a02013-04-19 01:02:55 +02007774 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
Johannes Berg56769e72017-03-15 14:26:04 +01007775 if (err) {
7776 rtnl_unlock();
Johannes Berg67748892010-10-04 21:14:06 +02007777 return err;
Johannes Berg56769e72017-03-15 14:26:04 +01007778 }
Johannes Berg2a519312009-02-10 21:25:55 +01007779
Johannes Berg48ab9052009-07-10 18:42:31 +02007780 wdev_lock(wdev);
7781 spin_lock_bh(&rdev->bss_lock);
7782 cfg80211_bss_expire(rdev);
7783
Johannes Berg9720bb32011-06-21 09:45:33 +02007784 cb->seq = rdev->bss_generation;
7785
Johannes Berg48ab9052009-07-10 18:42:31 +02007786 list_for_each_entry(scan, &rdev->bss_list, list) {
Johannes Berg2a519312009-02-10 21:25:55 +01007787 if (++idx <= start)
7788 continue;
Johannes Berg9720bb32011-06-21 09:45:33 +02007789 if (nl80211_send_bss(skb, cb,
Johannes Berg2a519312009-02-10 21:25:55 +01007790 cb->nlh->nlmsg_seq, NLM_F_MULTI,
Johannes Berg48ab9052009-07-10 18:42:31 +02007791 rdev, wdev, scan) < 0) {
Johannes Berg2a519312009-02-10 21:25:55 +01007792 idx--;
Johannes Berg67748892010-10-04 21:14:06 +02007793 break;
Johannes Berg2a519312009-02-10 21:25:55 +01007794 }
7795 }
7796
Johannes Berg48ab9052009-07-10 18:42:31 +02007797 spin_unlock_bh(&rdev->bss_lock);
7798 wdev_unlock(wdev);
Johannes Berg2a519312009-02-10 21:25:55 +01007799
Johannes Berg97990a02013-04-19 01:02:55 +02007800 cb->args[2] = idx;
Johannes Berg56769e72017-03-15 14:26:04 +01007801 rtnl_unlock();
Johannes Berg2a519312009-02-10 21:25:55 +01007802
Johannes Berg67748892010-10-04 21:14:06 +02007803 return skb->len;
Johannes Berg2a519312009-02-10 21:25:55 +01007804}
7805
Eric W. Biederman15e47302012-09-07 20:12:54 +00007806static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
Johannes Berg11f78ac2014-11-14 16:43:50 +01007807 int flags, struct net_device *dev,
7808 bool allow_radio_stats,
7809 struct survey_info *survey)
Holger Schurig61fa7132009-11-11 12:25:40 +01007810{
7811 void *hdr;
7812 struct nlattr *infoattr;
7813
Johannes Berg11f78ac2014-11-14 16:43:50 +01007814 /* skip radio stats if userspace didn't request them */
7815 if (!survey->channel && !allow_radio_stats)
7816 return 0;
7817
Eric W. Biederman15e47302012-09-07 20:12:54 +00007818 hdr = nl80211hdr_put(msg, portid, seq, flags,
Holger Schurig61fa7132009-11-11 12:25:40 +01007819 NL80211_CMD_NEW_SURVEY_RESULTS);
7820 if (!hdr)
7821 return -ENOMEM;
7822
David S. Miller9360ffd2012-03-29 04:41:26 -04007823 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
7824 goto nla_put_failure;
Holger Schurig61fa7132009-11-11 12:25:40 +01007825
7826 infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
7827 if (!infoattr)
7828 goto nla_put_failure;
7829
Johannes Berg11f78ac2014-11-14 16:43:50 +01007830 if (survey->channel &&
7831 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
David S. Miller9360ffd2012-03-29 04:41:26 -04007832 survey->channel->center_freq))
7833 goto nla_put_failure;
7834
7835 if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
7836 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
7837 goto nla_put_failure;
7838 if ((survey->filled & SURVEY_INFO_IN_USE) &&
7839 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
7840 goto nla_put_failure;
Johannes Berg4ed20be2014-11-14 16:35:34 +01007841 if ((survey->filled & SURVEY_INFO_TIME) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007842 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
7843 survey->time, NL80211_SURVEY_INFO_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04007844 goto nla_put_failure;
Johannes Berg4ed20be2014-11-14 16:35:34 +01007845 if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007846 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
7847 survey->time_busy, NL80211_SURVEY_INFO_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04007848 goto nla_put_failure;
Johannes Berg4ed20be2014-11-14 16:35:34 +01007849 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007850 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
7851 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04007852 goto nla_put_failure;
Johannes Berg4ed20be2014-11-14 16:35:34 +01007853 if ((survey->filled & SURVEY_INFO_TIME_RX) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007854 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
7855 survey->time_rx, NL80211_SURVEY_INFO_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04007856 goto nla_put_failure;
Johannes Berg4ed20be2014-11-14 16:35:34 +01007857 if ((survey->filled & SURVEY_INFO_TIME_TX) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007858 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
7859 survey->time_tx, NL80211_SURVEY_INFO_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04007860 goto nla_put_failure;
Johannes Berg052536a2014-11-14 16:44:11 +01007861 if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007862 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
7863 survey->time_scan, NL80211_SURVEY_INFO_PAD))
Johannes Berg052536a2014-11-14 16:44:11 +01007864 goto nla_put_failure;
Holger Schurig61fa7132009-11-11 12:25:40 +01007865
7866 nla_nest_end(msg, infoattr);
7867
Johannes Berg053c0952015-01-16 22:09:00 +01007868 genlmsg_end(msg, hdr);
7869 return 0;
Holger Schurig61fa7132009-11-11 12:25:40 +01007870
7871 nla_put_failure:
7872 genlmsg_cancel(msg, hdr);
7873 return -EMSGSIZE;
7874}
7875
Johannes Berg11f78ac2014-11-14 16:43:50 +01007876static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
Holger Schurig61fa7132009-11-11 12:25:40 +01007877{
7878 struct survey_info survey;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08007879 struct cfg80211_registered_device *rdev;
Johannes Berg97990a02013-04-19 01:02:55 +02007880 struct wireless_dev *wdev;
7881 int survey_idx = cb->args[2];
Holger Schurig61fa7132009-11-11 12:25:40 +01007882 int res;
Johannes Berg11f78ac2014-11-14 16:43:50 +01007883 bool radio_stats;
Holger Schurig61fa7132009-11-11 12:25:40 +01007884
Johannes Berg56769e72017-03-15 14:26:04 +01007885 rtnl_lock();
Zhao, Gang1b8ec872014-04-21 12:53:02 +08007886 res = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
Johannes Berg67748892010-10-04 21:14:06 +02007887 if (res)
Johannes Berg56769e72017-03-15 14:26:04 +01007888 goto out_err;
Holger Schurig61fa7132009-11-11 12:25:40 +01007889
Johannes Berg11f78ac2014-11-14 16:43:50 +01007890 /* prepare_wdev_dump parsed the attributes */
7891 radio_stats = nl80211_fam.attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
7892
Johannes Berg97990a02013-04-19 01:02:55 +02007893 if (!wdev->netdev) {
7894 res = -EINVAL;
7895 goto out_err;
7896 }
7897
Zhao, Gang1b8ec872014-04-21 12:53:02 +08007898 if (!rdev->ops->dump_survey) {
Holger Schurig61fa7132009-11-11 12:25:40 +01007899 res = -EOPNOTSUPP;
7900 goto out_err;
7901 }
7902
7903 while (1) {
Zhao, Gang1b8ec872014-04-21 12:53:02 +08007904 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
Holger Schurig61fa7132009-11-11 12:25:40 +01007905 if (res == -ENOENT)
7906 break;
7907 if (res)
7908 goto out_err;
7909
Johannes Berg11f78ac2014-11-14 16:43:50 +01007910 /* don't send disabled channels, but do send non-channel data */
7911 if (survey.channel &&
7912 survey.channel->flags & IEEE80211_CHAN_DISABLED) {
Luis R. Rodriguez180cdc72011-05-27 07:24:02 -07007913 survey_idx++;
7914 continue;
7915 }
7916
Holger Schurig61fa7132009-11-11 12:25:40 +01007917 if (nl80211_send_survey(skb,
Eric W. Biederman15e47302012-09-07 20:12:54 +00007918 NETLINK_CB(cb->skb).portid,
Holger Schurig61fa7132009-11-11 12:25:40 +01007919 cb->nlh->nlmsg_seq, NLM_F_MULTI,
Johannes Berg11f78ac2014-11-14 16:43:50 +01007920 wdev->netdev, radio_stats, &survey) < 0)
Holger Schurig61fa7132009-11-11 12:25:40 +01007921 goto out;
7922 survey_idx++;
7923 }
7924
7925 out:
Johannes Berg97990a02013-04-19 01:02:55 +02007926 cb->args[2] = survey_idx;
Holger Schurig61fa7132009-11-11 12:25:40 +01007927 res = skb->len;
7928 out_err:
Johannes Berg56769e72017-03-15 14:26:04 +01007929 rtnl_unlock();
Holger Schurig61fa7132009-11-11 12:25:40 +01007930 return res;
7931}
7932
Samuel Ortizb23aa672009-07-01 21:26:54 +02007933static bool nl80211_valid_wpa_versions(u32 wpa_versions)
7934{
7935 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
7936 NL80211_WPA_VERSION_2));
7937}
7938
Jouni Malinen636a5d32009-03-19 13:39:22 +02007939static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
7940{
Johannes Berg4c476992010-10-04 21:36:35 +02007941 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7942 struct net_device *dev = info->user_ptr[1];
Johannes Berg19957bb2009-07-02 17:20:43 +02007943 struct ieee80211_channel *chan;
Jouni Malinen3255b4a2016-10-27 00:41:58 +03007944 const u8 *bssid, *ssid, *ie = NULL, *auth_data = NULL;
7945 int err, ssid_len, ie_len = 0, auth_data_len = 0;
Johannes Berg19957bb2009-07-02 17:20:43 +02007946 enum nl80211_auth_type auth_type;
Johannes Bergfffd0932009-07-08 14:22:54 +02007947 struct key_parse key;
Jouni Malinend5cdfac2010-04-04 09:37:19 +03007948 bool local_state_change;
Jouni Malinen636a5d32009-03-19 13:39:22 +02007949
Johannes Bergf4a11bb2009-03-27 12:40:28 +01007950 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
7951 return -EINVAL;
7952
7953 if (!info->attrs[NL80211_ATTR_MAC])
7954 return -EINVAL;
7955
Jouni Malinen17780922009-03-27 20:52:47 +02007956 if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
7957 return -EINVAL;
7958
Johannes Berg19957bb2009-07-02 17:20:43 +02007959 if (!info->attrs[NL80211_ATTR_SSID])
7960 return -EINVAL;
7961
7962 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
7963 return -EINVAL;
7964
Johannes Bergfffd0932009-07-08 14:22:54 +02007965 err = nl80211_parse_key(info, &key);
7966 if (err)
7967 return err;
7968
7969 if (key.idx >= 0) {
Johannes Berge31b8212010-10-05 19:39:30 +02007970 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
7971 return -EINVAL;
Johannes Bergfffd0932009-07-08 14:22:54 +02007972 if (!key.p.key || !key.p.key_len)
7973 return -EINVAL;
7974 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
7975 key.p.key_len != WLAN_KEY_LEN_WEP40) &&
7976 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
7977 key.p.key_len != WLAN_KEY_LEN_WEP104))
7978 return -EINVAL;
Johannes Bergb6b55552016-09-13 16:25:58 +02007979 if (key.idx > 3)
Johannes Bergfffd0932009-07-08 14:22:54 +02007980 return -EINVAL;
7981 } else {
7982 key.p.key_len = 0;
7983 key.p.key = NULL;
7984 }
7985
Johannes Bergafea0b72010-08-10 09:46:42 +02007986 if (key.idx >= 0) {
7987 int i;
7988 bool ok = false;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07007989
Johannes Bergafea0b72010-08-10 09:46:42 +02007990 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
7991 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
7992 ok = true;
7993 break;
7994 }
7995 }
Johannes Berg4c476992010-10-04 21:36:35 +02007996 if (!ok)
7997 return -EINVAL;
Johannes Bergafea0b72010-08-10 09:46:42 +02007998 }
7999
Johannes Berg4c476992010-10-04 21:36:35 +02008000 if (!rdev->ops->auth)
8001 return -EOPNOTSUPP;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008002
Johannes Berg074ac8d2010-09-16 14:58:22 +02008003 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02008004 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8005 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02008006
Johannes Berg19957bb2009-07-02 17:20:43 +02008007 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Jouni Malinen664834d2014-01-15 00:01:44 +02008008 chan = nl80211_get_valid_chan(&rdev->wiphy,
8009 info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8010 if (!chan)
Johannes Berg4c476992010-10-04 21:36:35 +02008011 return -EINVAL;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008012
Johannes Berg19957bb2009-07-02 17:20:43 +02008013 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8014 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8015
8016 if (info->attrs[NL80211_ATTR_IE]) {
8017 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8018 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8019 }
8020
8021 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
Jouni Malinene39e5b52012-09-30 19:29:39 +03008022 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
Johannes Berg4c476992010-10-04 21:36:35 +02008023 return -EINVAL;
Johannes Berg19957bb2009-07-02 17:20:43 +02008024
Jouni Malinene20f90f2016-10-27 00:42:02 +03008025 if ((auth_type == NL80211_AUTHTYPE_SAE ||
8026 auth_type == NL80211_AUTHTYPE_FILS_SK ||
8027 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
8028 auth_type == NL80211_AUTHTYPE_FILS_PK) &&
Jouni Malinen3255b4a2016-10-27 00:41:58 +03008029 !info->attrs[NL80211_ATTR_AUTH_DATA])
Jouni Malinene39e5b52012-09-30 19:29:39 +03008030 return -EINVAL;
8031
Jouni Malinen3255b4a2016-10-27 00:41:58 +03008032 if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
Jouni Malinene20f90f2016-10-27 00:42:02 +03008033 if (auth_type != NL80211_AUTHTYPE_SAE &&
8034 auth_type != NL80211_AUTHTYPE_FILS_SK &&
8035 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
8036 auth_type != NL80211_AUTHTYPE_FILS_PK)
Jouni Malinene39e5b52012-09-30 19:29:39 +03008037 return -EINVAL;
Jouni Malinen3255b4a2016-10-27 00:41:58 +03008038 auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
8039 auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
Jouni Malinene39e5b52012-09-30 19:29:39 +03008040 /* need to include at least Auth Transaction and Status Code */
Jouni Malinen3255b4a2016-10-27 00:41:58 +03008041 if (auth_data_len < 4)
Jouni Malinene39e5b52012-09-30 19:29:39 +03008042 return -EINVAL;
8043 }
8044
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008045 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8046
Johannes Berg95de8172012-01-20 13:55:25 +01008047 /*
8048 * Since we no longer track auth state, ignore
8049 * requests to only change local state.
8050 */
8051 if (local_state_change)
8052 return 0;
8053
Johannes Berg91bf9b22013-05-15 17:44:01 +02008054 wdev_lock(dev->ieee80211_ptr);
8055 err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
8056 ssid, ssid_len, ie, ie_len,
8057 key.p.key, key.p.key_len, key.idx,
Jouni Malinen3255b4a2016-10-27 00:41:58 +03008058 auth_data, auth_data_len);
Johannes Berg91bf9b22013-05-15 17:44:01 +02008059 wdev_unlock(dev->ieee80211_ptr);
8060 return err;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008061}
8062
Johannes Bergc0692b82010-08-27 14:26:53 +03008063static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
8064 struct genl_info *info,
Johannes Berg3dc27d22009-07-02 21:36:37 +02008065 struct cfg80211_crypto_settings *settings,
8066 int cipher_limit)
Samuel Ortizb23aa672009-07-01 21:26:54 +02008067{
Johannes Bergc0b2bbd2009-07-25 16:54:36 +02008068 memset(settings, 0, sizeof(*settings));
8069
Samuel Ortizb23aa672009-07-01 21:26:54 +02008070 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
8071
Johannes Bergc0692b82010-08-27 14:26:53 +03008072 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
8073 u16 proto;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07008074
Johannes Bergc0692b82010-08-27 14:26:53 +03008075 proto = nla_get_u16(
8076 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
8077 settings->control_port_ethertype = cpu_to_be16(proto);
8078 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
8079 proto != ETH_P_PAE)
8080 return -EINVAL;
8081 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
8082 settings->control_port_no_encrypt = true;
8083 } else
8084 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
8085
Samuel Ortizb23aa672009-07-01 21:26:54 +02008086 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
8087 void *data;
8088 int len, i;
8089
8090 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
8091 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
8092 settings->n_ciphers_pairwise = len / sizeof(u32);
8093
8094 if (len % sizeof(u32))
8095 return -EINVAL;
8096
Johannes Berg3dc27d22009-07-02 21:36:37 +02008097 if (settings->n_ciphers_pairwise > cipher_limit)
Samuel Ortizb23aa672009-07-01 21:26:54 +02008098 return -EINVAL;
8099
8100 memcpy(settings->ciphers_pairwise, data, len);
8101
8102 for (i = 0; i < settings->n_ciphers_pairwise; i++)
Jouni Malinen38ba3c52011-09-21 18:14:56 +03008103 if (!cfg80211_supported_cipher_suite(
8104 &rdev->wiphy,
Samuel Ortizb23aa672009-07-01 21:26:54 +02008105 settings->ciphers_pairwise[i]))
8106 return -EINVAL;
8107 }
8108
8109 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
8110 settings->cipher_group =
8111 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
Jouni Malinen38ba3c52011-09-21 18:14:56 +03008112 if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
8113 settings->cipher_group))
Samuel Ortizb23aa672009-07-01 21:26:54 +02008114 return -EINVAL;
8115 }
8116
8117 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
8118 settings->wpa_versions =
8119 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
8120 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
8121 return -EINVAL;
8122 }
8123
8124 if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
8125 void *data;
Jouni Malinen6d302402011-09-21 18:11:33 +03008126 int len;
Samuel Ortizb23aa672009-07-01 21:26:54 +02008127
8128 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
8129 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
8130 settings->n_akm_suites = len / sizeof(u32);
8131
8132 if (len % sizeof(u32))
8133 return -EINVAL;
8134
Jouni Malinen1b9ca022011-09-21 16:13:07 +03008135 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
8136 return -EINVAL;
8137
Samuel Ortizb23aa672009-07-01 21:26:54 +02008138 memcpy(settings->akm_suites, data, len);
Samuel Ortizb23aa672009-07-01 21:26:54 +02008139 }
8140
8141 return 0;
8142}
8143
Jouni Malinen636a5d32009-03-19 13:39:22 +02008144static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
8145{
Johannes Berg4c476992010-10-04 21:36:35 +02008146 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8147 struct net_device *dev = info->user_ptr[1];
Johannes Bergf444de02010-05-05 15:25:02 +02008148 struct ieee80211_channel *chan;
Johannes Bergf62fab72013-02-21 20:09:09 +01008149 struct cfg80211_assoc_request req = {};
8150 const u8 *bssid, *ssid;
8151 int err, ssid_len = 0;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008152
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008153 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8154 return -EINVAL;
8155
8156 if (!info->attrs[NL80211_ATTR_MAC] ||
Johannes Berg19957bb2009-07-02 17:20:43 +02008157 !info->attrs[NL80211_ATTR_SSID] ||
8158 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008159 return -EINVAL;
8160
Johannes Berg4c476992010-10-04 21:36:35 +02008161 if (!rdev->ops->assoc)
8162 return -EOPNOTSUPP;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008163
Johannes Berg074ac8d2010-09-16 14:58:22 +02008164 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02008165 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8166 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02008167
Johannes Berg19957bb2009-07-02 17:20:43 +02008168 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008169
Jouni Malinen664834d2014-01-15 00:01:44 +02008170 chan = nl80211_get_valid_chan(&rdev->wiphy,
8171 info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8172 if (!chan)
Johannes Berg4c476992010-10-04 21:36:35 +02008173 return -EINVAL;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008174
Johannes Berg19957bb2009-07-02 17:20:43 +02008175 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8176 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008177
8178 if (info->attrs[NL80211_ATTR_IE]) {
Johannes Bergf62fab72013-02-21 20:09:09 +01008179 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8180 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008181 }
8182
Jouni Malinendc6382c2009-05-06 22:09:37 +03008183 if (info->attrs[NL80211_ATTR_USE_MFP]) {
Johannes Berg4f5dadc2009-07-07 03:56:10 +02008184 enum nl80211_mfp mfp =
Jouni Malinendc6382c2009-05-06 22:09:37 +03008185 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
Johannes Berg4f5dadc2009-07-07 03:56:10 +02008186 if (mfp == NL80211_MFP_REQUIRED)
Johannes Bergf62fab72013-02-21 20:09:09 +01008187 req.use_mfp = true;
Johannes Berg4c476992010-10-04 21:36:35 +02008188 else if (mfp != NL80211_MFP_NO)
8189 return -EINVAL;
Jouni Malinendc6382c2009-05-06 22:09:37 +03008190 }
8191
Johannes Berg3e5d7642009-07-07 14:37:26 +02008192 if (info->attrs[NL80211_ATTR_PREV_BSSID])
Johannes Bergf62fab72013-02-21 20:09:09 +01008193 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
Johannes Berg3e5d7642009-07-07 14:37:26 +02008194
Ben Greear7e7c8922011-11-18 11:31:59 -08008195 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
Johannes Bergf62fab72013-02-21 20:09:09 +01008196 req.flags |= ASSOC_REQ_DISABLE_HT;
Ben Greear7e7c8922011-11-18 11:31:59 -08008197
8198 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
Johannes Bergf62fab72013-02-21 20:09:09 +01008199 memcpy(&req.ht_capa_mask,
8200 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8201 sizeof(req.ht_capa_mask));
Ben Greear7e7c8922011-11-18 11:31:59 -08008202
8203 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
Johannes Bergf62fab72013-02-21 20:09:09 +01008204 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
Ben Greear7e7c8922011-11-18 11:31:59 -08008205 return -EINVAL;
Johannes Bergf62fab72013-02-21 20:09:09 +01008206 memcpy(&req.ht_capa,
8207 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8208 sizeof(req.ht_capa));
Ben Greear7e7c8922011-11-18 11:31:59 -08008209 }
8210
Johannes Bergee2aca32013-02-21 17:36:01 +01008211 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
Johannes Bergf62fab72013-02-21 20:09:09 +01008212 req.flags |= ASSOC_REQ_DISABLE_VHT;
Johannes Bergee2aca32013-02-21 17:36:01 +01008213
8214 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
Johannes Bergf62fab72013-02-21 20:09:09 +01008215 memcpy(&req.vht_capa_mask,
8216 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
8217 sizeof(req.vht_capa_mask));
Johannes Bergee2aca32013-02-21 17:36:01 +01008218
8219 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
Johannes Bergf62fab72013-02-21 20:09:09 +01008220 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
Johannes Bergee2aca32013-02-21 17:36:01 +01008221 return -EINVAL;
Johannes Bergf62fab72013-02-21 20:09:09 +01008222 memcpy(&req.vht_capa,
8223 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
8224 sizeof(req.vht_capa));
Johannes Bergee2aca32013-02-21 17:36:01 +01008225 }
8226
Assaf Kraussbab5ab72014-09-03 15:25:01 +03008227 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
Beni Lev0c9ca112016-02-17 20:30:00 +02008228 if (!((rdev->wiphy.features &
8229 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
8230 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
8231 !wiphy_ext_feature_isset(&rdev->wiphy,
8232 NL80211_EXT_FEATURE_RRM))
Assaf Kraussbab5ab72014-09-03 15:25:01 +03008233 return -EINVAL;
8234 req.flags |= ASSOC_REQ_USE_RRM;
8235 }
8236
Jouni Malinenc9a63622016-10-27 00:42:03 +03008237 if (info->attrs[NL80211_ATTR_FILS_KEK]) {
8238 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
8239 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
8240 if (!info->attrs[NL80211_ATTR_FILS_NONCES])
8241 return -EINVAL;
8242 req.fils_nonces =
8243 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
8244 }
8245
Johannes Bergf62fab72013-02-21 20:09:09 +01008246 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
Johannes Berg91bf9b22013-05-15 17:44:01 +02008247 if (!err) {
8248 wdev_lock(dev->ieee80211_ptr);
Andrzej Zaborowski5f3f4d32018-02-04 21:57:28 +05308249
Johannes Bergf62fab72013-02-21 20:09:09 +01008250 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
8251 ssid, ssid_len, &req);
Andrzej Zaborowski5f3f4d32018-02-04 21:57:28 +05308252
8253 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
8254 dev->ieee80211_ptr->conn_owner_nlportid =
8255 info->snd_portid;
8256 memcpy(dev->ieee80211_ptr->disconnect_bssid,
8257 bssid, ETH_ALEN);
8258 }
8259
Johannes Berg91bf9b22013-05-15 17:44:01 +02008260 wdev_unlock(dev->ieee80211_ptr);
8261 }
Jouni Malinen636a5d32009-03-19 13:39:22 +02008262
Jouni Malinen636a5d32009-03-19 13:39:22 +02008263 return err;
8264}
8265
8266static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
8267{
Johannes Berg4c476992010-10-04 21:36:35 +02008268 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8269 struct net_device *dev = info->user_ptr[1];
Johannes Berg19957bb2009-07-02 17:20:43 +02008270 const u8 *ie = NULL, *bssid;
Johannes Berg91bf9b22013-05-15 17:44:01 +02008271 int ie_len = 0, err;
Johannes Berg19957bb2009-07-02 17:20:43 +02008272 u16 reason_code;
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008273 bool local_state_change;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008274
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008275 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8276 return -EINVAL;
8277
8278 if (!info->attrs[NL80211_ATTR_MAC])
8279 return -EINVAL;
8280
8281 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8282 return -EINVAL;
8283
Johannes Berg4c476992010-10-04 21:36:35 +02008284 if (!rdev->ops->deauth)
8285 return -EOPNOTSUPP;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008286
Johannes Berg074ac8d2010-09-16 14:58:22 +02008287 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02008288 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8289 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02008290
Johannes Berg19957bb2009-07-02 17:20:43 +02008291 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008292
Johannes Berg19957bb2009-07-02 17:20:43 +02008293 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8294 if (reason_code == 0) {
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008295 /* Reason Code 0 is reserved */
Johannes Berg4c476992010-10-04 21:36:35 +02008296 return -EINVAL;
Jouni Malinen255e7372009-03-20 21:21:17 +02008297 }
Jouni Malinen636a5d32009-03-19 13:39:22 +02008298
8299 if (info->attrs[NL80211_ATTR_IE]) {
Johannes Berg19957bb2009-07-02 17:20:43 +02008300 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8301 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008302 }
8303
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008304 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8305
Johannes Berg91bf9b22013-05-15 17:44:01 +02008306 wdev_lock(dev->ieee80211_ptr);
8307 err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
8308 local_state_change);
8309 wdev_unlock(dev->ieee80211_ptr);
8310 return err;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008311}
8312
8313static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
8314{
Johannes Berg4c476992010-10-04 21:36:35 +02008315 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8316 struct net_device *dev = info->user_ptr[1];
Johannes Berg19957bb2009-07-02 17:20:43 +02008317 const u8 *ie = NULL, *bssid;
Johannes Berg91bf9b22013-05-15 17:44:01 +02008318 int ie_len = 0, err;
Johannes Berg19957bb2009-07-02 17:20:43 +02008319 u16 reason_code;
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008320 bool local_state_change;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008321
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008322 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8323 return -EINVAL;
8324
8325 if (!info->attrs[NL80211_ATTR_MAC])
8326 return -EINVAL;
8327
8328 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8329 return -EINVAL;
8330
Johannes Berg4c476992010-10-04 21:36:35 +02008331 if (!rdev->ops->disassoc)
8332 return -EOPNOTSUPP;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008333
Johannes Berg074ac8d2010-09-16 14:58:22 +02008334 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02008335 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8336 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02008337
Johannes Berg19957bb2009-07-02 17:20:43 +02008338 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008339
Johannes Berg19957bb2009-07-02 17:20:43 +02008340 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8341 if (reason_code == 0) {
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008342 /* Reason Code 0 is reserved */
Johannes Berg4c476992010-10-04 21:36:35 +02008343 return -EINVAL;
Jouni Malinen255e7372009-03-20 21:21:17 +02008344 }
Jouni Malinen636a5d32009-03-19 13:39:22 +02008345
8346 if (info->attrs[NL80211_ATTR_IE]) {
Johannes Berg19957bb2009-07-02 17:20:43 +02008347 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8348 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008349 }
8350
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008351 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8352
Johannes Berg91bf9b22013-05-15 17:44:01 +02008353 wdev_lock(dev->ieee80211_ptr);
8354 err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
8355 local_state_change);
8356 wdev_unlock(dev->ieee80211_ptr);
8357 return err;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008358}
8359
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01008360static bool
8361nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
Johannes Berg57fbcce2016-04-12 15:56:15 +02008362 int mcast_rate[NUM_NL80211_BANDS],
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01008363 int rateval)
8364{
8365 struct wiphy *wiphy = &rdev->wiphy;
8366 bool found = false;
8367 int band, i;
8368
Johannes Berg57fbcce2016-04-12 15:56:15 +02008369 for (band = 0; band < NUM_NL80211_BANDS; band++) {
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01008370 struct ieee80211_supported_band *sband;
8371
8372 sband = wiphy->bands[band];
8373 if (!sband)
8374 continue;
8375
8376 for (i = 0; i < sband->n_bitrates; i++) {
8377 if (sband->bitrates[i].bitrate == rateval) {
8378 mcast_rate[band] = i + 1;
8379 found = true;
8380 break;
8381 }
8382 }
8383 }
8384
8385 return found;
8386}
8387
Johannes Berg04a773a2009-04-19 21:24:32 +02008388static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
8389{
Johannes Berg4c476992010-10-04 21:36:35 +02008390 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8391 struct net_device *dev = info->user_ptr[1];
Johannes Berg04a773a2009-04-19 21:24:32 +02008392 struct cfg80211_ibss_params ibss;
8393 struct wiphy *wiphy;
Johannes Bergfffd0932009-07-08 14:22:54 +02008394 struct cfg80211_cached_keys *connkeys = NULL;
Johannes Berg04a773a2009-04-19 21:24:32 +02008395 int err;
8396
Johannes Berg8e30bc52009-04-22 17:45:38 +02008397 memset(&ibss, 0, sizeof(ibss));
8398
Johannes Berg04a773a2009-04-19 21:24:32 +02008399 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8400 return -EINVAL;
8401
Johannes Berg683b6d32012-11-08 21:25:48 +01008402 if (!info->attrs[NL80211_ATTR_SSID] ||
Johannes Berg04a773a2009-04-19 21:24:32 +02008403 !nla_len(info->attrs[NL80211_ATTR_SSID]))
8404 return -EINVAL;
8405
Johannes Berg8e30bc52009-04-22 17:45:38 +02008406 ibss.beacon_interval = 100;
8407
Purushottam Kushwaha12d20fc92016-08-11 15:14:02 +05308408 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
Johannes Berg8e30bc52009-04-22 17:45:38 +02008409 ibss.beacon_interval =
8410 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
Purushottam Kushwaha12d20fc92016-08-11 15:14:02 +05308411
Purushottam Kushwahac6800ff2016-10-12 18:26:51 +05308412 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
8413 ibss.beacon_interval);
Purushottam Kushwaha12d20fc92016-08-11 15:14:02 +05308414 if (err)
8415 return err;
Johannes Berg8e30bc52009-04-22 17:45:38 +02008416
Johannes Berg4c476992010-10-04 21:36:35 +02008417 if (!rdev->ops->join_ibss)
8418 return -EOPNOTSUPP;
Johannes Berg04a773a2009-04-19 21:24:32 +02008419
Johannes Berg4c476992010-10-04 21:36:35 +02008420 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8421 return -EOPNOTSUPP;
Johannes Berg04a773a2009-04-19 21:24:32 +02008422
Johannes Berg79c97e92009-07-07 03:56:12 +02008423 wiphy = &rdev->wiphy;
Johannes Berg04a773a2009-04-19 21:24:32 +02008424
Johannes Berg39193492011-09-16 13:45:25 +02008425 if (info->attrs[NL80211_ATTR_MAC]) {
Johannes Berg04a773a2009-04-19 21:24:32 +02008426 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Johannes Berg39193492011-09-16 13:45:25 +02008427
8428 if (!is_valid_ether_addr(ibss.bssid))
8429 return -EINVAL;
8430 }
Johannes Berg04a773a2009-04-19 21:24:32 +02008431 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8432 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8433
8434 if (info->attrs[NL80211_ATTR_IE]) {
8435 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8436 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8437 }
8438
Johannes Berg683b6d32012-11-08 21:25:48 +01008439 err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
8440 if (err)
8441 return err;
Alexander Simon54858ee5b2011-11-30 16:56:32 +01008442
Ilan Peer174e0cd2014-02-23 09:13:01 +02008443 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
8444 NL80211_IFTYPE_ADHOC))
Alexander Simon54858ee5b2011-11-30 16:56:32 +01008445 return -EINVAL;
8446
Simon Wunderlich2f301ab2013-05-16 13:00:28 +02008447 switch (ibss.chandef.width) {
Simon Wunderlichbf372642013-07-08 16:55:58 +02008448 case NL80211_CHAN_WIDTH_5:
8449 case NL80211_CHAN_WIDTH_10:
Simon Wunderlich2f301ab2013-05-16 13:00:28 +02008450 case NL80211_CHAN_WIDTH_20_NOHT:
8451 break;
8452 case NL80211_CHAN_WIDTH_20:
8453 case NL80211_CHAN_WIDTH_40:
Janusz.Dziedzic@tieto.comffc11992015-02-21 16:52:39 +01008454 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8455 return -EINVAL;
8456 break;
8457 case NL80211_CHAN_WIDTH_80:
8458 case NL80211_CHAN_WIDTH_80P80:
8459 case NL80211_CHAN_WIDTH_160:
8460 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8461 return -EINVAL;
8462 if (!wiphy_ext_feature_isset(&rdev->wiphy,
8463 NL80211_EXT_FEATURE_VHT_IBSS))
8464 return -EINVAL;
8465 break;
Simon Wunderlich2f301ab2013-05-16 13:00:28 +02008466 default:
Johannes Bergdb9c64c2012-11-09 14:56:41 +01008467 return -EINVAL;
Simon Wunderlich2f301ab2013-05-16 13:00:28 +02008468 }
Johannes Bergdb9c64c2012-11-09 14:56:41 +01008469
Johannes Berg04a773a2009-04-19 21:24:32 +02008470 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
Johannes Bergfffd0932009-07-08 14:22:54 +02008471 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
Johannes Berg04a773a2009-04-19 21:24:32 +02008472
Teemu Paasikivifbd2c8d2010-06-14 12:55:31 +03008473 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
8474 u8 *rates =
8475 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8476 int n_rates =
8477 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8478 struct ieee80211_supported_band *sband =
Johannes Berg683b6d32012-11-08 21:25:48 +01008479 wiphy->bands[ibss.chandef.chan->band];
Teemu Paasikivifbd2c8d2010-06-14 12:55:31 +03008480
Johannes Berg34850ab2011-07-18 18:08:35 +02008481 err = ieee80211_get_ratemask(sband, rates, n_rates,
8482 &ibss.basic_rates);
8483 if (err)
8484 return err;
Teemu Paasikivifbd2c8d2010-06-14 12:55:31 +03008485 }
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01008486
Simon Wunderlich803768f2013-06-28 10:39:58 +02008487 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8488 memcpy(&ibss.ht_capa_mask,
8489 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8490 sizeof(ibss.ht_capa_mask));
8491
8492 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8493 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8494 return -EINVAL;
8495 memcpy(&ibss.ht_capa,
8496 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8497 sizeof(ibss.ht_capa));
8498 }
8499
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01008500 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
8501 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
8502 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
8503 return -EINVAL;
Teemu Paasikivifbd2c8d2010-06-14 12:55:31 +03008504
Johannes Berg4c476992010-10-04 21:36:35 +02008505 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
Sujith Manoharande7044e2012-10-18 10:19:28 +05308506 bool no_ht = false;
8507
Johannes Berg4c476992010-10-04 21:36:35 +02008508 connkeys = nl80211_parse_connkeys(rdev,
Sujith Manoharande7044e2012-10-18 10:19:28 +05308509 info->attrs[NL80211_ATTR_KEYS],
8510 &no_ht);
Johannes Berg4c476992010-10-04 21:36:35 +02008511 if (IS_ERR(connkeys))
8512 return PTR_ERR(connkeys);
Sujith Manoharande7044e2012-10-18 10:19:28 +05308513
Johannes Berg3d9d1d62012-11-08 23:14:50 +01008514 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
8515 no_ht) {
Ola Olsson5e950a72016-02-11 01:00:22 +01008516 kzfree(connkeys);
Sujith Manoharande7044e2012-10-18 10:19:28 +05308517 return -EINVAL;
8518 }
Johannes Berg4c476992010-10-04 21:36:35 +02008519 }
Johannes Berg04a773a2009-04-19 21:24:32 +02008520
Antonio Quartulli267335d2012-01-31 20:25:47 +01008521 ibss.control_port =
8522 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
8523
Simon Wunderlich5336fa82013-10-07 18:41:05 +02008524 ibss.userspace_handles_dfs =
8525 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
8526
Johannes Berg4c476992010-10-04 21:36:35 +02008527 err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
Johannes Bergfffd0932009-07-08 14:22:54 +02008528 if (err)
Johannes Bergb47f6102014-09-10 13:39:54 +03008529 kzfree(connkeys);
Johannes Berg04a773a2009-04-19 21:24:32 +02008530 return err;
8531}
8532
8533static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
8534{
Johannes Berg4c476992010-10-04 21:36:35 +02008535 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8536 struct net_device *dev = info->user_ptr[1];
Johannes Berg04a773a2009-04-19 21:24:32 +02008537
Johannes Berg4c476992010-10-04 21:36:35 +02008538 if (!rdev->ops->leave_ibss)
8539 return -EOPNOTSUPP;
Johannes Berg04a773a2009-04-19 21:24:32 +02008540
Johannes Berg4c476992010-10-04 21:36:35 +02008541 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8542 return -EOPNOTSUPP;
Johannes Berg04a773a2009-04-19 21:24:32 +02008543
Johannes Berg4c476992010-10-04 21:36:35 +02008544 return cfg80211_leave_ibss(rdev, dev, false);
Johannes Berg04a773a2009-04-19 21:24:32 +02008545}
8546
Antonio Quartullif4e583c2012-11-02 13:27:48 +01008547static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
8548{
8549 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8550 struct net_device *dev = info->user_ptr[1];
Johannes Berg57fbcce2016-04-12 15:56:15 +02008551 int mcast_rate[NUM_NL80211_BANDS];
Antonio Quartullif4e583c2012-11-02 13:27:48 +01008552 u32 nla_rate;
8553 int err;
8554
8555 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
Bertold Van den Bergh876dc932015-08-05 16:02:21 +02008556 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
8557 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
Antonio Quartullif4e583c2012-11-02 13:27:48 +01008558 return -EOPNOTSUPP;
8559
8560 if (!rdev->ops->set_mcast_rate)
8561 return -EOPNOTSUPP;
8562
8563 memset(mcast_rate, 0, sizeof(mcast_rate));
8564
8565 if (!info->attrs[NL80211_ATTR_MCAST_RATE])
8566 return -EINVAL;
8567
8568 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
8569 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
8570 return -EINVAL;
8571
Ilan Peera1056b12015-10-22 22:27:46 +03008572 err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
Antonio Quartullif4e583c2012-11-02 13:27:48 +01008573
8574 return err;
8575}
8576
Johannes Bergad7e7182013-11-13 13:37:47 +01008577static struct sk_buff *
8578__cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
Ahmad Kholaif6c09e792015-02-26 15:26:53 +02008579 struct wireless_dev *wdev, int approxlen,
8580 u32 portid, u32 seq, enum nl80211_commands cmd,
Johannes Berg567ffc32013-12-18 14:43:31 +01008581 enum nl80211_attrs attr,
8582 const struct nl80211_vendor_cmd_info *info,
8583 gfp_t gfp)
Johannes Bergad7e7182013-11-13 13:37:47 +01008584{
8585 struct sk_buff *skb;
8586 void *hdr;
8587 struct nlattr *data;
8588
8589 skb = nlmsg_new(approxlen + 100, gfp);
8590 if (!skb)
8591 return NULL;
8592
8593 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
8594 if (!hdr) {
8595 kfree_skb(skb);
8596 return NULL;
8597 }
8598
8599 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
8600 goto nla_put_failure;
Johannes Berg567ffc32013-12-18 14:43:31 +01008601
8602 if (info) {
8603 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
8604 info->vendor_id))
8605 goto nla_put_failure;
8606 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
8607 info->subcmd))
8608 goto nla_put_failure;
8609 }
8610
Ahmad Kholaif6c09e792015-02-26 15:26:53 +02008611 if (wdev) {
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02008612 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
8613 wdev_id(wdev), NL80211_ATTR_PAD))
Ahmad Kholaif6c09e792015-02-26 15:26:53 +02008614 goto nla_put_failure;
8615 if (wdev->netdev &&
8616 nla_put_u32(skb, NL80211_ATTR_IFINDEX,
8617 wdev->netdev->ifindex))
8618 goto nla_put_failure;
8619 }
8620
Johannes Bergad7e7182013-11-13 13:37:47 +01008621 data = nla_nest_start(skb, attr);
Johannes Berg76e1fb42016-09-14 09:55:57 +02008622 if (!data)
8623 goto nla_put_failure;
Johannes Bergad7e7182013-11-13 13:37:47 +01008624
8625 ((void **)skb->cb)[0] = rdev;
8626 ((void **)skb->cb)[1] = hdr;
8627 ((void **)skb->cb)[2] = data;
8628
8629 return skb;
8630
8631 nla_put_failure:
8632 kfree_skb(skb);
8633 return NULL;
8634}
Antonio Quartullif4e583c2012-11-02 13:27:48 +01008635
Johannes Berge03ad6e2014-01-01 17:22:30 +01008636struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
Ahmad Kholaif6c09e792015-02-26 15:26:53 +02008637 struct wireless_dev *wdev,
Johannes Berge03ad6e2014-01-01 17:22:30 +01008638 enum nl80211_commands cmd,
8639 enum nl80211_attrs attr,
8640 int vendor_event_idx,
8641 int approxlen, gfp_t gfp)
8642{
Zhao, Gangf26cbf42014-04-21 12:53:03 +08008643 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berge03ad6e2014-01-01 17:22:30 +01008644 const struct nl80211_vendor_cmd_info *info;
8645
8646 switch (cmd) {
8647 case NL80211_CMD_TESTMODE:
8648 if (WARN_ON(vendor_event_idx != -1))
8649 return NULL;
8650 info = NULL;
8651 break;
8652 case NL80211_CMD_VENDOR:
8653 if (WARN_ON(vendor_event_idx < 0 ||
8654 vendor_event_idx >= wiphy->n_vendor_events))
8655 return NULL;
8656 info = &wiphy->vendor_events[vendor_event_idx];
8657 break;
8658 default:
8659 WARN_ON(1);
8660 return NULL;
8661 }
8662
Ahmad Kholaif6c09e792015-02-26 15:26:53 +02008663 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, 0, 0,
Johannes Berge03ad6e2014-01-01 17:22:30 +01008664 cmd, attr, info, gfp);
8665}
8666EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
8667
8668void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
8669{
8670 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
8671 void *hdr = ((void **)skb->cb)[1];
8672 struct nlattr *data = ((void **)skb->cb)[2];
8673 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
8674
Johannes Bergbd8c78e2014-07-30 14:55:26 +02008675 /* clear CB data for netlink core to own from now on */
8676 memset(skb->cb, 0, sizeof(skb->cb));
8677
Johannes Berge03ad6e2014-01-01 17:22:30 +01008678 nla_nest_end(skb, data);
8679 genlmsg_end(skb, hdr);
8680
8681 if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
8682 mcgrp = NL80211_MCGRP_VENDOR;
8683
8684 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), skb, 0,
8685 mcgrp, gfp);
8686}
8687EXPORT_SYMBOL(__cfg80211_send_event_skb);
8688
Johannes Bergaff89a92009-07-01 21:26:51 +02008689#ifdef CONFIG_NL80211_TESTMODE
Johannes Bergaff89a92009-07-01 21:26:51 +02008690static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
8691{
Johannes Berg4c476992010-10-04 21:36:35 +02008692 struct cfg80211_registered_device *rdev = info->user_ptr[0];
David Spinadelfc73f112013-07-31 18:04:15 +03008693 struct wireless_dev *wdev =
8694 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
Johannes Bergaff89a92009-07-01 21:26:51 +02008695 int err;
8696
David Spinadelfc73f112013-07-31 18:04:15 +03008697 if (!rdev->ops->testmode_cmd)
8698 return -EOPNOTSUPP;
8699
8700 if (IS_ERR(wdev)) {
8701 err = PTR_ERR(wdev);
8702 if (err != -EINVAL)
8703 return err;
8704 wdev = NULL;
8705 } else if (wdev->wiphy != &rdev->wiphy) {
8706 return -EINVAL;
8707 }
8708
Johannes Bergaff89a92009-07-01 21:26:51 +02008709 if (!info->attrs[NL80211_ATTR_TESTDATA])
8710 return -EINVAL;
8711
Johannes Bergad7e7182013-11-13 13:37:47 +01008712 rdev->cur_cmd_info = info;
David Spinadelfc73f112013-07-31 18:04:15 +03008713 err = rdev_testmode_cmd(rdev, wdev,
Johannes Bergaff89a92009-07-01 21:26:51 +02008714 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
8715 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
Johannes Bergad7e7182013-11-13 13:37:47 +01008716 rdev->cur_cmd_info = NULL;
Johannes Bergaff89a92009-07-01 21:26:51 +02008717
Johannes Bergaff89a92009-07-01 21:26:51 +02008718 return err;
8719}
8720
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008721static int nl80211_testmode_dump(struct sk_buff *skb,
8722 struct netlink_callback *cb)
8723{
Johannes Berg00918d32011-12-13 17:22:05 +01008724 struct cfg80211_registered_device *rdev;
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008725 int err;
8726 long phy_idx;
8727 void *data = NULL;
8728 int data_len = 0;
8729
Johannes Berg5fe231e2013-05-08 21:45:15 +02008730 rtnl_lock();
8731
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008732 if (cb->args[0]) {
8733 /*
8734 * 0 is a valid index, but not valid for args[0],
8735 * so we need to offset by 1.
8736 */
8737 phy_idx = cb->args[0] - 1;
8738 } else {
8739 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
8740 nl80211_fam.attrbuf, nl80211_fam.maxattr,
8741 nl80211_policy);
8742 if (err)
Johannes Berg5fe231e2013-05-08 21:45:15 +02008743 goto out_err;
Johannes Berg00918d32011-12-13 17:22:05 +01008744
Johannes Berg2bd7e352012-06-15 14:23:16 +02008745 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk),
8746 nl80211_fam.attrbuf);
8747 if (IS_ERR(rdev)) {
Johannes Berg5fe231e2013-05-08 21:45:15 +02008748 err = PTR_ERR(rdev);
8749 goto out_err;
Johannes Berg00918d32011-12-13 17:22:05 +01008750 }
Johannes Berg2bd7e352012-06-15 14:23:16 +02008751 phy_idx = rdev->wiphy_idx;
8752 rdev = NULL;
Johannes Berg2bd7e352012-06-15 14:23:16 +02008753
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008754 if (nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA])
8755 cb->args[1] =
8756 (long)nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA];
8757 }
8758
8759 if (cb->args[1]) {
8760 data = nla_data((void *)cb->args[1]);
8761 data_len = nla_len((void *)cb->args[1]);
8762 }
8763
Johannes Berg00918d32011-12-13 17:22:05 +01008764 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
8765 if (!rdev) {
Johannes Berg5fe231e2013-05-08 21:45:15 +02008766 err = -ENOENT;
8767 goto out_err;
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008768 }
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008769
Johannes Berg00918d32011-12-13 17:22:05 +01008770 if (!rdev->ops->testmode_dump) {
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008771 err = -EOPNOTSUPP;
8772 goto out_err;
8773 }
8774
8775 while (1) {
Eric W. Biederman15e47302012-09-07 20:12:54 +00008776 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008777 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8778 NL80211_CMD_TESTMODE);
8779 struct nlattr *tmdata;
8780
Dan Carpentercb35fba2013-08-14 14:50:01 +03008781 if (!hdr)
8782 break;
8783
David S. Miller9360ffd2012-03-29 04:41:26 -04008784 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008785 genlmsg_cancel(skb, hdr);
8786 break;
8787 }
8788
8789 tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
8790 if (!tmdata) {
8791 genlmsg_cancel(skb, hdr);
8792 break;
8793 }
Hila Gonene35e4d22012-06-27 17:19:42 +03008794 err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008795 nla_nest_end(skb, tmdata);
8796
8797 if (err == -ENOBUFS || err == -ENOENT) {
8798 genlmsg_cancel(skb, hdr);
8799 break;
8800 } else if (err) {
8801 genlmsg_cancel(skb, hdr);
8802 goto out_err;
8803 }
8804
8805 genlmsg_end(skb, hdr);
8806 }
8807
8808 err = skb->len;
8809 /* see above */
8810 cb->args[0] = phy_idx + 1;
8811 out_err:
Johannes Berg5fe231e2013-05-08 21:45:15 +02008812 rtnl_unlock();
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008813 return err;
8814}
Johannes Bergaff89a92009-07-01 21:26:51 +02008815#endif
8816
Samuel Ortizb23aa672009-07-01 21:26:54 +02008817static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
8818{
Johannes Berg4c476992010-10-04 21:36:35 +02008819 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8820 struct net_device *dev = info->user_ptr[1];
Samuel Ortizb23aa672009-07-01 21:26:54 +02008821 struct cfg80211_connect_params connect;
8822 struct wiphy *wiphy;
Johannes Bergfffd0932009-07-08 14:22:54 +02008823 struct cfg80211_cached_keys *connkeys = NULL;
Samuel Ortizb23aa672009-07-01 21:26:54 +02008824 int err;
8825
8826 memset(&connect, 0, sizeof(connect));
8827
8828 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8829 return -EINVAL;
8830
8831 if (!info->attrs[NL80211_ATTR_SSID] ||
8832 !nla_len(info->attrs[NL80211_ATTR_SSID]))
8833 return -EINVAL;
8834
8835 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
8836 connect.auth_type =
8837 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
Jouni Malinene39e5b52012-09-30 19:29:39 +03008838 if (!nl80211_valid_auth_type(rdev, connect.auth_type,
8839 NL80211_CMD_CONNECT))
Samuel Ortizb23aa672009-07-01 21:26:54 +02008840 return -EINVAL;
8841 } else
8842 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
8843
8844 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
8845
Johannes Bergc0692b82010-08-27 14:26:53 +03008846 err = nl80211_crypto_settings(rdev, info, &connect.crypto,
Johannes Berg3dc27d22009-07-02 21:36:37 +02008847 NL80211_MAX_NR_CIPHER_SUITES);
Samuel Ortizb23aa672009-07-01 21:26:54 +02008848 if (err)
8849 return err;
Samuel Ortizb23aa672009-07-01 21:26:54 +02008850
Johannes Berg074ac8d2010-09-16 14:58:22 +02008851 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02008852 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8853 return -EOPNOTSUPP;
Samuel Ortizb23aa672009-07-01 21:26:54 +02008854
Johannes Berg79c97e92009-07-07 03:56:12 +02008855 wiphy = &rdev->wiphy;
Samuel Ortizb23aa672009-07-01 21:26:54 +02008856
Bala Shanmugam4486ea92012-03-07 17:27:12 +05308857 connect.bg_scan_period = -1;
8858 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
8859 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
8860 connect.bg_scan_period =
8861 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
8862 }
8863
Samuel Ortizb23aa672009-07-01 21:26:54 +02008864 if (info->attrs[NL80211_ATTR_MAC])
8865 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Jouni Malinen1df4a512014-01-15 00:00:47 +02008866 else if (info->attrs[NL80211_ATTR_MAC_HINT])
8867 connect.bssid_hint =
8868 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
Samuel Ortizb23aa672009-07-01 21:26:54 +02008869 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8870 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8871
8872 if (info->attrs[NL80211_ATTR_IE]) {
8873 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8874 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8875 }
8876
Jouni Malinencee00a92013-01-15 17:15:57 +02008877 if (info->attrs[NL80211_ATTR_USE_MFP]) {
8878 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
8879 if (connect.mfp != NL80211_MFP_REQUIRED &&
8880 connect.mfp != NL80211_MFP_NO)
8881 return -EINVAL;
8882 } else {
8883 connect.mfp = NL80211_MFP_NO;
8884 }
8885
Jouni Malinenba6fbac2016-03-29 13:53:27 +03008886 if (info->attrs[NL80211_ATTR_PREV_BSSID])
8887 connect.prev_bssid =
8888 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
8889
Samuel Ortizb23aa672009-07-01 21:26:54 +02008890 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
Jouni Malinen664834d2014-01-15 00:01:44 +02008891 connect.channel = nl80211_get_valid_chan(
8892 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8893 if (!connect.channel)
Johannes Berg4c476992010-10-04 21:36:35 +02008894 return -EINVAL;
Jouni Malinen1df4a512014-01-15 00:00:47 +02008895 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
Jouni Malinen664834d2014-01-15 00:01:44 +02008896 connect.channel_hint = nl80211_get_valid_chan(
8897 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
8898 if (!connect.channel_hint)
Jouni Malinen1df4a512014-01-15 00:00:47 +02008899 return -EINVAL;
Samuel Ortizb23aa672009-07-01 21:26:54 +02008900 }
8901
Johannes Bergfffd0932009-07-08 14:22:54 +02008902 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
8903 connkeys = nl80211_parse_connkeys(rdev,
Sujith Manoharande7044e2012-10-18 10:19:28 +05308904 info->attrs[NL80211_ATTR_KEYS], NULL);
Johannes Berg4c476992010-10-04 21:36:35 +02008905 if (IS_ERR(connkeys))
8906 return PTR_ERR(connkeys);
Johannes Bergfffd0932009-07-08 14:22:54 +02008907 }
8908
Ben Greear7e7c8922011-11-18 11:31:59 -08008909 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
8910 connect.flags |= ASSOC_REQ_DISABLE_HT;
8911
8912 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8913 memcpy(&connect.ht_capa_mask,
8914 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8915 sizeof(connect.ht_capa_mask));
8916
8917 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
Wei Yongjunb4e4f472012-09-02 21:41:04 +08008918 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
Johannes Bergb47f6102014-09-10 13:39:54 +03008919 kzfree(connkeys);
Ben Greear7e7c8922011-11-18 11:31:59 -08008920 return -EINVAL;
Wei Yongjunb4e4f472012-09-02 21:41:04 +08008921 }
Ben Greear7e7c8922011-11-18 11:31:59 -08008922 memcpy(&connect.ht_capa,
8923 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8924 sizeof(connect.ht_capa));
8925 }
8926
Johannes Bergee2aca32013-02-21 17:36:01 +01008927 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
8928 connect.flags |= ASSOC_REQ_DISABLE_VHT;
8929
8930 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
8931 memcpy(&connect.vht_capa_mask,
8932 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
8933 sizeof(connect.vht_capa_mask));
8934
8935 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
8936 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
Johannes Bergb47f6102014-09-10 13:39:54 +03008937 kzfree(connkeys);
Johannes Bergee2aca32013-02-21 17:36:01 +01008938 return -EINVAL;
8939 }
8940 memcpy(&connect.vht_capa,
8941 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
8942 sizeof(connect.vht_capa));
8943 }
8944
Assaf Kraussbab5ab72014-09-03 15:25:01 +03008945 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
Beni Lev0c9ca112016-02-17 20:30:00 +02008946 if (!((rdev->wiphy.features &
8947 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
8948 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
8949 !wiphy_ext_feature_isset(&rdev->wiphy,
8950 NL80211_EXT_FEATURE_RRM)) {
Ola Olsson707554b2015-12-11 21:04:52 +01008951 kzfree(connkeys);
Assaf Kraussbab5ab72014-09-03 15:25:01 +03008952 return -EINVAL;
Ola Olsson707554b2015-12-11 21:04:52 +01008953 }
Assaf Kraussbab5ab72014-09-03 15:25:01 +03008954 connect.flags |= ASSOC_REQ_USE_RRM;
8955 }
8956
Lior David34d50512016-01-28 10:58:25 +02008957 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
Johannes Berg57fbcce2016-04-12 15:56:15 +02008958 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
Lior David34d50512016-01-28 10:58:25 +02008959 kzfree(connkeys);
8960 return -EOPNOTSUPP;
8961 }
8962
Arend van Spriel38de03d2016-03-02 20:37:18 +01008963 if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
8964 /* bss selection makes no sense if bssid is set */
8965 if (connect.bssid) {
8966 kzfree(connkeys);
8967 return -EINVAL;
8968 }
8969
8970 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
8971 wiphy, &connect.bss_select);
8972 if (err) {
8973 kzfree(connkeys);
8974 return err;
8975 }
8976 }
8977
Vidyullatha Kanchanapally36eabf62017-03-31 00:22:34 +03008978 if (wiphy_ext_feature_isset(&rdev->wiphy,
8979 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
8980 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
8981 info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
8982 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
8983 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
8984 connect.fils_erp_username =
8985 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
8986 connect.fils_erp_username_len =
8987 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
8988 connect.fils_erp_realm =
8989 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
8990 connect.fils_erp_realm_len =
8991 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
8992 connect.fils_erp_next_seq_num =
8993 nla_get_u16(
8994 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
8995 connect.fils_erp_rrk =
8996 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
8997 connect.fils_erp_rrk_len =
8998 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
8999 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
9000 info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
9001 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
9002 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9003 kzfree(connkeys);
9004 return -EINVAL;
9005 }
9006
Srinivas Dasarid041a1a2018-02-07 18:32:17 +05309007 if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) {
9008 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
Srinivas Dasari49691ba2018-04-20 11:41:14 +05309009 kzfree(connkeys);
Srinivas Dasarid041a1a2018-02-07 18:32:17 +05309010 return -EINVAL;
9011 }
9012 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT;
9013 }
9014
Johannes Berg83739b02013-05-15 17:44:01 +02009015 wdev_lock(dev->ieee80211_ptr);
Andrzej Zaborowski5f3f4d32018-02-04 21:57:28 +05309016
Jouni Malinen4ce2bd92016-03-29 13:53:28 +03009017 err = cfg80211_connect(rdev, dev, &connect, connkeys,
9018 connect.prev_bssid);
Johannes Bergfffd0932009-07-08 14:22:54 +02009019 if (err)
Johannes Bergb47f6102014-09-10 13:39:54 +03009020 kzfree(connkeys);
Andrzej Zaborowski5f3f4d32018-02-04 21:57:28 +05309021
9022 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9023 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
9024 if (connect.bssid)
9025 memcpy(dev->ieee80211_ptr->disconnect_bssid,
9026 connect.bssid, ETH_ALEN);
9027 else
9028 memset(dev->ieee80211_ptr->disconnect_bssid,
9029 0, ETH_ALEN);
9030 }
9031
9032 wdev_unlock(dev->ieee80211_ptr);
9033
Samuel Ortizb23aa672009-07-01 21:26:54 +02009034 return err;
9035}
9036
vamsi krishna30da4e82016-10-27 16:51:11 +03009037static int nl80211_update_connect_params(struct sk_buff *skb,
9038 struct genl_info *info)
9039{
9040 struct cfg80211_connect_params connect = {};
9041 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9042 struct net_device *dev = info->user_ptr[1];
9043 struct wireless_dev *wdev = dev->ieee80211_ptr;
9044 u32 changed = 0;
9045 int ret;
9046
9047 if (!rdev->ops->update_connect_params)
9048 return -EOPNOTSUPP;
9049
9050 if (info->attrs[NL80211_ATTR_IE]) {
9051 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
9052 return -EINVAL;
9053 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9054 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9055 changed |= UPDATE_ASSOC_IES;
9056 }
9057
Vidyullatha Kanchanapally5f5a26b2017-08-02 16:31:40 +05309058 if (wiphy_ext_feature_isset(&rdev->wiphy,
9059 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
9060 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
9061 info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
9062 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
9063 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9064 connect.fils_erp_username =
9065 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
9066 connect.fils_erp_username_len =
9067 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
9068 connect.fils_erp_realm =
9069 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
9070 connect.fils_erp_realm_len =
9071 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
9072 connect.fils_erp_next_seq_num =
9073 nla_get_u16(
9074 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
9075 connect.fils_erp_rrk =
9076 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
9077 connect.fils_erp_rrk_len =
9078 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
9079 changed |= UPDATE_FILS_ERP_INFO;
9080 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
9081 info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
9082 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
9083 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9084 return -EINVAL;
9085 }
9086
9087 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
9088 u32 auth_type =
9089 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
9090 if (!nl80211_valid_auth_type(rdev, auth_type,
9091 NL80211_CMD_CONNECT))
9092 return -EINVAL;
9093 connect.auth_type = auth_type;
9094 changed |= UPDATE_AUTH_TYPE;
9095 }
9096
vamsi krishna30da4e82016-10-27 16:51:11 +03009097 wdev_lock(dev->ieee80211_ptr);
9098 if (!wdev->current_bss)
9099 ret = -ENOLINK;
9100 else
9101 ret = rdev_update_connect_params(rdev, dev, &connect, changed);
9102 wdev_unlock(dev->ieee80211_ptr);
9103
9104 return ret;
9105}
9106
Samuel Ortizb23aa672009-07-01 21:26:54 +02009107static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
9108{
Johannes Berg4c476992010-10-04 21:36:35 +02009109 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9110 struct net_device *dev = info->user_ptr[1];
Samuel Ortizb23aa672009-07-01 21:26:54 +02009111 u16 reason;
Johannes Berg83739b02013-05-15 17:44:01 +02009112 int ret;
Samuel Ortizb23aa672009-07-01 21:26:54 +02009113
9114 if (!info->attrs[NL80211_ATTR_REASON_CODE])
9115 reason = WLAN_REASON_DEAUTH_LEAVING;
9116 else
9117 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9118
9119 if (reason == 0)
9120 return -EINVAL;
9121
Johannes Berg074ac8d2010-09-16 14:58:22 +02009122 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02009123 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9124 return -EOPNOTSUPP;
Samuel Ortizb23aa672009-07-01 21:26:54 +02009125
Johannes Berg83739b02013-05-15 17:44:01 +02009126 wdev_lock(dev->ieee80211_ptr);
9127 ret = cfg80211_disconnect(rdev, dev, reason, true);
9128 wdev_unlock(dev->ieee80211_ptr);
9129 return ret;
Samuel Ortizb23aa672009-07-01 21:26:54 +02009130}
9131
Johannes Berg463d0182009-07-14 00:33:35 +02009132static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
9133{
Johannes Berg4c476992010-10-04 21:36:35 +02009134 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg463d0182009-07-14 00:33:35 +02009135 struct net *net;
9136 int err;
Johannes Berg463d0182009-07-14 00:33:35 +02009137
Vadim Kochan4b681c82015-01-12 16:34:05 +02009138 if (info->attrs[NL80211_ATTR_PID]) {
9139 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
9140
9141 net = get_net_ns_by_pid(pid);
9142 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
9143 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
9144
9145 net = get_net_ns_by_fd(fd);
9146 } else {
Johannes Berg463d0182009-07-14 00:33:35 +02009147 return -EINVAL;
Vadim Kochan4b681c82015-01-12 16:34:05 +02009148 }
Johannes Berg463d0182009-07-14 00:33:35 +02009149
Johannes Berg4c476992010-10-04 21:36:35 +02009150 if (IS_ERR(net))
9151 return PTR_ERR(net);
Johannes Berg463d0182009-07-14 00:33:35 +02009152
9153 err = 0;
9154
9155 /* check if anything to do */
Johannes Berg4c476992010-10-04 21:36:35 +02009156 if (!net_eq(wiphy_net(&rdev->wiphy), net))
9157 err = cfg80211_switch_netns(rdev, net);
Johannes Berg463d0182009-07-14 00:33:35 +02009158
Johannes Berg463d0182009-07-14 00:33:35 +02009159 put_net(net);
Johannes Berg463d0182009-07-14 00:33:35 +02009160 return err;
9161}
9162
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009163static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
9164{
Johannes Berg4c476992010-10-04 21:36:35 +02009165 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009166 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
9167 struct cfg80211_pmksa *pmksa) = NULL;
Johannes Berg4c476992010-10-04 21:36:35 +02009168 struct net_device *dev = info->user_ptr[1];
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009169 struct cfg80211_pmksa pmksa;
9170
9171 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
9172
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009173 if (!info->attrs[NL80211_ATTR_PMKID])
9174 return -EINVAL;
9175
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009176 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
Vidyullatha Kanchanapally36eabf62017-03-31 00:22:34 +03009177
9178 if (info->attrs[NL80211_ATTR_MAC]) {
9179 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9180 } else if (info->attrs[NL80211_ATTR_SSID] &&
9181 info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
9182 (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA ||
9183 info->attrs[NL80211_ATTR_PMK])) {
9184 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9185 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9186 pmksa.cache_id =
9187 nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
9188 } else {
9189 return -EINVAL;
9190 }
9191 if (info->attrs[NL80211_ATTR_PMK]) {
9192 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
9193 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
9194 }
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009195
Johannes Berg074ac8d2010-09-16 14:58:22 +02009196 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Liangwei Dong11e648c2019-01-18 16:54:38 +05309197 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
9198 !(dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP &&
9199 wiphy_ext_feature_isset(&rdev->wiphy,
9200 NL80211_EXT_FEATURE_AP_PMKSA_CACHING)))
Johannes Berg4c476992010-10-04 21:36:35 +02009201 return -EOPNOTSUPP;
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009202
9203 switch (info->genlhdr->cmd) {
9204 case NL80211_CMD_SET_PMKSA:
9205 rdev_ops = rdev->ops->set_pmksa;
9206 break;
9207 case NL80211_CMD_DEL_PMKSA:
9208 rdev_ops = rdev->ops->del_pmksa;
9209 break;
9210 default:
9211 WARN_ON(1);
9212 break;
9213 }
9214
Johannes Berg4c476992010-10-04 21:36:35 +02009215 if (!rdev_ops)
9216 return -EOPNOTSUPP;
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009217
Johannes Berg4c476992010-10-04 21:36:35 +02009218 return rdev_ops(&rdev->wiphy, dev, &pmksa);
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009219}
9220
9221static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
9222{
Johannes Berg4c476992010-10-04 21:36:35 +02009223 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9224 struct net_device *dev = info->user_ptr[1];
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009225
Johannes Berg074ac8d2010-09-16 14:58:22 +02009226 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02009227 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9228 return -EOPNOTSUPP;
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009229
Johannes Berg4c476992010-10-04 21:36:35 +02009230 if (!rdev->ops->flush_pmksa)
9231 return -EOPNOTSUPP;
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009232
Hila Gonene35e4d22012-06-27 17:19:42 +03009233 return rdev_flush_pmksa(rdev, dev);
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009234}
9235
Arik Nemtsov109086c2011-09-28 14:12:50 +03009236static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
9237{
9238 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9239 struct net_device *dev = info->user_ptr[1];
9240 u8 action_code, dialog_token;
Sunil Dutt Undekaridf942e72014-02-20 16:22:09 +05309241 u32 peer_capability = 0;
Arik Nemtsov109086c2011-09-28 14:12:50 +03009242 u16 status_code;
9243 u8 *peer;
Arik Nemtsov31fa97c2014-06-11 17:18:21 +03009244 bool initiator;
Arik Nemtsov109086c2011-09-28 14:12:50 +03009245
9246 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
9247 !rdev->ops->tdls_mgmt)
9248 return -EOPNOTSUPP;
9249
9250 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
9251 !info->attrs[NL80211_ATTR_STATUS_CODE] ||
9252 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
9253 !info->attrs[NL80211_ATTR_IE] ||
9254 !info->attrs[NL80211_ATTR_MAC])
9255 return -EINVAL;
9256
9257 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
9258 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
9259 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
9260 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
Arik Nemtsov31fa97c2014-06-11 17:18:21 +03009261 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
Sunil Dutt Undekaridf942e72014-02-20 16:22:09 +05309262 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
9263 peer_capability =
9264 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
Arik Nemtsov109086c2011-09-28 14:12:50 +03009265
Hila Gonene35e4d22012-06-27 17:19:42 +03009266 return rdev_tdls_mgmt(rdev, dev, peer, action_code,
Sunil Dutt Undekaridf942e72014-02-20 16:22:09 +05309267 dialog_token, status_code, peer_capability,
Arik Nemtsov31fa97c2014-06-11 17:18:21 +03009268 initiator,
Hila Gonene35e4d22012-06-27 17:19:42 +03009269 nla_data(info->attrs[NL80211_ATTR_IE]),
9270 nla_len(info->attrs[NL80211_ATTR_IE]));
Arik Nemtsov109086c2011-09-28 14:12:50 +03009271}
9272
9273static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
9274{
9275 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9276 struct net_device *dev = info->user_ptr[1];
9277 enum nl80211_tdls_operation operation;
9278 u8 *peer;
9279
9280 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
9281 !rdev->ops->tdls_oper)
9282 return -EOPNOTSUPP;
9283
9284 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
9285 !info->attrs[NL80211_ATTR_MAC])
9286 return -EINVAL;
9287
9288 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
9289 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
9290
Hila Gonene35e4d22012-06-27 17:19:42 +03009291 return rdev_tdls_oper(rdev, dev, peer, operation);
Arik Nemtsov109086c2011-09-28 14:12:50 +03009292}
9293
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009294static int nl80211_remain_on_channel(struct sk_buff *skb,
9295 struct genl_info *info)
9296{
Johannes Berg4c476992010-10-04 21:36:35 +02009297 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg71bbc992012-06-15 15:30:18 +02009298 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg683b6d32012-11-08 21:25:48 +01009299 struct cfg80211_chan_def chandef;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009300 struct sk_buff *msg;
9301 void *hdr;
9302 u64 cookie;
Johannes Berg683b6d32012-11-08 21:25:48 +01009303 u32 duration;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009304 int err;
9305
9306 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
9307 !info->attrs[NL80211_ATTR_DURATION])
9308 return -EINVAL;
9309
9310 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
9311
Johannes Berg7c4ef712011-11-18 15:33:48 +01009312 if (!rdev->ops->remain_on_channel ||
9313 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
Johannes Berg4c476992010-10-04 21:36:35 +02009314 return -EOPNOTSUPP;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009315
Johannes Bergebf348f2012-06-01 12:50:54 +02009316 /*
9317 * We should be on that channel for at least a minimum amount of
9318 * time (10ms) but no longer than the driver supports.
9319 */
9320 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9321 duration > rdev->wiphy.max_remain_on_channel_duration)
9322 return -EINVAL;
9323
Johannes Berg683b6d32012-11-08 21:25:48 +01009324 err = nl80211_parse_chandef(rdev, info, &chandef);
9325 if (err)
9326 return err;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009327
9328 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg4c476992010-10-04 21:36:35 +02009329 if (!msg)
9330 return -ENOMEM;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009331
Eric W. Biederman15e47302012-09-07 20:12:54 +00009332 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009333 NL80211_CMD_REMAIN_ON_CHANNEL);
Dan Carpentercb35fba2013-08-14 14:50:01 +03009334 if (!hdr) {
9335 err = -ENOBUFS;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009336 goto free_msg;
9337 }
9338
Johannes Berg683b6d32012-11-08 21:25:48 +01009339 err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
9340 duration, &cookie);
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009341
9342 if (err)
9343 goto free_msg;
9344
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02009345 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
9346 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04009347 goto nla_put_failure;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009348
9349 genlmsg_end(msg, hdr);
Johannes Berg4c476992010-10-04 21:36:35 +02009350
9351 return genlmsg_reply(msg, info);
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009352
9353 nla_put_failure:
9354 err = -ENOBUFS;
9355 free_msg:
9356 nlmsg_free(msg);
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009357 return err;
9358}
9359
9360static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
9361 struct genl_info *info)
9362{
Johannes Berg4c476992010-10-04 21:36:35 +02009363 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg71bbc992012-06-15 15:30:18 +02009364 struct wireless_dev *wdev = info->user_ptr[1];
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009365 u64 cookie;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009366
9367 if (!info->attrs[NL80211_ATTR_COOKIE])
9368 return -EINVAL;
9369
Johannes Berg4c476992010-10-04 21:36:35 +02009370 if (!rdev->ops->cancel_remain_on_channel)
9371 return -EOPNOTSUPP;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009372
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009373 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
9374
Hila Gonene35e4d22012-06-27 17:19:42 +03009375 return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009376}
9377
Jouni Malinen13ae75b2009-12-29 12:59:45 +02009378static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
9379 struct genl_info *info)
9380{
Jouni Malinen13ae75b2009-12-29 12:59:45 +02009381 struct cfg80211_bitrate_mask mask;
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05309382 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg4c476992010-10-04 21:36:35 +02009383 struct net_device *dev = info->user_ptr[1];
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05309384 int err;
Jouni Malinen13ae75b2009-12-29 12:59:45 +02009385
Johannes Berg4c476992010-10-04 21:36:35 +02009386 if (!rdev->ops->set_bitrate_mask)
9387 return -EOPNOTSUPP;
Jouni Malinen13ae75b2009-12-29 12:59:45 +02009388
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05309389 err = nl80211_parse_tx_bitrate_mask(info, &mask);
9390 if (err)
9391 return err;
Janusz Dziedzic78693032013-12-03 09:50:44 +01009392
Hila Gonene35e4d22012-06-27 17:19:42 +03009393 return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
Jouni Malinen13ae75b2009-12-29 12:59:45 +02009394}
9395
Johannes Berg2e161f72010-08-12 15:38:38 +02009396static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
Jouni Malinen026331c2010-02-15 12:53:10 +02009397{
Johannes Berg4c476992010-10-04 21:36:35 +02009398 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg71bbc992012-06-15 15:30:18 +02009399 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg2e161f72010-08-12 15:38:38 +02009400 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
Jouni Malinen026331c2010-02-15 12:53:10 +02009401
9402 if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
9403 return -EINVAL;
9404
Johannes Berg2e161f72010-08-12 15:38:38 +02009405 if (info->attrs[NL80211_ATTR_FRAME_TYPE])
9406 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
Jouni Malinen026331c2010-02-15 12:53:10 +02009407
Johannes Berg71bbc992012-06-15 15:30:18 +02009408 switch (wdev->iftype) {
9409 case NL80211_IFTYPE_STATION:
9410 case NL80211_IFTYPE_ADHOC:
9411 case NL80211_IFTYPE_P2P_CLIENT:
9412 case NL80211_IFTYPE_AP:
9413 case NL80211_IFTYPE_AP_VLAN:
9414 case NL80211_IFTYPE_MESH_POINT:
9415 case NL80211_IFTYPE_P2P_GO:
Johannes Berg98104fde2012-06-16 00:19:54 +02009416 case NL80211_IFTYPE_P2P_DEVICE:
Johannes Berg71bbc992012-06-15 15:30:18 +02009417 break;
Ayala Bekercb3b7d82016-09-20 17:31:13 +03009418 case NL80211_IFTYPE_NAN:
Johannes Berg71bbc992012-06-15 15:30:18 +02009419 default:
Johannes Berg4c476992010-10-04 21:36:35 +02009420 return -EOPNOTSUPP;
Johannes Berg71bbc992012-06-15 15:30:18 +02009421 }
Jouni Malinen026331c2010-02-15 12:53:10 +02009422
9423 /* not much point in registering if we can't reply */
Johannes Berg4c476992010-10-04 21:36:35 +02009424 if (!rdev->ops->mgmt_tx)
9425 return -EOPNOTSUPP;
Jouni Malinen026331c2010-02-15 12:53:10 +02009426
Eric W. Biederman15e47302012-09-07 20:12:54 +00009427 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
Jouni Malinen026331c2010-02-15 12:53:10 +02009428 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
9429 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
Jouni Malinen026331c2010-02-15 12:53:10 +02009430}
9431
Johannes Berg2e161f72010-08-12 15:38:38 +02009432static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
Jouni Malinen026331c2010-02-15 12:53:10 +02009433{
Johannes Berg4c476992010-10-04 21:36:35 +02009434 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg71bbc992012-06-15 15:30:18 +02009435 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg683b6d32012-11-08 21:25:48 +01009436 struct cfg80211_chan_def chandef;
Jouni Malinen026331c2010-02-15 12:53:10 +02009437 int err;
Johannes Bergd64d3732011-11-10 09:44:46 +01009438 void *hdr = NULL;
Jouni Malinen026331c2010-02-15 12:53:10 +02009439 u64 cookie;
Johannes Berge247bd902011-11-04 11:18:21 +01009440 struct sk_buff *msg = NULL;
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009441 struct cfg80211_mgmt_tx_params params = {
9442 .dont_wait_for_ack =
9443 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
9444 };
Jouni Malinen026331c2010-02-15 12:53:10 +02009445
Johannes Berg683b6d32012-11-08 21:25:48 +01009446 if (!info->attrs[NL80211_ATTR_FRAME])
Jouni Malinen026331c2010-02-15 12:53:10 +02009447 return -EINVAL;
9448
Johannes Berg4c476992010-10-04 21:36:35 +02009449 if (!rdev->ops->mgmt_tx)
9450 return -EOPNOTSUPP;
Jouni Malinen026331c2010-02-15 12:53:10 +02009451
Johannes Berg71bbc992012-06-15 15:30:18 +02009452 switch (wdev->iftype) {
Antonio Quartulliea141b752013-06-11 14:20:03 +02009453 case NL80211_IFTYPE_P2P_DEVICE:
9454 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
9455 return -EINVAL;
Johannes Berg71bbc992012-06-15 15:30:18 +02009456 case NL80211_IFTYPE_STATION:
9457 case NL80211_IFTYPE_ADHOC:
9458 case NL80211_IFTYPE_P2P_CLIENT:
9459 case NL80211_IFTYPE_AP:
9460 case NL80211_IFTYPE_AP_VLAN:
9461 case NL80211_IFTYPE_MESH_POINT:
9462 case NL80211_IFTYPE_P2P_GO:
9463 break;
Ayala Bekercb3b7d82016-09-20 17:31:13 +03009464 case NL80211_IFTYPE_NAN:
Johannes Berg71bbc992012-06-15 15:30:18 +02009465 default:
Johannes Berg4c476992010-10-04 21:36:35 +02009466 return -EOPNOTSUPP;
Johannes Berg71bbc992012-06-15 15:30:18 +02009467 }
Jouni Malinen026331c2010-02-15 12:53:10 +02009468
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009469 if (info->attrs[NL80211_ATTR_DURATION]) {
Johannes Berg7c4ef712011-11-18 15:33:48 +01009470 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009471 return -EINVAL;
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009472 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
Johannes Bergebf348f2012-06-01 12:50:54 +02009473
9474 /*
9475 * We should wait on the channel for at least a minimum amount
9476 * of time (10ms) but no longer than the driver supports.
9477 */
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009478 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9479 params.wait > rdev->wiphy.max_remain_on_channel_duration)
Johannes Bergebf348f2012-06-01 12:50:54 +02009480 return -EINVAL;
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009481 }
9482
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009483 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009484
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009485 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
Johannes Berg7c4ef712011-11-18 15:33:48 +01009486 return -EINVAL;
9487
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009488 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
Rajkumar Manoharane9f935e2011-09-25 14:53:30 +05309489
Antonio Quartulliea141b752013-06-11 14:20:03 +02009490 /* get the channel if any has been specified, otherwise pass NULL to
9491 * the driver. The latter will use the current one
9492 */
9493 chandef.chan = NULL;
9494 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9495 err = nl80211_parse_chandef(rdev, info, &chandef);
9496 if (err)
9497 return err;
9498 }
9499
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009500 if (!chandef.chan && params.offchan)
Antonio Quartulliea141b752013-06-11 14:20:03 +02009501 return -EINVAL;
Jouni Malinen026331c2010-02-15 12:53:10 +02009502
Andrei Otcheretianski34d22ce2014-05-09 14:11:44 +03009503 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
9504 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
9505
9506 if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
9507 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9508 int i;
9509
9510 if (len % sizeof(u16))
9511 return -EINVAL;
9512
9513 params.n_csa_offsets = len / sizeof(u16);
9514 params.csa_offsets =
9515 nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9516
9517 /* check that all the offsets fit the frame */
9518 for (i = 0; i < params.n_csa_offsets; i++) {
9519 if (params.csa_offsets[i] >= params.len)
9520 return -EINVAL;
9521 }
9522 }
9523
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009524 if (!params.dont_wait_for_ack) {
Johannes Berge247bd902011-11-04 11:18:21 +01009525 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9526 if (!msg)
9527 return -ENOMEM;
Jouni Malinen026331c2010-02-15 12:53:10 +02009528
Eric W. Biederman15e47302012-09-07 20:12:54 +00009529 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Johannes Berge247bd902011-11-04 11:18:21 +01009530 NL80211_CMD_FRAME);
Dan Carpentercb35fba2013-08-14 14:50:01 +03009531 if (!hdr) {
9532 err = -ENOBUFS;
Johannes Berge247bd902011-11-04 11:18:21 +01009533 goto free_msg;
9534 }
Jouni Malinen026331c2010-02-15 12:53:10 +02009535 }
Johannes Berge247bd902011-11-04 11:18:21 +01009536
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009537 params.chan = chandef.chan;
9538 err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
Jouni Malinen026331c2010-02-15 12:53:10 +02009539 if (err)
9540 goto free_msg;
9541
Johannes Berge247bd902011-11-04 11:18:21 +01009542 if (msg) {
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02009543 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
9544 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04009545 goto nla_put_failure;
Jouni Malinen026331c2010-02-15 12:53:10 +02009546
Johannes Berge247bd902011-11-04 11:18:21 +01009547 genlmsg_end(msg, hdr);
9548 return genlmsg_reply(msg, info);
9549 }
9550
9551 return 0;
Jouni Malinen026331c2010-02-15 12:53:10 +02009552
9553 nla_put_failure:
9554 err = -ENOBUFS;
9555 free_msg:
9556 nlmsg_free(msg);
Jouni Malinen026331c2010-02-15 12:53:10 +02009557 return err;
9558}
9559
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009560static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
9561{
9562 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg71bbc992012-06-15 15:30:18 +02009563 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009564 u64 cookie;
9565
9566 if (!info->attrs[NL80211_ATTR_COOKIE])
9567 return -EINVAL;
9568
9569 if (!rdev->ops->mgmt_tx_cancel_wait)
9570 return -EOPNOTSUPP;
9571
Johannes Berg71bbc992012-06-15 15:30:18 +02009572 switch (wdev->iftype) {
9573 case NL80211_IFTYPE_STATION:
9574 case NL80211_IFTYPE_ADHOC:
9575 case NL80211_IFTYPE_P2P_CLIENT:
9576 case NL80211_IFTYPE_AP:
9577 case NL80211_IFTYPE_AP_VLAN:
9578 case NL80211_IFTYPE_P2P_GO:
Johannes Berg98104fde2012-06-16 00:19:54 +02009579 case NL80211_IFTYPE_P2P_DEVICE:
Johannes Berg71bbc992012-06-15 15:30:18 +02009580 break;
Ayala Bekercb3b7d82016-09-20 17:31:13 +03009581 case NL80211_IFTYPE_NAN:
Johannes Berg71bbc992012-06-15 15:30:18 +02009582 default:
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009583 return -EOPNOTSUPP;
Johannes Berg71bbc992012-06-15 15:30:18 +02009584 }
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009585
9586 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
9587
Hila Gonene35e4d22012-06-27 17:19:42 +03009588 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009589}
9590
Kalle Valoffb9eb32010-02-17 17:58:10 +02009591static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
9592{
Johannes Berg4c476992010-10-04 21:36:35 +02009593 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Kalle Valoffb9eb32010-02-17 17:58:10 +02009594 struct wireless_dev *wdev;
Johannes Berg4c476992010-10-04 21:36:35 +02009595 struct net_device *dev = info->user_ptr[1];
Kalle Valoffb9eb32010-02-17 17:58:10 +02009596 u8 ps_state;
9597 bool state;
9598 int err;
9599
Johannes Berg4c476992010-10-04 21:36:35 +02009600 if (!info->attrs[NL80211_ATTR_PS_STATE])
9601 return -EINVAL;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009602
9603 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
9604
Johannes Berg4c476992010-10-04 21:36:35 +02009605 if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
9606 return -EINVAL;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009607
9608 wdev = dev->ieee80211_ptr;
9609
Johannes Berg4c476992010-10-04 21:36:35 +02009610 if (!rdev->ops->set_power_mgmt)
9611 return -EOPNOTSUPP;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009612
9613 state = (ps_state == NL80211_PS_ENABLED) ? true : false;
9614
9615 if (state == wdev->ps)
Johannes Berg4c476992010-10-04 21:36:35 +02009616 return 0;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009617
Hila Gonene35e4d22012-06-27 17:19:42 +03009618 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
Johannes Berg4c476992010-10-04 21:36:35 +02009619 if (!err)
9620 wdev->ps = state;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009621 return err;
9622}
9623
9624static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
9625{
Johannes Berg4c476992010-10-04 21:36:35 +02009626 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Kalle Valoffb9eb32010-02-17 17:58:10 +02009627 enum nl80211_ps_state ps_state;
9628 struct wireless_dev *wdev;
Johannes Berg4c476992010-10-04 21:36:35 +02009629 struct net_device *dev = info->user_ptr[1];
Kalle Valoffb9eb32010-02-17 17:58:10 +02009630 struct sk_buff *msg;
9631 void *hdr;
9632 int err;
9633
Kalle Valoffb9eb32010-02-17 17:58:10 +02009634 wdev = dev->ieee80211_ptr;
9635
Johannes Berg4c476992010-10-04 21:36:35 +02009636 if (!rdev->ops->set_power_mgmt)
9637 return -EOPNOTSUPP;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009638
9639 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg4c476992010-10-04 21:36:35 +02009640 if (!msg)
9641 return -ENOMEM;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009642
Eric W. Biederman15e47302012-09-07 20:12:54 +00009643 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Kalle Valoffb9eb32010-02-17 17:58:10 +02009644 NL80211_CMD_GET_POWER_SAVE);
9645 if (!hdr) {
Johannes Berg4c476992010-10-04 21:36:35 +02009646 err = -ENOBUFS;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009647 goto free_msg;
9648 }
9649
9650 if (wdev->ps)
9651 ps_state = NL80211_PS_ENABLED;
9652 else
9653 ps_state = NL80211_PS_DISABLED;
9654
David S. Miller9360ffd2012-03-29 04:41:26 -04009655 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
9656 goto nla_put_failure;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009657
9658 genlmsg_end(msg, hdr);
Johannes Berg4c476992010-10-04 21:36:35 +02009659 return genlmsg_reply(msg, info);
Kalle Valoffb9eb32010-02-17 17:58:10 +02009660
Johannes Berg4c476992010-10-04 21:36:35 +02009661 nla_put_failure:
Kalle Valoffb9eb32010-02-17 17:58:10 +02009662 err = -ENOBUFS;
Johannes Berg4c476992010-10-04 21:36:35 +02009663 free_msg:
Kalle Valoffb9eb32010-02-17 17:58:10 +02009664 nlmsg_free(msg);
Kalle Valoffb9eb32010-02-17 17:58:10 +02009665 return err;
9666}
9667
Johannes Berg94e860f2014-01-20 23:58:15 +01009668static const struct nla_policy
9669nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009670 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
9671 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
9672 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
Thomas Pedersen84f10702012-07-12 16:17:33 -07009673 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
9674 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
9675 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009676};
9677
Thomas Pedersen84f10702012-07-12 16:17:33 -07009678static int nl80211_set_cqm_txe(struct genl_info *info,
Johannes Bergd9d8b012012-11-26 12:51:52 +01009679 u32 rate, u32 pkts, u32 intvl)
Thomas Pedersen84f10702012-07-12 16:17:33 -07009680{
9681 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Thomas Pedersen84f10702012-07-12 16:17:33 -07009682 struct net_device *dev = info->user_ptr[1];
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009683 struct wireless_dev *wdev = dev->ieee80211_ptr;
Thomas Pedersen84f10702012-07-12 16:17:33 -07009684
Johannes Bergd9d8b012012-11-26 12:51:52 +01009685 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
Thomas Pedersen84f10702012-07-12 16:17:33 -07009686 return -EINVAL;
9687
Thomas Pedersen84f10702012-07-12 16:17:33 -07009688 if (!rdev->ops->set_cqm_txe_config)
9689 return -EOPNOTSUPP;
9690
9691 if (wdev->iftype != NL80211_IFTYPE_STATION &&
9692 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9693 return -EOPNOTSUPP;
9694
Hila Gonene35e4d22012-06-27 17:19:42 +03009695 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
Thomas Pedersen84f10702012-07-12 16:17:33 -07009696}
9697
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009698static int nl80211_set_cqm_rssi(struct genl_info *info,
9699 s32 threshold, u32 hysteresis)
9700{
Johannes Berg4c476992010-10-04 21:36:35 +02009701 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg4c476992010-10-04 21:36:35 +02009702 struct net_device *dev = info->user_ptr[1];
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009703 struct wireless_dev *wdev = dev->ieee80211_ptr;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009704
9705 if (threshold > 0)
9706 return -EINVAL;
9707
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009708 /* disabling - hysteresis should also be zero then */
9709 if (threshold == 0)
9710 hysteresis = 0;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009711
Johannes Berg4c476992010-10-04 21:36:35 +02009712 if (!rdev->ops->set_cqm_rssi_config)
9713 return -EOPNOTSUPP;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009714
Johannes Berg074ac8d2010-09-16 14:58:22 +02009715 if (wdev->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02009716 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9717 return -EOPNOTSUPP;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009718
Hila Gonene35e4d22012-06-27 17:19:42 +03009719 return rdev_set_cqm_rssi_config(rdev, dev, threshold, hysteresis);
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009720}
9721
9722static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
9723{
9724 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
9725 struct nlattr *cqm;
9726 int err;
9727
9728 cqm = info->attrs[NL80211_ATTR_CQM];
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009729 if (!cqm)
9730 return -EINVAL;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009731
9732 err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
9733 nl80211_attr_cqm_policy);
9734 if (err)
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009735 return err;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009736
9737 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
9738 attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009739 s32 threshold = nla_get_s32(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
9740 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009741
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009742 return nl80211_set_cqm_rssi(info, threshold, hysteresis);
9743 }
9744
9745 if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
9746 attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
9747 attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
9748 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
9749 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
9750 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
9751
9752 return nl80211_set_cqm_txe(info, rate, pkts, intvl);
9753 }
9754
9755 return -EINVAL;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009756}
9757
Rostislav Lisovy6e0bd6c2014-11-03 10:33:18 +01009758static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
9759{
9760 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9761 struct net_device *dev = info->user_ptr[1];
9762 struct ocb_setup setup = {};
9763 int err;
9764
9765 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
9766 if (err)
9767 return err;
9768
9769 return cfg80211_join_ocb(rdev, dev, &setup);
9770}
9771
9772static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
9773{
9774 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9775 struct net_device *dev = info->user_ptr[1];
9776
9777 return cfg80211_leave_ocb(rdev, dev);
9778}
9779
Johannes Berg29cbe682010-12-03 09:20:44 +01009780static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
9781{
9782 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9783 struct net_device *dev = info->user_ptr[1];
9784 struct mesh_config cfg;
Javier Cardonac80d5452010-12-16 17:37:49 -08009785 struct mesh_setup setup;
Johannes Berg29cbe682010-12-03 09:20:44 +01009786 int err;
9787
9788 /* start with default */
9789 memcpy(&cfg, &default_mesh_config, sizeof(cfg));
Javier Cardonac80d5452010-12-16 17:37:49 -08009790 memcpy(&setup, &default_mesh_setup, sizeof(setup));
Johannes Berg29cbe682010-12-03 09:20:44 +01009791
Javier Cardona24bdd9f2010-12-16 17:37:48 -08009792 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
Johannes Berg29cbe682010-12-03 09:20:44 +01009793 /* and parse parameters if given */
Javier Cardona24bdd9f2010-12-16 17:37:48 -08009794 err = nl80211_parse_mesh_config(info, &cfg, NULL);
Johannes Berg29cbe682010-12-03 09:20:44 +01009795 if (err)
9796 return err;
9797 }
9798
9799 if (!info->attrs[NL80211_ATTR_MESH_ID] ||
9800 !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
9801 return -EINVAL;
9802
Javier Cardonac80d5452010-12-16 17:37:49 -08009803 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
9804 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
9805
Chun-Yeow Yeoh4bb62342011-11-24 17:15:20 -08009806 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
9807 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
9808 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
9809 return -EINVAL;
9810
Marco Porsch9bdbf042013-01-07 16:04:51 +01009811 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
9812 setup.beacon_interval =
9813 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
Purushottam Kushwaha12d20fc92016-08-11 15:14:02 +05309814
Purushottam Kushwahac6800ff2016-10-12 18:26:51 +05309815 err = cfg80211_validate_beacon_int(rdev,
9816 NL80211_IFTYPE_MESH_POINT,
9817 setup.beacon_interval);
Purushottam Kushwaha12d20fc92016-08-11 15:14:02 +05309818 if (err)
9819 return err;
Marco Porsch9bdbf042013-01-07 16:04:51 +01009820 }
9821
9822 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
9823 setup.dtim_period =
9824 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
9825 if (setup.dtim_period < 1 || setup.dtim_period > 100)
9826 return -EINVAL;
9827 }
9828
Javier Cardonac80d5452010-12-16 17:37:49 -08009829 if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
9830 /* parse additional setup parameters if given */
9831 err = nl80211_parse_mesh_setup(info, &setup);
9832 if (err)
9833 return err;
9834 }
9835
Thomas Pedersend37bb182013-03-04 13:06:13 -08009836 if (setup.user_mpm)
9837 cfg.auto_open_plinks = false;
9838
Johannes Bergcc1d2802012-05-16 23:50:20 +02009839 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
Johannes Berg683b6d32012-11-08 21:25:48 +01009840 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
9841 if (err)
9842 return err;
Johannes Bergcc1d2802012-05-16 23:50:20 +02009843 } else {
9844 /* cfg80211_join_mesh() will sort it out */
Johannes Berg683b6d32012-11-08 21:25:48 +01009845 setup.chandef.chan = NULL;
Johannes Bergcc1d2802012-05-16 23:50:20 +02009846 }
9847
Ashok Nagarajanffb3cf32013-06-03 10:33:36 -07009848 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
9849 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9850 int n_rates =
9851 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9852 struct ieee80211_supported_band *sband;
9853
9854 if (!setup.chandef.chan)
9855 return -EINVAL;
9856
9857 sband = rdev->wiphy.bands[setup.chandef.chan->band];
9858
9859 err = ieee80211_get_ratemask(sband, rates, n_rates,
9860 &setup.basic_rates);
9861 if (err)
9862 return err;
9863 }
9864
Johannes Berg8564e382016-09-19 09:44:44 +02009865 if (info->attrs[NL80211_ATTR_TX_RATES]) {
9866 err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
9867 if (err)
9868 return err;
9869
Johannes Berg091eac32017-09-18 22:46:36 +02009870 if (!setup.chandef.chan)
9871 return -EINVAL;
9872
Johannes Berg8564e382016-09-19 09:44:44 +02009873 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
9874 &setup.beacon_rate);
9875 if (err)
9876 return err;
9877 }
9878
Javier Cardonac80d5452010-12-16 17:37:49 -08009879 return cfg80211_join_mesh(rdev, dev, &setup, &cfg);
Johannes Berg29cbe682010-12-03 09:20:44 +01009880}
9881
9882static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
9883{
9884 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9885 struct net_device *dev = info->user_ptr[1];
9886
9887 return cfg80211_leave_mesh(rdev, dev);
9888}
9889
Johannes Bergdfb89c52012-06-27 09:23:48 +02009890#ifdef CONFIG_PM
Amitkumar Karwarbb92d192013-02-12 12:16:26 -08009891static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
9892 struct cfg80211_registered_device *rdev)
9893{
Johannes Berg6abb9cb2013-05-15 09:30:07 +02009894 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
Amitkumar Karwarbb92d192013-02-12 12:16:26 -08009895 struct nlattr *nl_pats, *nl_pat;
9896 int i, pat_len;
9897
Johannes Berg6abb9cb2013-05-15 09:30:07 +02009898 if (!wowlan->n_patterns)
Amitkumar Karwarbb92d192013-02-12 12:16:26 -08009899 return 0;
9900
9901 nl_pats = nla_nest_start(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
9902 if (!nl_pats)
9903 return -ENOBUFS;
9904
Johannes Berg6abb9cb2013-05-15 09:30:07 +02009905 for (i = 0; i < wowlan->n_patterns; i++) {
Amitkumar Karwarbb92d192013-02-12 12:16:26 -08009906 nl_pat = nla_nest_start(msg, i + 1);
9907 if (!nl_pat)
9908 return -ENOBUFS;
Johannes Berg6abb9cb2013-05-15 09:30:07 +02009909 pat_len = wowlan->patterns[i].pattern_len;
Amitkumar Karwar50ac6602013-06-25 19:03:56 -07009910 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
Johannes Berg6abb9cb2013-05-15 09:30:07 +02009911 wowlan->patterns[i].mask) ||
Amitkumar Karwar50ac6602013-06-25 19:03:56 -07009912 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
9913 wowlan->patterns[i].pattern) ||
9914 nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
Johannes Berg6abb9cb2013-05-15 09:30:07 +02009915 wowlan->patterns[i].pkt_offset))
Amitkumar Karwarbb92d192013-02-12 12:16:26 -08009916 return -ENOBUFS;
9917 nla_nest_end(msg, nl_pat);
9918 }
9919 nla_nest_end(msg, nl_pats);
9920
9921 return 0;
9922}
9923
Johannes Berg2a0e0472013-01-23 22:57:40 +01009924static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
9925 struct cfg80211_wowlan_tcp *tcp)
9926{
9927 struct nlattr *nl_tcp;
9928
9929 if (!tcp)
9930 return 0;
9931
9932 nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
9933 if (!nl_tcp)
9934 return -ENOBUFS;
9935
Jiri Benc930345e2015-03-29 16:59:25 +02009936 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
9937 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
Johannes Berg2a0e0472013-01-23 22:57:40 +01009938 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
9939 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
9940 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
9941 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
9942 tcp->payload_len, tcp->payload) ||
9943 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
9944 tcp->data_interval) ||
9945 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
9946 tcp->wake_len, tcp->wake_data) ||
9947 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
9948 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
9949 return -ENOBUFS;
9950
9951 if (tcp->payload_seq.len &&
9952 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
9953 sizeof(tcp->payload_seq), &tcp->payload_seq))
9954 return -ENOBUFS;
9955
9956 if (tcp->payload_tok.len &&
9957 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
9958 sizeof(tcp->payload_tok) + tcp->tokens_size,
9959 &tcp->payload_tok))
9960 return -ENOBUFS;
9961
Johannes Berge248ad32013-05-16 10:24:28 +02009962 nla_nest_end(msg, nl_tcp);
9963
Johannes Berg2a0e0472013-01-23 22:57:40 +01009964 return 0;
9965}
9966
Luciano Coelho75453cc2015-01-09 14:06:37 +02009967static int nl80211_send_wowlan_nd(struct sk_buff *msg,
9968 struct cfg80211_sched_scan_request *req)
9969{
Avraham Stern3b06d272015-10-12 09:51:34 +03009970 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
Luciano Coelho75453cc2015-01-09 14:06:37 +02009971 int i;
9972
9973 if (!req)
9974 return 0;
9975
9976 nd = nla_nest_start(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
9977 if (!nd)
9978 return -ENOBUFS;
9979
Avraham Stern3b06d272015-10-12 09:51:34 +03009980 if (req->n_scan_plans == 1 &&
9981 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
9982 req->scan_plans[0].interval * 1000))
Luciano Coelho75453cc2015-01-09 14:06:37 +02009983 return -ENOBUFS;
9984
Luciano Coelho21fea562015-03-17 16:36:01 +02009985 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
9986 return -ENOBUFS;
9987
vamsi krishnaf4f1a542017-01-13 01:12:20 +02009988 if (req->relative_rssi_set) {
9989 struct nl80211_bss_select_rssi_adjust rssi_adjust;
9990
9991 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
9992 req->relative_rssi))
9993 return -ENOBUFS;
9994
9995 rssi_adjust.band = req->rssi_adjust.band;
9996 rssi_adjust.delta = req->rssi_adjust.delta;
9997 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
9998 sizeof(rssi_adjust), &rssi_adjust))
9999 return -ENOBUFS;
10000 }
10001
Luciano Coelho75453cc2015-01-09 14:06:37 +020010002 freqs = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
10003 if (!freqs)
10004 return -ENOBUFS;
10005
Johannes Berg53b18982016-09-14 09:59:21 +020010006 for (i = 0; i < req->n_channels; i++) {
10007 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
10008 return -ENOBUFS;
10009 }
Luciano Coelho75453cc2015-01-09 14:06:37 +020010010
10011 nla_nest_end(msg, freqs);
10012
10013 if (req->n_match_sets) {
10014 matches = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_MATCH);
Johannes Berg76e1fb42016-09-14 09:55:57 +020010015 if (!matches)
10016 return -ENOBUFS;
10017
Luciano Coelho75453cc2015-01-09 14:06:37 +020010018 for (i = 0; i < req->n_match_sets; i++) {
10019 match = nla_nest_start(msg, i);
Johannes Berg76e1fb42016-09-14 09:55:57 +020010020 if (!match)
10021 return -ENOBUFS;
10022
Johannes Berg53b18982016-09-14 09:59:21 +020010023 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
10024 req->match_sets[i].ssid.ssid_len,
10025 req->match_sets[i].ssid.ssid))
10026 return -ENOBUFS;
Luciano Coelho75453cc2015-01-09 14:06:37 +020010027 nla_nest_end(msg, match);
10028 }
10029 nla_nest_end(msg, matches);
10030 }
10031
Avraham Stern3b06d272015-10-12 09:51:34 +030010032 scan_plans = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
10033 if (!scan_plans)
10034 return -ENOBUFS;
10035
10036 for (i = 0; i < req->n_scan_plans; i++) {
10037 scan_plan = nla_nest_start(msg, i + 1);
Johannes Berg76e1fb42016-09-14 09:55:57 +020010038 if (!scan_plan)
10039 return -ENOBUFS;
10040
Avraham Stern3b06d272015-10-12 09:51:34 +030010041 if (!scan_plan ||
10042 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
10043 req->scan_plans[i].interval) ||
10044 (req->scan_plans[i].iterations &&
10045 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
10046 req->scan_plans[i].iterations)))
10047 return -ENOBUFS;
10048 nla_nest_end(msg, scan_plan);
10049 }
10050 nla_nest_end(msg, scan_plans);
10051
Luciano Coelho75453cc2015-01-09 14:06:37 +020010052 nla_nest_end(msg, nd);
10053
10054 return 0;
10055}
10056
Johannes Bergff1b6e62011-05-04 15:37:28 +020010057static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
10058{
10059 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10060 struct sk_buff *msg;
10061 void *hdr;
Johannes Berg2a0e0472013-01-23 22:57:40 +010010062 u32 size = NLMSG_DEFAULT_SIZE;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010063
Johannes Berg964dc9e2013-06-03 17:25:34 +020010064 if (!rdev->wiphy.wowlan)
Johannes Bergff1b6e62011-05-04 15:37:28 +020010065 return -EOPNOTSUPP;
10066
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010067 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
Johannes Berg2a0e0472013-01-23 22:57:40 +010010068 /* adjust size to have room for all the data */
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010069 size += rdev->wiphy.wowlan_config->tcp->tokens_size +
10070 rdev->wiphy.wowlan_config->tcp->payload_len +
10071 rdev->wiphy.wowlan_config->tcp->wake_len +
10072 rdev->wiphy.wowlan_config->tcp->wake_len / 8;
Johannes Berg2a0e0472013-01-23 22:57:40 +010010073 }
10074
10075 msg = nlmsg_new(size, GFP_KERNEL);
Johannes Bergff1b6e62011-05-04 15:37:28 +020010076 if (!msg)
10077 return -ENOMEM;
10078
Eric W. Biederman15e47302012-09-07 20:12:54 +000010079 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Johannes Bergff1b6e62011-05-04 15:37:28 +020010080 NL80211_CMD_GET_WOWLAN);
10081 if (!hdr)
10082 goto nla_put_failure;
10083
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010084 if (rdev->wiphy.wowlan_config) {
Johannes Bergff1b6e62011-05-04 15:37:28 +020010085 struct nlattr *nl_wowlan;
10086
10087 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
10088 if (!nl_wowlan)
10089 goto nla_put_failure;
10090
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010091 if ((rdev->wiphy.wowlan_config->any &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010092 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010093 (rdev->wiphy.wowlan_config->disconnect &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010094 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010095 (rdev->wiphy.wowlan_config->magic_pkt &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010096 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010097 (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010098 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010099 (rdev->wiphy.wowlan_config->eap_identity_req &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010100 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010101 (rdev->wiphy.wowlan_config->four_way_handshake &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010102 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010103 (rdev->wiphy.wowlan_config->rfkill_release &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010104 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
10105 goto nla_put_failure;
Johannes Berg2a0e0472013-01-23 22:57:40 +010010106
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010107 if (nl80211_send_wowlan_patterns(msg, rdev))
10108 goto nla_put_failure;
Johannes Berg2a0e0472013-01-23 22:57:40 +010010109
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010110 if (nl80211_send_wowlan_tcp(msg,
10111 rdev->wiphy.wowlan_config->tcp))
Johannes Berg2a0e0472013-01-23 22:57:40 +010010112 goto nla_put_failure;
10113
Luciano Coelho75453cc2015-01-09 14:06:37 +020010114 if (nl80211_send_wowlan_nd(
10115 msg,
10116 rdev->wiphy.wowlan_config->nd_config))
10117 goto nla_put_failure;
10118
Johannes Bergff1b6e62011-05-04 15:37:28 +020010119 nla_nest_end(msg, nl_wowlan);
10120 }
10121
10122 genlmsg_end(msg, hdr);
10123 return genlmsg_reply(msg, info);
10124
10125nla_put_failure:
10126 nlmsg_free(msg);
10127 return -ENOBUFS;
10128}
10129
Johannes Berg2a0e0472013-01-23 22:57:40 +010010130static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
10131 struct nlattr *attr,
10132 struct cfg80211_wowlan *trig)
10133{
10134 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
10135 struct cfg80211_wowlan_tcp *cfg;
10136 struct nl80211_wowlan_tcp_data_token *tok = NULL;
10137 struct nl80211_wowlan_tcp_data_seq *seq = NULL;
10138 u32 size;
10139 u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
10140 int err, port;
10141
Johannes Berg964dc9e2013-06-03 17:25:34 +020010142 if (!rdev->wiphy.wowlan->tcp)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010143 return -EINVAL;
10144
10145 err = nla_parse(tb, MAX_NL80211_WOWLAN_TCP,
10146 nla_data(attr), nla_len(attr),
10147 nl80211_wowlan_tcp_policy);
10148 if (err)
10149 return err;
10150
10151 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
10152 !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
10153 !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
10154 !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
10155 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
10156 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
10157 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
10158 !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
10159 return -EINVAL;
10160
10161 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
Johannes Berg964dc9e2013-06-03 17:25:34 +020010162 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010163 return -EINVAL;
10164
10165 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
Johannes Berg964dc9e2013-06-03 17:25:34 +020010166 rdev->wiphy.wowlan->tcp->data_interval_max ||
Johannes Berg723d5682013-02-26 13:56:40 +010010167 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010168 return -EINVAL;
10169
10170 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
Johannes Berg964dc9e2013-06-03 17:25:34 +020010171 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010172 return -EINVAL;
10173
10174 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
10175 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
10176 return -EINVAL;
10177
10178 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
10179 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
10180
10181 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
10182 tokens_size = tokln - sizeof(*tok);
10183
10184 if (!tok->len || tokens_size % tok->len)
10185 return -EINVAL;
Johannes Berg964dc9e2013-06-03 17:25:34 +020010186 if (!rdev->wiphy.wowlan->tcp->tok)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010187 return -EINVAL;
Johannes Berg964dc9e2013-06-03 17:25:34 +020010188 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010189 return -EINVAL;
Johannes Berg964dc9e2013-06-03 17:25:34 +020010190 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010191 return -EINVAL;
Johannes Berg964dc9e2013-06-03 17:25:34 +020010192 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010193 return -EINVAL;
10194 if (tok->offset + tok->len > data_size)
10195 return -EINVAL;
10196 }
10197
10198 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
10199 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
Johannes Berg964dc9e2013-06-03 17:25:34 +020010200 if (!rdev->wiphy.wowlan->tcp->seq)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010201 return -EINVAL;
10202 if (seq->len == 0 || seq->len > 4)
10203 return -EINVAL;
10204 if (seq->len + seq->offset > data_size)
10205 return -EINVAL;
10206 }
10207
10208 size = sizeof(*cfg);
10209 size += data_size;
10210 size += wake_size + wake_mask_size;
10211 size += tokens_size;
10212
10213 cfg = kzalloc(size, GFP_KERNEL);
10214 if (!cfg)
10215 return -ENOMEM;
Jiri Benc67b61f62015-03-29 16:59:26 +020010216 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
10217 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
Johannes Berg2a0e0472013-01-23 22:57:40 +010010218 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
10219 ETH_ALEN);
10220 if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
10221 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
10222 else
10223 port = 0;
10224#ifdef CONFIG_INET
10225 /* allocate a socket and port for it and use it */
10226 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
10227 IPPROTO_TCP, &cfg->sock, 1);
10228 if (err) {
10229 kfree(cfg);
10230 return err;
10231 }
10232 if (inet_csk_get_port(cfg->sock->sk, port)) {
10233 sock_release(cfg->sock);
10234 kfree(cfg);
10235 return -EADDRINUSE;
10236 }
10237 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
10238#else
10239 if (!port) {
10240 kfree(cfg);
10241 return -EINVAL;
10242 }
10243 cfg->src_port = port;
10244#endif
10245
10246 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
10247 cfg->payload_len = data_size;
10248 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
10249 memcpy((void *)cfg->payload,
10250 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
10251 data_size);
10252 if (seq)
10253 cfg->payload_seq = *seq;
10254 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
10255 cfg->wake_len = wake_size;
10256 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
10257 memcpy((void *)cfg->wake_data,
10258 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
10259 wake_size);
10260 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
10261 data_size + wake_size;
10262 memcpy((void *)cfg->wake_mask,
10263 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
10264 wake_mask_size);
10265 if (tok) {
10266 cfg->tokens_size = tokens_size;
10267 memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
10268 }
10269
10270 trig->tcp = cfg;
10271
10272 return 0;
10273}
10274
Luciano Coelho8cd4d452014-09-17 11:55:28 +030010275static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
10276 const struct wiphy_wowlan_support *wowlan,
10277 struct nlattr *attr,
10278 struct cfg80211_wowlan *trig)
10279{
10280 struct nlattr **tb;
10281 int err;
10282
10283 tb = kzalloc(NUM_NL80211_ATTR * sizeof(*tb), GFP_KERNEL);
10284 if (!tb)
10285 return -ENOMEM;
10286
10287 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
10288 err = -EOPNOTSUPP;
10289 goto out;
10290 }
10291
10292 err = nla_parse(tb, NL80211_ATTR_MAX,
10293 nla_data(attr), nla_len(attr),
10294 nl80211_policy);
10295 if (err)
10296 goto out;
10297
Johannes Bergad2b26a2014-06-12 21:39:05 +020010298 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb);
Luciano Coelho8cd4d452014-09-17 11:55:28 +030010299 err = PTR_ERR_OR_ZERO(trig->nd_config);
10300 if (err)
10301 trig->nd_config = NULL;
10302
10303out:
10304 kfree(tb);
10305 return err;
10306}
10307
Johannes Bergff1b6e62011-05-04 15:37:28 +020010308static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
10309{
10310 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10311 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
Johannes Bergff1b6e62011-05-04 15:37:28 +020010312 struct cfg80211_wowlan new_triggers = {};
Johannes Bergae33bd82012-07-12 16:25:02 +020010313 struct cfg80211_wowlan *ntrig;
Johannes Berg964dc9e2013-06-03 17:25:34 +020010314 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010315 int err, i;
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010316 bool prev_enabled = rdev->wiphy.wowlan_config;
Johannes Berg98fc4382015-03-01 09:10:13 +020010317 bool regular = false;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010318
Johannes Berg964dc9e2013-06-03 17:25:34 +020010319 if (!wowlan)
Johannes Bergff1b6e62011-05-04 15:37:28 +020010320 return -EOPNOTSUPP;
10321
Johannes Bergae33bd82012-07-12 16:25:02 +020010322 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
10323 cfg80211_rdev_free_wowlan(rdev);
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010324 rdev->wiphy.wowlan_config = NULL;
Johannes Bergae33bd82012-07-12 16:25:02 +020010325 goto set_wakeup;
10326 }
Johannes Bergff1b6e62011-05-04 15:37:28 +020010327
10328 err = nla_parse(tb, MAX_NL80211_WOWLAN_TRIG,
10329 nla_data(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
10330 nla_len(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
10331 nl80211_wowlan_policy);
10332 if (err)
10333 return err;
10334
10335 if (tb[NL80211_WOWLAN_TRIG_ANY]) {
10336 if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
10337 return -EINVAL;
10338 new_triggers.any = true;
10339 }
10340
10341 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
10342 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
10343 return -EINVAL;
10344 new_triggers.disconnect = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010345 regular = true;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010346 }
10347
10348 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
10349 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
10350 return -EINVAL;
10351 new_triggers.magic_pkt = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010352 regular = true;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010353 }
10354
Johannes Berg77dbbb12011-07-13 10:48:55 +020010355 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
10356 return -EINVAL;
10357
10358 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
10359 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
10360 return -EINVAL;
10361 new_triggers.gtk_rekey_failure = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010362 regular = true;
Johannes Berg77dbbb12011-07-13 10:48:55 +020010363 }
10364
10365 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
10366 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
10367 return -EINVAL;
10368 new_triggers.eap_identity_req = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010369 regular = true;
Johannes Berg77dbbb12011-07-13 10:48:55 +020010370 }
10371
10372 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
10373 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
10374 return -EINVAL;
10375 new_triggers.four_way_handshake = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010376 regular = true;
Johannes Berg77dbbb12011-07-13 10:48:55 +020010377 }
10378
10379 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
10380 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
10381 return -EINVAL;
10382 new_triggers.rfkill_release = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010383 regular = true;
Johannes Berg77dbbb12011-07-13 10:48:55 +020010384 }
10385
Johannes Bergff1b6e62011-05-04 15:37:28 +020010386 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
10387 struct nlattr *pat;
10388 int n_patterns = 0;
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010389 int rem, pat_len, mask_len, pkt_offset;
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010390 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
Johannes Bergff1b6e62011-05-04 15:37:28 +020010391
Johannes Berg98fc4382015-03-01 09:10:13 +020010392 regular = true;
10393
Johannes Bergff1b6e62011-05-04 15:37:28 +020010394 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
10395 rem)
10396 n_patterns++;
10397 if (n_patterns > wowlan->n_patterns)
10398 return -EINVAL;
10399
10400 new_triggers.patterns = kcalloc(n_patterns,
10401 sizeof(new_triggers.patterns[0]),
10402 GFP_KERNEL);
10403 if (!new_triggers.patterns)
10404 return -ENOMEM;
10405
10406 new_triggers.n_patterns = n_patterns;
10407 i = 0;
10408
10409 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
10410 rem) {
Johannes Berg922bd802014-05-19 17:59:50 +020010411 u8 *mask_pat;
10412
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010413 nla_parse(pat_tb, MAX_NL80211_PKTPAT, nla_data(pat),
Peng Xu4ec90fd2017-10-10 13:56:53 -070010414 nla_len(pat), nl80211_packet_pattern_policy);
Johannes Bergff1b6e62011-05-04 15:37:28 +020010415 err = -EINVAL;
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010416 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10417 !pat_tb[NL80211_PKTPAT_PATTERN])
Johannes Bergff1b6e62011-05-04 15:37:28 +020010418 goto error;
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010419 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
Johannes Bergff1b6e62011-05-04 15:37:28 +020010420 mask_len = DIV_ROUND_UP(pat_len, 8);
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010421 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
Johannes Bergff1b6e62011-05-04 15:37:28 +020010422 goto error;
10423 if (pat_len > wowlan->pattern_max_len ||
10424 pat_len < wowlan->pattern_min_len)
10425 goto error;
10426
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010427 if (!pat_tb[NL80211_PKTPAT_OFFSET])
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010428 pkt_offset = 0;
10429 else
10430 pkt_offset = nla_get_u32(
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010431 pat_tb[NL80211_PKTPAT_OFFSET]);
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010432 if (pkt_offset > wowlan->max_pkt_offset)
10433 goto error;
10434 new_triggers.patterns[i].pkt_offset = pkt_offset;
10435
Johannes Berg922bd802014-05-19 17:59:50 +020010436 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10437 if (!mask_pat) {
Johannes Bergff1b6e62011-05-04 15:37:28 +020010438 err = -ENOMEM;
10439 goto error;
10440 }
Johannes Berg922bd802014-05-19 17:59:50 +020010441 new_triggers.patterns[i].mask = mask_pat;
10442 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
Johannes Bergff1b6e62011-05-04 15:37:28 +020010443 mask_len);
Johannes Berg922bd802014-05-19 17:59:50 +020010444 mask_pat += mask_len;
10445 new_triggers.patterns[i].pattern = mask_pat;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010446 new_triggers.patterns[i].pattern_len = pat_len;
Johannes Berg922bd802014-05-19 17:59:50 +020010447 memcpy(mask_pat,
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010448 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
Johannes Bergff1b6e62011-05-04 15:37:28 +020010449 pat_len);
10450 i++;
10451 }
10452 }
10453
Johannes Berg2a0e0472013-01-23 22:57:40 +010010454 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
Johannes Berg98fc4382015-03-01 09:10:13 +020010455 regular = true;
Johannes Berg2a0e0472013-01-23 22:57:40 +010010456 err = nl80211_parse_wowlan_tcp(
10457 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
10458 &new_triggers);
10459 if (err)
10460 goto error;
10461 }
10462
Luciano Coelho8cd4d452014-09-17 11:55:28 +030010463 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
Johannes Berg98fc4382015-03-01 09:10:13 +020010464 regular = true;
Luciano Coelho8cd4d452014-09-17 11:55:28 +030010465 err = nl80211_parse_wowlan_nd(
10466 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
10467 &new_triggers);
10468 if (err)
10469 goto error;
10470 }
10471
Johannes Berg98fc4382015-03-01 09:10:13 +020010472 /* The 'any' trigger means the device continues operating more or less
10473 * as in its normal operation mode and wakes up the host on most of the
10474 * normal interrupts (like packet RX, ...)
10475 * It therefore makes little sense to combine with the more constrained
10476 * wakeup trigger modes.
10477 */
10478 if (new_triggers.any && regular) {
10479 err = -EINVAL;
10480 goto error;
10481 }
10482
Johannes Bergae33bd82012-07-12 16:25:02 +020010483 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
10484 if (!ntrig) {
10485 err = -ENOMEM;
10486 goto error;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010487 }
Johannes Bergae33bd82012-07-12 16:25:02 +020010488 cfg80211_rdev_free_wowlan(rdev);
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010489 rdev->wiphy.wowlan_config = ntrig;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010490
Johannes Bergae33bd82012-07-12 16:25:02 +020010491 set_wakeup:
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010492 if (rdev->ops->set_wakeup &&
10493 prev_enabled != !!rdev->wiphy.wowlan_config)
10494 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
Johannes Berg6d525632012-04-04 15:05:25 +020010495
Johannes Bergff1b6e62011-05-04 15:37:28 +020010496 return 0;
10497 error:
10498 for (i = 0; i < new_triggers.n_patterns; i++)
10499 kfree(new_triggers.patterns[i].mask);
10500 kfree(new_triggers.patterns);
Johannes Berg2a0e0472013-01-23 22:57:40 +010010501 if (new_triggers.tcp && new_triggers.tcp->sock)
10502 sock_release(new_triggers.tcp->sock);
10503 kfree(new_triggers.tcp);
Ola Olssone5dbe072015-12-12 23:17:17 +010010504 kfree(new_triggers.nd_config);
Johannes Bergff1b6e62011-05-04 15:37:28 +020010505 return err;
10506}
Johannes Bergdfb89c52012-06-27 09:23:48 +020010507#endif
Johannes Bergff1b6e62011-05-04 15:37:28 +020010508
Amitkumar Karwarbe29b992013-06-28 11:51:26 -070010509static int nl80211_send_coalesce_rules(struct sk_buff *msg,
10510 struct cfg80211_registered_device *rdev)
10511{
10512 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
10513 int i, j, pat_len;
10514 struct cfg80211_coalesce_rules *rule;
10515
10516 if (!rdev->coalesce->n_rules)
10517 return 0;
10518
10519 nl_rules = nla_nest_start(msg, NL80211_ATTR_COALESCE_RULE);
10520 if (!nl_rules)
10521 return -ENOBUFS;
10522
10523 for (i = 0; i < rdev->coalesce->n_rules; i++) {
10524 nl_rule = nla_nest_start(msg, i + 1);
10525 if (!nl_rule)
10526 return -ENOBUFS;
10527
10528 rule = &rdev->coalesce->rules[i];
10529 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
10530 rule->delay))
10531 return -ENOBUFS;
10532
10533 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
10534 rule->condition))
10535 return -ENOBUFS;
10536
10537 nl_pats = nla_nest_start(msg,
10538 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
10539 if (!nl_pats)
10540 return -ENOBUFS;
10541
10542 for (j = 0; j < rule->n_patterns; j++) {
10543 nl_pat = nla_nest_start(msg, j + 1);
10544 if (!nl_pat)
10545 return -ENOBUFS;
10546 pat_len = rule->patterns[j].pattern_len;
10547 if (nla_put(msg, NL80211_PKTPAT_MASK,
10548 DIV_ROUND_UP(pat_len, 8),
10549 rule->patterns[j].mask) ||
10550 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
10551 rule->patterns[j].pattern) ||
10552 nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
10553 rule->patterns[j].pkt_offset))
10554 return -ENOBUFS;
10555 nla_nest_end(msg, nl_pat);
10556 }
10557 nla_nest_end(msg, nl_pats);
10558 nla_nest_end(msg, nl_rule);
10559 }
10560 nla_nest_end(msg, nl_rules);
10561
10562 return 0;
10563}
10564
10565static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
10566{
10567 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10568 struct sk_buff *msg;
10569 void *hdr;
10570
10571 if (!rdev->wiphy.coalesce)
10572 return -EOPNOTSUPP;
10573
10574 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10575 if (!msg)
10576 return -ENOMEM;
10577
10578 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10579 NL80211_CMD_GET_COALESCE);
10580 if (!hdr)
10581 goto nla_put_failure;
10582
10583 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
10584 goto nla_put_failure;
10585
10586 genlmsg_end(msg, hdr);
10587 return genlmsg_reply(msg, info);
10588
10589nla_put_failure:
10590 nlmsg_free(msg);
10591 return -ENOBUFS;
10592}
10593
10594void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
10595{
10596 struct cfg80211_coalesce *coalesce = rdev->coalesce;
10597 int i, j;
10598 struct cfg80211_coalesce_rules *rule;
10599
10600 if (!coalesce)
10601 return;
10602
10603 for (i = 0; i < coalesce->n_rules; i++) {
10604 rule = &coalesce->rules[i];
10605 for (j = 0; j < rule->n_patterns; j++)
10606 kfree(rule->patterns[j].mask);
10607 kfree(rule->patterns);
10608 }
10609 kfree(coalesce->rules);
10610 kfree(coalesce);
10611 rdev->coalesce = NULL;
10612}
10613
10614static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
10615 struct nlattr *rule,
10616 struct cfg80211_coalesce_rules *new_rule)
10617{
10618 int err, i;
10619 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10620 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
10621 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
10622 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
10623
10624 err = nla_parse(tb, NL80211_ATTR_COALESCE_RULE_MAX, nla_data(rule),
10625 nla_len(rule), nl80211_coalesce_policy);
10626 if (err)
10627 return err;
10628
10629 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
10630 new_rule->delay =
10631 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
10632 if (new_rule->delay > coalesce->max_delay)
10633 return -EINVAL;
10634
10635 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
10636 new_rule->condition =
10637 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
10638 if (new_rule->condition != NL80211_COALESCE_CONDITION_MATCH &&
10639 new_rule->condition != NL80211_COALESCE_CONDITION_NO_MATCH)
10640 return -EINVAL;
10641
10642 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
10643 return -EINVAL;
10644
10645 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10646 rem)
10647 n_patterns++;
10648 if (n_patterns > coalesce->n_patterns)
10649 return -EINVAL;
10650
10651 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
10652 GFP_KERNEL);
10653 if (!new_rule->patterns)
10654 return -ENOMEM;
10655
10656 new_rule->n_patterns = n_patterns;
10657 i = 0;
10658
10659 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10660 rem) {
Johannes Berg922bd802014-05-19 17:59:50 +020010661 u8 *mask_pat;
10662
Amitkumar Karwarbe29b992013-06-28 11:51:26 -070010663 nla_parse(pat_tb, MAX_NL80211_PKTPAT, nla_data(pat),
Peng Xu4ec90fd2017-10-10 13:56:53 -070010664 nla_len(pat), nl80211_packet_pattern_policy);
Amitkumar Karwarbe29b992013-06-28 11:51:26 -070010665 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10666 !pat_tb[NL80211_PKTPAT_PATTERN])
10667 return -EINVAL;
10668 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
10669 mask_len = DIV_ROUND_UP(pat_len, 8);
10670 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
10671 return -EINVAL;
10672 if (pat_len > coalesce->pattern_max_len ||
10673 pat_len < coalesce->pattern_min_len)
10674 return -EINVAL;
10675
10676 if (!pat_tb[NL80211_PKTPAT_OFFSET])
10677 pkt_offset = 0;
10678 else
10679 pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
10680 if (pkt_offset > coalesce->max_pkt_offset)
10681 return -EINVAL;
10682 new_rule->patterns[i].pkt_offset = pkt_offset;
10683
Johannes Berg922bd802014-05-19 17:59:50 +020010684 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10685 if (!mask_pat)
Amitkumar Karwarbe29b992013-06-28 11:51:26 -070010686 return -ENOMEM;
Johannes Berg922bd802014-05-19 17:59:50 +020010687
10688 new_rule->patterns[i].mask = mask_pat;
10689 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
10690 mask_len);
10691
10692 mask_pat += mask_len;
10693 new_rule->patterns[i].pattern = mask_pat;
Amitkumar Karwarbe29b992013-06-28 11:51:26 -070010694 new_rule->patterns[i].pattern_len = pat_len;
Johannes Berg922bd802014-05-19 17:59:50 +020010695 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
10696 pat_len);
Amitkumar Karwarbe29b992013-06-28 11:51:26 -070010697 i++;
10698 }
10699
10700 return 0;
10701}
10702
10703static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
10704{
10705 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10706 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10707 struct cfg80211_coalesce new_coalesce = {};
10708 struct cfg80211_coalesce *n_coalesce;
10709 int err, rem_rule, n_rules = 0, i, j;
10710 struct nlattr *rule;
10711 struct cfg80211_coalesce_rules *tmp_rule;
10712
10713 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
10714 return -EOPNOTSUPP;
10715
10716 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
10717 cfg80211_rdev_free_coalesce(rdev);
Ilan Peera1056b12015-10-22 22:27:46 +030010718 rdev_set_coalesce(rdev, NULL);
Amitkumar Karwarbe29b992013-06-28 11:51:26 -070010719 return 0;
10720 }
10721
10722 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10723 rem_rule)
10724 n_rules++;
10725 if (n_rules > coalesce->n_rules)
10726 return -EINVAL;
10727
10728 new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
10729 GFP_KERNEL);
10730 if (!new_coalesce.rules)
10731 return -ENOMEM;
10732
10733 new_coalesce.n_rules = n_rules;
10734 i = 0;
10735
10736 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10737 rem_rule) {
10738 err = nl80211_parse_coalesce_rule(rdev, rule,
10739 &new_coalesce.rules[i]);
10740 if (err)
10741 goto error;
10742
10743 i++;
10744 }
10745
Ilan Peera1056b12015-10-22 22:27:46 +030010746 err = rdev_set_coalesce(rdev, &new_coalesce);
Amitkumar Karwarbe29b992013-06-28 11:51:26 -070010747 if (err)
10748 goto error;
10749
10750 n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
10751 if (!n_coalesce) {
10752 err = -ENOMEM;
10753 goto error;
10754 }
10755 cfg80211_rdev_free_coalesce(rdev);
10756 rdev->coalesce = n_coalesce;
10757
10758 return 0;
10759error:
10760 for (i = 0; i < new_coalesce.n_rules; i++) {
10761 tmp_rule = &new_coalesce.rules[i];
10762 for (j = 0; j < tmp_rule->n_patterns; j++)
10763 kfree(tmp_rule->patterns[j].mask);
10764 kfree(tmp_rule->patterns);
10765 }
10766 kfree(new_coalesce.rules);
10767
10768 return err;
10769}
10770
Johannes Berge5497d72011-07-05 16:35:40 +020010771static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
10772{
10773 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10774 struct net_device *dev = info->user_ptr[1];
10775 struct wireless_dev *wdev = dev->ieee80211_ptr;
10776 struct nlattr *tb[NUM_NL80211_REKEY_DATA];
10777 struct cfg80211_gtk_rekey_data rekey_data;
10778 int err;
10779
10780 if (!info->attrs[NL80211_ATTR_REKEY_DATA])
10781 return -EINVAL;
10782
10783 err = nla_parse(tb, MAX_NL80211_REKEY_DATA,
10784 nla_data(info->attrs[NL80211_ATTR_REKEY_DATA]),
10785 nla_len(info->attrs[NL80211_ATTR_REKEY_DATA]),
10786 nl80211_rekey_policy);
10787 if (err)
10788 return err;
10789
Vidyullatha Kanchanapally84aa3ba2017-05-25 20:20:41 +053010790 if (!tb[NL80211_REKEY_DATA_KEK] || !tb[NL80211_REKEY_DATA_REPLAY_CTR] ||
10791 (!wiphy_ext_feature_isset(&rdev->wiphy,
10792 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
10793 !wiphy_ext_feature_isset(&rdev->wiphy,
10794 NL80211_EXT_FEATURE_FILS_STA) &&
10795 !tb[NL80211_REKEY_DATA_KCK]))
10796 return -EINVAL;
10797
Johannes Berge5497d72011-07-05 16:35:40 +020010798 if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
10799 return -ERANGE;
Vidyullatha Kanchanapally84aa3ba2017-05-25 20:20:41 +053010800 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) < NL80211_KEK_LEN)
Johannes Berge5497d72011-07-05 16:35:40 +020010801 return -ERANGE;
Vidyullatha Kanchanapally84aa3ba2017-05-25 20:20:41 +053010802 if (tb[NL80211_REKEY_DATA_KCK] &&
10803 nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
Johannes Berge5497d72011-07-05 16:35:40 +020010804 return -ERANGE;
10805
Vidyullatha Kanchanapally84aa3ba2017-05-25 20:20:41 +053010806 memset(&rekey_data, 0, sizeof(rekey_data));
Johannes Berg78f686c2014-09-10 22:28:06 +030010807 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
Vidyullatha Kanchanapally84aa3ba2017-05-25 20:20:41 +053010808 rekey_data.kek_len = nla_len(tb[NL80211_REKEY_DATA_KEK]);
10809 if (tb[NL80211_REKEY_DATA_KCK])
10810 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
Johannes Berg78f686c2014-09-10 22:28:06 +030010811 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
Johannes Berge5497d72011-07-05 16:35:40 +020010812
10813 wdev_lock(wdev);
10814 if (!wdev->current_bss) {
10815 err = -ENOTCONN;
10816 goto out;
10817 }
10818
10819 if (!rdev->ops->set_rekey_data) {
10820 err = -EOPNOTSUPP;
10821 goto out;
10822 }
10823
Hila Gonene35e4d22012-06-27 17:19:42 +030010824 err = rdev_set_rekey_data(rdev, dev, &rekey_data);
Johannes Berge5497d72011-07-05 16:35:40 +020010825 out:
10826 wdev_unlock(wdev);
10827 return err;
10828}
10829
Johannes Berg28946da2011-11-04 11:18:12 +010010830static int nl80211_register_unexpected_frame(struct sk_buff *skb,
10831 struct genl_info *info)
10832{
10833 struct net_device *dev = info->user_ptr[1];
10834 struct wireless_dev *wdev = dev->ieee80211_ptr;
10835
10836 if (wdev->iftype != NL80211_IFTYPE_AP &&
10837 wdev->iftype != NL80211_IFTYPE_P2P_GO)
10838 return -EINVAL;
10839
Eric W. Biederman15e47302012-09-07 20:12:54 +000010840 if (wdev->ap_unexpected_nlportid)
Johannes Berg28946da2011-11-04 11:18:12 +010010841 return -EBUSY;
10842
Eric W. Biederman15e47302012-09-07 20:12:54 +000010843 wdev->ap_unexpected_nlportid = info->snd_portid;
Johannes Berg28946da2011-11-04 11:18:12 +010010844 return 0;
10845}
10846
Johannes Berg7f6cf312011-11-04 11:18:15 +010010847static int nl80211_probe_client(struct sk_buff *skb,
10848 struct genl_info *info)
10849{
10850 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10851 struct net_device *dev = info->user_ptr[1];
10852 struct wireless_dev *wdev = dev->ieee80211_ptr;
10853 struct sk_buff *msg;
10854 void *hdr;
10855 const u8 *addr;
10856 u64 cookie;
10857 int err;
10858
10859 if (wdev->iftype != NL80211_IFTYPE_AP &&
10860 wdev->iftype != NL80211_IFTYPE_P2P_GO)
10861 return -EOPNOTSUPP;
10862
10863 if (!info->attrs[NL80211_ATTR_MAC])
10864 return -EINVAL;
10865
10866 if (!rdev->ops->probe_client)
10867 return -EOPNOTSUPP;
10868
10869 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10870 if (!msg)
10871 return -ENOMEM;
10872
Eric W. Biederman15e47302012-09-07 20:12:54 +000010873 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Johannes Berg7f6cf312011-11-04 11:18:15 +010010874 NL80211_CMD_PROBE_CLIENT);
Dan Carpentercb35fba2013-08-14 14:50:01 +030010875 if (!hdr) {
10876 err = -ENOBUFS;
Johannes Berg7f6cf312011-11-04 11:18:15 +010010877 goto free_msg;
10878 }
10879
10880 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
10881
Hila Gonene35e4d22012-06-27 17:19:42 +030010882 err = rdev_probe_client(rdev, dev, addr, &cookie);
Johannes Berg7f6cf312011-11-04 11:18:15 +010010883 if (err)
10884 goto free_msg;
10885
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020010886 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
10887 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -040010888 goto nla_put_failure;
Johannes Berg7f6cf312011-11-04 11:18:15 +010010889
10890 genlmsg_end(msg, hdr);
10891
10892 return genlmsg_reply(msg, info);
10893
10894 nla_put_failure:
10895 err = -ENOBUFS;
10896 free_msg:
10897 nlmsg_free(msg);
10898 return err;
10899}
10900
Johannes Berg5e7602302011-11-04 11:18:17 +010010901static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
10902{
10903 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Ben Greear37c73b52012-10-26 14:49:25 -070010904 struct cfg80211_beacon_registration *reg, *nreg;
10905 int rv;
Johannes Berg5e7602302011-11-04 11:18:17 +010010906
10907 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
10908 return -EOPNOTSUPP;
10909
Ben Greear37c73b52012-10-26 14:49:25 -070010910 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
10911 if (!nreg)
10912 return -ENOMEM;
Johannes Berg5e7602302011-11-04 11:18:17 +010010913
Ben Greear37c73b52012-10-26 14:49:25 -070010914 /* First, check if already registered. */
10915 spin_lock_bh(&rdev->beacon_registrations_lock);
10916 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
10917 if (reg->nlportid == info->snd_portid) {
10918 rv = -EALREADY;
10919 goto out_err;
10920 }
10921 }
10922 /* Add it to the list */
10923 nreg->nlportid = info->snd_portid;
10924 list_add(&nreg->list, &rdev->beacon_registrations);
10925
10926 spin_unlock_bh(&rdev->beacon_registrations_lock);
Johannes Berg5e7602302011-11-04 11:18:17 +010010927
10928 return 0;
Ben Greear37c73b52012-10-26 14:49:25 -070010929out_err:
10930 spin_unlock_bh(&rdev->beacon_registrations_lock);
10931 kfree(nreg);
10932 return rv;
Johannes Berg5e7602302011-11-04 11:18:17 +010010933}
10934
Johannes Berg98104fde2012-06-16 00:19:54 +020010935static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
10936{
10937 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10938 struct wireless_dev *wdev = info->user_ptr[1];
10939 int err;
10940
10941 if (!rdev->ops->start_p2p_device)
10942 return -EOPNOTSUPP;
10943
10944 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
10945 return -EOPNOTSUPP;
10946
10947 if (wdev->p2p_started)
10948 return 0;
10949
Luciano Coelhob6a55012014-02-27 11:07:21 +020010950 if (rfkill_blocked(rdev->rfkill))
10951 return -ERFKILL;
Johannes Berg98104fde2012-06-16 00:19:54 +020010952
Johannes Bergeeb126e2012-10-23 15:16:50 +020010953 err = rdev_start_p2p_device(rdev, wdev);
Johannes Berg98104fde2012-06-16 00:19:54 +020010954 if (err)
10955 return err;
10956
10957 wdev->p2p_started = true;
Johannes Berg98104fde2012-06-16 00:19:54 +020010958 rdev->opencount++;
Johannes Berg98104fde2012-06-16 00:19:54 +020010959
10960 return 0;
10961}
10962
10963static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
10964{
10965 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10966 struct wireless_dev *wdev = info->user_ptr[1];
10967
10968 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
10969 return -EOPNOTSUPP;
10970
10971 if (!rdev->ops->stop_p2p_device)
10972 return -EOPNOTSUPP;
10973
Johannes Bergf9f47522013-03-19 15:04:07 +010010974 cfg80211_stop_p2p_device(rdev, wdev);
Johannes Berg98104fde2012-06-16 00:19:54 +020010975
10976 return 0;
10977}
10978
Ayala Bekercb3b7d82016-09-20 17:31:13 +030010979static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
10980{
10981 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10982 struct wireless_dev *wdev = info->user_ptr[1];
10983 struct cfg80211_nan_conf conf = {};
10984 int err;
10985
10986 if (wdev->iftype != NL80211_IFTYPE_NAN)
10987 return -EOPNOTSUPP;
10988
10989 if (wdev->nan_started)
10990 return -EEXIST;
10991
10992 if (rfkill_blocked(rdev->rfkill))
10993 return -ERFKILL;
10994
10995 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
10996 return -EINVAL;
10997
10998 if (!info->attrs[NL80211_ATTR_NAN_DUAL])
10999 return -EINVAL;
11000
11001 conf.master_pref =
11002 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
11003 if (!conf.master_pref)
11004 return -EINVAL;
11005
11006 conf.dual = nla_get_u8(info->attrs[NL80211_ATTR_NAN_DUAL]);
11007
11008 err = rdev_start_nan(rdev, wdev, &conf);
11009 if (err)
11010 return err;
11011
11012 wdev->nan_started = true;
11013 rdev->opencount++;
11014
11015 return 0;
11016}
11017
11018static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
11019{
11020 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11021 struct wireless_dev *wdev = info->user_ptr[1];
11022
11023 if (wdev->iftype != NL80211_IFTYPE_NAN)
11024 return -EOPNOTSUPP;
11025
11026 cfg80211_stop_nan(rdev, wdev);
11027
11028 return 0;
11029}
11030
Ayala Bekera442b762016-09-20 17:31:15 +030011031static int validate_nan_filter(struct nlattr *filter_attr)
11032{
11033 struct nlattr *attr;
11034 int len = 0, n_entries = 0, rem;
11035
11036 nla_for_each_nested(attr, filter_attr, rem) {
11037 len += nla_len(attr);
11038 n_entries++;
11039 }
11040
11041 if (len >= U8_MAX)
11042 return -EINVAL;
11043
11044 return n_entries;
11045}
11046
11047static int handle_nan_filter(struct nlattr *attr_filter,
11048 struct cfg80211_nan_func *func,
11049 bool tx)
11050{
11051 struct nlattr *attr;
11052 int n_entries, rem, i;
11053 struct cfg80211_nan_func_filter *filter;
11054
11055 n_entries = validate_nan_filter(attr_filter);
11056 if (n_entries < 0)
11057 return n_entries;
11058
11059 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
11060
11061 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
11062 if (!filter)
11063 return -ENOMEM;
11064
11065 i = 0;
11066 nla_for_each_nested(attr, attr_filter, rem) {
11067 filter[i].filter = kmemdup(nla_data(attr), nla_len(attr),
11068 GFP_KERNEL);
11069 filter[i].len = nla_len(attr);
11070 i++;
11071 }
11072 if (tx) {
11073 func->num_tx_filters = n_entries;
11074 func->tx_filters = filter;
11075 } else {
11076 func->num_rx_filters = n_entries;
11077 func->rx_filters = filter;
11078 }
11079
11080 return 0;
11081}
11082
11083static int nl80211_nan_add_func(struct sk_buff *skb,
11084 struct genl_info *info)
11085{
11086 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11087 struct wireless_dev *wdev = info->user_ptr[1];
11088 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
11089 struct cfg80211_nan_func *func;
11090 struct sk_buff *msg = NULL;
11091 void *hdr = NULL;
11092 int err = 0;
11093
11094 if (wdev->iftype != NL80211_IFTYPE_NAN)
11095 return -EOPNOTSUPP;
11096
11097 if (!wdev->nan_started)
11098 return -ENOTCONN;
11099
11100 if (!info->attrs[NL80211_ATTR_NAN_FUNC])
11101 return -EINVAL;
11102
11103 if (wdev->owner_nlportid &&
11104 wdev->owner_nlportid != info->snd_portid)
11105 return -ENOTCONN;
11106
11107 err = nla_parse(tb, NL80211_NAN_FUNC_ATTR_MAX,
11108 nla_data(info->attrs[NL80211_ATTR_NAN_FUNC]),
11109 nla_len(info->attrs[NL80211_ATTR_NAN_FUNC]),
11110 nl80211_nan_func_policy);
11111 if (err)
11112 return err;
11113
11114 func = kzalloc(sizeof(*func), GFP_KERNEL);
11115 if (!func)
11116 return -ENOMEM;
11117
11118 func->cookie = wdev->wiphy->cookie_counter++;
11119
11120 if (!tb[NL80211_NAN_FUNC_TYPE] ||
11121 nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
11122 err = -EINVAL;
11123 goto out;
11124 }
11125
11126
11127 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
11128
11129 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
11130 err = -EINVAL;
11131 goto out;
11132 }
11133
11134 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
11135 sizeof(func->service_id));
11136
11137 func->close_range =
11138 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
11139
11140 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
11141 func->serv_spec_info_len =
11142 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
11143 func->serv_spec_info =
11144 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
11145 func->serv_spec_info_len,
11146 GFP_KERNEL);
11147 if (!func->serv_spec_info) {
11148 err = -ENOMEM;
11149 goto out;
11150 }
11151 }
11152
11153 if (tb[NL80211_NAN_FUNC_TTL])
11154 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
11155
11156 switch (func->type) {
11157 case NL80211_NAN_FUNC_PUBLISH:
11158 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
11159 err = -EINVAL;
11160 goto out;
11161 }
11162
11163 func->publish_type =
11164 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
11165 func->publish_bcast =
11166 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
11167
11168 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
11169 func->publish_bcast) {
11170 err = -EINVAL;
11171 goto out;
11172 }
11173 break;
11174 case NL80211_NAN_FUNC_SUBSCRIBE:
11175 func->subscribe_active =
11176 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
11177 break;
11178 case NL80211_NAN_FUNC_FOLLOW_UP:
11179 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
Hao Chen4ec2b1c2018-01-03 11:00:31 +080011180 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
11181 !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
Ayala Bekera442b762016-09-20 17:31:15 +030011182 err = -EINVAL;
11183 goto out;
11184 }
11185
11186 func->followup_id =
11187 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
11188 func->followup_reqid =
11189 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
11190 memcpy(func->followup_dest.addr,
11191 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
11192 sizeof(func->followup_dest.addr));
11193 if (func->ttl) {
11194 err = -EINVAL;
11195 goto out;
11196 }
11197 break;
11198 default:
11199 err = -EINVAL;
11200 goto out;
11201 }
11202
11203 if (tb[NL80211_NAN_FUNC_SRF]) {
11204 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
11205
11206 err = nla_parse(srf_tb, NL80211_NAN_SRF_ATTR_MAX,
11207 nla_data(tb[NL80211_NAN_FUNC_SRF]),
11208 nla_len(tb[NL80211_NAN_FUNC_SRF]), NULL);
11209 if (err)
11210 goto out;
11211
11212 func->srf_include =
11213 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
11214
11215 if (srf_tb[NL80211_NAN_SRF_BF]) {
11216 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
11217 !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
11218 err = -EINVAL;
11219 goto out;
11220 }
11221
11222 func->srf_bf_len =
11223 nla_len(srf_tb[NL80211_NAN_SRF_BF]);
11224 func->srf_bf =
11225 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
11226 func->srf_bf_len, GFP_KERNEL);
11227 if (!func->srf_bf) {
11228 err = -ENOMEM;
11229 goto out;
11230 }
11231
11232 func->srf_bf_idx =
11233 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
11234 } else {
11235 struct nlattr *attr, *mac_attr =
11236 srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
11237 int n_entries, rem, i = 0;
11238
11239 if (!mac_attr) {
11240 err = -EINVAL;
11241 goto out;
11242 }
11243
11244 n_entries = validate_acl_mac_addrs(mac_attr);
11245 if (n_entries <= 0) {
11246 err = -EINVAL;
11247 goto out;
11248 }
11249
11250 func->srf_num_macs = n_entries;
11251 func->srf_macs =
11252 kzalloc(sizeof(*func->srf_macs) * n_entries,
11253 GFP_KERNEL);
11254 if (!func->srf_macs) {
11255 err = -ENOMEM;
11256 goto out;
11257 }
11258
11259 nla_for_each_nested(attr, mac_attr, rem)
11260 memcpy(func->srf_macs[i++].addr, nla_data(attr),
11261 sizeof(*func->srf_macs));
11262 }
11263 }
11264
11265 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
11266 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
11267 func, true);
11268 if (err)
11269 goto out;
11270 }
11271
11272 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
11273 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
11274 func, false);
11275 if (err)
11276 goto out;
11277 }
11278
11279 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11280 if (!msg) {
11281 err = -ENOMEM;
11282 goto out;
11283 }
11284
11285 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11286 NL80211_CMD_ADD_NAN_FUNCTION);
11287 /* This can't really happen - we just allocated 4KB */
11288 if (WARN_ON(!hdr)) {
11289 err = -ENOMEM;
11290 goto out;
11291 }
11292
11293 err = rdev_add_nan_func(rdev, wdev, func);
11294out:
11295 if (err < 0) {
11296 cfg80211_free_nan_func(func);
11297 nlmsg_free(msg);
11298 return err;
11299 }
11300
11301 /* propagate the instance id and cookie to userspace */
11302 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
11303 NL80211_ATTR_PAD))
11304 goto nla_put_failure;
11305
11306 func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
11307 if (!func_attr)
11308 goto nla_put_failure;
11309
11310 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
11311 func->instance_id))
11312 goto nla_put_failure;
11313
11314 nla_nest_end(msg, func_attr);
11315
11316 genlmsg_end(msg, hdr);
11317 return genlmsg_reply(msg, info);
11318
11319nla_put_failure:
11320 nlmsg_free(msg);
11321 return -ENOBUFS;
11322}
11323
11324static int nl80211_nan_del_func(struct sk_buff *skb,
11325 struct genl_info *info)
11326{
11327 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11328 struct wireless_dev *wdev = info->user_ptr[1];
11329 u64 cookie;
11330
11331 if (wdev->iftype != NL80211_IFTYPE_NAN)
11332 return -EOPNOTSUPP;
11333
11334 if (!wdev->nan_started)
11335 return -ENOTCONN;
11336
11337 if (!info->attrs[NL80211_ATTR_COOKIE])
11338 return -EINVAL;
11339
11340 if (wdev->owner_nlportid &&
11341 wdev->owner_nlportid != info->snd_portid)
11342 return -ENOTCONN;
11343
11344 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
11345
11346 rdev_del_nan_func(rdev, wdev, cookie);
11347
11348 return 0;
11349}
11350
Ayala Bekera5a9dcf2016-09-20 17:31:16 +030011351static int nl80211_nan_change_config(struct sk_buff *skb,
11352 struct genl_info *info)
11353{
11354 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11355 struct wireless_dev *wdev = info->user_ptr[1];
11356 struct cfg80211_nan_conf conf = {};
11357 u32 changed = 0;
11358
11359 if (wdev->iftype != NL80211_IFTYPE_NAN)
11360 return -EOPNOTSUPP;
11361
11362 if (!wdev->nan_started)
11363 return -ENOTCONN;
11364
11365 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
11366 conf.master_pref =
11367 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
11368 if (conf.master_pref <= 1 || conf.master_pref == 255)
11369 return -EINVAL;
11370
11371 changed |= CFG80211_NAN_CONF_CHANGED_PREF;
11372 }
11373
11374 if (info->attrs[NL80211_ATTR_NAN_DUAL]) {
11375 conf.dual = nla_get_u8(info->attrs[NL80211_ATTR_NAN_DUAL]);
11376 changed |= CFG80211_NAN_CONF_CHANGED_DUAL;
11377 }
11378
11379 if (!changed)
11380 return -EINVAL;
11381
11382 return rdev_nan_change_conf(rdev, wdev, &conf, changed);
11383}
11384
Ayala Beker50bcd312016-09-20 17:31:17 +030011385void cfg80211_nan_match(struct wireless_dev *wdev,
11386 struct cfg80211_nan_match_params *match, gfp_t gfp)
11387{
11388 struct wiphy *wiphy = wdev->wiphy;
11389 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11390 struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
11391 struct sk_buff *msg;
11392 void *hdr;
11393
11394 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
11395 return;
11396
11397 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
11398 if (!msg)
11399 return;
11400
11401 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
11402 if (!hdr) {
11403 nlmsg_free(msg);
11404 return;
11405 }
11406
11407 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11408 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
11409 wdev->netdev->ifindex)) ||
11410 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
11411 NL80211_ATTR_PAD))
11412 goto nla_put_failure;
11413
11414 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
11415 NL80211_ATTR_PAD) ||
11416 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
11417 goto nla_put_failure;
11418
11419 match_attr = nla_nest_start(msg, NL80211_ATTR_NAN_MATCH);
11420 if (!match_attr)
11421 goto nla_put_failure;
11422
11423 local_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_LOCAL);
11424 if (!local_func_attr)
11425 goto nla_put_failure;
11426
11427 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
11428 goto nla_put_failure;
11429
11430 nla_nest_end(msg, local_func_attr);
11431
11432 peer_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_PEER);
11433 if (!peer_func_attr)
11434 goto nla_put_failure;
11435
11436 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
11437 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
11438 goto nla_put_failure;
11439
11440 if (match->info && match->info_len &&
11441 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
11442 match->info))
11443 goto nla_put_failure;
11444
11445 nla_nest_end(msg, peer_func_attr);
11446 nla_nest_end(msg, match_attr);
11447 genlmsg_end(msg, hdr);
11448
11449 if (!wdev->owner_nlportid)
11450 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11451 msg, 0, NL80211_MCGRP_NAN, gfp);
11452 else
11453 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11454 wdev->owner_nlportid);
11455
11456 return;
11457
11458nla_put_failure:
11459 nlmsg_free(msg);
11460}
11461EXPORT_SYMBOL(cfg80211_nan_match);
11462
Ayala Beker368e5a72016-09-20 17:31:18 +030011463void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
11464 u8 inst_id,
11465 enum nl80211_nan_func_term_reason reason,
11466 u64 cookie, gfp_t gfp)
11467{
11468 struct wiphy *wiphy = wdev->wiphy;
11469 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11470 struct sk_buff *msg;
11471 struct nlattr *func_attr;
11472 void *hdr;
11473
11474 if (WARN_ON(!inst_id))
11475 return;
11476
11477 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
11478 if (!msg)
11479 return;
11480
11481 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
11482 if (!hdr) {
11483 nlmsg_free(msg);
11484 return;
11485 }
11486
11487 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11488 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
11489 wdev->netdev->ifindex)) ||
11490 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
11491 NL80211_ATTR_PAD))
11492 goto nla_put_failure;
11493
11494 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
11495 NL80211_ATTR_PAD))
11496 goto nla_put_failure;
11497
11498 func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
11499 if (!func_attr)
11500 goto nla_put_failure;
11501
11502 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
11503 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
11504 goto nla_put_failure;
11505
11506 nla_nest_end(msg, func_attr);
11507 genlmsg_end(msg, hdr);
11508
11509 if (!wdev->owner_nlportid)
11510 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11511 msg, 0, NL80211_MCGRP_NAN, gfp);
11512 else
11513 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11514 wdev->owner_nlportid);
11515
11516 return;
11517
11518nla_put_failure:
11519 nlmsg_free(msg);
11520}
11521EXPORT_SYMBOL(cfg80211_nan_func_terminated);
11522
Johannes Berg3713b4e2013-02-14 16:19:38 +010011523static int nl80211_get_protocol_features(struct sk_buff *skb,
11524 struct genl_info *info)
11525{
11526 void *hdr;
11527 struct sk_buff *msg;
11528
11529 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11530 if (!msg)
11531 return -ENOMEM;
11532
11533 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11534 NL80211_CMD_GET_PROTOCOL_FEATURES);
11535 if (!hdr)
11536 goto nla_put_failure;
11537
11538 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
11539 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
11540 goto nla_put_failure;
11541
11542 genlmsg_end(msg, hdr);
11543 return genlmsg_reply(msg, info);
11544
11545 nla_put_failure:
11546 kfree_skb(msg);
11547 return -ENOBUFS;
11548}
11549
Jouni Malinen355199e2013-02-27 17:14:27 +020011550static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
11551{
11552 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11553 struct cfg80211_update_ft_ies_params ft_params;
11554 struct net_device *dev = info->user_ptr[1];
11555
11556 if (!rdev->ops->update_ft_ies)
11557 return -EOPNOTSUPP;
11558
11559 if (!info->attrs[NL80211_ATTR_MDID] ||
Arunk Khandavalli1a648fb2018-08-21 14:20:20 +053011560 !info->attrs[NL80211_ATTR_IE] ||
Jouni Malinen355199e2013-02-27 17:14:27 +020011561 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
11562 return -EINVAL;
11563
11564 memset(&ft_params, 0, sizeof(ft_params));
11565 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
11566 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
11567 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
11568
11569 return rdev_update_ft_ies(rdev, dev, &ft_params);
11570}
11571
Arend van Spriel5de17982013-04-18 15:49:00 +020011572static int nl80211_crit_protocol_start(struct sk_buff *skb,
11573 struct genl_info *info)
11574{
11575 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11576 struct wireless_dev *wdev = info->user_ptr[1];
11577 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
11578 u16 duration;
11579 int ret;
11580
11581 if (!rdev->ops->crit_proto_start)
11582 return -EOPNOTSUPP;
11583
11584 if (WARN_ON(!rdev->ops->crit_proto_stop))
11585 return -EINVAL;
11586
11587 if (rdev->crit_proto_nlportid)
11588 return -EBUSY;
11589
11590 /* determine protocol if provided */
11591 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
11592 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
11593
11594 if (proto >= NUM_NL80211_CRIT_PROTO)
11595 return -EINVAL;
11596
11597 /* timeout must be provided */
11598 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
11599 return -EINVAL;
11600
11601 duration =
11602 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
11603
11604 if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
11605 return -ERANGE;
11606
11607 ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
11608 if (!ret)
11609 rdev->crit_proto_nlportid = info->snd_portid;
11610
11611 return ret;
11612}
11613
11614static int nl80211_crit_protocol_stop(struct sk_buff *skb,
11615 struct genl_info *info)
11616{
11617 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11618 struct wireless_dev *wdev = info->user_ptr[1];
11619
11620 if (!rdev->ops->crit_proto_stop)
11621 return -EOPNOTSUPP;
11622
11623 if (rdev->crit_proto_nlportid) {
11624 rdev->crit_proto_nlportid = 0;
11625 rdev_crit_proto_stop(rdev, wdev);
11626 }
11627 return 0;
11628}
11629
Johannes Bergad7e7182013-11-13 13:37:47 +010011630static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
11631{
11632 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11633 struct wireless_dev *wdev =
11634 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
11635 int i, err;
11636 u32 vid, subcmd;
11637
11638 if (!rdev->wiphy.vendor_commands)
11639 return -EOPNOTSUPP;
11640
11641 if (IS_ERR(wdev)) {
11642 err = PTR_ERR(wdev);
11643 if (err != -EINVAL)
11644 return err;
11645 wdev = NULL;
11646 } else if (wdev->wiphy != &rdev->wiphy) {
11647 return -EINVAL;
11648 }
11649
11650 if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
11651 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
11652 return -EINVAL;
11653
11654 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
11655 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
11656 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
11657 const struct wiphy_vendor_command *vcmd;
11658 void *data = NULL;
11659 int len = 0;
11660
11661 vcmd = &rdev->wiphy.vendor_commands[i];
11662
11663 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11664 continue;
11665
11666 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
11667 WIPHY_VENDOR_CMD_NEED_NETDEV)) {
11668 if (!wdev)
11669 return -EINVAL;
11670 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
11671 !wdev->netdev)
11672 return -EINVAL;
11673
11674 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
11675 if (wdev->netdev &&
11676 !netif_running(wdev->netdev))
11677 return -ENETDOWN;
11678 if (!wdev->netdev && !wdev->p2p_started)
11679 return -ENETDOWN;
11680 }
Johannes Berg7bdbe402015-08-15 22:39:49 +030011681
11682 if (!vcmd->doit)
11683 return -EOPNOTSUPP;
Johannes Bergad7e7182013-11-13 13:37:47 +010011684 } else {
11685 wdev = NULL;
11686 }
11687
11688 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
11689 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11690 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11691 }
11692
11693 rdev->cur_cmd_info = info;
11694 err = rdev->wiphy.vendor_commands[i].doit(&rdev->wiphy, wdev,
11695 data, len);
11696 rdev->cur_cmd_info = NULL;
11697 return err;
11698 }
11699
11700 return -EOPNOTSUPP;
11701}
11702
Johannes Berg7bdbe402015-08-15 22:39:49 +030011703static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
11704 struct netlink_callback *cb,
11705 struct cfg80211_registered_device **rdev,
11706 struct wireless_dev **wdev)
11707{
11708 u32 vid, subcmd;
11709 unsigned int i;
11710 int vcmd_idx = -1;
11711 int err;
11712 void *data = NULL;
11713 unsigned int data_len = 0;
11714
Johannes Berg7bdbe402015-08-15 22:39:49 +030011715 if (cb->args[0]) {
11716 /* subtract the 1 again here */
11717 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
11718 struct wireless_dev *tmp;
11719
Johannes Berg56769e72017-03-15 14:26:04 +010011720 if (!wiphy)
11721 return -ENODEV;
Johannes Berg7bdbe402015-08-15 22:39:49 +030011722 *rdev = wiphy_to_rdev(wiphy);
11723 *wdev = NULL;
11724
11725 if (cb->args[1]) {
Johannes Berg53873f12016-05-03 16:52:04 +030011726 list_for_each_entry(tmp, &wiphy->wdev_list, list) {
Johannes Berg7bdbe402015-08-15 22:39:49 +030011727 if (tmp->identifier == cb->args[1] - 1) {
11728 *wdev = tmp;
11729 break;
11730 }
11731 }
11732 }
11733
11734 /* keep rtnl locked in successful case */
11735 return 0;
11736 }
11737
11738 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
11739 nl80211_fam.attrbuf, nl80211_fam.maxattr,
11740 nl80211_policy);
11741 if (err)
Johannes Berg56769e72017-03-15 14:26:04 +010011742 return err;
Johannes Berg7bdbe402015-08-15 22:39:49 +030011743
11744 if (!nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_ID] ||
Johannes Berg56769e72017-03-15 14:26:04 +010011745 !nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_SUBCMD])
11746 return -EINVAL;
Johannes Berg7bdbe402015-08-15 22:39:49 +030011747
11748 *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk),
11749 nl80211_fam.attrbuf);
11750 if (IS_ERR(*wdev))
11751 *wdev = NULL;
11752
11753 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk),
11754 nl80211_fam.attrbuf);
Johannes Berg56769e72017-03-15 14:26:04 +010011755 if (IS_ERR(*rdev))
11756 return PTR_ERR(*rdev);
Johannes Berg7bdbe402015-08-15 22:39:49 +030011757
11758 vid = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_ID]);
11759 subcmd = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
11760
11761 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
11762 const struct wiphy_vendor_command *vcmd;
11763
11764 vcmd = &(*rdev)->wiphy.vendor_commands[i];
11765
11766 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11767 continue;
11768
Johannes Berg56769e72017-03-15 14:26:04 +010011769 if (!vcmd->dumpit)
11770 return -EOPNOTSUPP;
Johannes Berg7bdbe402015-08-15 22:39:49 +030011771
11772 vcmd_idx = i;
11773 break;
11774 }
11775
Johannes Berg56769e72017-03-15 14:26:04 +010011776 if (vcmd_idx < 0)
11777 return -EOPNOTSUPP;
Johannes Berg7bdbe402015-08-15 22:39:49 +030011778
11779 if (nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_DATA]) {
11780 data = nla_data(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_DATA]);
11781 data_len = nla_len(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_DATA]);
11782 }
11783
11784 /* 0 is the first index - add 1 to parse only once */
11785 cb->args[0] = (*rdev)->wiphy_idx + 1;
11786 /* add 1 to know if it was NULL */
11787 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
11788 cb->args[2] = vcmd_idx;
11789 cb->args[3] = (unsigned long)data;
11790 cb->args[4] = data_len;
11791
11792 /* keep rtnl locked in successful case */
11793 return 0;
Johannes Berg7bdbe402015-08-15 22:39:49 +030011794}
11795
11796static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
11797 struct netlink_callback *cb)
11798{
11799 struct cfg80211_registered_device *rdev;
11800 struct wireless_dev *wdev;
11801 unsigned int vcmd_idx;
11802 const struct wiphy_vendor_command *vcmd;
11803 void *data;
11804 int data_len;
11805 int err;
11806 struct nlattr *vendor_data;
11807
Johannes Berg56769e72017-03-15 14:26:04 +010011808 rtnl_lock();
Johannes Berg7bdbe402015-08-15 22:39:49 +030011809 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
11810 if (err)
Johannes Berg56769e72017-03-15 14:26:04 +010011811 goto out;
Johannes Berg7bdbe402015-08-15 22:39:49 +030011812
11813 vcmd_idx = cb->args[2];
11814 data = (void *)cb->args[3];
11815 data_len = cb->args[4];
11816 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
11817
11818 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
11819 WIPHY_VENDOR_CMD_NEED_NETDEV)) {
Johannes Berg56769e72017-03-15 14:26:04 +010011820 if (!wdev) {
11821 err = -EINVAL;
11822 goto out;
11823 }
Johannes Berg7bdbe402015-08-15 22:39:49 +030011824 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
Johannes Berg56769e72017-03-15 14:26:04 +010011825 !wdev->netdev) {
11826 err = -EINVAL;
11827 goto out;
11828 }
Johannes Berg7bdbe402015-08-15 22:39:49 +030011829
11830 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
11831 if (wdev->netdev &&
Johannes Berg56769e72017-03-15 14:26:04 +010011832 !netif_running(wdev->netdev)) {
11833 err = -ENETDOWN;
11834 goto out;
11835 }
11836 if (!wdev->netdev && !wdev->p2p_started) {
11837 err = -ENETDOWN;
11838 goto out;
11839 }
Johannes Berg7bdbe402015-08-15 22:39:49 +030011840 }
11841 }
11842
11843 while (1) {
11844 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
11845 cb->nlh->nlmsg_seq, NLM_F_MULTI,
11846 NL80211_CMD_VENDOR);
11847 if (!hdr)
11848 break;
11849
11850 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020011851 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
11852 wdev_id(wdev),
11853 NL80211_ATTR_PAD))) {
Johannes Berg7bdbe402015-08-15 22:39:49 +030011854 genlmsg_cancel(skb, hdr);
11855 break;
11856 }
11857
11858 vendor_data = nla_nest_start(skb, NL80211_ATTR_VENDOR_DATA);
11859 if (!vendor_data) {
11860 genlmsg_cancel(skb, hdr);
11861 break;
11862 }
11863
11864 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
11865 (unsigned long *)&cb->args[5]);
11866 nla_nest_end(skb, vendor_data);
11867
11868 if (err == -ENOBUFS || err == -ENOENT) {
11869 genlmsg_cancel(skb, hdr);
11870 break;
11871 } else if (err) {
11872 genlmsg_cancel(skb, hdr);
11873 goto out;
11874 }
11875
11876 genlmsg_end(skb, hdr);
11877 }
11878
11879 err = skb->len;
11880 out:
11881 rtnl_unlock();
11882 return err;
11883}
11884
Johannes Bergad7e7182013-11-13 13:37:47 +010011885struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
11886 enum nl80211_commands cmd,
11887 enum nl80211_attrs attr,
11888 int approxlen)
11889{
Zhao, Gangf26cbf42014-04-21 12:53:03 +080011890 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Bergad7e7182013-11-13 13:37:47 +010011891
11892 if (WARN_ON(!rdev->cur_cmd_info))
11893 return NULL;
11894
Ahmad Kholaif6c09e792015-02-26 15:26:53 +020011895 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
Johannes Bergad7e7182013-11-13 13:37:47 +010011896 rdev->cur_cmd_info->snd_portid,
11897 rdev->cur_cmd_info->snd_seq,
Johannes Berg567ffc32013-12-18 14:43:31 +010011898 cmd, attr, NULL, GFP_KERNEL);
Johannes Bergad7e7182013-11-13 13:37:47 +010011899}
11900EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
11901
11902int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
11903{
11904 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
11905 void *hdr = ((void **)skb->cb)[1];
11906 struct nlattr *data = ((void **)skb->cb)[2];
11907
Johannes Bergbd8c78e2014-07-30 14:55:26 +020011908 /* clear CB data for netlink core to own from now on */
11909 memset(skb->cb, 0, sizeof(skb->cb));
11910
Johannes Bergad7e7182013-11-13 13:37:47 +010011911 if (WARN_ON(!rdev->cur_cmd_info)) {
11912 kfree_skb(skb);
11913 return -EINVAL;
11914 }
11915
11916 nla_nest_end(skb, data);
11917 genlmsg_end(skb, hdr);
11918 return genlmsg_reply(skb, rdev->cur_cmd_info);
11919}
11920EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
11921
Kyeyoon Parkfa9ffc72013-12-16 23:01:30 -080011922static int nl80211_set_qos_map(struct sk_buff *skb,
11923 struct genl_info *info)
11924{
11925 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11926 struct cfg80211_qos_map *qos_map = NULL;
11927 struct net_device *dev = info->user_ptr[1];
11928 u8 *pos, len, num_des, des_len, des;
11929 int ret;
11930
11931 if (!rdev->ops->set_qos_map)
11932 return -EOPNOTSUPP;
11933
11934 if (info->attrs[NL80211_ATTR_QOS_MAP]) {
11935 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
11936 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
11937
11938 if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
11939 len > IEEE80211_QOS_MAP_LEN_MAX)
11940 return -EINVAL;
11941
11942 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
11943 if (!qos_map)
11944 return -ENOMEM;
11945
11946 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
11947 if (num_des) {
11948 des_len = num_des *
11949 sizeof(struct cfg80211_dscp_exception);
11950 memcpy(qos_map->dscp_exception, pos, des_len);
11951 qos_map->num_des = num_des;
11952 for (des = 0; des < num_des; des++) {
11953 if (qos_map->dscp_exception[des].up > 7) {
11954 kfree(qos_map);
11955 return -EINVAL;
11956 }
11957 }
11958 pos += des_len;
11959 }
11960 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
11961 }
11962
11963 wdev_lock(dev->ieee80211_ptr);
11964 ret = nl80211_key_allowed(dev->ieee80211_ptr);
11965 if (!ret)
11966 ret = rdev_set_qos_map(rdev, dev, qos_map);
11967 wdev_unlock(dev->ieee80211_ptr);
11968
11969 kfree(qos_map);
11970 return ret;
11971}
11972
Johannes Berg960d01a2014-09-09 22:55:35 +030011973static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
11974{
11975 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11976 struct net_device *dev = info->user_ptr[1];
11977 struct wireless_dev *wdev = dev->ieee80211_ptr;
11978 const u8 *peer;
11979 u8 tsid, up;
11980 u16 admitted_time = 0;
11981 int err;
11982
Johannes Berg723e73a2014-10-22 09:25:06 +020011983 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
Johannes Berg960d01a2014-09-09 22:55:35 +030011984 return -EOPNOTSUPP;
11985
11986 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
11987 !info->attrs[NL80211_ATTR_USER_PRIO])
11988 return -EINVAL;
11989
11990 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
11991 if (tsid >= IEEE80211_NUM_TIDS)
11992 return -EINVAL;
11993
11994 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
11995 if (up >= IEEE80211_NUM_UPS)
11996 return -EINVAL;
11997
11998 /* WMM uses TIDs 0-7 even for TSPEC */
Johannes Berg723e73a2014-10-22 09:25:06 +020011999 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
Johannes Berg960d01a2014-09-09 22:55:35 +030012000 /* TODO: handle 802.11 TSPEC/admission control
Johannes Berg723e73a2014-10-22 09:25:06 +020012001 * need more attributes for that (e.g. BA session requirement);
12002 * change the WMM adminssion test above to allow both then
Johannes Berg960d01a2014-09-09 22:55:35 +030012003 */
12004 return -EINVAL;
12005 }
12006
12007 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12008
12009 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
12010 admitted_time =
12011 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
12012 if (!admitted_time)
12013 return -EINVAL;
12014 }
12015
12016 wdev_lock(wdev);
12017 switch (wdev->iftype) {
12018 case NL80211_IFTYPE_STATION:
12019 case NL80211_IFTYPE_P2P_CLIENT:
12020 if (wdev->current_bss)
12021 break;
12022 err = -ENOTCONN;
12023 goto out;
12024 default:
12025 err = -EOPNOTSUPP;
12026 goto out;
12027 }
12028
12029 err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
12030
12031 out:
12032 wdev_unlock(wdev);
12033 return err;
12034}
12035
12036static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
12037{
12038 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12039 struct net_device *dev = info->user_ptr[1];
12040 struct wireless_dev *wdev = dev->ieee80211_ptr;
12041 const u8 *peer;
12042 u8 tsid;
12043 int err;
12044
12045 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
12046 return -EINVAL;
12047
12048 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
12049 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12050
12051 wdev_lock(wdev);
12052 err = rdev_del_tx_ts(rdev, dev, tsid, peer);
12053 wdev_unlock(wdev);
12054
12055 return err;
12056}
12057
Arik Nemtsov1057d352014-11-19 12:54:26 +020012058static int nl80211_tdls_channel_switch(struct sk_buff *skb,
12059 struct genl_info *info)
12060{
12061 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12062 struct net_device *dev = info->user_ptr[1];
12063 struct wireless_dev *wdev = dev->ieee80211_ptr;
12064 struct cfg80211_chan_def chandef = {};
12065 const u8 *addr;
12066 u8 oper_class;
12067 int err;
12068
12069 if (!rdev->ops->tdls_channel_switch ||
12070 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
12071 return -EOPNOTSUPP;
12072
12073 switch (dev->ieee80211_ptr->iftype) {
12074 case NL80211_IFTYPE_STATION:
12075 case NL80211_IFTYPE_P2P_CLIENT:
12076 break;
12077 default:
12078 return -EOPNOTSUPP;
12079 }
12080
12081 if (!info->attrs[NL80211_ATTR_MAC] ||
12082 !info->attrs[NL80211_ATTR_OPER_CLASS])
12083 return -EINVAL;
12084
12085 err = nl80211_parse_chandef(rdev, info, &chandef);
12086 if (err)
12087 return err;
12088
12089 /*
12090 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
12091 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
12092 * specification is not defined for them.
12093 */
Johannes Berg57fbcce2016-04-12 15:56:15 +020012094 if (chandef.chan->band == NL80211_BAND_2GHZ &&
Arik Nemtsov1057d352014-11-19 12:54:26 +020012095 chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
12096 chandef.width != NL80211_CHAN_WIDTH_20)
12097 return -EINVAL;
12098
12099 /* we will be active on the TDLS link */
Arik Nemtsov923b3522015-07-08 15:41:44 +030012100 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
12101 wdev->iftype))
Arik Nemtsov1057d352014-11-19 12:54:26 +020012102 return -EINVAL;
12103
12104 /* don't allow switching to DFS channels */
12105 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
12106 return -EINVAL;
12107
12108 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
12109 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
12110
12111 wdev_lock(wdev);
12112 err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
12113 wdev_unlock(wdev);
12114
12115 return err;
12116}
12117
12118static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
12119 struct genl_info *info)
12120{
12121 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12122 struct net_device *dev = info->user_ptr[1];
12123 struct wireless_dev *wdev = dev->ieee80211_ptr;
12124 const u8 *addr;
12125
12126 if (!rdev->ops->tdls_channel_switch ||
12127 !rdev->ops->tdls_cancel_channel_switch ||
12128 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
12129 return -EOPNOTSUPP;
12130
12131 switch (dev->ieee80211_ptr->iftype) {
12132 case NL80211_IFTYPE_STATION:
12133 case NL80211_IFTYPE_P2P_CLIENT:
12134 break;
12135 default:
12136 return -EOPNOTSUPP;
12137 }
12138
12139 if (!info->attrs[NL80211_ATTR_MAC])
12140 return -EINVAL;
12141
12142 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
12143
12144 wdev_lock(wdev);
12145 rdev_tdls_cancel_channel_switch(rdev, dev, addr);
12146 wdev_unlock(wdev);
12147
12148 return 0;
12149}
12150
Michael Braund757efc2016-10-10 19:12:22 +020012151static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
12152 struct genl_info *info)
12153{
12154 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12155 struct net_device *dev = info->user_ptr[1];
12156 struct wireless_dev *wdev = dev->ieee80211_ptr;
12157 const struct nlattr *nla;
12158 bool enabled;
12159
12160 if (netif_running(dev))
12161 return -EBUSY;
12162
12163 if (!rdev->ops->set_multicast_to_unicast)
12164 return -EOPNOTSUPP;
12165
12166 if (wdev->iftype != NL80211_IFTYPE_AP &&
12167 wdev->iftype != NL80211_IFTYPE_P2P_GO)
12168 return -EOPNOTSUPP;
12169
12170 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
12171 enabled = nla_get_flag(nla);
12172
12173 return rdev_set_multicast_to_unicast(rdev, dev, enabled);
12174}
12175
Srinivas Dasarid041a1a2018-02-07 18:32:17 +053012176static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info)
12177{
12178 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12179 struct net_device *dev = info->user_ptr[1];
12180 struct cfg80211_external_auth_params params;
12181
Srinivas Dasari05c8cd32018-02-02 11:15:27 +020012182 if (!rdev->ops->external_auth)
Srinivas Dasarid041a1a2018-02-07 18:32:17 +053012183 return -EOPNOTSUPP;
12184
Srinivas Dasari0c095552019-08-12 13:08:43 +053012185 if (!info->attrs[NL80211_ATTR_SSID] &&
12186 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
12187 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
Srinivas Dasarid041a1a2018-02-07 18:32:17 +053012188 return -EINVAL;
12189
12190 if (!info->attrs[NL80211_ATTR_BSSID])
12191 return -EINVAL;
12192
12193 if (!info->attrs[NL80211_ATTR_STATUS_CODE])
12194 return -EINVAL;
12195
12196 memset(&params, 0, sizeof(params));
12197
Srinivas Dasari0c095552019-08-12 13:08:43 +053012198 if (info->attrs[NL80211_ATTR_SSID]) {
12199 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
12200 if (params.ssid.ssid_len == 0 ||
12201 params.ssid.ssid_len > IEEE80211_MAX_SSID_LEN)
12202 return -EINVAL;
12203 memcpy(params.ssid.ssid,
12204 nla_data(info->attrs[NL80211_ATTR_SSID]),
12205 params.ssid.ssid_len);
12206 }
Srinivas Dasarid041a1a2018-02-07 18:32:17 +053012207
12208 memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]),
12209 ETH_ALEN);
12210
12211 params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
12212
Srinivas Dasari0c095552019-08-12 13:08:43 +053012213 if (info->attrs[NL80211_ATTR_PMKID])
12214 params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
12215
Srinivas Dasarid041a1a2018-02-07 18:32:17 +053012216 return rdev_external_auth(rdev, dev, &params);
12217}
12218
Sunil Dutt6e200822019-04-09 13:09:28 +053012219static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info)
12220{
12221 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12222 struct cfg80211_update_owe_info owe_info;
12223 struct net_device *dev = info->user_ptr[1];
12224
12225 if (!rdev->ops->update_owe_info)
12226 return -EOPNOTSUPP;
12227
12228 if (!info->attrs[NL80211_ATTR_STATUS_CODE] ||
12229 !info->attrs[NL80211_ATTR_MAC])
12230 return -EINVAL;
12231
12232 memset(&owe_info, 0, sizeof(owe_info));
12233 owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
12234 nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN);
12235
12236 if (info->attrs[NL80211_ATTR_IE]) {
12237 owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
12238 owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
12239 }
12240
12241 return rdev_update_owe_info(rdev, dev, &owe_info);
12242}
12243
Johannes Berg4c476992010-10-04 21:36:35 +020012244#define NL80211_FLAG_NEED_WIPHY 0x01
12245#define NL80211_FLAG_NEED_NETDEV 0x02
12246#define NL80211_FLAG_NEED_RTNL 0x04
Johannes Berg41265712010-10-04 21:14:05 +020012247#define NL80211_FLAG_CHECK_NETDEV_UP 0x08
12248#define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
12249 NL80211_FLAG_CHECK_NETDEV_UP)
Johannes Berg1bf614e2012-06-15 15:23:36 +020012250#define NL80211_FLAG_NEED_WDEV 0x10
Johannes Berg98104fde2012-06-16 00:19:54 +020012251/* If a netdev is associated, it must be UP, P2P must be started */
Johannes Berg1bf614e2012-06-15 15:23:36 +020012252#define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
12253 NL80211_FLAG_CHECK_NETDEV_UP)
Johannes Berg5393b912014-09-10 15:00:16 +030012254#define NL80211_FLAG_CLEAR_SKB 0x20
Johannes Berg4c476992010-10-04 21:36:35 +020012255
Johannes Bergf84f7712013-11-14 17:14:45 +010012256static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
Johannes Berg4c476992010-10-04 21:36:35 +020012257 struct genl_info *info)
12258{
12259 struct cfg80211_registered_device *rdev;
Johannes Berg89a54e42012-06-15 14:33:17 +020012260 struct wireless_dev *wdev;
Johannes Berg4c476992010-10-04 21:36:35 +020012261 struct net_device *dev;
Johannes Berg4c476992010-10-04 21:36:35 +020012262 bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
12263
12264 if (rtnl)
12265 rtnl_lock();
12266
12267 if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
Johannes Berg4f7eff12012-06-15 14:14:22 +020012268 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
Johannes Berg4c476992010-10-04 21:36:35 +020012269 if (IS_ERR(rdev)) {
12270 if (rtnl)
12271 rtnl_unlock();
12272 return PTR_ERR(rdev);
12273 }
12274 info->user_ptr[0] = rdev;
Johannes Berg1bf614e2012-06-15 15:23:36 +020012275 } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
12276 ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
Johannes Berg5fe231e2013-05-08 21:45:15 +020012277 ASSERT_RTNL();
12278
Johannes Berg89a54e42012-06-15 14:33:17 +020012279 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
12280 info->attrs);
12281 if (IS_ERR(wdev)) {
Johannes Berg4c476992010-10-04 21:36:35 +020012282 if (rtnl)
12283 rtnl_unlock();
Johannes Berg89a54e42012-06-15 14:33:17 +020012284 return PTR_ERR(wdev);
Johannes Berg4c476992010-10-04 21:36:35 +020012285 }
Johannes Berg89a54e42012-06-15 14:33:17 +020012286
Johannes Berg89a54e42012-06-15 14:33:17 +020012287 dev = wdev->netdev;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080012288 rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Berg89a54e42012-06-15 14:33:17 +020012289
Johannes Berg1bf614e2012-06-15 15:23:36 +020012290 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
12291 if (!dev) {
Johannes Berg1bf614e2012-06-15 15:23:36 +020012292 if (rtnl)
12293 rtnl_unlock();
12294 return -EINVAL;
12295 }
12296
12297 info->user_ptr[1] = dev;
12298 } else {
12299 info->user_ptr[1] = wdev;
Johannes Berg41265712010-10-04 21:14:05 +020012300 }
Johannes Berg89a54e42012-06-15 14:33:17 +020012301
Johannes Berg1bf614e2012-06-15 15:23:36 +020012302 if (dev) {
12303 if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
12304 !netif_running(dev)) {
Johannes Berg1bf614e2012-06-15 15:23:36 +020012305 if (rtnl)
12306 rtnl_unlock();
12307 return -ENETDOWN;
12308 }
12309
12310 dev_hold(dev);
Johannes Berg98104fde2012-06-16 00:19:54 +020012311 } else if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP) {
Ayala Bekercb3b7d82016-09-20 17:31:13 +030012312 if (wdev->iftype == NL80211_IFTYPE_P2P_DEVICE &&
12313 !wdev->p2p_started) {
12314 if (rtnl)
12315 rtnl_unlock();
12316 return -ENETDOWN;
12317 }
12318 if (wdev->iftype == NL80211_IFTYPE_NAN &&
12319 !wdev->nan_started) {
Johannes Berg98104fde2012-06-16 00:19:54 +020012320 if (rtnl)
12321 rtnl_unlock();
12322 return -ENETDOWN;
12323 }
Johannes Berg1bf614e2012-06-15 15:23:36 +020012324 }
12325
Johannes Berg4c476992010-10-04 21:36:35 +020012326 info->user_ptr[0] = rdev;
Johannes Berg4c476992010-10-04 21:36:35 +020012327 }
12328
12329 return 0;
12330}
12331
Johannes Bergf84f7712013-11-14 17:14:45 +010012332static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
Johannes Berg4c476992010-10-04 21:36:35 +020012333 struct genl_info *info)
12334{
Johannes Berg1bf614e2012-06-15 15:23:36 +020012335 if (info->user_ptr[1]) {
12336 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
12337 struct wireless_dev *wdev = info->user_ptr[1];
12338
12339 if (wdev->netdev)
12340 dev_put(wdev->netdev);
12341 } else {
12342 dev_put(info->user_ptr[1]);
12343 }
12344 }
Johannes Berg5393b912014-09-10 15:00:16 +030012345
Johannes Berg4c476992010-10-04 21:36:35 +020012346 if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
12347 rtnl_unlock();
Johannes Berg5393b912014-09-10 15:00:16 +030012348
12349 /* If needed, clear the netlink message payload from the SKB
12350 * as it might contain key data that shouldn't stick around on
12351 * the heap after the SKB is freed. The netlink message header
12352 * is still needed for further processing, so leave it intact.
12353 */
12354 if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
12355 struct nlmsghdr *nlh = nlmsg_hdr(skb);
12356
12357 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
12358 }
Johannes Berg4c476992010-10-04 21:36:35 +020012359}
12360
Johannes Berg4534de82013-11-14 17:14:46 +010012361static const struct genl_ops nl80211_ops[] = {
Johannes Berg55682962007-09-20 13:09:35 -040012362 {
12363 .cmd = NL80211_CMD_GET_WIPHY,
12364 .doit = nl80211_get_wiphy,
12365 .dumpit = nl80211_dump_wiphy,
Johannes Berg86e8cf92013-06-19 10:57:22 +020012366 .done = nl80211_dump_wiphy_done,
Johannes Berg55682962007-09-20 13:09:35 -040012367 .policy = nl80211_policy,
12368 /* can be retrieved by unprivileged users */
Johannes Berg5fe231e2013-05-08 21:45:15 +020012369 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12370 NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012371 },
12372 {
12373 .cmd = NL80211_CMD_SET_WIPHY,
12374 .doit = nl80211_set_wiphy,
12375 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012376 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012377 .internal_flags = NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012378 },
12379 {
12380 .cmd = NL80211_CMD_GET_INTERFACE,
12381 .doit = nl80211_get_interface,
12382 .dumpit = nl80211_dump_interface,
12383 .policy = nl80211_policy,
12384 /* can be retrieved by unprivileged users */
Johannes Berg5fe231e2013-05-08 21:45:15 +020012385 .internal_flags = NL80211_FLAG_NEED_WDEV |
12386 NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012387 },
12388 {
12389 .cmd = NL80211_CMD_SET_INTERFACE,
12390 .doit = nl80211_set_interface,
12391 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012392 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012393 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12394 NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012395 },
12396 {
12397 .cmd = NL80211_CMD_NEW_INTERFACE,
12398 .doit = nl80211_new_interface,
12399 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012400 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012401 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12402 NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012403 },
12404 {
12405 .cmd = NL80211_CMD_DEL_INTERFACE,
12406 .doit = nl80211_del_interface,
12407 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012408 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg84efbb82012-06-16 00:00:26 +020012409 .internal_flags = NL80211_FLAG_NEED_WDEV |
Johannes Berg4c476992010-10-04 21:36:35 +020012410 NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012411 },
Johannes Berg41ade002007-12-19 02:03:29 +010012412 {
12413 .cmd = NL80211_CMD_GET_KEY,
12414 .doit = nl80211_get_key,
12415 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012416 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012417 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012418 NL80211_FLAG_NEED_RTNL,
Johannes Berg41ade002007-12-19 02:03:29 +010012419 },
12420 {
12421 .cmd = NL80211_CMD_SET_KEY,
12422 .doit = nl80211_set_key,
12423 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012424 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012425 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg5393b912014-09-10 15:00:16 +030012426 NL80211_FLAG_NEED_RTNL |
12427 NL80211_FLAG_CLEAR_SKB,
Johannes Berg41ade002007-12-19 02:03:29 +010012428 },
12429 {
12430 .cmd = NL80211_CMD_NEW_KEY,
12431 .doit = nl80211_new_key,
12432 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012433 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012434 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg5393b912014-09-10 15:00:16 +030012435 NL80211_FLAG_NEED_RTNL |
12436 NL80211_FLAG_CLEAR_SKB,
Johannes Berg41ade002007-12-19 02:03:29 +010012437 },
12438 {
12439 .cmd = NL80211_CMD_DEL_KEY,
12440 .doit = nl80211_del_key,
12441 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012442 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012443 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012444 NL80211_FLAG_NEED_RTNL,
Johannes Berg41ade002007-12-19 02:03:29 +010012445 },
Johannes Berged1b6cc2007-12-19 02:03:32 +010012446 {
12447 .cmd = NL80211_CMD_SET_BEACON,
12448 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012449 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg88600202012-02-13 15:17:18 +010012450 .doit = nl80211_set_beacon,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012451 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012452 NL80211_FLAG_NEED_RTNL,
Johannes Berged1b6cc2007-12-19 02:03:32 +010012453 },
12454 {
Johannes Berg88600202012-02-13 15:17:18 +010012455 .cmd = NL80211_CMD_START_AP,
Johannes Berged1b6cc2007-12-19 02:03:32 +010012456 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012457 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg88600202012-02-13 15:17:18 +010012458 .doit = nl80211_start_ap,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012459 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012460 NL80211_FLAG_NEED_RTNL,
Johannes Berged1b6cc2007-12-19 02:03:32 +010012461 },
12462 {
Johannes Berg88600202012-02-13 15:17:18 +010012463 .cmd = NL80211_CMD_STOP_AP,
Johannes Berged1b6cc2007-12-19 02:03:32 +010012464 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012465 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg88600202012-02-13 15:17:18 +010012466 .doit = nl80211_stop_ap,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012467 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012468 NL80211_FLAG_NEED_RTNL,
Johannes Berged1b6cc2007-12-19 02:03:32 +010012469 },
Johannes Berg5727ef12007-12-19 02:03:34 +010012470 {
12471 .cmd = NL80211_CMD_GET_STATION,
12472 .doit = nl80211_get_station,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012473 .dumpit = nl80211_dump_station,
Johannes Berg5727ef12007-12-19 02:03:34 +010012474 .policy = nl80211_policy,
Johannes Berg4c476992010-10-04 21:36:35 +020012475 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12476 NL80211_FLAG_NEED_RTNL,
Johannes Berg5727ef12007-12-19 02:03:34 +010012477 },
12478 {
12479 .cmd = NL80211_CMD_SET_STATION,
12480 .doit = nl80211_set_station,
12481 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012482 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012483 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012484 NL80211_FLAG_NEED_RTNL,
Johannes Berg5727ef12007-12-19 02:03:34 +010012485 },
12486 {
12487 .cmd = NL80211_CMD_NEW_STATION,
12488 .doit = nl80211_new_station,
12489 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012490 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012491 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012492 NL80211_FLAG_NEED_RTNL,
Johannes Berg5727ef12007-12-19 02:03:34 +010012493 },
12494 {
12495 .cmd = NL80211_CMD_DEL_STATION,
12496 .doit = nl80211_del_station,
12497 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012498 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012499 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012500 NL80211_FLAG_NEED_RTNL,
Johannes Berg5727ef12007-12-19 02:03:34 +010012501 },
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012502 {
12503 .cmd = NL80211_CMD_GET_MPATH,
12504 .doit = nl80211_get_mpath,
12505 .dumpit = nl80211_dump_mpath,
12506 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012507 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012508 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012509 NL80211_FLAG_NEED_RTNL,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012510 },
12511 {
Henning Rogge66be7d22014-09-12 08:58:49 +020012512 .cmd = NL80211_CMD_GET_MPP,
12513 .doit = nl80211_get_mpp,
12514 .dumpit = nl80211_dump_mpp,
12515 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012516 .flags = GENL_UNS_ADMIN_PERM,
Henning Rogge66be7d22014-09-12 08:58:49 +020012517 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12518 NL80211_FLAG_NEED_RTNL,
12519 },
12520 {
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012521 .cmd = NL80211_CMD_SET_MPATH,
12522 .doit = nl80211_set_mpath,
12523 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012524 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012525 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012526 NL80211_FLAG_NEED_RTNL,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012527 },
12528 {
12529 .cmd = NL80211_CMD_NEW_MPATH,
12530 .doit = nl80211_new_mpath,
12531 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012532 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012533 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012534 NL80211_FLAG_NEED_RTNL,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012535 },
12536 {
12537 .cmd = NL80211_CMD_DEL_MPATH,
12538 .doit = nl80211_del_mpath,
12539 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012540 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012541 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012542 NL80211_FLAG_NEED_RTNL,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012543 },
Jouni Malinen9f1ba902008-08-07 20:07:01 +030012544 {
12545 .cmd = NL80211_CMD_SET_BSS,
12546 .doit = nl80211_set_bss,
12547 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012548 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012549 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012550 NL80211_FLAG_NEED_RTNL,
Jouni Malinen9f1ba902008-08-07 20:07:01 +030012551 },
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -070012552 {
Luis R. Rodriguezf1303472009-01-30 09:26:42 -080012553 .cmd = NL80211_CMD_GET_REG,
Arik Nemtsovad30ca22014-12-15 19:25:59 +020012554 .doit = nl80211_get_reg_do,
12555 .dumpit = nl80211_get_reg_dump,
Luis R. Rodriguezf1303472009-01-30 09:26:42 -080012556 .policy = nl80211_policy,
Johannes Berg5fe231e2013-05-08 21:45:15 +020012557 .internal_flags = NL80211_FLAG_NEED_RTNL,
Luis R. Rodriguezf1303472009-01-30 09:26:42 -080012558 /* can be retrieved by unprivileged users */
12559 },
Johannes Bergb6863032015-10-15 09:25:18 +020012560#ifdef CONFIG_CFG80211_CRDA_SUPPORT
Luis R. Rodriguezf1303472009-01-30 09:26:42 -080012561 {
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -070012562 .cmd = NL80211_CMD_SET_REG,
12563 .doit = nl80211_set_reg,
12564 .policy = nl80211_policy,
12565 .flags = GENL_ADMIN_PERM,
Johannes Berg5fe231e2013-05-08 21:45:15 +020012566 .internal_flags = NL80211_FLAG_NEED_RTNL,
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -070012567 },
Johannes Bergb6863032015-10-15 09:25:18 +020012568#endif
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -070012569 {
12570 .cmd = NL80211_CMD_REQ_SET_REG,
12571 .doit = nl80211_req_set_reg,
12572 .policy = nl80211_policy,
12573 .flags = GENL_ADMIN_PERM,
12574 },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -070012575 {
Javier Cardona24bdd9f2010-12-16 17:37:48 -080012576 .cmd = NL80211_CMD_GET_MESH_CONFIG,
12577 .doit = nl80211_get_mesh_config,
colin@cozybit.com93da9cc2008-10-21 12:03:48 -070012578 .policy = nl80211_policy,
12579 /* can be retrieved by unprivileged users */
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012580 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012581 NL80211_FLAG_NEED_RTNL,
colin@cozybit.com93da9cc2008-10-21 12:03:48 -070012582 },
12583 {
Javier Cardona24bdd9f2010-12-16 17:37:48 -080012584 .cmd = NL80211_CMD_SET_MESH_CONFIG,
12585 .doit = nl80211_update_mesh_config,
colin@cozybit.com93da9cc2008-10-21 12:03:48 -070012586 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012587 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg29cbe682010-12-03 09:20:44 +010012588 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012589 NL80211_FLAG_NEED_RTNL,
colin@cozybit.com93da9cc2008-10-21 12:03:48 -070012590 },
Jouni Malinen9aed3cc2009-01-13 16:03:29 +020012591 {
Johannes Berg2a519312009-02-10 21:25:55 +010012592 .cmd = NL80211_CMD_TRIGGER_SCAN,
12593 .doit = nl80211_trigger_scan,
12594 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012595 .flags = GENL_UNS_ADMIN_PERM,
Johannes Bergfd014282012-06-18 19:17:03 +020012596 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012597 NL80211_FLAG_NEED_RTNL,
Johannes Berg2a519312009-02-10 21:25:55 +010012598 },
12599 {
Vidyullatha Kanchanapally91d3ab42015-10-30 19:14:49 +053012600 .cmd = NL80211_CMD_ABORT_SCAN,
12601 .doit = nl80211_abort_scan,
12602 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012603 .flags = GENL_UNS_ADMIN_PERM,
Vidyullatha Kanchanapally91d3ab42015-10-30 19:14:49 +053012604 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12605 NL80211_FLAG_NEED_RTNL,
12606 },
12607 {
Johannes Berg2a519312009-02-10 21:25:55 +010012608 .cmd = NL80211_CMD_GET_SCAN,
12609 .policy = nl80211_policy,
12610 .dumpit = nl80211_dump_scan,
12611 },
Jouni Malinen636a5d32009-03-19 13:39:22 +020012612 {
Luciano Coelho807f8a82011-05-11 17:09:35 +030012613 .cmd = NL80211_CMD_START_SCHED_SCAN,
12614 .doit = nl80211_start_sched_scan,
12615 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012616 .flags = GENL_UNS_ADMIN_PERM,
Luciano Coelho807f8a82011-05-11 17:09:35 +030012617 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12618 NL80211_FLAG_NEED_RTNL,
12619 },
12620 {
12621 .cmd = NL80211_CMD_STOP_SCHED_SCAN,
12622 .doit = nl80211_stop_sched_scan,
12623 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012624 .flags = GENL_UNS_ADMIN_PERM,
Luciano Coelho807f8a82011-05-11 17:09:35 +030012625 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12626 NL80211_FLAG_NEED_RTNL,
12627 },
12628 {
Jouni Malinen636a5d32009-03-19 13:39:22 +020012629 .cmd = NL80211_CMD_AUTHENTICATE,
12630 .doit = nl80211_authenticate,
12631 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012632 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012633 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg5393b912014-09-10 15:00:16 +030012634 NL80211_FLAG_NEED_RTNL |
12635 NL80211_FLAG_CLEAR_SKB,
Jouni Malinen636a5d32009-03-19 13:39:22 +020012636 },
12637 {
12638 .cmd = NL80211_CMD_ASSOCIATE,
12639 .doit = nl80211_associate,
12640 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012641 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012642 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012643 NL80211_FLAG_NEED_RTNL,
Jouni Malinen636a5d32009-03-19 13:39:22 +020012644 },
12645 {
12646 .cmd = NL80211_CMD_DEAUTHENTICATE,
12647 .doit = nl80211_deauthenticate,
12648 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012649 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012650 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012651 NL80211_FLAG_NEED_RTNL,
Jouni Malinen636a5d32009-03-19 13:39:22 +020012652 },
12653 {
12654 .cmd = NL80211_CMD_DISASSOCIATE,
12655 .doit = nl80211_disassociate,
12656 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012657 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012658 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012659 NL80211_FLAG_NEED_RTNL,
Jouni Malinen636a5d32009-03-19 13:39:22 +020012660 },
Johannes Berg04a773a2009-04-19 21:24:32 +020012661 {
12662 .cmd = NL80211_CMD_JOIN_IBSS,
12663 .doit = nl80211_join_ibss,
12664 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012665 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012666 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012667 NL80211_FLAG_NEED_RTNL,
Johannes Berg04a773a2009-04-19 21:24:32 +020012668 },
12669 {
12670 .cmd = NL80211_CMD_LEAVE_IBSS,
12671 .doit = nl80211_leave_ibss,
12672 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012673 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012674 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012675 NL80211_FLAG_NEED_RTNL,
Johannes Berg04a773a2009-04-19 21:24:32 +020012676 },
Johannes Bergaff89a92009-07-01 21:26:51 +020012677#ifdef CONFIG_NL80211_TESTMODE
12678 {
12679 .cmd = NL80211_CMD_TESTMODE,
12680 .doit = nl80211_testmode_do,
Wey-Yi Guy71063f02011-05-20 09:05:54 -070012681 .dumpit = nl80211_testmode_dump,
Johannes Bergaff89a92009-07-01 21:26:51 +020012682 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012683 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012684 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12685 NL80211_FLAG_NEED_RTNL,
Johannes Bergaff89a92009-07-01 21:26:51 +020012686 },
12687#endif
Samuel Ortizb23aa672009-07-01 21:26:54 +020012688 {
12689 .cmd = NL80211_CMD_CONNECT,
12690 .doit = nl80211_connect,
12691 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012692 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012693 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012694 NL80211_FLAG_NEED_RTNL,
Samuel Ortizb23aa672009-07-01 21:26:54 +020012695 },
12696 {
vamsi krishna30da4e82016-10-27 16:51:11 +030012697 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
12698 .doit = nl80211_update_connect_params,
12699 .policy = nl80211_policy,
12700 .flags = GENL_ADMIN_PERM,
12701 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12702 NL80211_FLAG_NEED_RTNL,
12703 },
12704 {
Samuel Ortizb23aa672009-07-01 21:26:54 +020012705 .cmd = NL80211_CMD_DISCONNECT,
12706 .doit = nl80211_disconnect,
12707 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012708 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012709 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012710 NL80211_FLAG_NEED_RTNL,
Samuel Ortizb23aa672009-07-01 21:26:54 +020012711 },
Johannes Berg463d0182009-07-14 00:33:35 +020012712 {
12713 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
12714 .doit = nl80211_wiphy_netns,
12715 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012716 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012717 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12718 NL80211_FLAG_NEED_RTNL,
Johannes Berg463d0182009-07-14 00:33:35 +020012719 },
Holger Schurig61fa7132009-11-11 12:25:40 +010012720 {
12721 .cmd = NL80211_CMD_GET_SURVEY,
12722 .policy = nl80211_policy,
12723 .dumpit = nl80211_dump_survey,
12724 },
Samuel Ortiz67fbb162009-11-24 23:59:15 +010012725 {
12726 .cmd = NL80211_CMD_SET_PMKSA,
12727 .doit = nl80211_setdel_pmksa,
12728 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012729 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012730 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012731 NL80211_FLAG_NEED_RTNL,
Samuel Ortiz67fbb162009-11-24 23:59:15 +010012732 },
12733 {
12734 .cmd = NL80211_CMD_DEL_PMKSA,
12735 .doit = nl80211_setdel_pmksa,
12736 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012737 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012738 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012739 NL80211_FLAG_NEED_RTNL,
Samuel Ortiz67fbb162009-11-24 23:59:15 +010012740 },
12741 {
12742 .cmd = NL80211_CMD_FLUSH_PMKSA,
12743 .doit = nl80211_flush_pmksa,
12744 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012745 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012746 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012747 NL80211_FLAG_NEED_RTNL,
Samuel Ortiz67fbb162009-11-24 23:59:15 +010012748 },
Jouni Malinen9588bbd2009-12-23 13:15:41 +010012749 {
12750 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
12751 .doit = nl80211_remain_on_channel,
12752 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012753 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg71bbc992012-06-15 15:30:18 +020012754 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012755 NL80211_FLAG_NEED_RTNL,
Jouni Malinen9588bbd2009-12-23 13:15:41 +010012756 },
12757 {
12758 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
12759 .doit = nl80211_cancel_remain_on_channel,
12760 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012761 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg71bbc992012-06-15 15:30:18 +020012762 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012763 NL80211_FLAG_NEED_RTNL,
Jouni Malinen9588bbd2009-12-23 13:15:41 +010012764 },
Jouni Malinen13ae75b2009-12-29 12:59:45 +020012765 {
12766 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
12767 .doit = nl80211_set_tx_bitrate_mask,
12768 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012769 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012770 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12771 NL80211_FLAG_NEED_RTNL,
Jouni Malinen13ae75b2009-12-29 12:59:45 +020012772 },
Jouni Malinen026331c2010-02-15 12:53:10 +020012773 {
Johannes Berg2e161f72010-08-12 15:38:38 +020012774 .cmd = NL80211_CMD_REGISTER_FRAME,
12775 .doit = nl80211_register_mgmt,
Jouni Malinen026331c2010-02-15 12:53:10 +020012776 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012777 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg71bbc992012-06-15 15:30:18 +020012778 .internal_flags = NL80211_FLAG_NEED_WDEV |
Johannes Berg4c476992010-10-04 21:36:35 +020012779 NL80211_FLAG_NEED_RTNL,
Jouni Malinen026331c2010-02-15 12:53:10 +020012780 },
12781 {
Johannes Berg2e161f72010-08-12 15:38:38 +020012782 .cmd = NL80211_CMD_FRAME,
12783 .doit = nl80211_tx_mgmt,
Jouni Malinen026331c2010-02-15 12:53:10 +020012784 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012785 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg71bbc992012-06-15 15:30:18 +020012786 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012787 NL80211_FLAG_NEED_RTNL,
Jouni Malinen026331c2010-02-15 12:53:10 +020012788 },
Kalle Valoffb9eb32010-02-17 17:58:10 +020012789 {
Johannes Bergf7ca38d2010-11-25 10:02:29 +010012790 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
12791 .doit = nl80211_tx_mgmt_cancel_wait,
12792 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012793 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg71bbc992012-06-15 15:30:18 +020012794 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
Johannes Bergf7ca38d2010-11-25 10:02:29 +010012795 NL80211_FLAG_NEED_RTNL,
12796 },
12797 {
Kalle Valoffb9eb32010-02-17 17:58:10 +020012798 .cmd = NL80211_CMD_SET_POWER_SAVE,
12799 .doit = nl80211_set_power_save,
12800 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012801 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012802 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12803 NL80211_FLAG_NEED_RTNL,
Kalle Valoffb9eb32010-02-17 17:58:10 +020012804 },
12805 {
12806 .cmd = NL80211_CMD_GET_POWER_SAVE,
12807 .doit = nl80211_get_power_save,
12808 .policy = nl80211_policy,
12809 /* can be retrieved by unprivileged users */
Johannes Berg4c476992010-10-04 21:36:35 +020012810 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12811 NL80211_FLAG_NEED_RTNL,
Kalle Valoffb9eb32010-02-17 17:58:10 +020012812 },
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020012813 {
12814 .cmd = NL80211_CMD_SET_CQM,
12815 .doit = nl80211_set_cqm,
12816 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012817 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012818 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12819 NL80211_FLAG_NEED_RTNL,
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020012820 },
Johannes Bergf444de02010-05-05 15:25:02 +020012821 {
12822 .cmd = NL80211_CMD_SET_CHANNEL,
12823 .doit = nl80211_set_channel,
12824 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012825 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012826 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12827 NL80211_FLAG_NEED_RTNL,
Johannes Bergf444de02010-05-05 15:25:02 +020012828 },
Bill Jordane8347eb2010-10-01 13:54:28 -040012829 {
12830 .cmd = NL80211_CMD_SET_WDS_PEER,
12831 .doit = nl80211_set_wds_peer,
12832 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012833 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg43b19952010-10-07 13:10:30 +020012834 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12835 NL80211_FLAG_NEED_RTNL,
Bill Jordane8347eb2010-10-01 13:54:28 -040012836 },
Johannes Berg29cbe682010-12-03 09:20:44 +010012837 {
12838 .cmd = NL80211_CMD_JOIN_MESH,
12839 .doit = nl80211_join_mesh,
12840 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012841 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg29cbe682010-12-03 09:20:44 +010012842 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12843 NL80211_FLAG_NEED_RTNL,
12844 },
12845 {
12846 .cmd = NL80211_CMD_LEAVE_MESH,
12847 .doit = nl80211_leave_mesh,
12848 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012849 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg29cbe682010-12-03 09:20:44 +010012850 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12851 NL80211_FLAG_NEED_RTNL,
12852 },
Rostislav Lisovy6e0bd6c2014-11-03 10:33:18 +010012853 {
12854 .cmd = NL80211_CMD_JOIN_OCB,
12855 .doit = nl80211_join_ocb,
12856 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012857 .flags = GENL_UNS_ADMIN_PERM,
Rostislav Lisovy6e0bd6c2014-11-03 10:33:18 +010012858 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12859 NL80211_FLAG_NEED_RTNL,
12860 },
12861 {
12862 .cmd = NL80211_CMD_LEAVE_OCB,
12863 .doit = nl80211_leave_ocb,
12864 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012865 .flags = GENL_UNS_ADMIN_PERM,
Rostislav Lisovy6e0bd6c2014-11-03 10:33:18 +010012866 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12867 NL80211_FLAG_NEED_RTNL,
12868 },
Johannes Bergdfb89c52012-06-27 09:23:48 +020012869#ifdef CONFIG_PM
Johannes Bergff1b6e62011-05-04 15:37:28 +020012870 {
12871 .cmd = NL80211_CMD_GET_WOWLAN,
12872 .doit = nl80211_get_wowlan,
12873 .policy = nl80211_policy,
12874 /* can be retrieved by unprivileged users */
12875 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12876 NL80211_FLAG_NEED_RTNL,
12877 },
12878 {
12879 .cmd = NL80211_CMD_SET_WOWLAN,
12880 .doit = nl80211_set_wowlan,
12881 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012882 .flags = GENL_UNS_ADMIN_PERM,
Johannes Bergff1b6e62011-05-04 15:37:28 +020012883 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12884 NL80211_FLAG_NEED_RTNL,
12885 },
Johannes Bergdfb89c52012-06-27 09:23:48 +020012886#endif
Johannes Berge5497d72011-07-05 16:35:40 +020012887 {
12888 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
12889 .doit = nl80211_set_rekey_data,
12890 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012891 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berge5497d72011-07-05 16:35:40 +020012892 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg5393b912014-09-10 15:00:16 +030012893 NL80211_FLAG_NEED_RTNL |
12894 NL80211_FLAG_CLEAR_SKB,
Johannes Berge5497d72011-07-05 16:35:40 +020012895 },
Arik Nemtsov109086c2011-09-28 14:12:50 +030012896 {
12897 .cmd = NL80211_CMD_TDLS_MGMT,
12898 .doit = nl80211_tdls_mgmt,
12899 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012900 .flags = GENL_UNS_ADMIN_PERM,
Arik Nemtsov109086c2011-09-28 14:12:50 +030012901 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12902 NL80211_FLAG_NEED_RTNL,
12903 },
12904 {
12905 .cmd = NL80211_CMD_TDLS_OPER,
12906 .doit = nl80211_tdls_oper,
12907 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012908 .flags = GENL_UNS_ADMIN_PERM,
Arik Nemtsov109086c2011-09-28 14:12:50 +030012909 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12910 NL80211_FLAG_NEED_RTNL,
12911 },
Johannes Berg28946da2011-11-04 11:18:12 +010012912 {
12913 .cmd = NL80211_CMD_UNEXPECTED_FRAME,
12914 .doit = nl80211_register_unexpected_frame,
12915 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012916 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg28946da2011-11-04 11:18:12 +010012917 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12918 NL80211_FLAG_NEED_RTNL,
12919 },
Johannes Berg7f6cf312011-11-04 11:18:15 +010012920 {
12921 .cmd = NL80211_CMD_PROBE_CLIENT,
12922 .doit = nl80211_probe_client,
12923 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012924 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012925 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg7f6cf312011-11-04 11:18:15 +010012926 NL80211_FLAG_NEED_RTNL,
12927 },
Johannes Berg5e7602302011-11-04 11:18:17 +010012928 {
12929 .cmd = NL80211_CMD_REGISTER_BEACONS,
12930 .doit = nl80211_register_beacons,
12931 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012932 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg5e7602302011-11-04 11:18:17 +010012933 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12934 NL80211_FLAG_NEED_RTNL,
12935 },
Simon Wunderlich1d9d9212011-11-18 14:20:43 +010012936 {
12937 .cmd = NL80211_CMD_SET_NOACK_MAP,
12938 .doit = nl80211_set_noack_map,
12939 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012940 .flags = GENL_UNS_ADMIN_PERM,
Simon Wunderlich1d9d9212011-11-18 14:20:43 +010012941 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12942 NL80211_FLAG_NEED_RTNL,
12943 },
Johannes Berg98104fde2012-06-16 00:19:54 +020012944 {
12945 .cmd = NL80211_CMD_START_P2P_DEVICE,
12946 .doit = nl80211_start_p2p_device,
12947 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012948 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg98104fde2012-06-16 00:19:54 +020012949 .internal_flags = NL80211_FLAG_NEED_WDEV |
12950 NL80211_FLAG_NEED_RTNL,
12951 },
12952 {
12953 .cmd = NL80211_CMD_STOP_P2P_DEVICE,
12954 .doit = nl80211_stop_p2p_device,
12955 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012956 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg98104fde2012-06-16 00:19:54 +020012957 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12958 NL80211_FLAG_NEED_RTNL,
12959 },
Antonio Quartullif4e583c2012-11-02 13:27:48 +010012960 {
Ayala Bekercb3b7d82016-09-20 17:31:13 +030012961 .cmd = NL80211_CMD_START_NAN,
12962 .doit = nl80211_start_nan,
12963 .policy = nl80211_policy,
12964 .flags = GENL_ADMIN_PERM,
12965 .internal_flags = NL80211_FLAG_NEED_WDEV |
12966 NL80211_FLAG_NEED_RTNL,
12967 },
12968 {
12969 .cmd = NL80211_CMD_STOP_NAN,
12970 .doit = nl80211_stop_nan,
12971 .policy = nl80211_policy,
12972 .flags = GENL_ADMIN_PERM,
12973 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12974 NL80211_FLAG_NEED_RTNL,
12975 },
12976 {
Ayala Bekera442b762016-09-20 17:31:15 +030012977 .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
12978 .doit = nl80211_nan_add_func,
12979 .policy = nl80211_policy,
12980 .flags = GENL_ADMIN_PERM,
12981 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12982 NL80211_FLAG_NEED_RTNL,
12983 },
12984 {
12985 .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
12986 .doit = nl80211_nan_del_func,
12987 .policy = nl80211_policy,
12988 .flags = GENL_ADMIN_PERM,
12989 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12990 NL80211_FLAG_NEED_RTNL,
12991 },
12992 {
Ayala Bekera5a9dcf2016-09-20 17:31:16 +030012993 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
12994 .doit = nl80211_nan_change_config,
12995 .policy = nl80211_policy,
12996 .flags = GENL_ADMIN_PERM,
12997 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12998 NL80211_FLAG_NEED_RTNL,
12999 },
13000 {
Antonio Quartullif4e583c2012-11-02 13:27:48 +010013001 .cmd = NL80211_CMD_SET_MCAST_RATE,
13002 .doit = nl80211_set_mcast_rate,
13003 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013004 .flags = GENL_UNS_ADMIN_PERM,
Antonio Quartullif4e583c2012-11-02 13:27:48 +010013005 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13006 NL80211_FLAG_NEED_RTNL,
13007 },
Vasanthakumar Thiagarajan77765ea2013-01-18 11:18:45 +053013008 {
13009 .cmd = NL80211_CMD_SET_MAC_ACL,
13010 .doit = nl80211_set_mac_acl,
13011 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013012 .flags = GENL_UNS_ADMIN_PERM,
Vasanthakumar Thiagarajan77765ea2013-01-18 11:18:45 +053013013 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13014 NL80211_FLAG_NEED_RTNL,
13015 },
Simon Wunderlich04f39042013-02-08 18:16:19 +010013016 {
13017 .cmd = NL80211_CMD_RADAR_DETECT,
13018 .doit = nl80211_start_radar_detection,
13019 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013020 .flags = GENL_UNS_ADMIN_PERM,
Simon Wunderlich04f39042013-02-08 18:16:19 +010013021 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13022 NL80211_FLAG_NEED_RTNL,
13023 },
Johannes Berg3713b4e2013-02-14 16:19:38 +010013024 {
13025 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
13026 .doit = nl80211_get_protocol_features,
13027 .policy = nl80211_policy,
13028 },
Jouni Malinen355199e2013-02-27 17:14:27 +020013029 {
13030 .cmd = NL80211_CMD_UPDATE_FT_IES,
13031 .doit = nl80211_update_ft_ies,
13032 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013033 .flags = GENL_UNS_ADMIN_PERM,
Jouni Malinen355199e2013-02-27 17:14:27 +020013034 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13035 NL80211_FLAG_NEED_RTNL,
13036 },
Arend van Spriel5de17982013-04-18 15:49:00 +020013037 {
13038 .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
13039 .doit = nl80211_crit_protocol_start,
13040 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013041 .flags = GENL_UNS_ADMIN_PERM,
Arend van Spriel5de17982013-04-18 15:49:00 +020013042 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13043 NL80211_FLAG_NEED_RTNL,
13044 },
13045 {
13046 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
13047 .doit = nl80211_crit_protocol_stop,
13048 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013049 .flags = GENL_UNS_ADMIN_PERM,
Arend van Spriel5de17982013-04-18 15:49:00 +020013050 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13051 NL80211_FLAG_NEED_RTNL,
Amitkumar Karwarbe29b992013-06-28 11:51:26 -070013052 },
13053 {
13054 .cmd = NL80211_CMD_GET_COALESCE,
13055 .doit = nl80211_get_coalesce,
13056 .policy = nl80211_policy,
13057 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13058 NL80211_FLAG_NEED_RTNL,
13059 },
13060 {
13061 .cmd = NL80211_CMD_SET_COALESCE,
13062 .doit = nl80211_set_coalesce,
13063 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013064 .flags = GENL_UNS_ADMIN_PERM,
Amitkumar Karwarbe29b992013-06-28 11:51:26 -070013065 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13066 NL80211_FLAG_NEED_RTNL,
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +020013067 },
13068 {
13069 .cmd = NL80211_CMD_CHANNEL_SWITCH,
13070 .doit = nl80211_channel_switch,
13071 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013072 .flags = GENL_UNS_ADMIN_PERM,
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +020013073 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13074 NL80211_FLAG_NEED_RTNL,
13075 },
Johannes Bergad7e7182013-11-13 13:37:47 +010013076 {
13077 .cmd = NL80211_CMD_VENDOR,
13078 .doit = nl80211_vendor_cmd,
Johannes Berg7bdbe402015-08-15 22:39:49 +030013079 .dumpit = nl80211_vendor_cmd_dump,
Johannes Bergad7e7182013-11-13 13:37:47 +010013080 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013081 .flags = GENL_UNS_ADMIN_PERM,
Johannes Bergad7e7182013-11-13 13:37:47 +010013082 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13083 NL80211_FLAG_NEED_RTNL,
13084 },
Kyeyoon Parkfa9ffc72013-12-16 23:01:30 -080013085 {
13086 .cmd = NL80211_CMD_SET_QOS_MAP,
13087 .doit = nl80211_set_qos_map,
13088 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013089 .flags = GENL_UNS_ADMIN_PERM,
Kyeyoon Parkfa9ffc72013-12-16 23:01:30 -080013090 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13091 NL80211_FLAG_NEED_RTNL,
13092 },
Johannes Berg960d01a2014-09-09 22:55:35 +030013093 {
13094 .cmd = NL80211_CMD_ADD_TX_TS,
13095 .doit = nl80211_add_tx_ts,
13096 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013097 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg960d01a2014-09-09 22:55:35 +030013098 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13099 NL80211_FLAG_NEED_RTNL,
13100 },
13101 {
13102 .cmd = NL80211_CMD_DEL_TX_TS,
13103 .doit = nl80211_del_tx_ts,
13104 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013105 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg960d01a2014-09-09 22:55:35 +030013106 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13107 NL80211_FLAG_NEED_RTNL,
13108 },
Arik Nemtsov1057d352014-11-19 12:54:26 +020013109 {
13110 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
13111 .doit = nl80211_tdls_channel_switch,
13112 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013113 .flags = GENL_UNS_ADMIN_PERM,
Arik Nemtsov1057d352014-11-19 12:54:26 +020013114 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13115 NL80211_FLAG_NEED_RTNL,
13116 },
13117 {
13118 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
13119 .doit = nl80211_tdls_cancel_channel_switch,
13120 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013121 .flags = GENL_UNS_ADMIN_PERM,
Arik Nemtsov1057d352014-11-19 12:54:26 +020013122 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13123 NL80211_FLAG_NEED_RTNL,
13124 },
Michael Braund757efc2016-10-10 19:12:22 +020013125 {
13126 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
13127 .doit = nl80211_set_multicast_to_unicast,
13128 .policy = nl80211_policy,
13129 .flags = GENL_UNS_ADMIN_PERM,
13130 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13131 NL80211_FLAG_NEED_RTNL,
13132 },
Srinivas Dasarid041a1a2018-02-07 18:32:17 +053013133 {
13134 .cmd = NL80211_CMD_EXTERNAL_AUTH,
13135 .doit = nl80211_external_auth,
13136 .policy = nl80211_policy,
13137 .flags = GENL_ADMIN_PERM,
13138 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13139 NL80211_FLAG_NEED_RTNL,
13140 },
Sunil Dutt6e200822019-04-09 13:09:28 +053013141 {
13142 .cmd = NL80211_CMD_UPDATE_OWE_INFO,
13143 .doit = nl80211_update_owe_info,
13144 .flags = GENL_ADMIN_PERM,
13145 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13146 NL80211_FLAG_NEED_RTNL,
13147 },
Johannes Berg55682962007-09-20 13:09:35 -040013148};
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013149
Johannes Berg55682962007-09-20 13:09:35 -040013150/* notification functions */
13151
Johannes Berg3bb20552014-05-26 13:52:25 +020013152void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
13153 enum nl80211_commands cmd)
Johannes Berg55682962007-09-20 13:09:35 -040013154{
13155 struct sk_buff *msg;
Johannes Berg86e8cf92013-06-19 10:57:22 +020013156 struct nl80211_dump_wiphy_state state = {};
Johannes Berg55682962007-09-20 13:09:35 -040013157
Johannes Berg3bb20552014-05-26 13:52:25 +020013158 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
13159 cmd != NL80211_CMD_DEL_WIPHY);
13160
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -070013161 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg55682962007-09-20 13:09:35 -040013162 if (!msg)
13163 return;
13164
Johannes Berg3bb20552014-05-26 13:52:25 +020013165 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
Johannes Berg55682962007-09-20 13:09:35 -040013166 nlmsg_free(msg);
13167 return;
13168 }
13169
Johannes Berg68eb5502013-11-19 15:19:38 +010013170 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013171 NL80211_MCGRP_CONFIG, GFP_KERNEL);
Johannes Berg55682962007-09-20 13:09:35 -040013172}
13173
Denis Kenzior896ff062016-08-03 16:58:33 -050013174void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
13175 struct wireless_dev *wdev,
13176 enum nl80211_commands cmd)
13177{
13178 struct sk_buff *msg;
13179
13180 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
13181 cmd != NL80211_CMD_DEL_INTERFACE);
13182
13183 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13184 if (!msg)
13185 return;
13186
13187 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev,
13188 cmd == NL80211_CMD_DEL_INTERFACE) < 0) {
13189 nlmsg_free(msg);
13190 return;
13191 }
13192
13193 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13194 NL80211_MCGRP_CONFIG, GFP_KERNEL);
13195}
13196
Johannes Berg362a4152009-05-24 16:43:15 +020013197static int nl80211_add_scan_req(struct sk_buff *msg,
13198 struct cfg80211_registered_device *rdev)
13199{
13200 struct cfg80211_scan_request *req = rdev->scan_req;
13201 struct nlattr *nest;
13202 int i;
13203
13204 if (WARN_ON(!req))
13205 return 0;
13206
13207 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
13208 if (!nest)
13209 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -040013210 for (i = 0; i < req->n_ssids; i++) {
13211 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
13212 goto nla_put_failure;
13213 }
Johannes Berg362a4152009-05-24 16:43:15 +020013214 nla_nest_end(msg, nest);
13215
13216 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
13217 if (!nest)
13218 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -040013219 for (i = 0; i < req->n_channels; i++) {
13220 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
13221 goto nla_put_failure;
13222 }
Johannes Berg362a4152009-05-24 16:43:15 +020013223 nla_nest_end(msg, nest);
13224
David S. Miller9360ffd2012-03-29 04:41:26 -040013225 if (req->ie &&
13226 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
13227 goto nla_put_failure;
Johannes Berg362a4152009-05-24 16:43:15 +020013228
Johannes Bergae917c92013-10-25 11:05:22 +020013229 if (req->flags &&
13230 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
13231 goto nla_put_failure;
Sam Lefflered4737712012-10-11 21:03:31 -070013232
Avraham Stern1d762502016-07-05 17:10:13 +030013233 if (req->info.scan_start_tsf &&
13234 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
13235 req->info.scan_start_tsf, NL80211_BSS_PAD) ||
13236 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
13237 req->info.tsf_bssid)))
13238 goto nla_put_failure;
13239
Johannes Berg362a4152009-05-24 16:43:15 +020013240 return 0;
13241 nla_put_failure:
13242 return -ENOBUFS;
13243}
13244
Johannes Berga538e2d2009-06-16 19:56:42 +020013245static int nl80211_send_scan_msg(struct sk_buff *msg,
13246 struct cfg80211_registered_device *rdev,
Johannes Bergfd014282012-06-18 19:17:03 +020013247 struct wireless_dev *wdev,
Eric W. Biederman15e47302012-09-07 20:12:54 +000013248 u32 portid, u32 seq, int flags,
Johannes Berga538e2d2009-06-16 19:56:42 +020013249 u32 cmd)
Johannes Berg2a519312009-02-10 21:25:55 +010013250{
13251 void *hdr;
13252
Eric W. Biederman15e47302012-09-07 20:12:54 +000013253 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
Johannes Berg2a519312009-02-10 21:25:55 +010013254 if (!hdr)
13255 return -1;
13256
David S. Miller9360ffd2012-03-29 04:41:26 -040013257 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Bergfd014282012-06-18 19:17:03 +020013258 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13259 wdev->netdev->ifindex)) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020013260 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13261 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -040013262 goto nla_put_failure;
Johannes Berg2a519312009-02-10 21:25:55 +010013263
Johannes Berg362a4152009-05-24 16:43:15 +020013264 /* ignore errors and send incomplete event anyway */
13265 nl80211_add_scan_req(msg, rdev);
Johannes Berg2a519312009-02-10 21:25:55 +010013266
Johannes Berg053c0952015-01-16 22:09:00 +010013267 genlmsg_end(msg, hdr);
13268 return 0;
Johannes Berg2a519312009-02-10 21:25:55 +010013269
13270 nla_put_failure:
13271 genlmsg_cancel(msg, hdr);
13272 return -EMSGSIZE;
13273}
13274
Luciano Coelho807f8a82011-05-11 17:09:35 +030013275static int
13276nl80211_send_sched_scan_msg(struct sk_buff *msg,
13277 struct cfg80211_registered_device *rdev,
13278 struct net_device *netdev,
Eric W. Biederman15e47302012-09-07 20:12:54 +000013279 u32 portid, u32 seq, int flags, u32 cmd)
Luciano Coelho807f8a82011-05-11 17:09:35 +030013280{
13281 void *hdr;
13282
Eric W. Biederman15e47302012-09-07 20:12:54 +000013283 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
Luciano Coelho807f8a82011-05-11 17:09:35 +030013284 if (!hdr)
13285 return -1;
13286
David S. Miller9360ffd2012-03-29 04:41:26 -040013287 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13288 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
13289 goto nla_put_failure;
Luciano Coelho807f8a82011-05-11 17:09:35 +030013290
Johannes Berg053c0952015-01-16 22:09:00 +010013291 genlmsg_end(msg, hdr);
13292 return 0;
Luciano Coelho807f8a82011-05-11 17:09:35 +030013293
13294 nla_put_failure:
13295 genlmsg_cancel(msg, hdr);
13296 return -EMSGSIZE;
13297}
13298
Johannes Berga538e2d2009-06-16 19:56:42 +020013299void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
Johannes Bergfd014282012-06-18 19:17:03 +020013300 struct wireless_dev *wdev)
Johannes Berga538e2d2009-06-16 19:56:42 +020013301{
13302 struct sk_buff *msg;
13303
Thomas Graf58050fc2012-06-28 03:57:45 +000013304 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berga538e2d2009-06-16 19:56:42 +020013305 if (!msg)
13306 return;
13307
Johannes Bergfd014282012-06-18 19:17:03 +020013308 if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
Johannes Berga538e2d2009-06-16 19:56:42 +020013309 NL80211_CMD_TRIGGER_SCAN) < 0) {
13310 nlmsg_free(msg);
13311 return;
13312 }
13313
Johannes Berg68eb5502013-11-19 15:19:38 +010013314 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013315 NL80211_MCGRP_SCAN, GFP_KERNEL);
Johannes Berga538e2d2009-06-16 19:56:42 +020013316}
13317
Johannes Bergf9d15d12014-01-22 11:14:19 +020013318struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
13319 struct wireless_dev *wdev, bool aborted)
Johannes Berg2a519312009-02-10 21:25:55 +010013320{
13321 struct sk_buff *msg;
13322
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -070013323 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg2a519312009-02-10 21:25:55 +010013324 if (!msg)
Johannes Bergf9d15d12014-01-22 11:14:19 +020013325 return NULL;
Johannes Berg2a519312009-02-10 21:25:55 +010013326
Johannes Bergfd014282012-06-18 19:17:03 +020013327 if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
Johannes Bergf9d15d12014-01-22 11:14:19 +020013328 aborted ? NL80211_CMD_SCAN_ABORTED :
13329 NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
Johannes Berg2a519312009-02-10 21:25:55 +010013330 nlmsg_free(msg);
Johannes Bergf9d15d12014-01-22 11:14:19 +020013331 return NULL;
Johannes Berg2a519312009-02-10 21:25:55 +010013332 }
13333
Johannes Bergf9d15d12014-01-22 11:14:19 +020013334 return msg;
Johannes Berg2a519312009-02-10 21:25:55 +010013335}
13336
Johannes Bergf9d15d12014-01-22 11:14:19 +020013337void nl80211_send_scan_result(struct cfg80211_registered_device *rdev,
13338 struct sk_buff *msg)
Johannes Berg2a519312009-02-10 21:25:55 +010013339{
Johannes Berg2a519312009-02-10 21:25:55 +010013340 if (!msg)
13341 return;
13342
Johannes Berg68eb5502013-11-19 15:19:38 +010013343 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013344 NL80211_MCGRP_SCAN, GFP_KERNEL);
Johannes Berg2a519312009-02-10 21:25:55 +010013345}
13346
Luciano Coelho807f8a82011-05-11 17:09:35 +030013347void nl80211_send_sched_scan_results(struct cfg80211_registered_device *rdev,
13348 struct net_device *netdev)
13349{
13350 struct sk_buff *msg;
13351
13352 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13353 if (!msg)
13354 return;
13355
13356 if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0,
13357 NL80211_CMD_SCHED_SCAN_RESULTS) < 0) {
13358 nlmsg_free(msg);
13359 return;
13360 }
13361
Johannes Berg68eb5502013-11-19 15:19:38 +010013362 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013363 NL80211_MCGRP_SCAN, GFP_KERNEL);
Luciano Coelho807f8a82011-05-11 17:09:35 +030013364}
13365
13366void nl80211_send_sched_scan(struct cfg80211_registered_device *rdev,
13367 struct net_device *netdev, u32 cmd)
13368{
13369 struct sk_buff *msg;
13370
Thomas Graf58050fc2012-06-28 03:57:45 +000013371 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Luciano Coelho807f8a82011-05-11 17:09:35 +030013372 if (!msg)
13373 return;
13374
13375 if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0, cmd) < 0) {
13376 nlmsg_free(msg);
13377 return;
13378 }
13379
Johannes Berg68eb5502013-11-19 15:19:38 +010013380 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013381 NL80211_MCGRP_SCAN, GFP_KERNEL);
Luciano Coelho807f8a82011-05-11 17:09:35 +030013382}
13383
Jonathan Doronb0d7aa52014-12-15 19:26:00 +020013384static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
13385 struct regulatory_request *request)
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013386{
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013387 /* Userspace can always count this one always being set */
David S. Miller9360ffd2012-03-29 04:41:26 -040013388 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
13389 goto nla_put_failure;
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013390
David S. Miller9360ffd2012-03-29 04:41:26 -040013391 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
13392 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13393 NL80211_REGDOM_TYPE_WORLD))
13394 goto nla_put_failure;
13395 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
13396 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13397 NL80211_REGDOM_TYPE_CUSTOM_WORLD))
13398 goto nla_put_failure;
13399 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
13400 request->intersect) {
13401 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13402 NL80211_REGDOM_TYPE_INTERSECTION))
13403 goto nla_put_failure;
13404 } else {
13405 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13406 NL80211_REGDOM_TYPE_COUNTRY) ||
13407 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
13408 request->alpha2))
13409 goto nla_put_failure;
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013410 }
13411
Arik Nemtsovad30ca22014-12-15 19:25:59 +020013412 if (request->wiphy_idx != WIPHY_IDX_INVALID) {
13413 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
13414
13415 if (wiphy &&
13416 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
13417 goto nla_put_failure;
Arik Nemtsov1bdd7162014-12-15 19:26:01 +020013418
13419 if (wiphy &&
13420 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
13421 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
13422 goto nla_put_failure;
Arik Nemtsovad30ca22014-12-15 19:25:59 +020013423 }
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013424
Jonathan Doronb0d7aa52014-12-15 19:26:00 +020013425 return true;
13426
13427nla_put_failure:
13428 return false;
13429}
13430
13431/*
13432 * This can happen on global regulatory changes or device specific settings
13433 * based on custom regulatory domains.
13434 */
13435void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
13436 struct regulatory_request *request)
13437{
13438 struct sk_buff *msg;
13439 void *hdr;
13440
13441 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13442 if (!msg)
13443 return;
13444
13445 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
13446 if (!hdr) {
13447 nlmsg_free(msg);
13448 return;
13449 }
13450
13451 if (nl80211_reg_change_event_fill(msg, request) == false)
13452 goto nla_put_failure;
13453
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013454 genlmsg_end(msg, hdr);
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013455
Johannes Bergbc43b282009-07-25 10:54:13 +020013456 rcu_read_lock();
Johannes Berg68eb5502013-11-19 15:19:38 +010013457 genlmsg_multicast_allns(&nl80211_fam, msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013458 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
Johannes Bergbc43b282009-07-25 10:54:13 +020013459 rcu_read_unlock();
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013460
13461 return;
13462
13463nla_put_failure:
13464 genlmsg_cancel(msg, hdr);
13465 nlmsg_free(msg);
13466}
13467
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013468static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
13469 struct net_device *netdev,
13470 const u8 *buf, size_t len,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013471 enum nl80211_commands cmd, gfp_t gfp,
13472 int uapsd_queues)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013473{
13474 struct sk_buff *msg;
13475 void *hdr;
13476
Johannes Berg14459722017-01-09 11:10:42 +010013477 msg = nlmsg_new(100 + len, gfp);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013478 if (!msg)
13479 return;
13480
13481 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13482 if (!hdr) {
13483 nlmsg_free(msg);
13484 return;
13485 }
13486
David S. Miller9360ffd2012-03-29 04:41:26 -040013487 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13488 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13489 nla_put(msg, NL80211_ATTR_FRAME, len, buf))
13490 goto nla_put_failure;
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013491
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013492 if (uapsd_queues >= 0) {
13493 struct nlattr *nla_wmm =
13494 nla_nest_start(msg, NL80211_ATTR_STA_WME);
13495 if (!nla_wmm)
13496 goto nla_put_failure;
13497
13498 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
13499 uapsd_queues))
13500 goto nla_put_failure;
13501
13502 nla_nest_end(msg, nla_wmm);
13503 }
13504
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013505 genlmsg_end(msg, hdr);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013506
Johannes Berg68eb5502013-11-19 15:19:38 +010013507 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013508 NL80211_MCGRP_MLME, gfp);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013509 return;
13510
13511 nla_put_failure:
13512 genlmsg_cancel(msg, hdr);
13513 nlmsg_free(msg);
13514}
13515
13516void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
Johannes Berge6d6e342009-07-01 21:26:47 +020013517 struct net_device *netdev, const u8 *buf,
13518 size_t len, gfp_t gfp)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013519{
13520 nl80211_send_mlme_event(rdev, netdev, buf, len,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013521 NL80211_CMD_AUTHENTICATE, gfp, -1);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013522}
13523
13524void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
13525 struct net_device *netdev, const u8 *buf,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013526 size_t len, gfp_t gfp, int uapsd_queues)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013527{
Johannes Berge6d6e342009-07-01 21:26:47 +020013528 nl80211_send_mlme_event(rdev, netdev, buf, len,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013529 NL80211_CMD_ASSOCIATE, gfp, uapsd_queues);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013530}
13531
Jouni Malinen53b46b82009-03-27 20:53:56 +020013532void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
Johannes Berge6d6e342009-07-01 21:26:47 +020013533 struct net_device *netdev, const u8 *buf,
13534 size_t len, gfp_t gfp)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013535{
13536 nl80211_send_mlme_event(rdev, netdev, buf, len,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013537 NL80211_CMD_DEAUTHENTICATE, gfp, -1);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013538}
13539
Jouni Malinen53b46b82009-03-27 20:53:56 +020013540void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
13541 struct net_device *netdev, const u8 *buf,
Johannes Berge6d6e342009-07-01 21:26:47 +020013542 size_t len, gfp_t gfp)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013543{
13544 nl80211_send_mlme_event(rdev, netdev, buf, len,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013545 NL80211_CMD_DISASSOCIATE, gfp, -1);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013546}
13547
Johannes Berg6ff57cf2013-05-16 00:55:00 +020013548void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
13549 size_t len)
Jouni Malinencf4e5942010-12-16 00:52:40 +020013550{
Johannes Berg947add32013-02-22 22:05:20 +010013551 struct wireless_dev *wdev = dev->ieee80211_ptr;
13552 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080013553 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg6ff57cf2013-05-16 00:55:00 +020013554 const struct ieee80211_mgmt *mgmt = (void *)buf;
13555 u32 cmd;
Jouni Malinencf4e5942010-12-16 00:52:40 +020013556
Johannes Berg6ff57cf2013-05-16 00:55:00 +020013557 if (WARN_ON(len < 2))
13558 return;
13559
13560 if (ieee80211_is_deauth(mgmt->frame_control))
13561 cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
13562 else
13563 cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
13564
13565 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013566 nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1);
Jouni Malinencf4e5942010-12-16 00:52:40 +020013567}
Johannes Berg6ff57cf2013-05-16 00:55:00 +020013568EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
Jouni Malinencf4e5942010-12-16 00:52:40 +020013569
Luis R. Rodriguez1b06bb42009-05-02 00:34:48 -040013570static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
13571 struct net_device *netdev, int cmd,
Johannes Berge6d6e342009-07-01 21:26:47 +020013572 const u8 *addr, gfp_t gfp)
Jouni Malinen1965c852009-04-22 21:38:25 +030013573{
13574 struct sk_buff *msg;
13575 void *hdr;
13576
Johannes Berge6d6e342009-07-01 21:26:47 +020013577 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Jouni Malinen1965c852009-04-22 21:38:25 +030013578 if (!msg)
13579 return;
13580
13581 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13582 if (!hdr) {
13583 nlmsg_free(msg);
13584 return;
13585 }
13586
David S. Miller9360ffd2012-03-29 04:41:26 -040013587 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13588 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13589 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
13590 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
13591 goto nla_put_failure;
Jouni Malinen1965c852009-04-22 21:38:25 +030013592
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013593 genlmsg_end(msg, hdr);
Jouni Malinen1965c852009-04-22 21:38:25 +030013594
Johannes Berg68eb5502013-11-19 15:19:38 +010013595 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013596 NL80211_MCGRP_MLME, gfp);
Jouni Malinen1965c852009-04-22 21:38:25 +030013597 return;
13598
13599 nla_put_failure:
13600 genlmsg_cancel(msg, hdr);
13601 nlmsg_free(msg);
13602}
13603
13604void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
Johannes Berge6d6e342009-07-01 21:26:47 +020013605 struct net_device *netdev, const u8 *addr,
13606 gfp_t gfp)
Jouni Malinen1965c852009-04-22 21:38:25 +030013607{
13608 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
Johannes Berge6d6e342009-07-01 21:26:47 +020013609 addr, gfp);
Jouni Malinen1965c852009-04-22 21:38:25 +030013610}
13611
13612void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
Johannes Berge6d6e342009-07-01 21:26:47 +020013613 struct net_device *netdev, const u8 *addr,
13614 gfp_t gfp)
Jouni Malinen1965c852009-04-22 21:38:25 +030013615{
Johannes Berge6d6e342009-07-01 21:26:47 +020013616 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
13617 addr, gfp);
Jouni Malinen1965c852009-04-22 21:38:25 +030013618}
13619
Samuel Ortizb23aa672009-07-01 21:26:54 +020013620void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
Vidyullatha Kanchanapally3f1905b2017-03-31 00:22:33 +030013621 struct net_device *netdev,
13622 struct cfg80211_connect_resp_params *cr,
Purushottam Kushwahadf935062017-01-13 01:12:21 +020013623 gfp_t gfp)
Samuel Ortizb23aa672009-07-01 21:26:54 +020013624{
13625 struct sk_buff *msg;
13626 void *hdr;
13627
Vidyullatha Kanchanapally36eabf62017-03-31 00:22:34 +030013628 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
13629 cr->fils_kek_len + cr->pmk_len +
13630 (cr->pmkid ? WLAN_PMKID_LEN : 0), gfp);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013631 if (!msg)
13632 return;
13633
13634 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
13635 if (!hdr) {
13636 nlmsg_free(msg);
13637 return;
13638 }
13639
David S. Miller9360ffd2012-03-29 04:41:26 -040013640 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13641 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
Vidyullatha Kanchanapally3f1905b2017-03-31 00:22:33 +030013642 (cr->bssid &&
13643 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cr->bssid)) ||
Jouni Malinenbf1ecd22016-05-31 00:16:50 +030013644 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
Vidyullatha Kanchanapally3f1905b2017-03-31 00:22:33 +030013645 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
13646 cr->status) ||
13647 (cr->status < 0 &&
Purushottam Kushwahadf935062017-01-13 01:12:21 +020013648 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
Vidyullatha Kanchanapally3f1905b2017-03-31 00:22:33 +030013649 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
13650 cr->timeout_reason))) ||
13651 (cr->req_ie &&
13652 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
13653 (cr->resp_ie &&
13654 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
Vidyullatha Kanchanapally36eabf62017-03-31 00:22:34 +030013655 cr->resp_ie)) ||
13656 (cr->update_erp_next_seq_num &&
13657 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
13658 cr->fils_erp_next_seq_num)) ||
13659 (cr->status == WLAN_STATUS_SUCCESS &&
13660 ((cr->fils_kek &&
13661 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils_kek_len,
13662 cr->fils_kek)) ||
13663 (cr->pmk &&
13664 nla_put(msg, NL80211_ATTR_PMK, cr->pmk_len, cr->pmk)) ||
13665 (cr->pmkid &&
13666 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->pmkid)))))
David S. Miller9360ffd2012-03-29 04:41:26 -040013667 goto nla_put_failure;
Samuel Ortizb23aa672009-07-01 21:26:54 +020013668
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013669 genlmsg_end(msg, hdr);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013670
Johannes Berg68eb5502013-11-19 15:19:38 +010013671 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013672 NL80211_MCGRP_MLME, gfp);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013673 return;
13674
13675 nla_put_failure:
13676 genlmsg_cancel(msg, hdr);
13677 nlmsg_free(msg);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013678}
13679
13680void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
Avraham Stern9e841a62017-04-26 10:58:49 +030013681 struct net_device *netdev,
13682 struct cfg80211_roam_info *info, gfp_t gfp)
Samuel Ortizb23aa672009-07-01 21:26:54 +020013683{
13684 struct sk_buff *msg;
13685 void *hdr;
Avraham Stern9e841a62017-04-26 10:58:49 +030013686 const u8 *bssid = info->bss ? info->bss->bssid : info->bssid;
Samuel Ortizb23aa672009-07-01 21:26:54 +020013687
Avraham Stern9e841a62017-04-26 10:58:49 +030013688 msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len, gfp);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013689 if (!msg)
13690 return;
13691
13692 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
13693 if (!hdr) {
13694 nlmsg_free(msg);
13695 return;
13696 }
13697
David S. Miller9360ffd2012-03-29 04:41:26 -040013698 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13699 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13700 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
Avraham Stern9e841a62017-04-26 10:58:49 +030013701 (info->req_ie &&
13702 nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
13703 info->req_ie)) ||
13704 (info->resp_ie &&
13705 nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
Avraham Stern562be6e2017-06-09 13:08:45 +010013706 info->resp_ie)) ||
13707 (info->authorized &&
13708 nla_put_flag(msg, NL80211_ATTR_PORT_AUTHORIZED)))
David S. Miller9360ffd2012-03-29 04:41:26 -040013709 goto nla_put_failure;
Samuel Ortizb23aa672009-07-01 21:26:54 +020013710
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013711 genlmsg_end(msg, hdr);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013712
Johannes Berg68eb5502013-11-19 15:19:38 +010013713 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013714 NL80211_MCGRP_MLME, gfp);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013715 return;
13716
13717 nla_put_failure:
13718 genlmsg_cancel(msg, hdr);
13719 nlmsg_free(msg);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013720}
13721
13722void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
13723 struct net_device *netdev, u16 reason,
Johannes Berg667503dd2009-07-07 03:56:11 +020013724 const u8 *ie, size_t ie_len, bool from_ap)
Samuel Ortizb23aa672009-07-01 21:26:54 +020013725{
13726 struct sk_buff *msg;
13727 void *hdr;
13728
Johannes Berg14459722017-01-09 11:10:42 +010013729 msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013730 if (!msg)
13731 return;
13732
13733 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
13734 if (!hdr) {
13735 nlmsg_free(msg);
13736 return;
13737 }
13738
David S. Miller9360ffd2012-03-29 04:41:26 -040013739 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13740 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13741 (from_ap && reason &&
13742 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
13743 (from_ap &&
13744 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
13745 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
13746 goto nla_put_failure;
Samuel Ortizb23aa672009-07-01 21:26:54 +020013747
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013748 genlmsg_end(msg, hdr);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013749
Johannes Berg68eb5502013-11-19 15:19:38 +010013750 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013751 NL80211_MCGRP_MLME, GFP_KERNEL);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013752 return;
13753
13754 nla_put_failure:
13755 genlmsg_cancel(msg, hdr);
13756 nlmsg_free(msg);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013757}
13758
Johannes Berg04a773a2009-04-19 21:24:32 +020013759void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
13760 struct net_device *netdev, const u8 *bssid,
13761 gfp_t gfp)
13762{
13763 struct sk_buff *msg;
13764 void *hdr;
13765
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -070013766 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Johannes Berg04a773a2009-04-19 21:24:32 +020013767 if (!msg)
13768 return;
13769
13770 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
13771 if (!hdr) {
13772 nlmsg_free(msg);
13773 return;
13774 }
13775
David S. Miller9360ffd2012-03-29 04:41:26 -040013776 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13777 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13778 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
13779 goto nla_put_failure;
Johannes Berg04a773a2009-04-19 21:24:32 +020013780
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013781 genlmsg_end(msg, hdr);
Johannes Berg04a773a2009-04-19 21:24:32 +020013782
Johannes Berg68eb5502013-11-19 15:19:38 +010013783 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013784 NL80211_MCGRP_MLME, gfp);
Johannes Berg04a773a2009-04-19 21:24:32 +020013785 return;
13786
13787 nla_put_failure:
13788 genlmsg_cancel(msg, hdr);
13789 nlmsg_free(msg);
13790}
13791
Johannes Berg947add32013-02-22 22:05:20 +010013792void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
13793 const u8* ie, u8 ie_len, gfp_t gfp)
Javier Cardonac93b5e72011-04-07 15:08:34 -070013794{
Johannes Berg947add32013-02-22 22:05:20 +010013795 struct wireless_dev *wdev = dev->ieee80211_ptr;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080013796 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Javier Cardonac93b5e72011-04-07 15:08:34 -070013797 struct sk_buff *msg;
13798 void *hdr;
13799
Johannes Berg947add32013-02-22 22:05:20 +010013800 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
13801 return;
13802
13803 trace_cfg80211_notify_new_peer_candidate(dev, addr);
13804
Johannes Berg14459722017-01-09 11:10:42 +010013805 msg = nlmsg_new(100 + ie_len, gfp);
Javier Cardonac93b5e72011-04-07 15:08:34 -070013806 if (!msg)
13807 return;
13808
13809 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
13810 if (!hdr) {
13811 nlmsg_free(msg);
13812 return;
13813 }
13814
David S. Miller9360ffd2012-03-29 04:41:26 -040013815 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg947add32013-02-22 22:05:20 +010013816 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
13817 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040013818 (ie_len && ie &&
13819 nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
13820 goto nla_put_failure;
Javier Cardonac93b5e72011-04-07 15:08:34 -070013821
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013822 genlmsg_end(msg, hdr);
Javier Cardonac93b5e72011-04-07 15:08:34 -070013823
Johannes Berg68eb5502013-11-19 15:19:38 +010013824 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013825 NL80211_MCGRP_MLME, gfp);
Javier Cardonac93b5e72011-04-07 15:08:34 -070013826 return;
13827
13828 nla_put_failure:
13829 genlmsg_cancel(msg, hdr);
13830 nlmsg_free(msg);
13831}
Johannes Berg947add32013-02-22 22:05:20 +010013832EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
Javier Cardonac93b5e72011-04-07 15:08:34 -070013833
Jouni Malinena3b8b052009-03-27 21:59:49 +020013834void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
13835 struct net_device *netdev, const u8 *addr,
13836 enum nl80211_key_type key_type, int key_id,
Johannes Berge6d6e342009-07-01 21:26:47 +020013837 const u8 *tsc, gfp_t gfp)
Jouni Malinena3b8b052009-03-27 21:59:49 +020013838{
13839 struct sk_buff *msg;
13840 void *hdr;
13841
Johannes Berge6d6e342009-07-01 21:26:47 +020013842 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Jouni Malinena3b8b052009-03-27 21:59:49 +020013843 if (!msg)
13844 return;
13845
13846 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
13847 if (!hdr) {
13848 nlmsg_free(msg);
13849 return;
13850 }
13851
David S. Miller9360ffd2012-03-29 04:41:26 -040013852 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13853 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13854 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
13855 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
13856 (key_id != -1 &&
13857 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
13858 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
13859 goto nla_put_failure;
Jouni Malinena3b8b052009-03-27 21:59:49 +020013860
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013861 genlmsg_end(msg, hdr);
Jouni Malinena3b8b052009-03-27 21:59:49 +020013862
Johannes Berg68eb5502013-11-19 15:19:38 +010013863 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013864 NL80211_MCGRP_MLME, gfp);
Jouni Malinena3b8b052009-03-27 21:59:49 +020013865 return;
13866
13867 nla_put_failure:
13868 genlmsg_cancel(msg, hdr);
13869 nlmsg_free(msg);
13870}
13871
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040013872void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
13873 struct ieee80211_channel *channel_before,
13874 struct ieee80211_channel *channel_after)
13875{
13876 struct sk_buff *msg;
13877 void *hdr;
13878 struct nlattr *nl_freq;
13879
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -070013880 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040013881 if (!msg)
13882 return;
13883
13884 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
13885 if (!hdr) {
13886 nlmsg_free(msg);
13887 return;
13888 }
13889
13890 /*
13891 * Since we are applying the beacon hint to a wiphy we know its
13892 * wiphy_idx is valid
13893 */
David S. Miller9360ffd2012-03-29 04:41:26 -040013894 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
13895 goto nla_put_failure;
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040013896
13897 /* Before */
13898 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
13899 if (!nl_freq)
13900 goto nla_put_failure;
Johannes Bergcdc89b92013-02-18 23:54:36 +010013901 if (nl80211_msg_put_channel(msg, channel_before, false))
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040013902 goto nla_put_failure;
13903 nla_nest_end(msg, nl_freq);
13904
13905 /* After */
13906 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
13907 if (!nl_freq)
13908 goto nla_put_failure;
Johannes Bergcdc89b92013-02-18 23:54:36 +010013909 if (nl80211_msg_put_channel(msg, channel_after, false))
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040013910 goto nla_put_failure;
13911 nla_nest_end(msg, nl_freq);
13912
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013913 genlmsg_end(msg, hdr);
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040013914
Johannes Berg463d0182009-07-14 00:33:35 +020013915 rcu_read_lock();
Johannes Berg68eb5502013-11-19 15:19:38 +010013916 genlmsg_multicast_allns(&nl80211_fam, msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013917 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
Johannes Berg463d0182009-07-14 00:33:35 +020013918 rcu_read_unlock();
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040013919
13920 return;
13921
13922nla_put_failure:
13923 genlmsg_cancel(msg, hdr);
13924 nlmsg_free(msg);
13925}
13926
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013927static void nl80211_send_remain_on_chan_event(
13928 int cmd, struct cfg80211_registered_device *rdev,
Johannes Berg71bbc992012-06-15 15:30:18 +020013929 struct wireless_dev *wdev, u64 cookie,
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013930 struct ieee80211_channel *chan,
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013931 unsigned int duration, gfp_t gfp)
13932{
13933 struct sk_buff *msg;
13934 void *hdr;
13935
13936 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13937 if (!msg)
13938 return;
13939
13940 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13941 if (!hdr) {
13942 nlmsg_free(msg);
13943 return;
13944 }
13945
David S. Miller9360ffd2012-03-29 04:41:26 -040013946 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg71bbc992012-06-15 15:30:18 +020013947 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13948 wdev->netdev->ifindex)) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020013949 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13950 NL80211_ATTR_PAD) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040013951 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
Johannes Berg42d97a52012-11-08 18:31:02 +010013952 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
13953 NL80211_CHAN_NO_HT) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020013954 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
13955 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -040013956 goto nla_put_failure;
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013957
David S. Miller9360ffd2012-03-29 04:41:26 -040013958 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
13959 nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
13960 goto nla_put_failure;
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013961
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013962 genlmsg_end(msg, hdr);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013963
Johannes Berg68eb5502013-11-19 15:19:38 +010013964 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013965 NL80211_MCGRP_MLME, gfp);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013966 return;
13967
13968 nla_put_failure:
13969 genlmsg_cancel(msg, hdr);
13970 nlmsg_free(msg);
13971}
13972
Johannes Berg947add32013-02-22 22:05:20 +010013973void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
13974 struct ieee80211_channel *chan,
13975 unsigned int duration, gfp_t gfp)
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013976{
Johannes Berg947add32013-02-22 22:05:20 +010013977 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080013978 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg947add32013-02-22 22:05:20 +010013979
13980 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013981 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
Johannes Berg71bbc992012-06-15 15:30:18 +020013982 rdev, wdev, cookie, chan,
Johannes Berg42d97a52012-11-08 18:31:02 +010013983 duration, gfp);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013984}
Johannes Berg947add32013-02-22 22:05:20 +010013985EXPORT_SYMBOL(cfg80211_ready_on_channel);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013986
Johannes Berg947add32013-02-22 22:05:20 +010013987void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
13988 struct ieee80211_channel *chan,
13989 gfp_t gfp)
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013990{
Johannes Berg947add32013-02-22 22:05:20 +010013991 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080013992 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg947add32013-02-22 22:05:20 +010013993
13994 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013995 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
Johannes Berg42d97a52012-11-08 18:31:02 +010013996 rdev, wdev, cookie, chan, 0, gfp);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013997}
Johannes Berg947add32013-02-22 22:05:20 +010013998EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013999
Johannes Berg947add32013-02-22 22:05:20 +010014000void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
14001 struct station_info *sinfo, gfp_t gfp)
Johannes Berg98b62182009-12-23 13:15:44 +010014002{
Johannes Berg947add32013-02-22 22:05:20 +010014003 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014004 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg98b62182009-12-23 13:15:44 +010014005 struct sk_buff *msg;
14006
Johannes Berg947add32013-02-22 22:05:20 +010014007 trace_cfg80211_new_sta(dev, mac_addr, sinfo);
14008
Thomas Graf58050fc2012-06-28 03:57:45 +000014009 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Johannes Berg98b62182009-12-23 13:15:44 +010014010 if (!msg)
14011 return;
14012
Johannes Bergcf5ead82014-11-14 17:14:00 +010014013 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
John W. Linville66266b32012-03-15 13:25:41 -040014014 rdev, dev, mac_addr, sinfo) < 0) {
Johannes Berg98b62182009-12-23 13:15:44 +010014015 nlmsg_free(msg);
14016 return;
14017 }
14018
Johannes Berg68eb5502013-11-19 15:19:38 +010014019 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014020 NL80211_MCGRP_MLME, gfp);
Johannes Berg98b62182009-12-23 13:15:44 +010014021}
Johannes Berg947add32013-02-22 22:05:20 +010014022EXPORT_SYMBOL(cfg80211_new_sta);
Johannes Berg98b62182009-12-23 13:15:44 +010014023
Johannes Bergcf5ead82014-11-14 17:14:00 +010014024void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
14025 struct station_info *sinfo, gfp_t gfp)
Jouni Malinenec15e682011-03-23 15:29:52 +020014026{
Johannes Berg947add32013-02-22 22:05:20 +010014027 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014028 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Jouni Malinenec15e682011-03-23 15:29:52 +020014029 struct sk_buff *msg;
Johannes Bergcf5ead82014-11-14 17:14:00 +010014030 struct station_info empty_sinfo = {};
14031
14032 if (!sinfo)
14033 sinfo = &empty_sinfo;
Jouni Malinenec15e682011-03-23 15:29:52 +020014034
Johannes Berg947add32013-02-22 22:05:20 +010014035 trace_cfg80211_del_sta(dev, mac_addr);
14036
Thomas Graf58050fc2012-06-28 03:57:45 +000014037 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Jouni Malinenec15e682011-03-23 15:29:52 +020014038 if (!msg)
14039 return;
14040
Johannes Bergcf5ead82014-11-14 17:14:00 +010014041 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
Johannes Berg57007122015-01-16 21:05:02 +010014042 rdev, dev, mac_addr, sinfo) < 0) {
Jouni Malinenec15e682011-03-23 15:29:52 +020014043 nlmsg_free(msg);
14044 return;
14045 }
14046
Johannes Berg68eb5502013-11-19 15:19:38 +010014047 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014048 NL80211_MCGRP_MLME, gfp);
Jouni Malinenec15e682011-03-23 15:29:52 +020014049}
Johannes Bergcf5ead82014-11-14 17:14:00 +010014050EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
Jouni Malinenec15e682011-03-23 15:29:52 +020014051
Johannes Berg947add32013-02-22 22:05:20 +010014052void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
14053 enum nl80211_connect_failed_reason reason,
14054 gfp_t gfp)
Pandiyarajan Pitchaimuthued44a952012-09-18 16:50:49 +053014055{
Johannes Berg947add32013-02-22 22:05:20 +010014056 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014057 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Pandiyarajan Pitchaimuthued44a952012-09-18 16:50:49 +053014058 struct sk_buff *msg;
14059 void *hdr;
14060
14061 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
14062 if (!msg)
14063 return;
14064
14065 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
14066 if (!hdr) {
14067 nlmsg_free(msg);
14068 return;
14069 }
14070
14071 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14072 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
14073 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
14074 goto nla_put_failure;
14075
14076 genlmsg_end(msg, hdr);
14077
Johannes Berg68eb5502013-11-19 15:19:38 +010014078 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014079 NL80211_MCGRP_MLME, gfp);
Pandiyarajan Pitchaimuthued44a952012-09-18 16:50:49 +053014080 return;
14081
14082 nla_put_failure:
14083 genlmsg_cancel(msg, hdr);
14084 nlmsg_free(msg);
14085}
Johannes Berg947add32013-02-22 22:05:20 +010014086EXPORT_SYMBOL(cfg80211_conn_failed);
Pandiyarajan Pitchaimuthued44a952012-09-18 16:50:49 +053014087
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014088static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
14089 const u8 *addr, gfp_t gfp)
Johannes Berg28946da2011-11-04 11:18:12 +010014090{
14091 struct wireless_dev *wdev = dev->ieee80211_ptr;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014092 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Berg28946da2011-11-04 11:18:12 +010014093 struct sk_buff *msg;
14094 void *hdr;
Eric W. Biederman15e47302012-09-07 20:12:54 +000014095 u32 nlportid = ACCESS_ONCE(wdev->ap_unexpected_nlportid);
Johannes Berg28946da2011-11-04 11:18:12 +010014096
Eric W. Biederman15e47302012-09-07 20:12:54 +000014097 if (!nlportid)
Johannes Berg28946da2011-11-04 11:18:12 +010014098 return false;
14099
14100 msg = nlmsg_new(100, gfp);
14101 if (!msg)
14102 return true;
14103
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014104 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
Johannes Berg28946da2011-11-04 11:18:12 +010014105 if (!hdr) {
14106 nlmsg_free(msg);
14107 return true;
14108 }
14109
David S. Miller9360ffd2012-03-29 04:41:26 -040014110 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14111 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14112 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
14113 goto nla_put_failure;
Johannes Berg28946da2011-11-04 11:18:12 +010014114
Johannes Berg9c90a9f2013-06-04 12:46:03 +020014115 genlmsg_end(msg, hdr);
Eric W. Biederman15e47302012-09-07 20:12:54 +000014116 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
Johannes Berg28946da2011-11-04 11:18:12 +010014117 return true;
14118
14119 nla_put_failure:
14120 genlmsg_cancel(msg, hdr);
14121 nlmsg_free(msg);
14122 return true;
14123}
14124
Johannes Berg947add32013-02-22 22:05:20 +010014125bool cfg80211_rx_spurious_frame(struct net_device *dev,
14126 const u8 *addr, gfp_t gfp)
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014127{
Johannes Berg947add32013-02-22 22:05:20 +010014128 struct wireless_dev *wdev = dev->ieee80211_ptr;
14129 bool ret;
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014130
Johannes Berg947add32013-02-22 22:05:20 +010014131 trace_cfg80211_rx_spurious_frame(dev, addr);
14132
14133 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
14134 wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
14135 trace_cfg80211_return_bool(false);
14136 return false;
14137 }
14138 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
14139 addr, gfp);
14140 trace_cfg80211_return_bool(ret);
14141 return ret;
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014142}
Johannes Berg947add32013-02-22 22:05:20 +010014143EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
14144
14145bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
14146 const u8 *addr, gfp_t gfp)
14147{
14148 struct wireless_dev *wdev = dev->ieee80211_ptr;
14149 bool ret;
14150
14151 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
14152
14153 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
14154 wdev->iftype != NL80211_IFTYPE_P2P_GO &&
14155 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
14156 trace_cfg80211_return_bool(false);
14157 return false;
14158 }
14159 ret = __nl80211_unexpected_frame(dev,
14160 NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
14161 addr, gfp);
14162 trace_cfg80211_return_bool(ret);
14163 return ret;
14164}
14165EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014166
Johannes Berg2e161f72010-08-12 15:38:38 +020014167int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
Eric W. Biederman15e47302012-09-07 20:12:54 +000014168 struct wireless_dev *wdev, u32 nlportid,
Johannes Berg804483e2012-03-05 22:18:41 +010014169 int freq, int sig_dbm,
Vladimir Kondratiev19504cf2013-08-15 14:51:28 +030014170 const u8 *buf, size_t len, u32 flags, gfp_t gfp)
Jouni Malinen026331c2010-02-15 12:53:10 +020014171{
Johannes Berg71bbc992012-06-15 15:30:18 +020014172 struct net_device *netdev = wdev->netdev;
Jouni Malinen026331c2010-02-15 12:53:10 +020014173 struct sk_buff *msg;
14174 void *hdr;
Jouni Malinen026331c2010-02-15 12:53:10 +020014175
Johannes Berg14459722017-01-09 11:10:42 +010014176 msg = nlmsg_new(100 + len, gfp);
Jouni Malinen026331c2010-02-15 12:53:10 +020014177 if (!msg)
14178 return -ENOMEM;
14179
Johannes Berg2e161f72010-08-12 15:38:38 +020014180 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
Jouni Malinen026331c2010-02-15 12:53:10 +020014181 if (!hdr) {
14182 nlmsg_free(msg);
14183 return -ENOMEM;
14184 }
14185
David S. Miller9360ffd2012-03-29 04:41:26 -040014186 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg71bbc992012-06-15 15:30:18 +020014187 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14188 netdev->ifindex)) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014189 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14190 NL80211_ATTR_PAD) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040014191 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
14192 (sig_dbm &&
14193 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
Vladimir Kondratiev19504cf2013-08-15 14:51:28 +030014194 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
14195 (flags &&
14196 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
David S. Miller9360ffd2012-03-29 04:41:26 -040014197 goto nla_put_failure;
Jouni Malinen026331c2010-02-15 12:53:10 +020014198
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014199 genlmsg_end(msg, hdr);
Jouni Malinen026331c2010-02-15 12:53:10 +020014200
Eric W. Biederman15e47302012-09-07 20:12:54 +000014201 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
Jouni Malinen026331c2010-02-15 12:53:10 +020014202
14203 nla_put_failure:
14204 genlmsg_cancel(msg, hdr);
14205 nlmsg_free(msg);
14206 return -ENOBUFS;
14207}
14208
Johannes Berg947add32013-02-22 22:05:20 +010014209void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
14210 const u8 *buf, size_t len, bool ack, gfp_t gfp)
Jouni Malinen026331c2010-02-15 12:53:10 +020014211{
Johannes Berg947add32013-02-22 22:05:20 +010014212 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014213 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg71bbc992012-06-15 15:30:18 +020014214 struct net_device *netdev = wdev->netdev;
Jouni Malinen026331c2010-02-15 12:53:10 +020014215 struct sk_buff *msg;
14216 void *hdr;
14217
Johannes Berg947add32013-02-22 22:05:20 +010014218 trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
14219
Johannes Berg14459722017-01-09 11:10:42 +010014220 msg = nlmsg_new(100 + len, gfp);
Jouni Malinen026331c2010-02-15 12:53:10 +020014221 if (!msg)
14222 return;
14223
Johannes Berg2e161f72010-08-12 15:38:38 +020014224 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
Jouni Malinen026331c2010-02-15 12:53:10 +020014225 if (!hdr) {
14226 nlmsg_free(msg);
14227 return;
14228 }
14229
David S. Miller9360ffd2012-03-29 04:41:26 -040014230 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg71bbc992012-06-15 15:30:18 +020014231 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14232 netdev->ifindex)) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014233 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14234 NL80211_ATTR_PAD) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040014235 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014236 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14237 NL80211_ATTR_PAD) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040014238 (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
14239 goto nla_put_failure;
Jouni Malinen026331c2010-02-15 12:53:10 +020014240
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014241 genlmsg_end(msg, hdr);
Jouni Malinen026331c2010-02-15 12:53:10 +020014242
Johannes Berg68eb5502013-11-19 15:19:38 +010014243 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014244 NL80211_MCGRP_MLME, gfp);
Jouni Malinen026331c2010-02-15 12:53:10 +020014245 return;
14246
14247 nla_put_failure:
14248 genlmsg_cancel(msg, hdr);
14249 nlmsg_free(msg);
14250}
Johannes Berg947add32013-02-22 22:05:20 +010014251EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
Jouni Malinen026331c2010-02-15 12:53:10 +020014252
Johannes Berg5b97f492014-11-26 12:37:43 +010014253static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
14254 const char *mac, gfp_t gfp)
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014255{
Johannes Berg947add32013-02-22 22:05:20 +010014256 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Berg5b97f492014-11-26 12:37:43 +010014257 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14258 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14259 void **cb;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014260
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014261 if (!msg)
Johannes Berg5b97f492014-11-26 12:37:43 +010014262 return NULL;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014263
Johannes Berg5b97f492014-11-26 12:37:43 +010014264 cb = (void **)msg->cb;
14265
14266 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
14267 if (!cb[0]) {
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014268 nlmsg_free(msg);
Johannes Berg5b97f492014-11-26 12:37:43 +010014269 return NULL;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014270 }
14271
David S. Miller9360ffd2012-03-29 04:41:26 -040014272 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg947add32013-02-22 22:05:20 +010014273 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
David S. Miller9360ffd2012-03-29 04:41:26 -040014274 goto nla_put_failure;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014275
Johannes Berg5b97f492014-11-26 12:37:43 +010014276 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014277 goto nla_put_failure;
14278
Johannes Berg5b97f492014-11-26 12:37:43 +010014279 cb[1] = nla_nest_start(msg, NL80211_ATTR_CQM);
14280 if (!cb[1])
14281 goto nla_put_failure;
14282
14283 cb[2] = rdev;
14284
14285 return msg;
14286 nla_put_failure:
14287 nlmsg_free(msg);
14288 return NULL;
14289}
14290
14291static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
14292{
14293 void **cb = (void **)msg->cb;
14294 struct cfg80211_registered_device *rdev = cb[2];
14295
14296 nla_nest_end(msg, cb[1]);
14297 genlmsg_end(msg, cb[0]);
14298
14299 memset(msg->cb, 0, sizeof(msg->cb));
14300
14301 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14302 NL80211_MCGRP_MLME, gfp);
14303}
14304
14305void cfg80211_cqm_rssi_notify(struct net_device *dev,
14306 enum nl80211_cqm_rssi_threshold_event rssi_event,
14307 gfp_t gfp)
14308{
14309 struct sk_buff *msg;
14310
14311 trace_cfg80211_cqm_rssi_notify(dev, rssi_event);
14312
Johannes Berg98f03342014-11-26 12:42:02 +010014313 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
14314 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
14315 return;
14316
Johannes Berg5b97f492014-11-26 12:37:43 +010014317 msg = cfg80211_prepare_cqm(dev, NULL, gfp);
14318 if (!msg)
14319 return;
14320
David S. Miller9360ffd2012-03-29 04:41:26 -040014321 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
14322 rssi_event))
14323 goto nla_put_failure;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014324
Johannes Berg5b97f492014-11-26 12:37:43 +010014325 cfg80211_send_cqm(msg, gfp);
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014326
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014327 return;
14328
14329 nla_put_failure:
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014330 nlmsg_free(msg);
14331}
Johannes Berg947add32013-02-22 22:05:20 +010014332EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014333
Johannes Berg5b97f492014-11-26 12:37:43 +010014334void cfg80211_cqm_txe_notify(struct net_device *dev,
14335 const u8 *peer, u32 num_packets,
14336 u32 rate, u32 intvl, gfp_t gfp)
14337{
14338 struct sk_buff *msg;
14339
14340 msg = cfg80211_prepare_cqm(dev, peer, gfp);
14341 if (!msg)
14342 return;
14343
14344 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
14345 goto nla_put_failure;
14346
14347 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
14348 goto nla_put_failure;
14349
14350 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
14351 goto nla_put_failure;
14352
14353 cfg80211_send_cqm(msg, gfp);
14354 return;
14355
14356 nla_put_failure:
14357 nlmsg_free(msg);
14358}
14359EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
14360
14361void cfg80211_cqm_pktloss_notify(struct net_device *dev,
14362 const u8 *peer, u32 num_packets, gfp_t gfp)
14363{
14364 struct sk_buff *msg;
14365
14366 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
14367
14368 msg = cfg80211_prepare_cqm(dev, peer, gfp);
14369 if (!msg)
14370 return;
14371
14372 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
14373 goto nla_put_failure;
14374
14375 cfg80211_send_cqm(msg, gfp);
14376 return;
14377
14378 nla_put_failure:
14379 nlmsg_free(msg);
14380}
14381EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
14382
Johannes Berg98f03342014-11-26 12:42:02 +010014383void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
14384{
14385 struct sk_buff *msg;
14386
14387 msg = cfg80211_prepare_cqm(dev, NULL, gfp);
14388 if (!msg)
14389 return;
14390
14391 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
14392 goto nla_put_failure;
14393
14394 cfg80211_send_cqm(msg, gfp);
14395 return;
14396
14397 nla_put_failure:
14398 nlmsg_free(msg);
14399}
14400EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
14401
Johannes Berg947add32013-02-22 22:05:20 +010014402static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
14403 struct net_device *netdev, const u8 *bssid,
14404 const u8 *replay_ctr, gfp_t gfp)
Johannes Berge5497d72011-07-05 16:35:40 +020014405{
14406 struct sk_buff *msg;
14407 struct nlattr *rekey_attr;
14408 void *hdr;
14409
Thomas Graf58050fc2012-06-28 03:57:45 +000014410 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Johannes Berge5497d72011-07-05 16:35:40 +020014411 if (!msg)
14412 return;
14413
14414 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
14415 if (!hdr) {
14416 nlmsg_free(msg);
14417 return;
14418 }
14419
David S. Miller9360ffd2012-03-29 04:41:26 -040014420 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14421 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14422 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
14423 goto nla_put_failure;
Johannes Berge5497d72011-07-05 16:35:40 +020014424
14425 rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
14426 if (!rekey_attr)
14427 goto nla_put_failure;
14428
David S. Miller9360ffd2012-03-29 04:41:26 -040014429 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
14430 NL80211_REPLAY_CTR_LEN, replay_ctr))
14431 goto nla_put_failure;
Johannes Berge5497d72011-07-05 16:35:40 +020014432
14433 nla_nest_end(msg, rekey_attr);
14434
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014435 genlmsg_end(msg, hdr);
Johannes Berge5497d72011-07-05 16:35:40 +020014436
Johannes Berg68eb5502013-11-19 15:19:38 +010014437 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014438 NL80211_MCGRP_MLME, gfp);
Johannes Berge5497d72011-07-05 16:35:40 +020014439 return;
14440
14441 nla_put_failure:
14442 genlmsg_cancel(msg, hdr);
14443 nlmsg_free(msg);
14444}
14445
Johannes Berg947add32013-02-22 22:05:20 +010014446void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
14447 const u8 *replay_ctr, gfp_t gfp)
14448{
14449 struct wireless_dev *wdev = dev->ieee80211_ptr;
14450 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014451 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg947add32013-02-22 22:05:20 +010014452
14453 trace_cfg80211_gtk_rekey_notify(dev, bssid);
14454 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
14455}
14456EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
14457
14458static void
14459nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
14460 struct net_device *netdev, int index,
14461 const u8 *bssid, bool preauth, gfp_t gfp)
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014462{
14463 struct sk_buff *msg;
14464 struct nlattr *attr;
14465 void *hdr;
14466
Thomas Graf58050fc2012-06-28 03:57:45 +000014467 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014468 if (!msg)
14469 return;
14470
14471 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
14472 if (!hdr) {
14473 nlmsg_free(msg);
14474 return;
14475 }
14476
David S. Miller9360ffd2012-03-29 04:41:26 -040014477 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14478 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
14479 goto nla_put_failure;
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014480
14481 attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
14482 if (!attr)
14483 goto nla_put_failure;
14484
David S. Miller9360ffd2012-03-29 04:41:26 -040014485 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
14486 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
14487 (preauth &&
14488 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
14489 goto nla_put_failure;
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014490
14491 nla_nest_end(msg, attr);
14492
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014493 genlmsg_end(msg, hdr);
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014494
Johannes Berg68eb5502013-11-19 15:19:38 +010014495 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014496 NL80211_MCGRP_MLME, gfp);
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014497 return;
14498
14499 nla_put_failure:
14500 genlmsg_cancel(msg, hdr);
14501 nlmsg_free(msg);
14502}
14503
Johannes Berg947add32013-02-22 22:05:20 +010014504void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
14505 const u8 *bssid, bool preauth, gfp_t gfp)
14506{
14507 struct wireless_dev *wdev = dev->ieee80211_ptr;
14508 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014509 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg947add32013-02-22 22:05:20 +010014510
14511 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
14512 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
14513}
14514EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
14515
14516static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
14517 struct net_device *netdev,
14518 struct cfg80211_chan_def *chandef,
Luciano Coelhof8d75522014-11-07 14:31:35 +020014519 gfp_t gfp,
14520 enum nl80211_commands notif,
14521 u8 count)
Thomas Pedersen53145262012-04-06 13:35:47 -070014522{
14523 struct sk_buff *msg;
14524 void *hdr;
14525
Thomas Graf58050fc2012-06-28 03:57:45 +000014526 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Thomas Pedersen53145262012-04-06 13:35:47 -070014527 if (!msg)
14528 return;
14529
Luciano Coelhof8d75522014-11-07 14:31:35 +020014530 hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
Thomas Pedersen53145262012-04-06 13:35:47 -070014531 if (!hdr) {
14532 nlmsg_free(msg);
14533 return;
14534 }
14535
Johannes Berg683b6d32012-11-08 21:25:48 +010014536 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
14537 goto nla_put_failure;
14538
14539 if (nl80211_send_chandef(msg, chandef))
John W. Linville7eab0f62012-04-12 14:25:14 -040014540 goto nla_put_failure;
Thomas Pedersen53145262012-04-06 13:35:47 -070014541
Luciano Coelhof8d75522014-11-07 14:31:35 +020014542 if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
14543 (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
14544 goto nla_put_failure;
14545
Thomas Pedersen53145262012-04-06 13:35:47 -070014546 genlmsg_end(msg, hdr);
14547
Johannes Berg68eb5502013-11-19 15:19:38 +010014548 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014549 NL80211_MCGRP_MLME, gfp);
Thomas Pedersen53145262012-04-06 13:35:47 -070014550 return;
14551
14552 nla_put_failure:
14553 genlmsg_cancel(msg, hdr);
14554 nlmsg_free(msg);
14555}
14556
Johannes Berg947add32013-02-22 22:05:20 +010014557void cfg80211_ch_switch_notify(struct net_device *dev,
14558 struct cfg80211_chan_def *chandef)
Thomas Pedersen84f10702012-07-12 16:17:33 -070014559{
Johannes Berg947add32013-02-22 22:05:20 +010014560 struct wireless_dev *wdev = dev->ieee80211_ptr;
14561 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014562 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg947add32013-02-22 22:05:20 +010014563
Simon Wunderliche487eae2013-11-21 18:19:51 +010014564 ASSERT_WDEV_LOCK(wdev);
Johannes Berg947add32013-02-22 22:05:20 +010014565
Simon Wunderliche487eae2013-11-21 18:19:51 +010014566 trace_cfg80211_ch_switch_notify(dev, chandef);
Johannes Berg947add32013-02-22 22:05:20 +010014567
Michal Kazior9e0e2962014-01-29 14:22:27 +010014568 wdev->chandef = *chandef;
Janusz Dziedzic96f55f12014-01-24 14:29:21 +010014569 wdev->preset_chandef = *chandef;
Sergey Matyukeviche5c17242019-03-26 09:27:37 +000014570
14571 if (wdev->iftype == NL80211_IFTYPE_STATION &&
14572 !WARN_ON(!wdev->current_bss))
14573 wdev->current_bss->pub.channel = chandef->chan;
14574
Luciano Coelhof8d75522014-11-07 14:31:35 +020014575 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
14576 NL80211_CMD_CH_SWITCH_NOTIFY, 0);
Johannes Berg947add32013-02-22 22:05:20 +010014577}
14578EXPORT_SYMBOL(cfg80211_ch_switch_notify);
14579
Luciano Coelhof8d75522014-11-07 14:31:35 +020014580void cfg80211_ch_switch_started_notify(struct net_device *dev,
14581 struct cfg80211_chan_def *chandef,
14582 u8 count)
14583{
14584 struct wireless_dev *wdev = dev->ieee80211_ptr;
14585 struct wiphy *wiphy = wdev->wiphy;
14586 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14587
14588 trace_cfg80211_ch_switch_started_notify(dev, chandef);
14589
14590 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
14591 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
14592}
14593EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
14594
Thomas Pedersen84f10702012-07-12 16:17:33 -070014595void
Simon Wunderlich04f39042013-02-08 18:16:19 +010014596nl80211_radar_notify(struct cfg80211_registered_device *rdev,
Janusz Dziedzicd2859df2013-11-06 13:55:51 +010014597 const struct cfg80211_chan_def *chandef,
Simon Wunderlich04f39042013-02-08 18:16:19 +010014598 enum nl80211_radar_event event,
14599 struct net_device *netdev, gfp_t gfp)
14600{
14601 struct sk_buff *msg;
14602 void *hdr;
14603
14604 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14605 if (!msg)
14606 return;
14607
14608 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
14609 if (!hdr) {
14610 nlmsg_free(msg);
14611 return;
14612 }
14613
14614 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
14615 goto nla_put_failure;
14616
14617 /* NOP and radar events don't need a netdev parameter */
14618 if (netdev) {
14619 struct wireless_dev *wdev = netdev->ieee80211_ptr;
14620
14621 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014622 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14623 NL80211_ATTR_PAD))
Simon Wunderlich04f39042013-02-08 18:16:19 +010014624 goto nla_put_failure;
14625 }
14626
14627 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
14628 goto nla_put_failure;
14629
14630 if (nl80211_send_chandef(msg, chandef))
14631 goto nla_put_failure;
14632
Johannes Berg9c90a9f2013-06-04 12:46:03 +020014633 genlmsg_end(msg, hdr);
Simon Wunderlich04f39042013-02-08 18:16:19 +010014634
Johannes Berg68eb5502013-11-19 15:19:38 +010014635 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014636 NL80211_MCGRP_MLME, gfp);
Simon Wunderlich04f39042013-02-08 18:16:19 +010014637 return;
14638
14639 nla_put_failure:
14640 genlmsg_cancel(msg, hdr);
14641 nlmsg_free(msg);
14642}
14643
Johannes Berg7f6cf312011-11-04 11:18:15 +010014644void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
14645 u64 cookie, bool acked, gfp_t gfp)
14646{
14647 struct wireless_dev *wdev = dev->ieee80211_ptr;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014648 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Berg7f6cf312011-11-04 11:18:15 +010014649 struct sk_buff *msg;
14650 void *hdr;
Johannes Berg7f6cf312011-11-04 11:18:15 +010014651
Beni Lev4ee3e062012-08-27 12:49:39 +030014652 trace_cfg80211_probe_status(dev, addr, cookie, acked);
14653
Thomas Graf58050fc2012-06-28 03:57:45 +000014654 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Beni Lev4ee3e062012-08-27 12:49:39 +030014655
Johannes Berg7f6cf312011-11-04 11:18:15 +010014656 if (!msg)
14657 return;
14658
14659 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
14660 if (!hdr) {
14661 nlmsg_free(msg);
14662 return;
14663 }
14664
David S. Miller9360ffd2012-03-29 04:41:26 -040014665 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14666 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14667 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014668 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14669 NL80211_ATTR_PAD) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040014670 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)))
14671 goto nla_put_failure;
Johannes Berg7f6cf312011-11-04 11:18:15 +010014672
Johannes Berg9c90a9f2013-06-04 12:46:03 +020014673 genlmsg_end(msg, hdr);
Johannes Berg7f6cf312011-11-04 11:18:15 +010014674
Johannes Berg68eb5502013-11-19 15:19:38 +010014675 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014676 NL80211_MCGRP_MLME, gfp);
Johannes Berg7f6cf312011-11-04 11:18:15 +010014677 return;
14678
14679 nla_put_failure:
14680 genlmsg_cancel(msg, hdr);
14681 nlmsg_free(msg);
14682}
14683EXPORT_SYMBOL(cfg80211_probe_status);
14684
Johannes Berg5e7602302011-11-04 11:18:17 +010014685void cfg80211_report_obss_beacon(struct wiphy *wiphy,
14686 const u8 *frame, size_t len,
Ben Greear37c73b52012-10-26 14:49:25 -070014687 int freq, int sig_dbm)
Johannes Berg5e7602302011-11-04 11:18:17 +010014688{
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014689 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg5e7602302011-11-04 11:18:17 +010014690 struct sk_buff *msg;
14691 void *hdr;
Ben Greear37c73b52012-10-26 14:49:25 -070014692 struct cfg80211_beacon_registration *reg;
Johannes Berg5e7602302011-11-04 11:18:17 +010014693
Beni Lev4ee3e062012-08-27 12:49:39 +030014694 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
14695
Ben Greear37c73b52012-10-26 14:49:25 -070014696 spin_lock_bh(&rdev->beacon_registrations_lock);
14697 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
14698 msg = nlmsg_new(len + 100, GFP_ATOMIC);
14699 if (!msg) {
14700 spin_unlock_bh(&rdev->beacon_registrations_lock);
14701 return;
14702 }
Johannes Berg5e7602302011-11-04 11:18:17 +010014703
Ben Greear37c73b52012-10-26 14:49:25 -070014704 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
14705 if (!hdr)
14706 goto nla_put_failure;
Johannes Berg5e7602302011-11-04 11:18:17 +010014707
Ben Greear37c73b52012-10-26 14:49:25 -070014708 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14709 (freq &&
14710 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
14711 (sig_dbm &&
14712 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
14713 nla_put(msg, NL80211_ATTR_FRAME, len, frame))
14714 goto nla_put_failure;
14715
14716 genlmsg_end(msg, hdr);
14717
14718 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
Johannes Berg5e7602302011-11-04 11:18:17 +010014719 }
Ben Greear37c73b52012-10-26 14:49:25 -070014720 spin_unlock_bh(&rdev->beacon_registrations_lock);
Johannes Berg5e7602302011-11-04 11:18:17 +010014721 return;
14722
14723 nla_put_failure:
Ben Greear37c73b52012-10-26 14:49:25 -070014724 spin_unlock_bh(&rdev->beacon_registrations_lock);
14725 if (hdr)
14726 genlmsg_cancel(msg, hdr);
Johannes Berg5e7602302011-11-04 11:18:17 +010014727 nlmsg_free(msg);
14728}
14729EXPORT_SYMBOL(cfg80211_report_obss_beacon);
14730
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010014731#ifdef CONFIG_PM
Luciano Coelho8cd4d452014-09-17 11:55:28 +030014732static int cfg80211_net_detect_results(struct sk_buff *msg,
14733 struct cfg80211_wowlan_wakeup *wakeup)
14734{
14735 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
14736 struct nlattr *nl_results, *nl_match, *nl_freqs;
14737 int i, j;
14738
14739 nl_results = nla_nest_start(
14740 msg, NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
14741 if (!nl_results)
14742 return -EMSGSIZE;
14743
14744 for (i = 0; i < nd->n_matches; i++) {
14745 struct cfg80211_wowlan_nd_match *match = nd->matches[i];
14746
14747 nl_match = nla_nest_start(msg, i);
14748 if (!nl_match)
14749 break;
14750
14751 /* The SSID attribute is optional in nl80211, but for
14752 * simplicity reasons it's always present in the
14753 * cfg80211 structure. If a driver can't pass the
14754 * SSID, that needs to be changed. A zero length SSID
14755 * is still a valid SSID (wildcard), so it cannot be
14756 * used for this purpose.
14757 */
14758 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
14759 match->ssid.ssid)) {
14760 nla_nest_cancel(msg, nl_match);
14761 goto out;
14762 }
14763
14764 if (match->n_channels) {
14765 nl_freqs = nla_nest_start(
14766 msg, NL80211_ATTR_SCAN_FREQUENCIES);
14767 if (!nl_freqs) {
14768 nla_nest_cancel(msg, nl_match);
14769 goto out;
14770 }
14771
14772 for (j = 0; j < match->n_channels; j++) {
Samuel Tan5528fae82015-02-09 21:29:15 +020014773 if (nla_put_u32(msg, j, match->channels[j])) {
Luciano Coelho8cd4d452014-09-17 11:55:28 +030014774 nla_nest_cancel(msg, nl_freqs);
14775 nla_nest_cancel(msg, nl_match);
14776 goto out;
14777 }
14778 }
14779
14780 nla_nest_end(msg, nl_freqs);
14781 }
14782
14783 nla_nest_end(msg, nl_match);
14784 }
14785
14786out:
14787 nla_nest_end(msg, nl_results);
14788 return 0;
14789}
14790
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010014791void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
14792 struct cfg80211_wowlan_wakeup *wakeup,
14793 gfp_t gfp)
14794{
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014795 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010014796 struct sk_buff *msg;
14797 void *hdr;
Johannes Berg9c90a9f2013-06-04 12:46:03 +020014798 int size = 200;
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010014799
14800 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
14801
14802 if (wakeup)
14803 size += wakeup->packet_present_len;
14804
14805 msg = nlmsg_new(size, gfp);
14806 if (!msg)
14807 return;
14808
14809 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
14810 if (!hdr)
14811 goto free_msg;
14812
14813 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014814 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14815 NL80211_ATTR_PAD))
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010014816 goto free_msg;
14817
14818 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14819 wdev->netdev->ifindex))
14820 goto free_msg;
14821
14822 if (wakeup) {
14823 struct nlattr *reasons;
14824
14825 reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
Johannes Berg7fa322c2013-10-25 11:16:58 +020014826 if (!reasons)
14827 goto free_msg;
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010014828
14829 if (wakeup->disconnect &&
14830 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
14831 goto free_msg;
14832 if (wakeup->magic_pkt &&
14833 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
14834 goto free_msg;
14835 if (wakeup->gtk_rekey_failure &&
14836 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
14837 goto free_msg;
14838 if (wakeup->eap_identity_req &&
14839 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
14840 goto free_msg;
14841 if (wakeup->four_way_handshake &&
14842 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
14843 goto free_msg;
14844 if (wakeup->rfkill_release &&
14845 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
14846 goto free_msg;
14847
14848 if (wakeup->pattern_idx >= 0 &&
14849 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
14850 wakeup->pattern_idx))
14851 goto free_msg;
14852
Johannes Bergae917c92013-10-25 11:05:22 +020014853 if (wakeup->tcp_match &&
14854 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
14855 goto free_msg;
Johannes Berg2a0e0472013-01-23 22:57:40 +010014856
Johannes Bergae917c92013-10-25 11:05:22 +020014857 if (wakeup->tcp_connlost &&
14858 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
14859 goto free_msg;
Johannes Berg2a0e0472013-01-23 22:57:40 +010014860
Johannes Bergae917c92013-10-25 11:05:22 +020014861 if (wakeup->tcp_nomoretokens &&
14862 nla_put_flag(msg,
14863 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
14864 goto free_msg;
Johannes Berg2a0e0472013-01-23 22:57:40 +010014865
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010014866 if (wakeup->packet) {
14867 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
14868 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
14869
14870 if (!wakeup->packet_80211) {
14871 pkt_attr =
14872 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
14873 len_attr =
14874 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
14875 }
14876
14877 if (wakeup->packet_len &&
14878 nla_put_u32(msg, len_attr, wakeup->packet_len))
14879 goto free_msg;
14880
14881 if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
14882 wakeup->packet))
14883 goto free_msg;
14884 }
14885
Luciano Coelho8cd4d452014-09-17 11:55:28 +030014886 if (wakeup->net_detect &&
14887 cfg80211_net_detect_results(msg, wakeup))
14888 goto free_msg;
14889
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010014890 nla_nest_end(msg, reasons);
14891 }
14892
Johannes Berg9c90a9f2013-06-04 12:46:03 +020014893 genlmsg_end(msg, hdr);
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010014894
Johannes Berg68eb5502013-11-19 15:19:38 +010014895 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014896 NL80211_MCGRP_MLME, gfp);
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010014897 return;
14898
14899 free_msg:
14900 nlmsg_free(msg);
14901}
14902EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
14903#endif
14904
Jouni Malinen3475b092012-11-16 22:49:57 +020014905void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
14906 enum nl80211_tdls_operation oper,
14907 u16 reason_code, gfp_t gfp)
14908{
14909 struct wireless_dev *wdev = dev->ieee80211_ptr;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014910 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Jouni Malinen3475b092012-11-16 22:49:57 +020014911 struct sk_buff *msg;
14912 void *hdr;
Jouni Malinen3475b092012-11-16 22:49:57 +020014913
14914 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
14915 reason_code);
14916
14917 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14918 if (!msg)
14919 return;
14920
14921 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
14922 if (!hdr) {
14923 nlmsg_free(msg);
14924 return;
14925 }
14926
14927 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14928 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14929 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
14930 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
14931 (reason_code > 0 &&
14932 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
14933 goto nla_put_failure;
14934
Johannes Berg9c90a9f2013-06-04 12:46:03 +020014935 genlmsg_end(msg, hdr);
Jouni Malinen3475b092012-11-16 22:49:57 +020014936
Johannes Berg68eb5502013-11-19 15:19:38 +010014937 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014938 NL80211_MCGRP_MLME, gfp);
Jouni Malinen3475b092012-11-16 22:49:57 +020014939 return;
14940
14941 nla_put_failure:
14942 genlmsg_cancel(msg, hdr);
14943 nlmsg_free(msg);
14944}
14945EXPORT_SYMBOL(cfg80211_tdls_oper_request);
14946
Jouni Malinen026331c2010-02-15 12:53:10 +020014947static int nl80211_netlink_notify(struct notifier_block * nb,
14948 unsigned long state,
14949 void *_notify)
14950{
14951 struct netlink_notify *notify = _notify;
14952 struct cfg80211_registered_device *rdev;
14953 struct wireless_dev *wdev;
Ben Greear37c73b52012-10-26 14:49:25 -070014954 struct cfg80211_beacon_registration *reg, *tmp;
Jouni Malinen026331c2010-02-15 12:53:10 +020014955
Dmitry Ivanov8f815cd2016-04-06 17:23:18 +030014956 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
Jouni Malinen026331c2010-02-15 12:53:10 +020014957 return NOTIFY_DONE;
14958
14959 rcu_read_lock();
14960
Johannes Berg5e7602302011-11-04 11:18:17 +010014961 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
Johannes Berg78f22b62014-03-24 17:57:27 +010014962 bool schedule_destroy_work = false;
Jukka Rissanen93a1e862014-12-15 13:25:39 +020014963 struct cfg80211_sched_scan_request *sched_scan_req =
14964 rcu_dereference(rdev->sched_scan_req);
14965
14966 if (sched_scan_req && notify->portid &&
Johannes Berg0a28f532017-01-05 10:57:14 +010014967 sched_scan_req->owner_nlportid == notify->portid) {
14968 sched_scan_req->owner_nlportid = 0;
14969
14970 if (rdev->ops->sched_scan_stop &&
14971 rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN)
14972 schedule_work(&rdev->sched_scan_stop_wk);
14973 }
Johannes Berg78f22b62014-03-24 17:57:27 +010014974
Johannes Berg53873f12016-05-03 16:52:04 +030014975 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
Eric W. Biederman15e47302012-09-07 20:12:54 +000014976 cfg80211_mlme_unregister_socket(wdev, notify->portid);
Ben Greear37c73b52012-10-26 14:49:25 -070014977
Johannes Berg78f22b62014-03-24 17:57:27 +010014978 if (wdev->owner_nlportid == notify->portid)
14979 schedule_destroy_work = true;
Andrzej Zaborowski5f3f4d32018-02-04 21:57:28 +053014980 else if (wdev->conn_owner_nlportid == notify->portid)
14981 schedule_work(&wdev->disconnect_wk);
Johannes Berg78f22b62014-03-24 17:57:27 +010014982 }
14983
Ben Greear37c73b52012-10-26 14:49:25 -070014984 spin_lock_bh(&rdev->beacon_registrations_lock);
14985 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
14986 list) {
14987 if (reg->nlportid == notify->portid) {
14988 list_del(&reg->list);
14989 kfree(reg);
14990 break;
14991 }
14992 }
14993 spin_unlock_bh(&rdev->beacon_registrations_lock);
Johannes Berg78f22b62014-03-24 17:57:27 +010014994
14995 if (schedule_destroy_work) {
14996 struct cfg80211_iface_destroy *destroy;
14997
14998 destroy = kzalloc(sizeof(*destroy), GFP_ATOMIC);
14999 if (destroy) {
15000 destroy->nlportid = notify->portid;
15001 spin_lock(&rdev->destroy_list_lock);
15002 list_add(&destroy->list, &rdev->destroy_list);
15003 spin_unlock(&rdev->destroy_list_lock);
15004 schedule_work(&rdev->destroy_work);
15005 }
15006 }
Johannes Berg5e7602302011-11-04 11:18:17 +010015007 }
Jouni Malinen026331c2010-02-15 12:53:10 +020015008
15009 rcu_read_unlock();
15010
Ilan peer05050752015-03-04 00:32:06 -050015011 /*
15012 * It is possible that the user space process that is controlling the
15013 * indoor setting disappeared, so notify the regulatory core.
15014 */
15015 regulatory_netlink_notify(notify->portid);
Zhao, Gang6784c7d2014-04-21 12:53:04 +080015016 return NOTIFY_OK;
Jouni Malinen026331c2010-02-15 12:53:10 +020015017}
15018
15019static struct notifier_block nl80211_netlink_notifier = {
15020 .notifier_call = nl80211_netlink_notify,
15021};
15022
Jouni Malinen355199e2013-02-27 17:14:27 +020015023void cfg80211_ft_event(struct net_device *netdev,
15024 struct cfg80211_ft_event_params *ft_event)
15025{
15026 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080015027 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Jouni Malinen355199e2013-02-27 17:14:27 +020015028 struct sk_buff *msg;
15029 void *hdr;
Jouni Malinen355199e2013-02-27 17:14:27 +020015030
15031 trace_cfg80211_ft_event(wiphy, netdev, ft_event);
15032
15033 if (!ft_event->target_ap)
15034 return;
15035
Dedy Lanskyfe064512018-05-17 13:46:22 +030015036 msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len,
15037 GFP_KERNEL);
Jouni Malinen355199e2013-02-27 17:14:27 +020015038 if (!msg)
15039 return;
15040
15041 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
Johannes Bergae917c92013-10-25 11:05:22 +020015042 if (!hdr)
15043 goto out;
Jouni Malinen355199e2013-02-27 17:14:27 +020015044
Johannes Bergae917c92013-10-25 11:05:22 +020015045 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15046 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15047 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
15048 goto out;
15049
15050 if (ft_event->ies &&
15051 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
15052 goto out;
15053 if (ft_event->ric_ies &&
15054 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
15055 ft_event->ric_ies))
15056 goto out;
Jouni Malinen355199e2013-02-27 17:14:27 +020015057
Johannes Berg9c90a9f2013-06-04 12:46:03 +020015058 genlmsg_end(msg, hdr);
Jouni Malinen355199e2013-02-27 17:14:27 +020015059
Johannes Berg68eb5502013-11-19 15:19:38 +010015060 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010015061 NL80211_MCGRP_MLME, GFP_KERNEL);
Johannes Bergae917c92013-10-25 11:05:22 +020015062 return;
15063 out:
15064 nlmsg_free(msg);
Jouni Malinen355199e2013-02-27 17:14:27 +020015065}
15066EXPORT_SYMBOL(cfg80211_ft_event);
15067
Arend van Spriel5de17982013-04-18 15:49:00 +020015068void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
15069{
15070 struct cfg80211_registered_device *rdev;
15071 struct sk_buff *msg;
15072 void *hdr;
15073 u32 nlportid;
15074
Zhao, Gangf26cbf42014-04-21 12:53:03 +080015075 rdev = wiphy_to_rdev(wdev->wiphy);
Arend van Spriel5de17982013-04-18 15:49:00 +020015076 if (!rdev->crit_proto_nlportid)
15077 return;
15078
15079 nlportid = rdev->crit_proto_nlportid;
15080 rdev->crit_proto_nlportid = 0;
15081
15082 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15083 if (!msg)
15084 return;
15085
15086 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
15087 if (!hdr)
15088 goto nla_put_failure;
15089
15090 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020015091 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15092 NL80211_ATTR_PAD))
Arend van Spriel5de17982013-04-18 15:49:00 +020015093 goto nla_put_failure;
15094
15095 genlmsg_end(msg, hdr);
15096
15097 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15098 return;
15099
15100 nla_put_failure:
15101 if (hdr)
15102 genlmsg_cancel(msg, hdr);
15103 nlmsg_free(msg);
Arend van Spriel5de17982013-04-18 15:49:00 +020015104}
15105EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
15106
Sameer Thalappilfaa4c4a2013-07-05 14:58:32 -070015107void cfg80211_ap_stopped(struct net_device *netdev, gfp_t gfp)
15108{
15109 struct wireless_dev *wdev = netdev->ieee80211_ptr;
15110 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15111
15112 nl80211_send_mlme_event(rdev, netdev, NULL, 0,
15113 NL80211_CMD_STOP_AP, gfp, -1);
15114}
15115EXPORT_SYMBOL(cfg80211_ap_stopped);
15116
Johannes Berg348baf02014-01-24 14:06:29 +010015117void nl80211_send_ap_stopped(struct wireless_dev *wdev)
15118{
15119 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080015120 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg348baf02014-01-24 14:06:29 +010015121 struct sk_buff *msg;
15122 void *hdr;
15123
15124 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15125 if (!msg)
15126 return;
15127
15128 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
15129 if (!hdr)
15130 goto out;
15131
15132 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15133 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020015134 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15135 NL80211_ATTR_PAD))
Johannes Berg348baf02014-01-24 14:06:29 +010015136 goto out;
15137
15138 genlmsg_end(msg, hdr);
15139
15140 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
15141 NL80211_MCGRP_MLME, GFP_KERNEL);
15142 return;
15143 out:
15144 nlmsg_free(msg);
15145}
15146
Srinivas Dasarid041a1a2018-02-07 18:32:17 +053015147int cfg80211_external_auth_request(struct net_device *dev,
15148 struct cfg80211_external_auth_params *params,
15149 gfp_t gfp)
15150{
15151 struct wireless_dev *wdev = dev->ieee80211_ptr;
15152 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15153 struct sk_buff *msg;
15154 void *hdr;
15155
15156 if (!wdev->conn_owner_nlportid)
15157 return -EINVAL;
15158
15159 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15160 if (!msg)
15161 return -ENOMEM;
15162
15163 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH);
15164 if (!hdr)
15165 goto nla_put_failure;
15166
15167 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15168 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15169 nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) ||
15170 nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION,
15171 params->action) ||
15172 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) ||
15173 nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len,
15174 params->ssid.ssid))
15175 goto nla_put_failure;
15176
15177 genlmsg_end(msg, hdr);
15178 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
15179 wdev->conn_owner_nlportid);
15180 return 0;
15181
15182 nla_put_failure:
15183 nlmsg_free(msg);
15184 return -ENOBUFS;
15185}
15186EXPORT_SYMBOL(cfg80211_external_auth_request);
15187
Sunil Dutt6e200822019-04-09 13:09:28 +053015188void cfg80211_update_owe_info_event(struct net_device *netdev,
15189 struct cfg80211_update_owe_info *owe_info,
15190 gfp_t gfp)
15191{
15192 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
15193 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15194 struct sk_buff *msg;
15195 void *hdr;
15196
15197 trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info);
15198
15199 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15200 if (!msg)
15201 return;
15202
15203 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO);
15204 if (!hdr)
15205 goto nla_put_failure;
15206
15207 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15208 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15209 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer))
15210 goto nla_put_failure;
15211
15212 if (!owe_info->ie_len ||
15213 nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie))
15214 goto nla_put_failure;
15215
15216 genlmsg_end(msg, hdr);
15217
15218 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15219 NL80211_MCGRP_MLME, gfp);
15220 return;
15221
15222nla_put_failure:
15223 genlmsg_cancel(msg, hdr);
15224 nlmsg_free(msg);
15225}
15226EXPORT_SYMBOL(cfg80211_update_owe_info_event);
15227
Johannes Berg55682962007-09-20 13:09:35 -040015228/* initialisation/exit functions */
15229
15230int nl80211_init(void)
15231{
Michał Mirosław0d63cbb2009-05-21 10:34:06 +000015232 int err;
Johannes Berg55682962007-09-20 13:09:35 -040015233
Johannes Berg2a94fe42013-11-19 15:19:39 +010015234 err = genl_register_family_with_ops_groups(&nl80211_fam, nl80211_ops,
15235 nl80211_mcgrps);
Johannes Berg55682962007-09-20 13:09:35 -040015236 if (err)
15237 return err;
15238
Jouni Malinen026331c2010-02-15 12:53:10 +020015239 err = netlink_register_notifier(&nl80211_netlink_notifier);
15240 if (err)
15241 goto err_out;
15242
Johannes Berg55682962007-09-20 13:09:35 -040015243 return 0;
15244 err_out:
15245 genl_unregister_family(&nl80211_fam);
15246 return err;
15247}
15248
15249void nl80211_exit(void)
15250{
Jouni Malinen026331c2010-02-15 12:53:10 +020015251 netlink_unregister_notifier(&nl80211_netlink_notifier);
Johannes Berg55682962007-09-20 13:09:35 -040015252 genl_unregister_family(&nl80211_fam);
15253}