blob: aa6b64069c80afbd08ac8521f2f36a5a94d29752 [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
Johannes Berg66cd7942017-02-07 22:40:44 +02006 * Copyright 2015-2017 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>
Johannes Berg2a519312009-02-10 21:25:55 +010019#include <linux/etherdevice.h>
Johannes Berg463d0182009-07-14 00:33:35 +020020#include <net/net_namespace.h>
Johannes Berg55682962007-09-20 13:09:35 -040021#include <net/genetlink.h>
22#include <net/cfg80211.h>
Johannes Berg463d0182009-07-14 00:33:35 +020023#include <net/sock.h>
Johannes Berg2a0e0472013-01-23 22:57:40 +010024#include <net/inet_connection_sock.h>
Johannes Berg55682962007-09-20 13:09:35 -040025#include "core.h"
26#include "nl80211.h"
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -070027#include "reg.h"
Hila Gonene35e4d22012-06-27 17:19:42 +030028#include "rdev-ops.h"
Johannes Berg55682962007-09-20 13:09:35 -040029
Jouni Malinen5fb628e2011-08-10 23:54:35 +030030static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
31 struct genl_info *info,
32 struct cfg80211_crypto_settings *settings,
33 int cipher_limit);
34
Johannes Berg55682962007-09-20 13:09:35 -040035/* the netlink family */
Johannes Berg489111e2016-10-24 14:40:03 +020036static struct genl_family nl80211_fam;
Johannes Berg55682962007-09-20 13:09:35 -040037
Johannes Berg2a94fe42013-11-19 15:19:39 +010038/* multicast groups */
39enum nl80211_multicast_groups {
40 NL80211_MCGRP_CONFIG,
41 NL80211_MCGRP_SCAN,
42 NL80211_MCGRP_REGULATORY,
43 NL80211_MCGRP_MLME,
Johannes Berg567ffc32013-12-18 14:43:31 +010044 NL80211_MCGRP_VENDOR,
Ayala Beker50bcd312016-09-20 17:31:17 +030045 NL80211_MCGRP_NAN,
Johannes Berg2a94fe42013-11-19 15:19:39 +010046 NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
47};
48
49static const struct genl_multicast_group nl80211_mcgrps[] = {
Johannes Berg71b836e2014-12-23 17:17:38 +010050 [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
51 [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
52 [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
53 [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
54 [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
Ayala Beker50bcd312016-09-20 17:31:17 +030055 [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
Johannes Berg2a94fe42013-11-19 15:19:39 +010056#ifdef CONFIG_NL80211_TESTMODE
Johannes Berg71b836e2014-12-23 17:17:38 +010057 [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
Johannes Berg2a94fe42013-11-19 15:19:39 +010058#endif
59};
60
Johannes Berg89a54e42012-06-15 14:33:17 +020061/* returns ERR_PTR values */
62static struct wireless_dev *
63__cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
Johannes Berg55682962007-09-20 13:09:35 -040064{
Johannes Berg89a54e42012-06-15 14:33:17 +020065 struct cfg80211_registered_device *rdev;
66 struct wireless_dev *result = NULL;
67 bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
68 bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
69 u64 wdev_id;
70 int wiphy_idx = -1;
71 int ifidx = -1;
Johannes Berg55682962007-09-20 13:09:35 -040072
Johannes Berg5fe231e2013-05-08 21:45:15 +020073 ASSERT_RTNL();
Johannes Berg55682962007-09-20 13:09:35 -040074
Johannes Berg89a54e42012-06-15 14:33:17 +020075 if (!have_ifidx && !have_wdev_id)
76 return ERR_PTR(-EINVAL);
Johannes Berg55682962007-09-20 13:09:35 -040077
Johannes Berg89a54e42012-06-15 14:33:17 +020078 if (have_ifidx)
79 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
80 if (have_wdev_id) {
81 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
82 wiphy_idx = wdev_id >> 32;
Johannes Berg55682962007-09-20 13:09:35 -040083 }
84
Johannes Berg89a54e42012-06-15 14:33:17 +020085 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
86 struct wireless_dev *wdev;
87
88 if (wiphy_net(&rdev->wiphy) != netns)
89 continue;
90
91 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
92 continue;
93
Johannes Berg53873f12016-05-03 16:52:04 +030094 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
Johannes Berg89a54e42012-06-15 14:33:17 +020095 if (have_ifidx && wdev->netdev &&
96 wdev->netdev->ifindex == ifidx) {
97 result = wdev;
98 break;
99 }
100 if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
101 result = wdev;
102 break;
103 }
104 }
Johannes Berg89a54e42012-06-15 14:33:17 +0200105
106 if (result)
107 break;
108 }
109
110 if (result)
111 return result;
112 return ERR_PTR(-ENODEV);
Johannes Berg55682962007-09-20 13:09:35 -0400113}
114
Johannes Berga9455402012-06-15 13:32:49 +0200115static struct cfg80211_registered_device *
Johannes Berg878d9ec2012-06-15 14:18:32 +0200116__cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
Johannes Berga9455402012-06-15 13:32:49 +0200117{
Johannes Berg7fee4772012-06-15 14:09:58 +0200118 struct cfg80211_registered_device *rdev = NULL, *tmp;
119 struct net_device *netdev;
Johannes Berga9455402012-06-15 13:32:49 +0200120
Johannes Berg5fe231e2013-05-08 21:45:15 +0200121 ASSERT_RTNL();
Johannes Berga9455402012-06-15 13:32:49 +0200122
Johannes Berg878d9ec2012-06-15 14:18:32 +0200123 if (!attrs[NL80211_ATTR_WIPHY] &&
Johannes Berg89a54e42012-06-15 14:33:17 +0200124 !attrs[NL80211_ATTR_IFINDEX] &&
125 !attrs[NL80211_ATTR_WDEV])
Johannes Berg7fee4772012-06-15 14:09:58 +0200126 return ERR_PTR(-EINVAL);
127
Johannes Berg878d9ec2012-06-15 14:18:32 +0200128 if (attrs[NL80211_ATTR_WIPHY])
Johannes Berg7fee4772012-06-15 14:09:58 +0200129 rdev = cfg80211_rdev_by_wiphy_idx(
Johannes Berg878d9ec2012-06-15 14:18:32 +0200130 nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
Johannes Berga9455402012-06-15 13:32:49 +0200131
Johannes Berg89a54e42012-06-15 14:33:17 +0200132 if (attrs[NL80211_ATTR_WDEV]) {
133 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
134 struct wireless_dev *wdev;
135 bool found = false;
136
137 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
138 if (tmp) {
139 /* make sure wdev exists */
Johannes Berg53873f12016-05-03 16:52:04 +0300140 list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
Johannes Berg89a54e42012-06-15 14:33:17 +0200141 if (wdev->identifier != (u32)wdev_id)
142 continue;
143 found = true;
144 break;
145 }
Johannes Berg89a54e42012-06-15 14:33:17 +0200146
147 if (!found)
148 tmp = NULL;
149
150 if (rdev && tmp != rdev)
151 return ERR_PTR(-EINVAL);
152 rdev = tmp;
153 }
154 }
155
Johannes Berg878d9ec2012-06-15 14:18:32 +0200156 if (attrs[NL80211_ATTR_IFINDEX]) {
157 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -0700158
Ying Xue7f2b8562014-01-15 10:23:45 +0800159 netdev = __dev_get_by_index(netns, ifindex);
Johannes Berg7fee4772012-06-15 14:09:58 +0200160 if (netdev) {
161 if (netdev->ieee80211_ptr)
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800162 tmp = wiphy_to_rdev(
163 netdev->ieee80211_ptr->wiphy);
Johannes Berg7fee4772012-06-15 14:09:58 +0200164 else
165 tmp = NULL;
166
Johannes Berg7fee4772012-06-15 14:09:58 +0200167 /* not wireless device -- return error */
168 if (!tmp)
169 return ERR_PTR(-EINVAL);
170
171 /* mismatch -- return error */
172 if (rdev && tmp != rdev)
173 return ERR_PTR(-EINVAL);
174
175 rdev = tmp;
Johannes Berga9455402012-06-15 13:32:49 +0200176 }
Johannes Berga9455402012-06-15 13:32:49 +0200177 }
178
Johannes Berg4f7eff12012-06-15 14:14:22 +0200179 if (!rdev)
180 return ERR_PTR(-ENODEV);
Johannes Berga9455402012-06-15 13:32:49 +0200181
Johannes Berg4f7eff12012-06-15 14:14:22 +0200182 if (netns != wiphy_net(&rdev->wiphy))
183 return ERR_PTR(-ENODEV);
184
185 return rdev;
Johannes Berga9455402012-06-15 13:32:49 +0200186}
187
188/*
189 * This function returns a pointer to the driver
190 * that the genl_info item that is passed refers to.
Johannes Berga9455402012-06-15 13:32:49 +0200191 *
192 * The result of this can be a PTR_ERR and hence must
193 * be checked with IS_ERR() for errors.
194 */
195static struct cfg80211_registered_device *
Johannes Berg4f7eff12012-06-15 14:14:22 +0200196cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
Johannes Berga9455402012-06-15 13:32:49 +0200197{
Johannes Berg5fe231e2013-05-08 21:45:15 +0200198 return __cfg80211_rdev_from_attrs(netns, info->attrs);
Johannes Berga9455402012-06-15 13:32:49 +0200199}
200
Johannes Berg55682962007-09-20 13:09:35 -0400201/* policy for the attributes */
Luciano Coelho8cd4d452014-09-17 11:55:28 +0300202static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
Johannes Berg55682962007-09-20 13:09:35 -0400203 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
204 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
David S. Miller079e24e2009-05-26 21:15:00 -0700205 .len = 20-1 },
Jouni Malinen31888482008-10-30 16:59:24 +0200206 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
Johannes Berg3d9d1d62012-11-08 23:14:50 +0100207
Jouni Malinen72bdcf32008-11-26 16:15:24 +0200208 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
Sujith094d05d2008-12-12 11:57:43 +0530209 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
Johannes Berg3d9d1d62012-11-08 23:14:50 +0100210 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
211 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
212 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
213
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +0200214 [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
215 [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
216 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
217 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
Lukáš Turek81077e82009-12-21 22:50:47 +0100218 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
Lorenzo Bianconi3057dbf2014-09-04 23:57:40 +0200219 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
Johannes Berg55682962007-09-20 13:09:35 -0400220
221 [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
222 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
223 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
Johannes Berg41ade002007-12-19 02:03:29 +0100224
Eliad Pellere007b852011-11-24 18:13:56 +0200225 [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
226 [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
Johannes Berg41ade002007-12-19 02:03:29 +0100227
Johannes Bergb9454e82009-07-08 13:29:08 +0200228 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
Johannes Berg41ade002007-12-19 02:03:29 +0100229 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
230 .len = WLAN_MAX_KEY_LEN },
231 [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
232 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
233 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
Jouni Malinen81962262011-11-02 23:36:31 +0200234 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
Johannes Berge31b8212010-10-05 19:39:30 +0200235 [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
Johannes Berged1b6cc2007-12-19 02:03:32 +0100236
237 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
238 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
239 [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
240 .len = IEEE80211_MAX_DATA_LEN },
241 [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
242 .len = IEEE80211_MAX_DATA_LEN },
Johannes Berg5727ef12007-12-19 02:03:34 +0100243 [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
244 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
245 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
246 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
247 .len = NL80211_MAX_SUPP_RATES },
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +0100248 [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
Johannes Berg5727ef12007-12-19 02:03:34 +0100249 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
Johannes Berg0a9542e2008-10-15 11:54:04 +0200250 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +0100251 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +0800252 .len = IEEE80211_MAX_MESH_ID_LEN },
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +0100253 [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
Jouni Malinen9f1ba902008-08-07 20:07:01 +0300254
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -0700255 [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
256 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
257
Jouni Malinen9f1ba902008-08-07 20:07:01 +0300258 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
259 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
260 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
Jouni Malinen90c97a02008-10-30 16:59:22 +0200261 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
262 .len = NL80211_MAX_SUPP_RATES },
Helmut Schaa50b12f52010-11-19 12:40:25 +0100263 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
Jouni Malinen36aedc92008-08-25 11:58:58 +0300264
Javier Cardona24bdd9f2010-12-16 17:37:48 -0800265 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
Javier Cardona15d5dda2011-04-07 15:08:28 -0700266 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -0700267
Johannes Berg6c739412011-11-03 09:27:01 +0100268 [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
Jouni Malinen9aed3cc2009-01-13 16:03:29 +0200269
270 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
271 [NL80211_ATTR_IE] = { .type = NLA_BINARY,
272 .len = IEEE80211_MAX_DATA_LEN },
Johannes Berg2a519312009-02-10 21:25:55 +0100273 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
274 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
Jouni Malinen636a5d32009-03-19 13:39:22 +0200275
276 [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
277 .len = IEEE80211_MAX_SSID_LEN },
278 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
279 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
Johannes Berg04a773a2009-04-19 21:24:32 +0200280 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
Jouni Malinen1965c852009-04-22 21:38:25 +0300281 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
Jouni Malinendc6382ce2009-05-06 22:09:37 +0300282 [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
Johannes Bergeccb8e82009-05-11 21:57:56 +0300283 [NL80211_ATTR_STA_FLAGS2] = {
284 .len = sizeof(struct nl80211_sta_flag_update),
285 },
Jouni Malinen3f77316c2009-05-11 21:57:57 +0300286 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
Johannes Bergc0692b82010-08-27 14:26:53 +0300287 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
288 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
Samuel Ortizb23aa672009-07-01 21:26:54 +0200289 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
290 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
291 [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
Johannes Berg463d0182009-07-14 00:33:35 +0200292 [NL80211_ATTR_PID] = { .type = NLA_U32 },
Felix Fietkau8b787642009-11-10 18:53:10 +0100293 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
Srinivas Dasari9361df12017-07-07 01:43:39 +0300294 [NL80211_ATTR_PMKID] = { .len = WLAN_PMKID_LEN },
Jouni Malinen9588bbd2009-12-23 13:15:41 +0100295 [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
296 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
Jouni Malinen13ae75b2009-12-29 12:59:45 +0200297 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
Jouni Malinen026331c2010-02-15 12:53:10 +0200298 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
299 .len = IEEE80211_MAX_DATA_LEN },
300 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
Kalle Valoffb9eb32010-02-17 17:58:10 +0200301 [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +0200302 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
Jouni Malinend5cdfac2010-04-04 09:37:19 +0300303 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
Felix Fietkaufd8aaaf2010-04-27 01:23:35 +0200304 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +0300305 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
306 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
Johannes Berg2e161f72010-08-12 15:38:38 +0200307 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
Bruno Randolfafe0cbf2010-11-10 12:50:50 +0900308 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
309 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
Felix Fietkau885a46d2010-11-11 15:07:22 +0100310 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
Johannes Bergf7ca38d2010-11-25 10:02:29 +0100311 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100312 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
Johannes Bergff1b6e62011-05-04 15:37:28 +0200313 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
Javier Cardona9c3990a2011-05-03 16:57:11 -0700314 [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
Luciano Coelhobbe6ad62011-05-11 17:09:37 +0300315 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
Johannes Berge5497d72011-07-05 16:35:40 +0200316 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
Johannes Berg34850ab2011-07-18 18:08:35 +0200317 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
Jouni Malinen32e9de82011-08-10 23:53:31 +0300318 [NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
Jouni Malinen9946ecf2011-08-10 23:55:56 +0300319 [NL80211_ATTR_IE_PROBE_RESP] = { .type = NLA_BINARY,
320 .len = IEEE80211_MAX_DATA_LEN },
321 [NL80211_ATTR_IE_ASSOC_RESP] = { .type = NLA_BINARY,
322 .len = IEEE80211_MAX_DATA_LEN },
Vivek Natarajanf4b34b52011-08-29 14:23:03 +0530323 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
Luciano Coelhoa1f1c212011-08-31 16:01:48 +0300324 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
Rajkumar Manoharane9f935e2011-09-25 14:53:30 +0530325 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
Arik Nemtsov109086c2011-09-28 14:12:50 +0300326 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
327 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
328 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
329 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
330 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
Arik Nemtsov31fa97c2014-06-11 17:18:21 +0300331 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
Johannes Berge247bd902011-11-04 11:18:21 +0100332 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
Arik Nemtsov00f740e2011-11-10 11:28:56 +0200333 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
334 .len = IEEE80211_MAX_DATA_LEN },
Luis R. Rodriguez8b60b072011-10-11 10:59:02 -0700335 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
Ben Greear7e7c8922011-11-18 11:31:59 -0800336 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
337 [NL80211_ATTR_HT_CAPABILITY_MASK] = {
338 .len = NL80211_HT_CAPABILITY_LEN
339 },
Simon Wunderlich1d9d9212011-11-18 14:20:43 +0100340 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
Vasanthakumar Thiagarajan1b658f12012-03-02 15:50:02 +0530341 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
Bala Shanmugam4486ea92012-03-07 17:27:12 +0530342 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
Johannes Berg89a54e42012-06-15 14:33:17 +0200343 [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
Luis R. Rodriguez57b5ce02012-07-12 11:49:18 -0700344 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
Jouni Malinen11b6b5a2016-10-27 00:41:58 +0300345 [NL80211_ATTR_AUTH_DATA] = { .type = NLA_BINARY, },
Mahesh Palivelaf461be3e2012-10-11 08:04:52 +0000346 [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
Sam Lefflered4737712012-10-11 21:03:31 -0700347 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
Johannes Berg53cabad2012-11-14 15:17:28 +0100348 [NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
349 [NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
Srinivas Dasari8feb69c2017-07-07 01:43:41 +0300350 [NL80211_ATTR_LOCAL_MESH_POWER_MODE] = {. type = NLA_U32 },
Vasanthakumar Thiagarajan77765ea2013-01-18 11:18:45 +0530351 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
352 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
Jouni Malinen9d62a982013-02-14 21:10:13 +0200353 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
354 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
Johannes Berg3713b4e2013-02-14 16:19:38 +0100355 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
Johannes Bergee2aca32013-02-21 17:36:01 +0100356 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
357 [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
358 .len = NL80211_VHT_CAPABILITY_LEN,
359 },
Jouni Malinen355199e2013-02-27 17:14:27 +0200360 [NL80211_ATTR_MDID] = { .type = NLA_U16 },
361 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
362 .len = IEEE80211_MAX_DATA_LEN },
Jouni Malinen5e4b6f52013-05-16 20:11:08 +0300363 [NL80211_ATTR_PEER_AID] = { .type = NLA_U16 },
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +0200364 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
365 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
366 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +0300367 [NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
368 [NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
Sunil Duttc01fc9a2013-10-09 20:45:21 +0530369 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
370 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
Simon Wunderlich5336fa82013-10-07 18:41:05 +0200371 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
Marek Kwaczynski60f4a7b2013-12-03 10:04:59 +0100372 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
Johannes Bergad7e7182013-11-13 13:37:47 +0100373 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
374 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
375 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
Kyeyoon Parkfa9ffc72013-12-16 23:01:30 -0800376 [NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
377 .len = IEEE80211_QOS_MAP_LEN_MAX },
Jouni Malinen1df4a512014-01-15 00:00:47 +0200378 [NL80211_ATTR_MAC_HINT] = { .len = ETH_ALEN },
379 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
Sunil Dutt Undekaridf942e72014-02-20 16:22:09 +0530380 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
Jukka Rissanen18e5ca62014-11-13 17:25:14 +0200381 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
Andrei Otcheretianski34d22ce2014-05-09 14:11:44 +0300382 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
Assaf Kraussbab5ab72014-09-03 15:25:01 +0300383 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
Johannes Berg960d01a2014-09-09 22:55:35 +0300384 [NL80211_ATTR_TSID] = { .type = NLA_U8 },
385 [NL80211_ATTR_USER_PRIO] = { .type = NLA_U8 },
386 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
Eliad Peller18998c32014-09-10 14:07:34 +0300387 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
Johannes Bergad2b26a2014-06-12 21:39:05 +0200388 [NL80211_ATTR_MAC_MASK] = { .len = ETH_ALEN },
Arik Nemtsov1bdd7162014-12-15 19:26:01 +0200389 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
Vadim Kochan4b681c82015-01-12 16:34:05 +0200390 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
Luciano Coelho9c748932015-01-16 16:04:09 +0200391 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
Ilan peer05050752015-03-04 00:32:06 -0500392 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
Lior David34d50512016-01-28 10:58:25 +0200393 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
Arend van Spriel38de03d2016-03-02 20:37:18 +0100394 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
Ayala Beker17b94242016-03-17 15:41:38 +0200395 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = { .type = NLA_U8 },
Aviya Erenfeldc6e6a0c2016-07-05 15:23:08 +0300396 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
397 .len = VHT_MUMIMO_GROUPS_DATA_LEN
398 },
399 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = { .len = ETH_ALEN },
Ayala Bekercb3b7d82016-09-20 17:31:13 +0300400 [NL80211_ATTR_NAN_MASTER_PREF] = { .type = NLA_U8 },
Luca Coelho85859892017-02-08 15:00:34 +0200401 [NL80211_ATTR_BANDS] = { .type = NLA_U32 },
Ayala Bekera442b762016-09-20 17:31:15 +0300402 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
Jouni Malinen348bd452016-10-27 00:42:03 +0300403 [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
404 .len = FILS_MAX_KEK_LEN },
405 [NL80211_ATTR_FILS_NONCES] = { .len = 2 * FILS_NONCE_LEN },
Michael Braunce0ce132016-10-10 19:12:22 +0200406 [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
Vamsi Krishna2fa436b2016-12-02 23:59:08 +0200407 [NL80211_ATTR_BSSID] = { .len = ETH_ALEN },
vamsi krishnabf95ecd2017-01-13 01:12:20 +0200408 [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
409 [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
410 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
411 },
Purushottam Kushwaha3093ebbeab2017-01-13 01:12:21 +0200412 [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
Vidyullatha Kanchanapallya3caf742017-03-31 00:22:34 +0300413 [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
414 .len = FILS_ERP_MAX_USERNAME_LEN },
415 [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
416 .len = FILS_ERP_MAX_REALM_LEN },
417 [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
418 [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
419 .len = FILS_ERP_MAX_RRK_LEN },
420 [NL80211_ATTR_FILS_CACHE_ID] = { .len = 2 },
421 [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
Arend Van Sprielca986ad2017-04-21 13:05:00 +0100422 [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
Srinivas Dasari40cbfa92018-01-25 17:13:38 +0200423 [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG },
Johannes Berg55682962007-09-20 13:09:35 -0400424};
425
Johannes Berge31b8212010-10-05 19:39:30 +0200426/* policy for the key attributes */
Alexey Dobriyanb54452b2010-02-18 08:14:31 +0000427static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
Johannes Bergfffd0932009-07-08 14:22:54 +0200428 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
Johannes Bergb9454e82009-07-08 13:29:08 +0200429 [NL80211_KEY_IDX] = { .type = NLA_U8 },
430 [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
Jouni Malinen81962262011-11-02 23:36:31 +0200431 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
Johannes Bergb9454e82009-07-08 13:29:08 +0200432 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
433 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
Johannes Berge31b8212010-10-05 19:39:30 +0200434 [NL80211_KEY_TYPE] = { .type = NLA_U32 },
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100435 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
436};
437
438/* policy for the key default flags */
439static const struct nla_policy
440nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
441 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
442 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
Johannes Bergb9454e82009-07-08 13:29:08 +0200443};
444
Johannes Bergf83ace32016-10-17 08:04:07 +0200445#ifdef CONFIG_PM
Johannes Bergff1b6e62011-05-04 15:37:28 +0200446/* policy for WoWLAN attributes */
447static const struct nla_policy
448nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
449 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
450 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
451 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
452 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
Johannes Berg77dbbb12011-07-13 10:48:55 +0200453 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
454 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
455 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
456 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
Johannes Berg2a0e0472013-01-23 22:57:40 +0100457 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
Luciano Coelho8cd4d452014-09-17 11:55:28 +0300458 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
Johannes Berg2a0e0472013-01-23 22:57:40 +0100459};
460
461static const struct nla_policy
462nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
463 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
464 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
465 [NL80211_WOWLAN_TCP_DST_MAC] = { .len = ETH_ALEN },
466 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
467 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
468 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .len = 1 },
469 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
470 .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
471 },
472 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
473 .len = sizeof(struct nl80211_wowlan_tcp_data_token)
474 },
475 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
476 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .len = 1 },
477 [NL80211_WOWLAN_TCP_WAKE_MASK] = { .len = 1 },
Johannes Bergff1b6e62011-05-04 15:37:28 +0200478};
Johannes Bergf83ace32016-10-17 08:04:07 +0200479#endif /* CONFIG_PM */
Johannes Bergff1b6e62011-05-04 15:37:28 +0200480
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -0700481/* policy for coalesce rule attributes */
482static const struct nla_policy
483nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
484 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
485 [NL80211_ATTR_COALESCE_RULE_CONDITION] = { .type = NLA_U32 },
486 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
487};
488
Johannes Berge5497d72011-07-05 16:35:40 +0200489/* policy for GTK rekey offload attributes */
490static const struct nla_policy
491nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
492 [NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
493 [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
494 [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
495};
496
Luciano Coelhoa1f1c212011-08-31 16:01:48 +0300497static const struct nla_policy
498nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
Johannes Berg4a4ab0d2012-06-13 11:17:11 +0200499 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
Luciano Coelhoa1f1c212011-08-31 16:01:48 +0300500 .len = IEEE80211_MAX_SSID_LEN },
Arend Van Spriel3007e352017-04-21 13:05:01 +0100501 [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = { .len = ETH_ALEN },
Thomas Pedersen88e920b2012-06-21 11:09:54 -0700502 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
Luciano Coelhoa1f1c212011-08-31 16:01:48 +0300503};
504
Avraham Stern3b06d272015-10-12 09:51:34 +0300505static const struct nla_policy
506nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
507 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
508 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
509};
510
Arend van Spriel38de03d2016-03-02 20:37:18 +0100511static const struct nla_policy
512nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
513 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
514 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
515 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
516 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
517 },
518};
519
Ayala Bekera442b762016-09-20 17:31:15 +0300520/* policy for NAN function attributes */
521static const struct nla_policy
522nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
523 [NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
Srinivas Dasari0a278442017-07-07 01:43:40 +0300524 [NL80211_NAN_FUNC_SERVICE_ID] = {
Ayala Bekera442b762016-09-20 17:31:15 +0300525 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
526 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
527 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
528 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
529 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
530 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
531 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = { .len = ETH_ALEN },
532 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
533 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
534 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
535 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
536 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
537 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
538 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
539 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
540 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
541};
542
543/* policy for Service Response Filter attributes */
544static const struct nla_policy
545nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
546 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
547 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
548 .len = NL80211_NAN_FUNC_SRF_MAX_LEN },
549 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
550 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
551};
552
Peng Xuad670232017-10-03 23:21:51 +0300553/* policy for packet pattern attributes */
554static const struct nla_policy
555nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
556 [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
557 [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
558 [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
559};
560
Johannes Berg97990a02013-04-19 01:02:55 +0200561static int nl80211_prepare_wdev_dump(struct sk_buff *skb,
562 struct netlink_callback *cb,
563 struct cfg80211_registered_device **rdev,
564 struct wireless_dev **wdev)
Holger Schuriga0438972009-11-11 11:30:02 +0100565{
Johannes Berg67748892010-10-04 21:14:06 +0200566 int err;
567
Johannes Berg97990a02013-04-19 01:02:55 +0200568 if (!cb->args[0]) {
569 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
Johannes Bergc90c39d2016-10-24 14:40:01 +0200570 genl_family_attrbuf(&nl80211_fam),
Johannes Bergfceb6432017-04-12 14:34:07 +0200571 nl80211_fam.maxattr, nl80211_policy, NULL);
Johannes Berg97990a02013-04-19 01:02:55 +0200572 if (err)
Johannes Bergea90e0d2017-03-15 14:26:04 +0100573 return err;
Johannes Berg97990a02013-04-19 01:02:55 +0200574
Johannes Bergc90c39d2016-10-24 14:40:01 +0200575 *wdev = __cfg80211_wdev_from_attrs(
576 sock_net(skb->sk),
577 genl_family_attrbuf(&nl80211_fam));
Johannes Bergea90e0d2017-03-15 14:26:04 +0100578 if (IS_ERR(*wdev))
579 return PTR_ERR(*wdev);
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800580 *rdev = wiphy_to_rdev((*wdev)->wiphy);
Johannes Bergc319d502013-07-30 22:34:28 +0200581 /* 0 is the first index - add 1 to parse only once */
582 cb->args[0] = (*rdev)->wiphy_idx + 1;
Johannes Berg97990a02013-04-19 01:02:55 +0200583 cb->args[1] = (*wdev)->identifier;
584 } else {
Johannes Bergc319d502013-07-30 22:34:28 +0200585 /* subtract the 1 again here */
586 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
Johannes Berg97990a02013-04-19 01:02:55 +0200587 struct wireless_dev *tmp;
588
Johannes Bergea90e0d2017-03-15 14:26:04 +0100589 if (!wiphy)
590 return -ENODEV;
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800591 *rdev = wiphy_to_rdev(wiphy);
Johannes Berg97990a02013-04-19 01:02:55 +0200592 *wdev = NULL;
593
Johannes Berg53873f12016-05-03 16:52:04 +0300594 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
Johannes Berg97990a02013-04-19 01:02:55 +0200595 if (tmp->identifier == cb->args[1]) {
596 *wdev = tmp;
597 break;
598 }
599 }
Johannes Berg97990a02013-04-19 01:02:55 +0200600
Johannes Bergea90e0d2017-03-15 14:26:04 +0100601 if (!*wdev)
602 return -ENODEV;
Johannes Berg67748892010-10-04 21:14:06 +0200603 }
604
Johannes Berg67748892010-10-04 21:14:06 +0200605 return 0;
Johannes Berg67748892010-10-04 21:14:06 +0200606}
607
Johannes Bergf4a11bb2009-03-27 12:40:28 +0100608/* IE validation */
609static bool is_valid_ie_attr(const struct nlattr *attr)
610{
611 const u8 *pos;
612 int len;
613
614 if (!attr)
615 return true;
616
617 pos = nla_data(attr);
618 len = nla_len(attr);
619
620 while (len) {
621 u8 elemlen;
622
623 if (len < 2)
624 return false;
625 len -= 2;
626
627 elemlen = pos[1];
628 if (elemlen > len)
629 return false;
630
631 len -= elemlen;
632 pos += 2 + elemlen;
633 }
634
635 return true;
636}
637
Johannes Berg55682962007-09-20 13:09:35 -0400638/* message building helper */
Eric W. Biederman15e47302012-09-07 20:12:54 +0000639static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
Johannes Berg55682962007-09-20 13:09:35 -0400640 int flags, u8 cmd)
641{
642 /* since there is no private header just add the generic one */
Eric W. Biederman15e47302012-09-07 20:12:54 +0000643 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
Johannes Berg55682962007-09-20 13:09:35 -0400644}
645
Luis R. Rodriguez5dab3b82009-04-02 14:08:08 -0400646static int nl80211_msg_put_channel(struct sk_buff *msg,
Johannes Bergcdc89b92013-02-18 23:54:36 +0100647 struct ieee80211_channel *chan,
648 bool large)
Luis R. Rodriguez5dab3b82009-04-02 14:08:08 -0400649{
Rostislav Lisovyea077c12014-04-15 14:37:55 +0200650 /* Some channels must be completely excluded from the
651 * list to protect old user-space tools from breaking
652 */
653 if (!large && chan->flags &
654 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
655 return 0;
656
David S. Miller9360ffd2012-03-29 04:41:26 -0400657 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
658 chan->center_freq))
659 goto nla_put_failure;
Luis R. Rodriguez5dab3b82009-04-02 14:08:08 -0400660
David S. Miller9360ffd2012-03-29 04:41:26 -0400661 if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
662 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
663 goto nla_put_failure;
Luis R. Rodriguez8fe02e12013-10-21 19:22:25 +0200664 if (chan->flags & IEEE80211_CHAN_NO_IR) {
665 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
666 goto nla_put_failure;
667 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
668 goto nla_put_failure;
669 }
Johannes Bergcdc89b92013-02-18 23:54:36 +0100670 if (chan->flags & IEEE80211_CHAN_RADAR) {
671 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
672 goto nla_put_failure;
673 if (large) {
674 u32 time;
675
676 time = elapsed_jiffies_msecs(chan->dfs_state_entered);
677
678 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
679 chan->dfs_state))
680 goto nla_put_failure;
681 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
682 time))
683 goto nla_put_failure;
Janusz Dziedzic089027e2014-02-21 19:46:12 +0100684 if (nla_put_u32(msg,
685 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
686 chan->dfs_cac_ms))
687 goto nla_put_failure;
Johannes Bergcdc89b92013-02-18 23:54:36 +0100688 }
689 }
Luis R. Rodriguez5dab3b82009-04-02 14:08:08 -0400690
Johannes Bergfe1abaf2013-02-27 15:39:45 +0100691 if (large) {
692 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
693 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
694 goto nla_put_failure;
695 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
696 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
697 goto nla_put_failure;
698 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
699 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
700 goto nla_put_failure;
701 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
702 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
703 goto nla_put_failure;
David Spinadel570dbde2014-02-23 09:12:59 +0200704 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
705 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
706 goto nla_put_failure;
Arik Nemtsov06f207f2015-05-06 16:28:31 +0300707 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
708 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
David Spinadel570dbde2014-02-23 09:12:59 +0200709 goto nla_put_failure;
Rostislav Lisovyea077c12014-04-15 14:37:55 +0200710 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
711 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
712 goto nla_put_failure;
713 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
714 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
715 goto nla_put_failure;
Johannes Bergfe1abaf2013-02-27 15:39:45 +0100716 }
717
David S. Miller9360ffd2012-03-29 04:41:26 -0400718 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
719 DBM_TO_MBM(chan->max_power)))
720 goto nla_put_failure;
Luis R. Rodriguez5dab3b82009-04-02 14:08:08 -0400721
722 return 0;
723
724 nla_put_failure:
725 return -ENOBUFS;
726}
727
Johannes Berg55682962007-09-20 13:09:35 -0400728/* netlink command implementations */
729
Johannes Bergb9454e82009-07-08 13:29:08 +0200730struct key_parse {
731 struct key_params p;
732 int idx;
Johannes Berge31b8212010-10-05 19:39:30 +0200733 int type;
Johannes Bergb9454e82009-07-08 13:29:08 +0200734 bool def, defmgmt;
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100735 bool def_uni, def_multi;
Johannes Bergb9454e82009-07-08 13:29:08 +0200736};
737
Johannes Berg768075e2017-11-13 15:35:06 +0100738static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key,
739 struct key_parse *k)
Johannes Bergb9454e82009-07-08 13:29:08 +0200740{
741 struct nlattr *tb[NL80211_KEY_MAX + 1];
742 int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
Johannes Berg768075e2017-11-13 15:35:06 +0100743 nl80211_key_policy, info->extack);
Johannes Bergb9454e82009-07-08 13:29:08 +0200744 if (err)
745 return err;
746
747 k->def = !!tb[NL80211_KEY_DEFAULT];
748 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
749
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100750 if (k->def) {
751 k->def_uni = true;
752 k->def_multi = true;
753 }
754 if (k->defmgmt)
755 k->def_multi = true;
756
Johannes Bergb9454e82009-07-08 13:29:08 +0200757 if (tb[NL80211_KEY_IDX])
758 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
759
760 if (tb[NL80211_KEY_DATA]) {
761 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
762 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
763 }
764
765 if (tb[NL80211_KEY_SEQ]) {
766 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
767 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
768 }
769
770 if (tb[NL80211_KEY_CIPHER])
771 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
772
Johannes Berge31b8212010-10-05 19:39:30 +0200773 if (tb[NL80211_KEY_TYPE]) {
774 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
775 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
Johannes Berg768075e2017-11-13 15:35:06 +0100776 return genl_err_attr(info, -EINVAL,
777 tb[NL80211_KEY_TYPE]);
Johannes Berge31b8212010-10-05 19:39:30 +0200778 }
779
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100780 if (tb[NL80211_KEY_DEFAULT_TYPES]) {
781 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -0700782
Johannes Berg2da8f412012-01-20 13:52:37 +0100783 err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
784 tb[NL80211_KEY_DEFAULT_TYPES],
Johannes Berg768075e2017-11-13 15:35:06 +0100785 nl80211_key_default_policy,
786 info->extack);
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100787 if (err)
788 return err;
789
790 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
791 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
792 }
793
Johannes Bergb9454e82009-07-08 13:29:08 +0200794 return 0;
795}
796
797static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
798{
799 if (info->attrs[NL80211_ATTR_KEY_DATA]) {
800 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
801 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
802 }
803
804 if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
805 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
806 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
807 }
808
809 if (info->attrs[NL80211_ATTR_KEY_IDX])
810 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
811
812 if (info->attrs[NL80211_ATTR_KEY_CIPHER])
813 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
814
815 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
816 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
817
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100818 if (k->def) {
819 k->def_uni = true;
820 k->def_multi = true;
821 }
822 if (k->defmgmt)
823 k->def_multi = true;
824
Johannes Berge31b8212010-10-05 19:39:30 +0200825 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
826 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
Johannes Berg768075e2017-11-13 15:35:06 +0100827 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES) {
828 GENL_SET_ERR_MSG(info, "key type out of range");
Johannes Berge31b8212010-10-05 19:39:30 +0200829 return -EINVAL;
Johannes Berg768075e2017-11-13 15:35:06 +0100830 }
Johannes Berge31b8212010-10-05 19:39:30 +0200831 }
832
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100833 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
834 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
Johannes Bergfceb6432017-04-12 14:34:07 +0200835 int err = nla_parse_nested(kdt,
836 NUM_NL80211_KEY_DEFAULT_TYPES - 1,
837 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
Johannes Bergfe521452017-04-12 14:34:08 +0200838 nl80211_key_default_policy,
839 info->extack);
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100840 if (err)
841 return err;
842
843 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
844 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
845 }
846
Johannes Bergb9454e82009-07-08 13:29:08 +0200847 return 0;
848}
849
850static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
851{
852 int err;
853
854 memset(k, 0, sizeof(*k));
855 k->idx = -1;
Johannes Berge31b8212010-10-05 19:39:30 +0200856 k->type = -1;
Johannes Bergb9454e82009-07-08 13:29:08 +0200857
858 if (info->attrs[NL80211_ATTR_KEY])
Johannes Berg768075e2017-11-13 15:35:06 +0100859 err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k);
Johannes Bergb9454e82009-07-08 13:29:08 +0200860 else
861 err = nl80211_parse_key_old(info, k);
862
863 if (err)
864 return err;
865
Johannes Berg768075e2017-11-13 15:35:06 +0100866 if (k->def && k->defmgmt) {
867 GENL_SET_ERR_MSG(info, "key with def && defmgmt is invalid");
Johannes Bergb9454e82009-07-08 13:29:08 +0200868 return -EINVAL;
Johannes Berg768075e2017-11-13 15:35:06 +0100869 }
Johannes Bergb9454e82009-07-08 13:29:08 +0200870
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100871 if (k->defmgmt) {
Johannes Berg768075e2017-11-13 15:35:06 +0100872 if (k->def_uni || !k->def_multi) {
873 GENL_SET_ERR_MSG(info, "defmgmt key must be mcast");
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100874 return -EINVAL;
Johannes Berg768075e2017-11-13 15:35:06 +0100875 }
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100876 }
877
Johannes Bergb9454e82009-07-08 13:29:08 +0200878 if (k->idx != -1) {
879 if (k->defmgmt) {
Johannes Berg768075e2017-11-13 15:35:06 +0100880 if (k->idx < 4 || k->idx > 5) {
881 GENL_SET_ERR_MSG(info,
882 "defmgmt key idx not 4 or 5");
Johannes Bergb9454e82009-07-08 13:29:08 +0200883 return -EINVAL;
Johannes Berg768075e2017-11-13 15:35:06 +0100884 }
Johannes Bergb9454e82009-07-08 13:29:08 +0200885 } else if (k->def) {
Johannes Berg768075e2017-11-13 15:35:06 +0100886 if (k->idx < 0 || k->idx > 3) {
887 GENL_SET_ERR_MSG(info, "def key idx not 0-3");
Johannes Bergb9454e82009-07-08 13:29:08 +0200888 return -EINVAL;
Johannes Berg768075e2017-11-13 15:35:06 +0100889 }
Johannes Bergb9454e82009-07-08 13:29:08 +0200890 } else {
Johannes Berg768075e2017-11-13 15:35:06 +0100891 if (k->idx < 0 || k->idx > 5) {
892 GENL_SET_ERR_MSG(info, "key idx not 0-5");
Johannes Bergb9454e82009-07-08 13:29:08 +0200893 return -EINVAL;
Johannes Berg768075e2017-11-13 15:35:06 +0100894 }
Johannes Bergb9454e82009-07-08 13:29:08 +0200895 }
896 }
897
898 return 0;
899}
900
Johannes Bergfffd0932009-07-08 14:22:54 +0200901static struct cfg80211_cached_keys *
902nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
Johannes Berg768075e2017-11-13 15:35:06 +0100903 struct genl_info *info, bool *no_ht)
Johannes Bergfffd0932009-07-08 14:22:54 +0200904{
Johannes Berg768075e2017-11-13 15:35:06 +0100905 struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS];
Johannes Bergfffd0932009-07-08 14:22:54 +0200906 struct key_parse parse;
907 struct nlattr *key;
908 struct cfg80211_cached_keys *result;
909 int rem, err, def = 0;
Johannes Bergf1c1f172016-09-13 17:08:23 +0200910 bool have_key = false;
911
912 nla_for_each_nested(key, keys, rem) {
913 have_key = true;
914 break;
915 }
916
917 if (!have_key)
918 return NULL;
Johannes Bergfffd0932009-07-08 14:22:54 +0200919
920 result = kzalloc(sizeof(*result), GFP_KERNEL);
921 if (!result)
922 return ERR_PTR(-ENOMEM);
923
924 result->def = -1;
Johannes Bergfffd0932009-07-08 14:22:54 +0200925
926 nla_for_each_nested(key, keys, rem) {
927 memset(&parse, 0, sizeof(parse));
928 parse.idx = -1;
929
Johannes Berg768075e2017-11-13 15:35:06 +0100930 err = nl80211_parse_key_new(info, key, &parse);
Johannes Bergfffd0932009-07-08 14:22:54 +0200931 if (err)
932 goto error;
933 err = -EINVAL;
934 if (!parse.p.key)
935 goto error;
Johannes Berg768075e2017-11-13 15:35:06 +0100936 if (parse.idx < 0 || parse.idx > 3) {
937 GENL_SET_ERR_MSG(info, "key index out of range [0-3]");
Johannes Bergfffd0932009-07-08 14:22:54 +0200938 goto error;
Johannes Berg768075e2017-11-13 15:35:06 +0100939 }
Johannes Bergfffd0932009-07-08 14:22:54 +0200940 if (parse.def) {
Johannes Berg768075e2017-11-13 15:35:06 +0100941 if (def) {
942 GENL_SET_ERR_MSG(info,
943 "only one key can be default");
Johannes Bergfffd0932009-07-08 14:22:54 +0200944 goto error;
Johannes Berg768075e2017-11-13 15:35:06 +0100945 }
Johannes Bergfffd0932009-07-08 14:22:54 +0200946 def = 1;
947 result->def = parse.idx;
Johannes Bergdbd2fd62010-12-09 19:58:59 +0100948 if (!parse.def_uni || !parse.def_multi)
949 goto error;
Johannes Bergfffd0932009-07-08 14:22:54 +0200950 } else if (parse.defmgmt)
951 goto error;
952 err = cfg80211_validate_key_settings(rdev, &parse.p,
Johannes Berge31b8212010-10-05 19:39:30 +0200953 parse.idx, false, NULL);
Johannes Bergfffd0932009-07-08 14:22:54 +0200954 if (err)
955 goto error;
Johannes Berg386b1f22016-09-13 16:10:02 +0200956 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
957 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
Johannes Berg768075e2017-11-13 15:35:06 +0100958 GENL_SET_ERR_MSG(info, "connect key must be WEP");
Johannes Berg386b1f22016-09-13 16:10:02 +0200959 err = -EINVAL;
960 goto error;
961 }
Johannes Bergfffd0932009-07-08 14:22:54 +0200962 result->params[parse.idx].cipher = parse.p.cipher;
963 result->params[parse.idx].key_len = parse.p.key_len;
964 result->params[parse.idx].key = result->data[parse.idx];
965 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
Sujith Manoharande7044e2012-10-18 10:19:28 +0530966
Johannes Berg386b1f22016-09-13 16:10:02 +0200967 /* must be WEP key if we got here */
968 if (no_ht)
969 *no_ht = true;
Johannes Bergfffd0932009-07-08 14:22:54 +0200970 }
971
Johannes Bergf1c1f172016-09-13 17:08:23 +0200972 if (result->def < 0) {
973 err = -EINVAL;
Johannes Berg768075e2017-11-13 15:35:06 +0100974 GENL_SET_ERR_MSG(info, "need a default/TX key");
Johannes Bergf1c1f172016-09-13 17:08:23 +0200975 goto error;
976 }
977
Johannes Bergfffd0932009-07-08 14:22:54 +0200978 return result;
979 error:
980 kfree(result);
981 return ERR_PTR(err);
982}
983
984static int nl80211_key_allowed(struct wireless_dev *wdev)
985{
986 ASSERT_WDEV_LOCK(wdev);
987
Johannes Bergfffd0932009-07-08 14:22:54 +0200988 switch (wdev->iftype) {
989 case NL80211_IFTYPE_AP:
990 case NL80211_IFTYPE_AP_VLAN:
Johannes Berg074ac8d2010-09-16 14:58:22 +0200991 case NL80211_IFTYPE_P2P_GO:
Thomas Pedersenff973af2011-05-03 16:57:12 -0700992 case NL80211_IFTYPE_MESH_POINT:
Johannes Bergfffd0932009-07-08 14:22:54 +0200993 break;
994 case NL80211_IFTYPE_ADHOC:
Johannes Bergfffd0932009-07-08 14:22:54 +0200995 case NL80211_IFTYPE_STATION:
Johannes Berg074ac8d2010-09-16 14:58:22 +0200996 case NL80211_IFTYPE_P2P_CLIENT:
Johannes Bergceca7b72013-05-16 00:55:45 +0200997 if (!wdev->current_bss)
Johannes Bergfffd0932009-07-08 14:22:54 +0200998 return -ENOLINK;
999 break;
Johannes Bergde4fcba2014-10-31 14:16:12 +01001000 case NL80211_IFTYPE_UNSPECIFIED:
Rostislav Lisovy6e0bd6c2014-11-03 10:33:18 +01001001 case NL80211_IFTYPE_OCB:
Johannes Bergde4fcba2014-10-31 14:16:12 +01001002 case NL80211_IFTYPE_MONITOR:
Ayala Bekercb3b7d82016-09-20 17:31:13 +03001003 case NL80211_IFTYPE_NAN:
Johannes Bergde4fcba2014-10-31 14:16:12 +01001004 case NL80211_IFTYPE_P2P_DEVICE:
1005 case NL80211_IFTYPE_WDS:
1006 case NUM_NL80211_IFTYPES:
Johannes Bergfffd0932009-07-08 14:22:54 +02001007 return -EINVAL;
1008 }
1009
1010 return 0;
1011}
1012
Jouni Malinen664834d2014-01-15 00:01:44 +02001013static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
1014 struct nlattr *tb)
1015{
1016 struct ieee80211_channel *chan;
1017
1018 if (tb == NULL)
1019 return NULL;
1020 chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
1021 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
1022 return NULL;
1023 return chan;
1024}
1025
Johannes Berg7527a782011-05-13 10:58:57 +02001026static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
1027{
1028 struct nlattr *nl_modes = nla_nest_start(msg, attr);
1029 int i;
1030
1031 if (!nl_modes)
1032 goto nla_put_failure;
1033
1034 i = 0;
1035 while (ifmodes) {
David S. Miller9360ffd2012-03-29 04:41:26 -04001036 if ((ifmodes & 1) && nla_put_flag(msg, i))
1037 goto nla_put_failure;
Johannes Berg7527a782011-05-13 10:58:57 +02001038 ifmodes >>= 1;
1039 i++;
1040 }
1041
1042 nla_nest_end(msg, nl_modes);
1043 return 0;
1044
1045nla_put_failure:
1046 return -ENOBUFS;
1047}
1048
1049static int nl80211_put_iface_combinations(struct wiphy *wiphy,
Johannes Bergcdc89b92013-02-18 23:54:36 +01001050 struct sk_buff *msg,
1051 bool large)
Johannes Berg7527a782011-05-13 10:58:57 +02001052{
1053 struct nlattr *nl_combis;
1054 int i, j;
1055
1056 nl_combis = nla_nest_start(msg,
1057 NL80211_ATTR_INTERFACE_COMBINATIONS);
1058 if (!nl_combis)
1059 goto nla_put_failure;
1060
1061 for (i = 0; i < wiphy->n_iface_combinations; i++) {
1062 const struct ieee80211_iface_combination *c;
1063 struct nlattr *nl_combi, *nl_limits;
1064
1065 c = &wiphy->iface_combinations[i];
1066
1067 nl_combi = nla_nest_start(msg, i + 1);
1068 if (!nl_combi)
1069 goto nla_put_failure;
1070
1071 nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
1072 if (!nl_limits)
1073 goto nla_put_failure;
1074
1075 for (j = 0; j < c->n_limits; j++) {
1076 struct nlattr *nl_limit;
1077
1078 nl_limit = nla_nest_start(msg, j + 1);
1079 if (!nl_limit)
1080 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -04001081 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
1082 c->limits[j].max))
1083 goto nla_put_failure;
Johannes Berg7527a782011-05-13 10:58:57 +02001084 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
1085 c->limits[j].types))
1086 goto nla_put_failure;
1087 nla_nest_end(msg, nl_limit);
1088 }
1089
1090 nla_nest_end(msg, nl_limits);
1091
David S. Miller9360ffd2012-03-29 04:41:26 -04001092 if (c->beacon_int_infra_match &&
1093 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
1094 goto nla_put_failure;
1095 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
1096 c->num_different_channels) ||
1097 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
1098 c->max_interfaces))
1099 goto nla_put_failure;
Johannes Bergcdc89b92013-02-18 23:54:36 +01001100 if (large &&
Felix Fietkau8c48b502014-05-05 11:48:40 +02001101 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
1102 c->radar_detect_widths) ||
1103 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
1104 c->radar_detect_regions)))
Johannes Bergcdc89b92013-02-18 23:54:36 +01001105 goto nla_put_failure;
Purushottam Kushwaha0c317a02016-10-12 18:26:51 +05301106 if (c->beacon_int_min_gcd &&
1107 nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
1108 c->beacon_int_min_gcd))
1109 goto nla_put_failure;
Johannes Berg7527a782011-05-13 10:58:57 +02001110
1111 nla_nest_end(msg, nl_combi);
1112 }
1113
1114 nla_nest_end(msg, nl_combis);
1115
1116 return 0;
1117nla_put_failure:
1118 return -ENOBUFS;
1119}
1120
Johannes Berg3713b4e2013-02-14 16:19:38 +01001121#ifdef CONFIG_PM
Johannes Bergb56cf722013-02-20 01:02:38 +01001122static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
1123 struct sk_buff *msg)
1124{
Johannes Berg964dc9e2013-06-03 17:25:34 +02001125 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
Johannes Bergb56cf722013-02-20 01:02:38 +01001126 struct nlattr *nl_tcp;
1127
1128 if (!tcp)
1129 return 0;
1130
1131 nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
1132 if (!nl_tcp)
1133 return -ENOBUFS;
1134
1135 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1136 tcp->data_payload_max))
1137 return -ENOBUFS;
1138
1139 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1140 tcp->data_payload_max))
1141 return -ENOBUFS;
1142
1143 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
1144 return -ENOBUFS;
1145
1146 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
1147 sizeof(*tcp->tok), tcp->tok))
1148 return -ENOBUFS;
1149
1150 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
1151 tcp->data_interval_max))
1152 return -ENOBUFS;
1153
1154 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
1155 tcp->wake_payload_max))
1156 return -ENOBUFS;
1157
1158 nla_nest_end(msg, nl_tcp);
1159 return 0;
1160}
1161
Johannes Berg3713b4e2013-02-14 16:19:38 +01001162static int nl80211_send_wowlan(struct sk_buff *msg,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001163 struct cfg80211_registered_device *rdev,
Johannes Bergb56cf722013-02-20 01:02:38 +01001164 bool large)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001165{
1166 struct nlattr *nl_wowlan;
1167
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001168 if (!rdev->wiphy.wowlan)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001169 return 0;
1170
1171 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1172 if (!nl_wowlan)
1173 return -ENOBUFS;
1174
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001175 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001176 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001177 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001178 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001179 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001180 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001181 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001182 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001183 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001184 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001185 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001186 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001187 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001188 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001189 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001190 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1191 return -ENOBUFS;
1192
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001193 if (rdev->wiphy.wowlan->n_patterns) {
Amitkumar Karwar50ac6602013-06-25 19:03:56 -07001194 struct nl80211_pattern_support pat = {
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001195 .max_patterns = rdev->wiphy.wowlan->n_patterns,
1196 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
1197 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
1198 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
Johannes Berg3713b4e2013-02-14 16:19:38 +01001199 };
1200
1201 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1202 sizeof(pat), &pat))
1203 return -ENOBUFS;
1204 }
1205
Luciano Coelho75453cc2015-01-09 14:06:37 +02001206 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
1207 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
1208 rdev->wiphy.wowlan->max_nd_match_sets))
1209 return -ENOBUFS;
1210
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001211 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
Johannes Bergb56cf722013-02-20 01:02:38 +01001212 return -ENOBUFS;
1213
Johannes Berg3713b4e2013-02-14 16:19:38 +01001214 nla_nest_end(msg, nl_wowlan);
1215
1216 return 0;
1217}
1218#endif
1219
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -07001220static int nl80211_send_coalesce(struct sk_buff *msg,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001221 struct cfg80211_registered_device *rdev)
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -07001222{
1223 struct nl80211_coalesce_rule_support rule;
1224
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001225 if (!rdev->wiphy.coalesce)
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -07001226 return 0;
1227
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001228 rule.max_rules = rdev->wiphy.coalesce->n_rules;
1229 rule.max_delay = rdev->wiphy.coalesce->max_delay;
1230 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
1231 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
1232 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
1233 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -07001234
1235 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
1236 return -ENOBUFS;
1237
1238 return 0;
1239}
1240
Johannes Berg3713b4e2013-02-14 16:19:38 +01001241static int nl80211_send_band_rateinfo(struct sk_buff *msg,
1242 struct ieee80211_supported_band *sband)
1243{
1244 struct nlattr *nl_rates, *nl_rate;
1245 struct ieee80211_rate *rate;
1246 int i;
1247
1248 /* add HT info */
1249 if (sband->ht_cap.ht_supported &&
1250 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
1251 sizeof(sband->ht_cap.mcs),
1252 &sband->ht_cap.mcs) ||
1253 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
1254 sband->ht_cap.cap) ||
1255 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1256 sband->ht_cap.ampdu_factor) ||
1257 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1258 sband->ht_cap.ampdu_density)))
1259 return -ENOBUFS;
1260
1261 /* add VHT info */
1262 if (sband->vht_cap.vht_supported &&
1263 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1264 sizeof(sband->vht_cap.vht_mcs),
1265 &sband->vht_cap.vht_mcs) ||
1266 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1267 sband->vht_cap.cap)))
1268 return -ENOBUFS;
1269
1270 /* add bitrates */
1271 nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
1272 if (!nl_rates)
1273 return -ENOBUFS;
1274
1275 for (i = 0; i < sband->n_bitrates; i++) {
1276 nl_rate = nla_nest_start(msg, i);
1277 if (!nl_rate)
1278 return -ENOBUFS;
1279
1280 rate = &sband->bitrates[i];
1281 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1282 rate->bitrate))
1283 return -ENOBUFS;
1284 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1285 nla_put_flag(msg,
1286 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1287 return -ENOBUFS;
1288
1289 nla_nest_end(msg, nl_rate);
1290 }
1291
1292 nla_nest_end(msg, nl_rates);
1293
1294 return 0;
1295}
1296
1297static int
1298nl80211_send_mgmt_stypes(struct sk_buff *msg,
1299 const struct ieee80211_txrx_stypes *mgmt_stypes)
1300{
1301 u16 stypes;
1302 struct nlattr *nl_ftypes, *nl_ifs;
1303 enum nl80211_iftype ift;
1304 int i;
1305
1306 if (!mgmt_stypes)
1307 return 0;
1308
1309 nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
1310 if (!nl_ifs)
1311 return -ENOBUFS;
1312
1313 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1314 nl_ftypes = nla_nest_start(msg, ift);
1315 if (!nl_ftypes)
1316 return -ENOBUFS;
1317 i = 0;
1318 stypes = mgmt_stypes[ift].tx;
1319 while (stypes) {
1320 if ((stypes & 1) &&
1321 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1322 (i << 4) | IEEE80211_FTYPE_MGMT))
1323 return -ENOBUFS;
1324 stypes >>= 1;
1325 i++;
1326 }
1327 nla_nest_end(msg, nl_ftypes);
1328 }
1329
1330 nla_nest_end(msg, nl_ifs);
1331
1332 nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
1333 if (!nl_ifs)
1334 return -ENOBUFS;
1335
1336 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1337 nl_ftypes = nla_nest_start(msg, ift);
1338 if (!nl_ftypes)
1339 return -ENOBUFS;
1340 i = 0;
1341 stypes = mgmt_stypes[ift].rx;
1342 while (stypes) {
1343 if ((stypes & 1) &&
1344 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1345 (i << 4) | IEEE80211_FTYPE_MGMT))
1346 return -ENOBUFS;
1347 stypes >>= 1;
1348 i++;
1349 }
1350 nla_nest_end(msg, nl_ftypes);
1351 }
1352 nla_nest_end(msg, nl_ifs);
1353
1354 return 0;
1355}
1356
Johannes Berg17948992016-10-26 11:42:04 +02001357#define CMD(op, n) \
1358 do { \
1359 if (rdev->ops->op) { \
1360 i++; \
1361 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
1362 goto nla_put_failure; \
1363 } \
1364 } while (0)
1365
1366static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
1367 struct sk_buff *msg)
1368{
1369 int i = 0;
1370
1371 /*
1372 * do *NOT* add anything into this function, new things need to be
1373 * advertised only to new versions of userspace that can deal with
1374 * the split (and they can't possibly care about new features...
1375 */
1376 CMD(add_virtual_intf, NEW_INTERFACE);
1377 CMD(change_virtual_intf, SET_INTERFACE);
1378 CMD(add_key, NEW_KEY);
1379 CMD(start_ap, START_AP);
1380 CMD(add_station, NEW_STATION);
1381 CMD(add_mpath, NEW_MPATH);
1382 CMD(update_mesh_config, SET_MESH_CONFIG);
1383 CMD(change_bss, SET_BSS);
1384 CMD(auth, AUTHENTICATE);
1385 CMD(assoc, ASSOCIATE);
1386 CMD(deauth, DEAUTHENTICATE);
1387 CMD(disassoc, DISASSOCIATE);
1388 CMD(join_ibss, JOIN_IBSS);
1389 CMD(join_mesh, JOIN_MESH);
1390 CMD(set_pmksa, SET_PMKSA);
1391 CMD(del_pmksa, DEL_PMKSA);
1392 CMD(flush_pmksa, FLUSH_PMKSA);
1393 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
1394 CMD(remain_on_channel, REMAIN_ON_CHANNEL);
1395 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
1396 CMD(mgmt_tx, FRAME);
1397 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
1398 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
1399 i++;
1400 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
1401 goto nla_put_failure;
1402 }
1403 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
1404 rdev->ops->join_mesh) {
1405 i++;
1406 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1407 goto nla_put_failure;
1408 }
1409 CMD(set_wds_peer, SET_WDS_PEER);
1410 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
1411 CMD(tdls_mgmt, TDLS_MGMT);
1412 CMD(tdls_oper, TDLS_OPER);
1413 }
Arend Van Sprielca986ad2017-04-21 13:05:00 +01001414 if (rdev->wiphy.max_sched_scan_reqs)
Johannes Berg17948992016-10-26 11:42:04 +02001415 CMD(sched_scan_start, START_SCHED_SCAN);
1416 CMD(probe_client, PROBE_CLIENT);
1417 CMD(set_noack_map, SET_NOACK_MAP);
1418 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
1419 i++;
1420 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1421 goto nla_put_failure;
1422 }
1423 CMD(start_p2p_device, START_P2P_DEVICE);
1424 CMD(set_mcast_rate, SET_MCAST_RATE);
1425#ifdef CONFIG_NL80211_TESTMODE
1426 CMD(testmode_cmd, TESTMODE);
1427#endif
1428
1429 if (rdev->ops->connect || rdev->ops->auth) {
1430 i++;
1431 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
1432 goto nla_put_failure;
1433 }
1434
1435 if (rdev->ops->disconnect || rdev->ops->deauth) {
1436 i++;
1437 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1438 goto nla_put_failure;
1439 }
1440
1441 return i;
1442 nla_put_failure:
1443 return -ENOBUFS;
1444}
1445
Johannes Berg86e8cf92013-06-19 10:57:22 +02001446struct nl80211_dump_wiphy_state {
1447 s64 filter_wiphy;
1448 long start;
Kanchanapally, Vidyullatha019ae3a2016-05-16 10:41:04 +05301449 long split_start, band_start, chan_start, capa_start;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001450 bool split;
1451};
1452
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001453static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
Johannes Berg3bb20552014-05-26 13:52:25 +02001454 enum nl80211_commands cmd,
Johannes Berg3713b4e2013-02-14 16:19:38 +01001455 struct sk_buff *msg, u32 portid, u32 seq,
Johannes Berg86e8cf92013-06-19 10:57:22 +02001456 int flags, struct nl80211_dump_wiphy_state *state)
Johannes Berg55682962007-09-20 13:09:35 -04001457{
1458 void *hdr;
Johannes Bergee688b002008-01-24 19:38:39 +01001459 struct nlattr *nl_bands, *nl_band;
1460 struct nlattr *nl_freqs, *nl_freq;
Johannes Berg8fdc6212009-03-14 09:34:01 +01001461 struct nlattr *nl_cmds;
Johannes Berg57fbcce2016-04-12 15:56:15 +02001462 enum nl80211_band band;
Johannes Bergee688b002008-01-24 19:38:39 +01001463 struct ieee80211_channel *chan;
Johannes Bergee688b002008-01-24 19:38:39 +01001464 int i;
Johannes Berg2e161f72010-08-12 15:38:38 +02001465 const struct ieee80211_txrx_stypes *mgmt_stypes =
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001466 rdev->wiphy.mgmt_stypes;
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001467 u32 features;
Johannes Berg55682962007-09-20 13:09:35 -04001468
Johannes Berg3bb20552014-05-26 13:52:25 +02001469 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
Johannes Berg55682962007-09-20 13:09:35 -04001470 if (!hdr)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001471 return -ENOBUFS;
1472
Johannes Berg86e8cf92013-06-19 10:57:22 +02001473 if (WARN_ON(!state))
1474 return -EINVAL;
Johannes Berg55682962007-09-20 13:09:35 -04001475
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001476 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001477 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001478 wiphy_name(&rdev->wiphy)) ||
David S. Miller9360ffd2012-03-29 04:41:26 -04001479 nla_put_u32(msg, NL80211_ATTR_GENERATION,
Johannes Berg3713b4e2013-02-14 16:19:38 +01001480 cfg80211_rdev_list_generation))
David S. Miller9360ffd2012-03-29 04:41:26 -04001481 goto nla_put_failure;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02001482
Johannes Berg3bb20552014-05-26 13:52:25 +02001483 if (cmd != NL80211_CMD_NEW_WIPHY)
1484 goto finish;
1485
Johannes Berg86e8cf92013-06-19 10:57:22 +02001486 switch (state->split_start) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001487 case 0:
1488 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001489 rdev->wiphy.retry_short) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001490 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001491 rdev->wiphy.retry_long) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001492 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001493 rdev->wiphy.frag_threshold) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001494 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001495 rdev->wiphy.rts_threshold) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001496 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001497 rdev->wiphy.coverage_class) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001498 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001499 rdev->wiphy.max_scan_ssids) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001500 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001501 rdev->wiphy.max_sched_scan_ssids) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001502 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001503 rdev->wiphy.max_scan_ie_len) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001504 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001505 rdev->wiphy.max_sched_scan_ie_len) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001506 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
Avraham Stern3b06d272015-10-12 09:51:34 +03001507 rdev->wiphy.max_match_sets) ||
1508 nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
1509 rdev->wiphy.max_sched_scan_plans) ||
1510 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
1511 rdev->wiphy.max_sched_scan_plan_interval) ||
1512 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
1513 rdev->wiphy.max_sched_scan_plan_iterations))
Johannes Bergee688b002008-01-24 19:38:39 +01001514 goto nla_put_failure;
1515
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001516 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001517 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
1518 goto nla_put_failure;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001519 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001520 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
1521 goto nla_put_failure;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001522 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001523 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
1524 goto nla_put_failure;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001525 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001526 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
1527 goto nla_put_failure;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001528 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001529 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
1530 goto nla_put_failure;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001531 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001532 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
David S. Miller9360ffd2012-03-29 04:41:26 -04001533 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001534 state->split_start++;
1535 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001536 break;
1537 case 1:
1538 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001539 sizeof(u32) * rdev->wiphy.n_cipher_suites,
1540 rdev->wiphy.cipher_suites))
Mahesh Palivelabf0c111e2012-06-22 07:27:46 +00001541 goto nla_put_failure;
1542
Johannes Berg3713b4e2013-02-14 16:19:38 +01001543 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001544 rdev->wiphy.max_num_pmkids))
Johannes Bergee688b002008-01-24 19:38:39 +01001545 goto nla_put_failure;
1546
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001547 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001548 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
1549 goto nla_put_failure;
Johannes Bergee688b002008-01-24 19:38:39 +01001550
Johannes Berg3713b4e2013-02-14 16:19:38 +01001551 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001552 rdev->wiphy.available_antennas_tx) ||
Johannes Berg3713b4e2013-02-14 16:19:38 +01001553 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001554 rdev->wiphy.available_antennas_rx))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001555 goto nla_put_failure;
Johannes Bergee688b002008-01-24 19:38:39 +01001556
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001557 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001558 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001559 rdev->wiphy.probe_resp_offload))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001560 goto nla_put_failure;
Jouni Malinene2f367f262008-11-21 19:01:30 +02001561
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001562 if ((rdev->wiphy.available_antennas_tx ||
1563 rdev->wiphy.available_antennas_rx) &&
1564 rdev->ops->get_antenna) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001565 u32 tx_ant = 0, rx_ant = 0;
1566 int res;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07001567
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001568 res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
Johannes Berg3713b4e2013-02-14 16:19:38 +01001569 if (!res) {
1570 if (nla_put_u32(msg,
1571 NL80211_ATTR_WIPHY_ANTENNA_TX,
1572 tx_ant) ||
1573 nla_put_u32(msg,
1574 NL80211_ATTR_WIPHY_ANTENNA_RX,
1575 rx_ant))
1576 goto nla_put_failure;
1577 }
Johannes Bergee688b002008-01-24 19:38:39 +01001578 }
1579
Johannes Berg86e8cf92013-06-19 10:57:22 +02001580 state->split_start++;
1581 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001582 break;
1583 case 2:
1584 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001585 rdev->wiphy.interface_modes))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001586 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001587 state->split_start++;
1588 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001589 break;
1590 case 3:
1591 nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
1592 if (!nl_bands)
Johannes Bergee688b002008-01-24 19:38:39 +01001593 goto nla_put_failure;
1594
Johannes Berg86e8cf92013-06-19 10:57:22 +02001595 for (band = state->band_start;
Johannes Berg57fbcce2016-04-12 15:56:15 +02001596 band < NUM_NL80211_BANDS; band++) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001597 struct ieee80211_supported_band *sband;
1598
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001599 sband = rdev->wiphy.bands[band];
Johannes Berg3713b4e2013-02-14 16:19:38 +01001600
1601 if (!sband)
1602 continue;
1603
1604 nl_band = nla_nest_start(msg, band);
1605 if (!nl_band)
Johannes Bergee688b002008-01-24 19:38:39 +01001606 goto nla_put_failure;
1607
Johannes Berg86e8cf92013-06-19 10:57:22 +02001608 switch (state->chan_start) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001609 case 0:
1610 if (nl80211_send_band_rateinfo(msg, sband))
1611 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001612 state->chan_start++;
1613 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001614 break;
1615 default:
1616 /* add frequencies */
1617 nl_freqs = nla_nest_start(
1618 msg, NL80211_BAND_ATTR_FREQS);
1619 if (!nl_freqs)
1620 goto nla_put_failure;
Johannes Bergee688b002008-01-24 19:38:39 +01001621
Johannes Berg86e8cf92013-06-19 10:57:22 +02001622 for (i = state->chan_start - 1;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001623 i < sband->n_channels;
1624 i++) {
1625 nl_freq = nla_nest_start(msg, i);
1626 if (!nl_freq)
1627 goto nla_put_failure;
1628
1629 chan = &sband->channels[i];
1630
Johannes Berg86e8cf92013-06-19 10:57:22 +02001631 if (nl80211_msg_put_channel(
1632 msg, chan,
1633 state->split))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001634 goto nla_put_failure;
1635
1636 nla_nest_end(msg, nl_freq);
Johannes Berg86e8cf92013-06-19 10:57:22 +02001637 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001638 break;
1639 }
1640 if (i < sband->n_channels)
Johannes Berg86e8cf92013-06-19 10:57:22 +02001641 state->chan_start = i + 2;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001642 else
Johannes Berg86e8cf92013-06-19 10:57:22 +02001643 state->chan_start = 0;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001644 nla_nest_end(msg, nl_freqs);
1645 }
1646
1647 nla_nest_end(msg, nl_band);
1648
Johannes Berg86e8cf92013-06-19 10:57:22 +02001649 if (state->split) {
Johannes Berg3713b4e2013-02-14 16:19:38 +01001650 /* start again here */
Johannes Berg86e8cf92013-06-19 10:57:22 +02001651 if (state->chan_start)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001652 band--;
1653 break;
1654 }
Johannes Bergee688b002008-01-24 19:38:39 +01001655 }
Johannes Berg3713b4e2013-02-14 16:19:38 +01001656 nla_nest_end(msg, nl_bands);
Johannes Bergee688b002008-01-24 19:38:39 +01001657
Johannes Berg57fbcce2016-04-12 15:56:15 +02001658 if (band < NUM_NL80211_BANDS)
Johannes Berg86e8cf92013-06-19 10:57:22 +02001659 state->band_start = band + 1;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001660 else
Johannes Berg86e8cf92013-06-19 10:57:22 +02001661 state->band_start = 0;
Johannes Bergee688b002008-01-24 19:38:39 +01001662
Johannes Berg3713b4e2013-02-14 16:19:38 +01001663 /* if bands & channels are done, continue outside */
Johannes Berg86e8cf92013-06-19 10:57:22 +02001664 if (state->band_start == 0 && state->chan_start == 0)
1665 state->split_start++;
1666 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001667 break;
1668 case 4:
1669 nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
1670 if (!nl_cmds)
David S. Miller9360ffd2012-03-29 04:41:26 -04001671 goto nla_put_failure;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001672
Johannes Berg17948992016-10-26 11:42:04 +02001673 i = nl80211_add_commands_unsplit(rdev, msg);
1674 if (i < 0)
1675 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001676 if (state->split) {
Arend van Spriel5de17982013-04-18 15:49:00 +02001677 CMD(crit_proto_start, CRIT_PROTOCOL_START);
1678 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001679 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02001680 CMD(channel_switch, CHANNEL_SWITCH);
Johannes Berg02df00e2014-06-10 14:06:25 +02001681 CMD(set_qos_map, SET_QOS_MAP);
Johannes Berg723e73a2014-10-22 09:25:06 +02001682 if (rdev->wiphy.features &
1683 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
Johannes Berg960d01a2014-09-09 22:55:35 +03001684 CMD(add_tx_ts, ADD_TX_TS);
Michael Braunce0ce132016-10-10 19:12:22 +02001685 CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
vamsi krishna088e8df2016-10-27 16:51:11 +03001686 CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
Arend van Spriel5de17982013-04-18 15:49:00 +02001687 }
Johannes Berg8fdc6212009-03-14 09:34:01 +01001688#undef CMD
Samuel Ortizb23aa672009-07-01 21:26:54 +02001689
Johannes Berg3713b4e2013-02-14 16:19:38 +01001690 nla_nest_end(msg, nl_cmds);
Johannes Berg86e8cf92013-06-19 10:57:22 +02001691 state->split_start++;
1692 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001693 break;
1694 case 5:
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001695 if (rdev->ops->remain_on_channel &&
1696 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001697 nla_put_u32(msg,
1698 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001699 rdev->wiphy.max_remain_on_channel_duration))
Johannes Berg2e161f72010-08-12 15:38:38 +02001700 goto nla_put_failure;
1701
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001702 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001703 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
1704 goto nla_put_failure;
Johannes Berg2e161f72010-08-12 15:38:38 +02001705
Johannes Berg3713b4e2013-02-14 16:19:38 +01001706 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
1707 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001708 state->split_start++;
1709 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001710 break;
1711 case 6:
Johannes Bergdfb89c52012-06-27 09:23:48 +02001712#ifdef CONFIG_PM
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001713 if (nl80211_send_wowlan(msg, rdev, state->split))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001714 goto nla_put_failure;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001715 state->split_start++;
1716 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001717 break;
1718#else
Johannes Berg86e8cf92013-06-19 10:57:22 +02001719 state->split_start++;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001720#endif
1721 case 7:
1722 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001723 rdev->wiphy.software_iftypes))
Johannes Bergff1b6e62011-05-04 15:37:28 +02001724 goto nla_put_failure;
1725
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001726 if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
Johannes Berg86e8cf92013-06-19 10:57:22 +02001727 state->split))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001728 goto nla_put_failure;
Johannes Bergff1b6e62011-05-04 15:37:28 +02001729
Johannes Berg86e8cf92013-06-19 10:57:22 +02001730 state->split_start++;
1731 if (state->split)
Johannes Berg3713b4e2013-02-14 16:19:38 +01001732 break;
1733 case 8:
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001734 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001735 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001736 rdev->wiphy.ap_sme_capa))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001737 goto nla_put_failure;
1738
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001739 features = rdev->wiphy.features;
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001740 /*
1741 * We can only add the per-channel limit information if the
1742 * dump is split, otherwise it makes it too big. Therefore
1743 * only advertise it in that case.
1744 */
Johannes Berg86e8cf92013-06-19 10:57:22 +02001745 if (state->split)
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001746 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
1747 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001748 goto nla_put_failure;
1749
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001750 if (rdev->wiphy.ht_capa_mod_mask &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001751 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001752 sizeof(*rdev->wiphy.ht_capa_mod_mask),
1753 rdev->wiphy.ht_capa_mod_mask))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001754 goto nla_put_failure;
1755
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001756 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
1757 rdev->wiphy.max_acl_mac_addrs &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01001758 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001759 rdev->wiphy.max_acl_mac_addrs))
Johannes Berg3713b4e2013-02-14 16:19:38 +01001760 goto nla_put_failure;
1761
1762 /*
1763 * Any information below this point is only available to
1764 * applications that can deal with it being split. This
1765 * helps ensure that newly added capabilities don't break
1766 * older tools by overrunning their buffers.
1767 *
1768 * We still increment split_start so that in the split
1769 * case we'll continue with more data in the next round,
1770 * but break unconditionally so unsplit data stops here.
1771 */
Johannes Berg86e8cf92013-06-19 10:57:22 +02001772 state->split_start++;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001773 break;
1774 case 9:
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001775 if (rdev->wiphy.extended_capabilities &&
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001776 (nla_put(msg, NL80211_ATTR_EXT_CAPA,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001777 rdev->wiphy.extended_capabilities_len,
1778 rdev->wiphy.extended_capabilities) ||
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001779 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001780 rdev->wiphy.extended_capabilities_len,
1781 rdev->wiphy.extended_capabilities_mask)))
Johannes Bergfe1abaf2013-02-27 15:39:45 +01001782 goto nla_put_failure;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001783
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001784 if (rdev->wiphy.vht_capa_mod_mask &&
Johannes Bergee2aca32013-02-21 17:36:01 +01001785 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001786 sizeof(*rdev->wiphy.vht_capa_mod_mask),
1787 rdev->wiphy.vht_capa_mod_mask))
Johannes Bergee2aca32013-02-21 17:36:01 +01001788 goto nla_put_failure;
1789
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -07001790 state->split_start++;
1791 break;
1792 case 10:
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001793 if (nl80211_send_coalesce(msg, rdev))
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -07001794 goto nla_put_failure;
1795
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001796 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
Felix Fietkau01e0daa2013-11-09 14:57:54 +01001797 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
1798 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
1799 goto nla_put_failure;
Jouni Malinenb43504c2014-01-15 00:01:08 +02001800
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001801 if (rdev->wiphy.max_ap_assoc_sta &&
Jouni Malinenb43504c2014-01-15 00:01:08 +02001802 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001803 rdev->wiphy.max_ap_assoc_sta))
Jouni Malinenb43504c2014-01-15 00:01:08 +02001804 goto nla_put_failure;
1805
Johannes Bergad7e7182013-11-13 13:37:47 +01001806 state->split_start++;
1807 break;
1808 case 11:
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001809 if (rdev->wiphy.n_vendor_commands) {
Johannes Berg567ffc32013-12-18 14:43:31 +01001810 const struct nl80211_vendor_cmd_info *info;
1811 struct nlattr *nested;
Johannes Bergad7e7182013-11-13 13:37:47 +01001812
Johannes Berg567ffc32013-12-18 14:43:31 +01001813 nested = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA);
1814 if (!nested)
Johannes Bergad7e7182013-11-13 13:37:47 +01001815 goto nla_put_failure;
Johannes Berg567ffc32013-12-18 14:43:31 +01001816
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001817 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
1818 info = &rdev->wiphy.vendor_commands[i].info;
Johannes Berg567ffc32013-12-18 14:43:31 +01001819 if (nla_put(msg, i + 1, sizeof(*info), info))
1820 goto nla_put_failure;
1821 }
1822 nla_nest_end(msg, nested);
1823 }
1824
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001825 if (rdev->wiphy.n_vendor_events) {
Johannes Berg567ffc32013-12-18 14:43:31 +01001826 const struct nl80211_vendor_cmd_info *info;
1827 struct nlattr *nested;
1828
1829 nested = nla_nest_start(msg,
1830 NL80211_ATTR_VENDOR_EVENTS);
1831 if (!nested)
1832 goto nla_put_failure;
1833
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001834 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
1835 info = &rdev->wiphy.vendor_events[i];
Johannes Berg567ffc32013-12-18 14:43:31 +01001836 if (nla_put(msg, i + 1, sizeof(*info), info))
1837 goto nla_put_failure;
1838 }
1839 nla_nest_end(msg, nested);
1840 }
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03001841 state->split_start++;
1842 break;
1843 case 12:
1844 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
1845 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
1846 rdev->wiphy.max_num_csa_counters))
1847 goto nla_put_failure;
Felix Fietkau01e0daa2013-11-09 14:57:54 +01001848
Arik Nemtsov1bdd7162014-12-15 19:26:01 +02001849 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
1850 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
1851 goto nla_put_failure;
1852
Arend Van Sprielca986ad2017-04-21 13:05:00 +01001853 if (rdev->wiphy.max_sched_scan_reqs &&
1854 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
1855 rdev->wiphy.max_sched_scan_reqs))
1856 goto nla_put_failure;
1857
Gautam Kumar Shuklad75bb062014-12-23 16:55:19 +01001858 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
1859 sizeof(rdev->wiphy.ext_features),
1860 rdev->wiphy.ext_features))
1861 goto nla_put_failure;
1862
Arend van Spriel38de03d2016-03-02 20:37:18 +01001863 if (rdev->wiphy.bss_select_support) {
1864 struct nlattr *nested;
1865 u32 bss_select_support = rdev->wiphy.bss_select_support;
1866
1867 nested = nla_nest_start(msg, NL80211_ATTR_BSS_SELECT);
1868 if (!nested)
1869 goto nla_put_failure;
1870
1871 i = 0;
1872 while (bss_select_support) {
1873 if ((bss_select_support & 1) &&
1874 nla_put_flag(msg, i))
1875 goto nla_put_failure;
1876 i++;
1877 bss_select_support >>= 1;
1878 }
1879 nla_nest_end(msg, nested);
1880 }
1881
Kanchanapally, Vidyullatha019ae3a2016-05-16 10:41:04 +05301882 state->split_start++;
1883 break;
1884 case 13:
1885 if (rdev->wiphy.num_iftype_ext_capab &&
1886 rdev->wiphy.iftype_ext_capab) {
1887 struct nlattr *nested_ext_capab, *nested;
1888
1889 nested = nla_nest_start(msg,
1890 NL80211_ATTR_IFTYPE_EXT_CAPA);
1891 if (!nested)
1892 goto nla_put_failure;
1893
1894 for (i = state->capa_start;
1895 i < rdev->wiphy.num_iftype_ext_capab; i++) {
1896 const struct wiphy_iftype_ext_capab *capab;
1897
1898 capab = &rdev->wiphy.iftype_ext_capab[i];
1899
1900 nested_ext_capab = nla_nest_start(msg, i);
1901 if (!nested_ext_capab ||
1902 nla_put_u32(msg, NL80211_ATTR_IFTYPE,
1903 capab->iftype) ||
1904 nla_put(msg, NL80211_ATTR_EXT_CAPA,
1905 capab->extended_capabilities_len,
1906 capab->extended_capabilities) ||
1907 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1908 capab->extended_capabilities_len,
1909 capab->extended_capabilities_mask))
1910 goto nla_put_failure;
1911
1912 nla_nest_end(msg, nested_ext_capab);
1913 if (state->split)
1914 break;
1915 }
1916 nla_nest_end(msg, nested);
1917 if (i < rdev->wiphy.num_iftype_ext_capab) {
1918 state->capa_start = i + 1;
1919 break;
1920 }
1921 }
1922
Luca Coelho85859892017-02-08 15:00:34 +02001923 if (nla_put_u32(msg, NL80211_ATTR_BANDS,
1924 rdev->wiphy.nan_supported_bands))
1925 goto nla_put_failure;
1926
Johannes Berg3713b4e2013-02-14 16:19:38 +01001927 /* done */
Johannes Berg86e8cf92013-06-19 10:57:22 +02001928 state->split_start = 0;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001929 break;
Johannes Bergff1b6e62011-05-04 15:37:28 +02001930 }
Johannes Berg3bb20552014-05-26 13:52:25 +02001931 finish:
Johannes Berg053c0952015-01-16 22:09:00 +01001932 genlmsg_end(msg, hdr);
1933 return 0;
Johannes Berg55682962007-09-20 13:09:35 -04001934
1935 nla_put_failure:
Thomas Grafbc3ed282008-06-03 16:36:54 -07001936 genlmsg_cancel(msg, hdr);
1937 return -EMSGSIZE;
Johannes Berg55682962007-09-20 13:09:35 -04001938}
1939
Johannes Berg86e8cf92013-06-19 10:57:22 +02001940static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
1941 struct netlink_callback *cb,
1942 struct nl80211_dump_wiphy_state *state)
1943{
Johannes Bergc90c39d2016-10-24 14:40:01 +02001944 struct nlattr **tb = genl_family_attrbuf(&nl80211_fam);
Johannes Bergfceb6432017-04-12 14:34:07 +02001945 int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize, tb,
1946 nl80211_fam.maxattr, nl80211_policy, NULL);
Johannes Berg86e8cf92013-06-19 10:57:22 +02001947 /* ignore parse errors for backward compatibility */
1948 if (ret)
1949 return 0;
1950
1951 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
1952 if (tb[NL80211_ATTR_WIPHY])
1953 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
1954 if (tb[NL80211_ATTR_WDEV])
1955 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
1956 if (tb[NL80211_ATTR_IFINDEX]) {
1957 struct net_device *netdev;
1958 struct cfg80211_registered_device *rdev;
1959 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
1960
Ying Xue7f2b8562014-01-15 10:23:45 +08001961 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
Johannes Berg86e8cf92013-06-19 10:57:22 +02001962 if (!netdev)
1963 return -ENODEV;
1964 if (netdev->ieee80211_ptr) {
Zhao, Gangf26cbf42014-04-21 12:53:03 +08001965 rdev = wiphy_to_rdev(
Johannes Berg86e8cf92013-06-19 10:57:22 +02001966 netdev->ieee80211_ptr->wiphy);
1967 state->filter_wiphy = rdev->wiphy_idx;
1968 }
Johannes Berg86e8cf92013-06-19 10:57:22 +02001969 }
1970
1971 return 0;
1972}
1973
Johannes Berg55682962007-09-20 13:09:35 -04001974static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
1975{
Johannes Berg645e77d2013-03-01 14:03:49 +01001976 int idx = 0, ret;
Johannes Berg86e8cf92013-06-19 10:57:22 +02001977 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001978 struct cfg80211_registered_device *rdev;
Johannes Berg3a5a4232013-06-19 10:09:57 +02001979
Johannes Berg5fe231e2013-05-08 21:45:15 +02001980 rtnl_lock();
Johannes Berg86e8cf92013-06-19 10:57:22 +02001981 if (!state) {
1982 state = kzalloc(sizeof(*state), GFP_KERNEL);
John W. Linville57ed5cd2013-06-28 13:18:21 -04001983 if (!state) {
1984 rtnl_unlock();
Johannes Berg86e8cf92013-06-19 10:57:22 +02001985 return -ENOMEM;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001986 }
Johannes Berg86e8cf92013-06-19 10:57:22 +02001987 state->filter_wiphy = -1;
1988 ret = nl80211_dump_wiphy_parse(skb, cb, state);
1989 if (ret) {
1990 kfree(state);
1991 rtnl_unlock();
1992 return ret;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001993 }
Johannes Berg86e8cf92013-06-19 10:57:22 +02001994 cb->args[0] = (long)state;
Johannes Berg3713b4e2013-02-14 16:19:38 +01001995 }
1996
Zhao, Gang1b8ec872014-04-21 12:53:02 +08001997 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1998 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
Johannes Berg463d0182009-07-14 00:33:35 +02001999 continue;
Johannes Berg86e8cf92013-06-19 10:57:22 +02002000 if (++idx <= state->start)
Johannes Berg55682962007-09-20 13:09:35 -04002001 continue;
Johannes Berg86e8cf92013-06-19 10:57:22 +02002002 if (state->filter_wiphy != -1 &&
Zhao, Gang1b8ec872014-04-21 12:53:02 +08002003 state->filter_wiphy != rdev->wiphy_idx)
Johannes Berg3713b4e2013-02-14 16:19:38 +01002004 continue;
2005 /* attempt to fit multiple wiphy data chunks into the skb */
2006 do {
Johannes Berg3bb20552014-05-26 13:52:25 +02002007 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
2008 skb,
Johannes Berg3713b4e2013-02-14 16:19:38 +01002009 NETLINK_CB(cb->skb).portid,
2010 cb->nlh->nlmsg_seq,
Johannes Berg86e8cf92013-06-19 10:57:22 +02002011 NLM_F_MULTI, state);
Johannes Berg3713b4e2013-02-14 16:19:38 +01002012 if (ret < 0) {
2013 /*
2014 * If sending the wiphy data didn't fit (ENOBUFS
2015 * or EMSGSIZE returned), this SKB is still
2016 * empty (so it's not too big because another
2017 * wiphy dataset is already in the skb) and
2018 * we've not tried to adjust the dump allocation
2019 * yet ... then adjust the alloc size to be
2020 * bigger, and return 1 but with the empty skb.
2021 * This results in an empty message being RX'ed
2022 * in userspace, but that is ignored.
2023 *
2024 * We can then retry with the larger buffer.
2025 */
2026 if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
Pontus Fuchsf12cb282014-01-16 15:00:40 +01002027 !skb->len && !state->split &&
Johannes Berg3713b4e2013-02-14 16:19:38 +01002028 cb->min_dump_alloc < 4096) {
2029 cb->min_dump_alloc = 4096;
Pontus Fuchsf12cb282014-01-16 15:00:40 +01002030 state->split_start = 0;
David S. Millerd98cae64e2013-06-19 16:49:39 -07002031 rtnl_unlock();
Johannes Berg3713b4e2013-02-14 16:19:38 +01002032 return 1;
2033 }
2034 idx--;
2035 break;
Johannes Berg645e77d2013-03-01 14:03:49 +01002036 }
Johannes Berg86e8cf92013-06-19 10:57:22 +02002037 } while (state->split_start > 0);
Johannes Berg3713b4e2013-02-14 16:19:38 +01002038 break;
Johannes Berg55682962007-09-20 13:09:35 -04002039 }
Johannes Berg5fe231e2013-05-08 21:45:15 +02002040 rtnl_unlock();
Johannes Berg55682962007-09-20 13:09:35 -04002041
Johannes Berg86e8cf92013-06-19 10:57:22 +02002042 state->start = idx;
Johannes Berg55682962007-09-20 13:09:35 -04002043
2044 return skb->len;
2045}
2046
Johannes Berg86e8cf92013-06-19 10:57:22 +02002047static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
2048{
2049 kfree((void *)cb->args[0]);
2050 return 0;
2051}
2052
Johannes Berg55682962007-09-20 13:09:35 -04002053static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
2054{
2055 struct sk_buff *msg;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08002056 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg86e8cf92013-06-19 10:57:22 +02002057 struct nl80211_dump_wiphy_state state = {};
Johannes Berg55682962007-09-20 13:09:35 -04002058
Johannes Berg645e77d2013-03-01 14:03:49 +01002059 msg = nlmsg_new(4096, GFP_KERNEL);
Johannes Berg55682962007-09-20 13:09:35 -04002060 if (!msg)
Johannes Berg4c476992010-10-04 21:36:35 +02002061 return -ENOMEM;
Johannes Berg55682962007-09-20 13:09:35 -04002062
Johannes Berg3bb20552014-05-26 13:52:25 +02002063 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
2064 info->snd_portid, info->snd_seq, 0,
Johannes Berg86e8cf92013-06-19 10:57:22 +02002065 &state) < 0) {
Johannes Berg4c476992010-10-04 21:36:35 +02002066 nlmsg_free(msg);
2067 return -ENOBUFS;
2068 }
Johannes Berg55682962007-09-20 13:09:35 -04002069
Johannes Berg134e6372009-07-10 09:51:34 +00002070 return genlmsg_reply(msg, info);
Johannes Berg55682962007-09-20 13:09:35 -04002071}
2072
Jouni Malinen31888482008-10-30 16:59:24 +02002073static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
2074 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
2075 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
2076 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
2077 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
2078 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
2079};
2080
2081static int parse_txq_params(struct nlattr *tb[],
2082 struct ieee80211_txq_params *txq_params)
2083{
Johannes Berga3304b02012-03-28 11:04:24 +02002084 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
Jouni Malinen31888482008-10-30 16:59:24 +02002085 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
2086 !tb[NL80211_TXQ_ATTR_AIFS])
2087 return -EINVAL;
2088
Johannes Berga3304b02012-03-28 11:04:24 +02002089 txq_params->ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
Jouni Malinen31888482008-10-30 16:59:24 +02002090 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
2091 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
2092 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
2093 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
2094
Johannes Berga3304b02012-03-28 11:04:24 +02002095 if (txq_params->ac >= NL80211_NUM_ACS)
2096 return -EINVAL;
2097
Jouni Malinen31888482008-10-30 16:59:24 +02002098 return 0;
2099}
2100
Johannes Bergf444de02010-05-05 15:25:02 +02002101static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
2102{
2103 /*
Johannes Bergcc1d2802012-05-16 23:50:20 +02002104 * You can only set the channel explicitly for WDS interfaces,
2105 * all others have their channel managed via their respective
2106 * "establish a connection" command (connect, join, ...)
2107 *
2108 * For AP/GO and mesh mode, the channel can be set with the
2109 * channel userspace API, but is only stored and passed to the
2110 * low-level driver when the AP starts or the mesh is joined.
2111 * This is for backward compatibility, userspace can also give
2112 * the channel in the start-ap or join-mesh commands instead.
Johannes Bergf444de02010-05-05 15:25:02 +02002113 *
2114 * Monitors are special as they are normally slaved to
Johannes Berge8c9bd52012-06-06 08:18:22 +02002115 * whatever else is going on, so they have their own special
2116 * operation to set the monitor channel if possible.
Johannes Bergf444de02010-05-05 15:25:02 +02002117 */
2118 return !wdev ||
2119 wdev->iftype == NL80211_IFTYPE_AP ||
Johannes Bergf444de02010-05-05 15:25:02 +02002120 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
Johannes Berg074ac8d2010-09-16 14:58:22 +02002121 wdev->iftype == NL80211_IFTYPE_MONITOR ||
2122 wdev->iftype == NL80211_IFTYPE_P2P_GO;
Johannes Bergf444de02010-05-05 15:25:02 +02002123}
2124
Johannes Berg683b6d32012-11-08 21:25:48 +01002125static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
2126 struct genl_info *info,
2127 struct cfg80211_chan_def *chandef)
2128{
Mahesh Paliveladbeca2e2012-11-29 14:11:07 +05302129 u32 control_freq;
Johannes Berg683b6d32012-11-08 21:25:48 +01002130
2131 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
2132 return -EINVAL;
2133
2134 control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
2135
2136 chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002137 chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
2138 chandef->center_freq1 = control_freq;
2139 chandef->center_freq2 = 0;
Johannes Berg683b6d32012-11-08 21:25:48 +01002140
2141 /* Primary channel not allowed */
2142 if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
2143 return -EINVAL;
2144
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002145 if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
2146 enum nl80211_channel_type chantype;
Johannes Berg683b6d32012-11-08 21:25:48 +01002147
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002148 chantype = nla_get_u32(
2149 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
2150
2151 switch (chantype) {
2152 case NL80211_CHAN_NO_HT:
2153 case NL80211_CHAN_HT20:
2154 case NL80211_CHAN_HT40PLUS:
2155 case NL80211_CHAN_HT40MINUS:
2156 cfg80211_chandef_create(chandef, chandef->chan,
2157 chantype);
Tova Mussaiffa46292017-08-05 11:44:38 +03002158 /* user input for center_freq is incorrect */
2159 if (info->attrs[NL80211_ATTR_CENTER_FREQ1] &&
2160 chandef->center_freq1 != nla_get_u32(
2161 info->attrs[NL80211_ATTR_CENTER_FREQ1]))
2162 return -EINVAL;
2163 /* center_freq2 must be zero */
2164 if (info->attrs[NL80211_ATTR_CENTER_FREQ2] &&
2165 nla_get_u32(info->attrs[NL80211_ATTR_CENTER_FREQ2]))
2166 return -EINVAL;
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002167 break;
2168 default:
Johannes Berg683b6d32012-11-08 21:25:48 +01002169 return -EINVAL;
Johannes Berg683b6d32012-11-08 21:25:48 +01002170 }
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002171 } else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
2172 chandef->width =
2173 nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
2174 if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
2175 chandef->center_freq1 =
2176 nla_get_u32(
2177 info->attrs[NL80211_ATTR_CENTER_FREQ1]);
2178 if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
2179 chandef->center_freq2 =
2180 nla_get_u32(
2181 info->attrs[NL80211_ATTR_CENTER_FREQ2]);
2182 }
2183
Johannes Berg9f5e8f62012-11-22 16:59:45 +01002184 if (!cfg80211_chandef_valid(chandef))
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002185 return -EINVAL;
2186
Johannes Berg9f5e8f62012-11-22 16:59:45 +01002187 if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
2188 IEEE80211_CHAN_DISABLED))
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002189 return -EINVAL;
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002190
Simon Wunderlich2f301ab2013-05-16 13:00:28 +02002191 if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
2192 chandef->width == NL80211_CHAN_WIDTH_10) &&
2193 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ))
2194 return -EINVAL;
2195
Johannes Berg683b6d32012-11-08 21:25:48 +01002196 return 0;
2197}
2198
Johannes Bergf444de02010-05-05 15:25:02 +02002199static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
Jouni Malinene16821b2014-04-28 11:22:08 +03002200 struct net_device *dev,
Johannes Bergf444de02010-05-05 15:25:02 +02002201 struct genl_info *info)
2202{
Johannes Berg683b6d32012-11-08 21:25:48 +01002203 struct cfg80211_chan_def chandef;
Johannes Bergf444de02010-05-05 15:25:02 +02002204 int result;
Johannes Berge8c9bd52012-06-06 08:18:22 +02002205 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
Jouni Malinene16821b2014-04-28 11:22:08 +03002206 struct wireless_dev *wdev = NULL;
Johannes Berge8c9bd52012-06-06 08:18:22 +02002207
Jouni Malinene16821b2014-04-28 11:22:08 +03002208 if (dev)
2209 wdev = dev->ieee80211_ptr;
Johannes Bergf444de02010-05-05 15:25:02 +02002210 if (!nl80211_can_set_dev_channel(wdev))
2211 return -EOPNOTSUPP;
Jouni Malinene16821b2014-04-28 11:22:08 +03002212 if (wdev)
2213 iftype = wdev->iftype;
Johannes Bergf444de02010-05-05 15:25:02 +02002214
Johannes Berg683b6d32012-11-08 21:25:48 +01002215 result = nl80211_parse_chandef(rdev, info, &chandef);
2216 if (result)
2217 return result;
Johannes Bergf444de02010-05-05 15:25:02 +02002218
Johannes Berge8c9bd52012-06-06 08:18:22 +02002219 switch (iftype) {
Johannes Bergaa430da2012-05-16 23:50:18 +02002220 case NL80211_IFTYPE_AP:
2221 case NL80211_IFTYPE_P2P_GO:
Arik Nemtsov923b3522015-07-08 15:41:44 +03002222 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
2223 iftype)) {
Johannes Bergaa430da2012-05-16 23:50:18 +02002224 result = -EINVAL;
2225 break;
2226 }
Jouni Malinene16821b2014-04-28 11:22:08 +03002227 if (wdev->beacon_interval) {
2228 if (!dev || !rdev->ops->set_ap_chanwidth ||
2229 !(rdev->wiphy.features &
2230 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
2231 result = -EBUSY;
2232 break;
2233 }
2234
2235 /* Only allow dynamic channel width changes */
2236 if (chandef.chan != wdev->preset_chandef.chan) {
2237 result = -EBUSY;
2238 break;
2239 }
2240 result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
2241 if (result)
2242 break;
2243 }
Johannes Berg683b6d32012-11-08 21:25:48 +01002244 wdev->preset_chandef = chandef;
Johannes Bergaa430da2012-05-16 23:50:18 +02002245 result = 0;
2246 break;
Johannes Bergcc1d2802012-05-16 23:50:20 +02002247 case NL80211_IFTYPE_MESH_POINT:
Johannes Berg683b6d32012-11-08 21:25:48 +01002248 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
Johannes Bergcc1d2802012-05-16 23:50:20 +02002249 break;
Johannes Berge8c9bd52012-06-06 08:18:22 +02002250 case NL80211_IFTYPE_MONITOR:
Johannes Berg683b6d32012-11-08 21:25:48 +01002251 result = cfg80211_set_monitor_channel(rdev, &chandef);
Johannes Berge8c9bd52012-06-06 08:18:22 +02002252 break;
Johannes Bergaa430da2012-05-16 23:50:18 +02002253 default:
Johannes Berge8c9bd52012-06-06 08:18:22 +02002254 result = -EINVAL;
Johannes Bergf444de02010-05-05 15:25:02 +02002255 }
Johannes Bergf444de02010-05-05 15:25:02 +02002256
2257 return result;
2258}
2259
2260static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
2261{
Johannes Berg4c476992010-10-04 21:36:35 +02002262 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2263 struct net_device *netdev = info->user_ptr[1];
Johannes Bergf444de02010-05-05 15:25:02 +02002264
Jouni Malinene16821b2014-04-28 11:22:08 +03002265 return __nl80211_set_channel(rdev, netdev, info);
Johannes Bergf444de02010-05-05 15:25:02 +02002266}
2267
Bill Jordane8347eb2010-10-01 13:54:28 -04002268static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
2269{
Johannes Berg43b19952010-10-07 13:10:30 +02002270 struct cfg80211_registered_device *rdev = info->user_ptr[0];
2271 struct net_device *dev = info->user_ptr[1];
2272 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Berg388ac772010-10-07 13:11:09 +02002273 const u8 *bssid;
Bill Jordane8347eb2010-10-01 13:54:28 -04002274
2275 if (!info->attrs[NL80211_ATTR_MAC])
2276 return -EINVAL;
2277
Johannes Berg43b19952010-10-07 13:10:30 +02002278 if (netif_running(dev))
2279 return -EBUSY;
Bill Jordane8347eb2010-10-01 13:54:28 -04002280
Johannes Berg43b19952010-10-07 13:10:30 +02002281 if (!rdev->ops->set_wds_peer)
2282 return -EOPNOTSUPP;
Bill Jordane8347eb2010-10-01 13:54:28 -04002283
Johannes Berg43b19952010-10-07 13:10:30 +02002284 if (wdev->iftype != NL80211_IFTYPE_WDS)
2285 return -EOPNOTSUPP;
Bill Jordane8347eb2010-10-01 13:54:28 -04002286
2287 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Hila Gonene35e4d22012-06-27 17:19:42 +03002288 return rdev_set_wds_peer(rdev, dev, bssid);
Bill Jordane8347eb2010-10-01 13:54:28 -04002289}
2290
Johannes Berg55682962007-09-20 13:09:35 -04002291static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
2292{
2293 struct cfg80211_registered_device *rdev;
Johannes Bergf444de02010-05-05 15:25:02 +02002294 struct net_device *netdev = NULL;
2295 struct wireless_dev *wdev;
Bill Jordana1e567c2010-09-10 11:22:32 -04002296 int result = 0, rem_txq_params = 0;
Jouni Malinen31888482008-10-30 16:59:24 +02002297 struct nlattr *nl_txq_params;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002298 u32 changed;
2299 u8 retry_short = 0, retry_long = 0;
2300 u32 frag_threshold = 0, rts_threshold = 0;
Lukáš Turek81077e82009-12-21 22:50:47 +01002301 u8 coverage_class = 0;
Johannes Berg55682962007-09-20 13:09:35 -04002302
Johannes Berg5fe231e2013-05-08 21:45:15 +02002303 ASSERT_RTNL();
2304
Johannes Bergf444de02010-05-05 15:25:02 +02002305 /*
2306 * Try to find the wiphy and netdev. Normally this
2307 * function shouldn't need the netdev, but this is
2308 * done for backward compatibility -- previously
2309 * setting the channel was done per wiphy, but now
2310 * it is per netdev. Previous userland like hostapd
2311 * also passed a netdev to set_wiphy, so that it is
2312 * possible to let that go to the right netdev!
2313 */
Johannes Berg4bbf4d52009-03-24 09:35:46 +01002314
Johannes Bergf444de02010-05-05 15:25:02 +02002315 if (info->attrs[NL80211_ATTR_IFINDEX]) {
2316 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
2317
Ying Xue7f2b8562014-01-15 10:23:45 +08002318 netdev = __dev_get_by_index(genl_info_net(info), ifindex);
Johannes Berg5fe231e2013-05-08 21:45:15 +02002319 if (netdev && netdev->ieee80211_ptr)
Zhao, Gangf26cbf42014-04-21 12:53:03 +08002320 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
Johannes Berg5fe231e2013-05-08 21:45:15 +02002321 else
Johannes Bergf444de02010-05-05 15:25:02 +02002322 netdev = NULL;
Johannes Berg4bbf4d52009-03-24 09:35:46 +01002323 }
2324
Johannes Bergf444de02010-05-05 15:25:02 +02002325 if (!netdev) {
Johannes Berg878d9ec2012-06-15 14:18:32 +02002326 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
2327 info->attrs);
Johannes Berg5fe231e2013-05-08 21:45:15 +02002328 if (IS_ERR(rdev))
Johannes Berg4c476992010-10-04 21:36:35 +02002329 return PTR_ERR(rdev);
Johannes Bergf444de02010-05-05 15:25:02 +02002330 wdev = NULL;
2331 netdev = NULL;
2332 result = 0;
Johannes Berg71fe96b2012-10-24 10:04:58 +02002333 } else
Johannes Bergf444de02010-05-05 15:25:02 +02002334 wdev = netdev->ieee80211_ptr;
Johannes Bergf444de02010-05-05 15:25:02 +02002335
2336 /*
2337 * end workaround code, by now the rdev is available
2338 * and locked, and wdev may or may not be NULL.
2339 */
Johannes Berg4bbf4d52009-03-24 09:35:46 +01002340
2341 if (info->attrs[NL80211_ATTR_WIPHY_NAME])
Jouni Malinen31888482008-10-30 16:59:24 +02002342 result = cfg80211_dev_rename(
2343 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
Johannes Berg4bbf4d52009-03-24 09:35:46 +01002344
Johannes Berg4bbf4d52009-03-24 09:35:46 +01002345 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002346 return result;
Johannes Berg55682962007-09-20 13:09:35 -04002347
Jouni Malinen31888482008-10-30 16:59:24 +02002348 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
2349 struct ieee80211_txq_params txq_params;
2350 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
2351
Ying Xue7f2b8562014-01-15 10:23:45 +08002352 if (!rdev->ops->set_txq_params)
2353 return -EOPNOTSUPP;
Jouni Malinen31888482008-10-30 16:59:24 +02002354
Ying Xue7f2b8562014-01-15 10:23:45 +08002355 if (!netdev)
2356 return -EINVAL;
Eliad Pellerf70f01c2011-09-25 20:06:53 +03002357
Johannes Berg133a3ff2011-11-03 14:50:13 +01002358 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
Ying Xue7f2b8562014-01-15 10:23:45 +08002359 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2360 return -EINVAL;
Johannes Berg133a3ff2011-11-03 14:50:13 +01002361
Ying Xue7f2b8562014-01-15 10:23:45 +08002362 if (!netif_running(netdev))
2363 return -ENETDOWN;
Johannes Berg2b5f8b02012-04-02 10:51:55 +02002364
Jouni Malinen31888482008-10-30 16:59:24 +02002365 nla_for_each_nested(nl_txq_params,
2366 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
2367 rem_txq_params) {
Johannes Bergbfe2c7b2016-10-26 14:42:21 +02002368 result = nla_parse_nested(tb, NL80211_TXQ_ATTR_MAX,
2369 nl_txq_params,
Johannes Bergfe521452017-04-12 14:34:08 +02002370 txq_params_policy,
2371 info->extack);
Johannes Bergae811e22014-01-24 10:17:47 +01002372 if (result)
2373 return result;
Jouni Malinen31888482008-10-30 16:59:24 +02002374 result = parse_txq_params(tb, &txq_params);
2375 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002376 return result;
Jouni Malinen31888482008-10-30 16:59:24 +02002377
Hila Gonene35e4d22012-06-27 17:19:42 +03002378 result = rdev_set_txq_params(rdev, netdev,
2379 &txq_params);
Jouni Malinen31888482008-10-30 16:59:24 +02002380 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002381 return result;
Jouni Malinen31888482008-10-30 16:59:24 +02002382 }
2383 }
2384
Jouni Malinen72bdcf32008-11-26 16:15:24 +02002385 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
Jouni Malinene16821b2014-04-28 11:22:08 +03002386 result = __nl80211_set_channel(
2387 rdev,
2388 nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
2389 info);
Jouni Malinen72bdcf32008-11-26 16:15:24 +02002390 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002391 return result;
Jouni Malinen72bdcf32008-11-26 16:15:24 +02002392 }
2393
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002394 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
Johannes Bergc8442112012-10-24 10:17:18 +02002395 struct wireless_dev *txp_wdev = wdev;
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002396 enum nl80211_tx_power_setting type;
2397 int idx, mbm = 0;
2398
Johannes Bergc8442112012-10-24 10:17:18 +02002399 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
2400 txp_wdev = NULL;
2401
Ying Xue7f2b8562014-01-15 10:23:45 +08002402 if (!rdev->ops->set_tx_power)
2403 return -EOPNOTSUPP;
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002404
2405 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
2406 type = nla_get_u32(info->attrs[idx]);
2407
2408 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
Ying Xue7f2b8562014-01-15 10:23:45 +08002409 (type != NL80211_TX_POWER_AUTOMATIC))
2410 return -EINVAL;
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002411
2412 if (type != NL80211_TX_POWER_AUTOMATIC) {
2413 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
2414 mbm = nla_get_u32(info->attrs[idx]);
2415 }
2416
Johannes Bergc8442112012-10-24 10:17:18 +02002417 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002418 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002419 return result;
Juuso Oikarinen98d2ff82010-06-23 12:12:38 +03002420 }
2421
Bruno Randolfafe0cbf2010-11-10 12:50:50 +09002422 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
2423 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
2424 u32 tx_ant, rx_ant;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07002425
Bruno Randolf7f531e02010-12-16 11:30:22 +09002426 if ((!rdev->wiphy.available_antennas_tx &&
2427 !rdev->wiphy.available_antennas_rx) ||
Ying Xue7f2b8562014-01-15 10:23:45 +08002428 !rdev->ops->set_antenna)
2429 return -EOPNOTSUPP;
Bruno Randolfafe0cbf2010-11-10 12:50:50 +09002430
2431 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
2432 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
2433
Bruno Randolfa7ffac92010-12-08 13:59:24 +09002434 /* reject antenna configurations which don't match the
Bruno Randolf7f531e02010-12-16 11:30:22 +09002435 * available antenna masks, except for the "all" mask */
2436 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
Ying Xue7f2b8562014-01-15 10:23:45 +08002437 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
2438 return -EINVAL;
Bruno Randolfa7ffac92010-12-08 13:59:24 +09002439
Bruno Randolf7f531e02010-12-16 11:30:22 +09002440 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
2441 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
Bruno Randolfa7ffac92010-12-08 13:59:24 +09002442
Hila Gonene35e4d22012-06-27 17:19:42 +03002443 result = rdev_set_antenna(rdev, tx_ant, rx_ant);
Bruno Randolfafe0cbf2010-11-10 12:50:50 +09002444 if (result)
Ying Xue7f2b8562014-01-15 10:23:45 +08002445 return result;
Bruno Randolfafe0cbf2010-11-10 12:50:50 +09002446 }
2447
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002448 changed = 0;
2449
2450 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
2451 retry_short = nla_get_u8(
2452 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
Ying Xue7f2b8562014-01-15 10:23:45 +08002453 if (retry_short == 0)
2454 return -EINVAL;
2455
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002456 changed |= WIPHY_PARAM_RETRY_SHORT;
2457 }
2458
2459 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
2460 retry_long = nla_get_u8(
2461 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
Ying Xue7f2b8562014-01-15 10:23:45 +08002462 if (retry_long == 0)
2463 return -EINVAL;
2464
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002465 changed |= WIPHY_PARAM_RETRY_LONG;
2466 }
2467
2468 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
2469 frag_threshold = nla_get_u32(
2470 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
Ying Xue7f2b8562014-01-15 10:23:45 +08002471 if (frag_threshold < 256)
2472 return -EINVAL;
2473
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002474 if (frag_threshold != (u32) -1) {
2475 /*
2476 * Fragments (apart from the last one) are required to
2477 * have even length. Make the fragmentation code
2478 * simpler by stripping LSB should someone try to use
2479 * odd threshold value.
2480 */
2481 frag_threshold &= ~0x1;
2482 }
2483 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
2484 }
2485
2486 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
2487 rts_threshold = nla_get_u32(
2488 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
2489 changed |= WIPHY_PARAM_RTS_THRESHOLD;
2490 }
2491
Lukáš Turek81077e82009-12-21 22:50:47 +01002492 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
Lorenzo Bianconi3057dbf2014-09-04 23:57:40 +02002493 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
2494 return -EINVAL;
2495
Lukáš Turek81077e82009-12-21 22:50:47 +01002496 coverage_class = nla_get_u8(
2497 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
2498 changed |= WIPHY_PARAM_COVERAGE_CLASS;
2499 }
2500
Lorenzo Bianconi3057dbf2014-09-04 23:57:40 +02002501 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
2502 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
2503 return -EOPNOTSUPP;
2504
2505 changed |= WIPHY_PARAM_DYN_ACK;
2506 }
2507
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002508 if (changed) {
2509 u8 old_retry_short, old_retry_long;
2510 u32 old_frag_threshold, old_rts_threshold;
Lukáš Turek81077e82009-12-21 22:50:47 +01002511 u8 old_coverage_class;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002512
Ying Xue7f2b8562014-01-15 10:23:45 +08002513 if (!rdev->ops->set_wiphy_params)
2514 return -EOPNOTSUPP;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002515
2516 old_retry_short = rdev->wiphy.retry_short;
2517 old_retry_long = rdev->wiphy.retry_long;
2518 old_frag_threshold = rdev->wiphy.frag_threshold;
2519 old_rts_threshold = rdev->wiphy.rts_threshold;
Lukáš Turek81077e82009-12-21 22:50:47 +01002520 old_coverage_class = rdev->wiphy.coverage_class;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002521
2522 if (changed & WIPHY_PARAM_RETRY_SHORT)
2523 rdev->wiphy.retry_short = retry_short;
2524 if (changed & WIPHY_PARAM_RETRY_LONG)
2525 rdev->wiphy.retry_long = retry_long;
2526 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
2527 rdev->wiphy.frag_threshold = frag_threshold;
2528 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
2529 rdev->wiphy.rts_threshold = rts_threshold;
Lukáš Turek81077e82009-12-21 22:50:47 +01002530 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
2531 rdev->wiphy.coverage_class = coverage_class;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002532
Hila Gonene35e4d22012-06-27 17:19:42 +03002533 result = rdev_set_wiphy_params(rdev, changed);
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002534 if (result) {
2535 rdev->wiphy.retry_short = old_retry_short;
2536 rdev->wiphy.retry_long = old_retry_long;
2537 rdev->wiphy.frag_threshold = old_frag_threshold;
2538 rdev->wiphy.rts_threshold = old_rts_threshold;
Lukáš Turek81077e82009-12-21 22:50:47 +01002539 rdev->wiphy.coverage_class = old_coverage_class;
Michal Kazior9189ee32015-08-03 10:55:24 +02002540 return result;
Jouni Malinenb9a5f8ca2009-04-20 18:39:05 +02002541 }
2542 }
Ying Xue7f2b8562014-01-15 10:23:45 +08002543 return 0;
Johannes Berg55682962007-09-20 13:09:35 -04002544}
2545
Johannes Berg71bbc992012-06-15 15:30:18 +02002546static inline u64 wdev_id(struct wireless_dev *wdev)
2547{
2548 return (u64)wdev->identifier |
Zhao, Gangf26cbf42014-04-21 12:53:03 +08002549 ((u64)wiphy_to_rdev(wdev->wiphy)->wiphy_idx << 32);
Johannes Berg71bbc992012-06-15 15:30:18 +02002550}
Johannes Berg55682962007-09-20 13:09:35 -04002551
Johannes Berg683b6d32012-11-08 21:25:48 +01002552static int nl80211_send_chandef(struct sk_buff *msg,
Janusz Dziedzicd2859df2013-11-06 13:55:51 +01002553 const struct cfg80211_chan_def *chandef)
Johannes Berg683b6d32012-11-08 21:25:48 +01002554{
Johannes Berg601555c2014-11-27 17:26:56 +01002555 if (WARN_ON(!cfg80211_chandef_valid(chandef)))
2556 return -EINVAL;
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002557
Johannes Berg683b6d32012-11-08 21:25:48 +01002558 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
2559 chandef->chan->center_freq))
2560 return -ENOBUFS;
Johannes Berg3d9d1d62012-11-08 23:14:50 +01002561 switch (chandef->width) {
2562 case NL80211_CHAN_WIDTH_20_NOHT:
2563 case NL80211_CHAN_WIDTH_20:
2564 case NL80211_CHAN_WIDTH_40:
2565 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
2566 cfg80211_get_chandef_type(chandef)))
2567 return -ENOBUFS;
2568 break;
2569 default:
2570 break;
2571 }
2572 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
2573 return -ENOBUFS;
2574 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
2575 return -ENOBUFS;
2576 if (chandef->center_freq2 &&
2577 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
Johannes Berg683b6d32012-11-08 21:25:48 +01002578 return -ENOBUFS;
2579 return 0;
2580}
2581
Eric W. Biederman15e47302012-09-07 20:12:54 +00002582static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
Johannes Bergd7264052009-04-19 16:23:20 +02002583 struct cfg80211_registered_device *rdev,
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02002584 struct wireless_dev *wdev, bool removal)
Johannes Berg55682962007-09-20 13:09:35 -04002585{
Johannes Berg72fb2ab2012-06-15 17:52:47 +02002586 struct net_device *dev = wdev->netdev;
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02002587 u8 cmd = NL80211_CMD_NEW_INTERFACE;
Johannes Berg55682962007-09-20 13:09:35 -04002588 void *hdr;
2589
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02002590 if (removal)
2591 cmd = NL80211_CMD_DEL_INTERFACE;
2592
2593 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
Johannes Berg55682962007-09-20 13:09:35 -04002594 if (!hdr)
2595 return -1;
2596
Johannes Berg72fb2ab2012-06-15 17:52:47 +02002597 if (dev &&
2598 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
Johannes Berg98104fde2012-06-16 00:19:54 +02002599 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
Johannes Berg72fb2ab2012-06-15 17:52:47 +02002600 goto nla_put_failure;
2601
2602 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
2603 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02002604 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
2605 NL80211_ATTR_PAD) ||
Johannes Berg98104fde2012-06-16 00:19:54 +02002606 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
David S. Miller9360ffd2012-03-29 04:41:26 -04002607 nla_put_u32(msg, NL80211_ATTR_GENERATION,
2608 rdev->devlist_generation ^
2609 (cfg80211_rdev_list_generation << 2)))
2610 goto nla_put_failure;
Johannes Bergf5ea9122009-08-07 16:17:38 +02002611
Johannes Berg5b7ccaf2012-07-12 19:45:08 +02002612 if (rdev->ops->get_channel) {
Johannes Berg683b6d32012-11-08 21:25:48 +01002613 int ret;
2614 struct cfg80211_chan_def chandef;
Johannes Berg5b7ccaf2012-07-12 19:45:08 +02002615
Johannes Berg683b6d32012-11-08 21:25:48 +01002616 ret = rdev_get_channel(rdev, wdev, &chandef);
2617 if (ret == 0) {
2618 if (nl80211_send_chandef(msg, &chandef))
2619 goto nla_put_failure;
2620 }
Pontus Fuchsd91df0e2012-04-03 16:39:58 +02002621 }
2622
Rafał Miłeckid55d0d52015-08-31 22:59:38 +02002623 if (rdev->ops->get_tx_power) {
2624 int dbm, ret;
2625
2626 ret = rdev_get_tx_power(rdev, wdev, &dbm);
2627 if (ret == 0 &&
2628 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
2629 DBM_TO_MBM(dbm)))
2630 goto nla_put_failure;
2631 }
2632
Johannes Berg44905262017-10-17 21:56:01 +02002633 wdev_lock(wdev);
2634 switch (wdev->iftype) {
2635 case NL80211_IFTYPE_AP:
2636 if (wdev->ssid_len &&
2637 nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
Johannes Berg4564b182017-12-11 12:33:47 +01002638 goto nla_put_failure_locked;
Johannes Berg44905262017-10-17 21:56:01 +02002639 break;
2640 case NL80211_IFTYPE_STATION:
2641 case NL80211_IFTYPE_P2P_CLIENT:
2642 case NL80211_IFTYPE_ADHOC: {
2643 const u8 *ssid_ie;
2644 if (!wdev->current_bss)
2645 break;
Dominik Brodowski7a94b8c2018-01-15 08:12:15 +01002646 rcu_read_lock();
Johannes Berg44905262017-10-17 21:56:01 +02002647 ssid_ie = ieee80211_bss_get_ie(&wdev->current_bss->pub,
2648 WLAN_EID_SSID);
Dominik Brodowski7a94b8c2018-01-15 08:12:15 +01002649 if (ssid_ie &&
2650 nla_put(msg, NL80211_ATTR_SSID, ssid_ie[1], ssid_ie + 2))
2651 goto nla_put_failure_rcu_locked;
2652 rcu_read_unlock();
Johannes Berg44905262017-10-17 21:56:01 +02002653 break;
2654 }
2655 default:
2656 /* nothing */
2657 break;
Antonio Quartullib84e7a02012-11-07 12:52:20 +01002658 }
Johannes Berg44905262017-10-17 21:56:01 +02002659 wdev_unlock(wdev);
Antonio Quartullib84e7a02012-11-07 12:52:20 +01002660
Johannes Berg053c0952015-01-16 22:09:00 +01002661 genlmsg_end(msg, hdr);
2662 return 0;
Johannes Berg55682962007-09-20 13:09:35 -04002663
Dominik Brodowski7a94b8c2018-01-15 08:12:15 +01002664 nla_put_failure_rcu_locked:
2665 rcu_read_unlock();
Johannes Berg4564b182017-12-11 12:33:47 +01002666 nla_put_failure_locked:
2667 wdev_unlock(wdev);
Johannes Berg55682962007-09-20 13:09:35 -04002668 nla_put_failure:
Thomas Grafbc3ed282008-06-03 16:36:54 -07002669 genlmsg_cancel(msg, hdr);
2670 return -EMSGSIZE;
Johannes Berg55682962007-09-20 13:09:35 -04002671}
2672
2673static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
2674{
2675 int wp_idx = 0;
2676 int if_idx = 0;
2677 int wp_start = cb->args[0];
2678 int if_start = cb->args[1];
Denis Kenziorb7fb44d2016-08-03 17:02:15 -05002679 int filter_wiphy = -1;
Johannes Bergf5ea9122009-08-07 16:17:38 +02002680 struct cfg80211_registered_device *rdev;
Johannes Berg55682962007-09-20 13:09:35 -04002681 struct wireless_dev *wdev;
Johannes Bergea90e0d2017-03-15 14:26:04 +01002682 int ret;
Johannes Berg55682962007-09-20 13:09:35 -04002683
Johannes Berg5fe231e2013-05-08 21:45:15 +02002684 rtnl_lock();
Denis Kenziorb7fb44d2016-08-03 17:02:15 -05002685 if (!cb->args[2]) {
2686 struct nl80211_dump_wiphy_state state = {
2687 .filter_wiphy = -1,
2688 };
Denis Kenziorb7fb44d2016-08-03 17:02:15 -05002689
2690 ret = nl80211_dump_wiphy_parse(skb, cb, &state);
2691 if (ret)
Johannes Bergea90e0d2017-03-15 14:26:04 +01002692 goto out_unlock;
Denis Kenziorb7fb44d2016-08-03 17:02:15 -05002693
2694 filter_wiphy = state.filter_wiphy;
2695
2696 /*
2697 * if filtering, set cb->args[2] to +1 since 0 is the default
2698 * value needed to determine that parsing is necessary.
2699 */
2700 if (filter_wiphy >= 0)
2701 cb->args[2] = filter_wiphy + 1;
2702 else
2703 cb->args[2] = -1;
2704 } else if (cb->args[2] > 0) {
2705 filter_wiphy = cb->args[2] - 1;
2706 }
2707
Johannes Bergf5ea9122009-08-07 16:17:38 +02002708 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2709 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
Johannes Berg463d0182009-07-14 00:33:35 +02002710 continue;
Johannes Bergbba95fe2008-07-29 13:22:51 +02002711 if (wp_idx < wp_start) {
2712 wp_idx++;
Johannes Berg55682962007-09-20 13:09:35 -04002713 continue;
Johannes Bergbba95fe2008-07-29 13:22:51 +02002714 }
Denis Kenziorb7fb44d2016-08-03 17:02:15 -05002715
2716 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
2717 continue;
2718
Johannes Berg55682962007-09-20 13:09:35 -04002719 if_idx = 0;
2720
Johannes Berg53873f12016-05-03 16:52:04 +03002721 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
Johannes Bergbba95fe2008-07-29 13:22:51 +02002722 if (if_idx < if_start) {
2723 if_idx++;
Johannes Berg55682962007-09-20 13:09:35 -04002724 continue;
Johannes Bergbba95fe2008-07-29 13:22:51 +02002725 }
Eric W. Biederman15e47302012-09-07 20:12:54 +00002726 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
Johannes Berg55682962007-09-20 13:09:35 -04002727 cb->nlh->nlmsg_seq, NLM_F_MULTI,
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02002728 rdev, wdev, false) < 0) {
Johannes Bergbba95fe2008-07-29 13:22:51 +02002729 goto out;
2730 }
2731 if_idx++;
Johannes Berg55682962007-09-20 13:09:35 -04002732 }
Johannes Bergbba95fe2008-07-29 13:22:51 +02002733
2734 wp_idx++;
Johannes Berg55682962007-09-20 13:09:35 -04002735 }
Johannes Bergbba95fe2008-07-29 13:22:51 +02002736 out:
Johannes Berg55682962007-09-20 13:09:35 -04002737 cb->args[0] = wp_idx;
2738 cb->args[1] = if_idx;
2739
Johannes Bergea90e0d2017-03-15 14:26:04 +01002740 ret = skb->len;
2741 out_unlock:
2742 rtnl_unlock();
2743
2744 return ret;
Johannes Berg55682962007-09-20 13:09:35 -04002745}
2746
2747static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
2748{
2749 struct sk_buff *msg;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08002750 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg72fb2ab2012-06-15 17:52:47 +02002751 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg55682962007-09-20 13:09:35 -04002752
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -07002753 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg55682962007-09-20 13:09:35 -04002754 if (!msg)
Johannes Berg4c476992010-10-04 21:36:35 +02002755 return -ENOMEM;
Johannes Berg55682962007-09-20 13:09:35 -04002756
Eric W. Biederman15e47302012-09-07 20:12:54 +00002757 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02002758 rdev, wdev, false) < 0) {
Johannes Berg4c476992010-10-04 21:36:35 +02002759 nlmsg_free(msg);
2760 return -ENOBUFS;
2761 }
Johannes Berg55682962007-09-20 13:09:35 -04002762
Johannes Berg134e6372009-07-10 09:51:34 +00002763 return genlmsg_reply(msg, info);
Johannes Berg55682962007-09-20 13:09:35 -04002764}
2765
Michael Wu66f7ac52008-01-31 19:48:22 +01002766static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
2767 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
2768 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
2769 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
2770 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
2771 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
Felix Fietkaue057d3c2013-05-28 13:01:52 +02002772 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
Michael Wu66f7ac52008-01-31 19:48:22 +01002773};
2774
2775static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
2776{
2777 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
2778 int flag;
2779
2780 *mntrflags = 0;
2781
2782 if (!nla)
2783 return -EINVAL;
2784
Johannes Bergfceb6432017-04-12 14:34:07 +02002785 if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX, nla,
2786 mntr_flags_policy, NULL))
Michael Wu66f7ac52008-01-31 19:48:22 +01002787 return -EINVAL;
2788
2789 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
2790 if (flags[flag])
2791 *mntrflags |= (1<<flag);
2792
Johannes Berg818a9862017-04-12 11:23:28 +02002793 *mntrflags |= MONITOR_FLAG_CHANGED;
2794
Michael Wu66f7ac52008-01-31 19:48:22 +01002795 return 0;
2796}
2797
Johannes Berg1db77592017-04-12 11:36:31 +02002798static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
2799 enum nl80211_iftype type,
2800 struct genl_info *info,
2801 struct vif_params *params)
2802{
2803 bool change = false;
2804 int err;
2805
2806 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
2807 if (type != NL80211_IFTYPE_MONITOR)
2808 return -EINVAL;
2809
2810 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
2811 &params->flags);
2812 if (err)
2813 return err;
2814
2815 change = true;
2816 }
2817
2818 if (params->flags & MONITOR_FLAG_ACTIVE &&
2819 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
2820 return -EOPNOTSUPP;
2821
2822 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
2823 const u8 *mumimo_groups;
2824 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2825
2826 if (type != NL80211_IFTYPE_MONITOR)
2827 return -EINVAL;
2828
2829 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2830 return -EOPNOTSUPP;
2831
2832 mumimo_groups =
2833 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
2834
2835 /* bits 0 and 63 are reserved and must be zero */
Johannes Berg49546012017-04-27 09:13:38 +02002836 if ((mumimo_groups[0] & BIT(0)) ||
2837 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7)))
Johannes Berg1db77592017-04-12 11:36:31 +02002838 return -EINVAL;
2839
2840 params->vht_mumimo_groups = mumimo_groups;
2841 change = true;
2842 }
2843
2844 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
2845 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2846
2847 if (type != NL80211_IFTYPE_MONITOR)
2848 return -EINVAL;
2849
2850 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2851 return -EOPNOTSUPP;
2852
2853 params->vht_mumimo_follow_addr =
2854 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
2855 change = true;
2856 }
2857
2858 return change ? 1 : 0;
2859}
2860
Johannes Berg9bc383d2009-11-19 11:55:19 +01002861static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002862 struct net_device *netdev, u8 use_4addr,
2863 enum nl80211_iftype iftype)
Johannes Berg9bc383d2009-11-19 11:55:19 +01002864{
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002865 if (!use_4addr) {
Jiri Pirkof350a0a82010-06-15 06:50:45 +00002866 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002867 return -EBUSY;
Johannes Berg9bc383d2009-11-19 11:55:19 +01002868 return 0;
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002869 }
Johannes Berg9bc383d2009-11-19 11:55:19 +01002870
2871 switch (iftype) {
2872 case NL80211_IFTYPE_AP_VLAN:
2873 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
2874 return 0;
2875 break;
2876 case NL80211_IFTYPE_STATION:
2877 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
2878 return 0;
2879 break;
2880 default:
2881 break;
2882 }
2883
2884 return -EOPNOTSUPP;
2885}
2886
Johannes Berg55682962007-09-20 13:09:35 -04002887static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
2888{
Johannes Berg4c476992010-10-04 21:36:35 +02002889 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01002890 struct vif_params params;
Johannes Berge36d56b2009-06-09 21:04:43 +02002891 int err;
Johannes Berg04a773a2009-04-19 21:24:32 +02002892 enum nl80211_iftype otype, ntype;
Johannes Berg4c476992010-10-04 21:36:35 +02002893 struct net_device *dev = info->user_ptr[1];
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002894 bool change = false;
Johannes Berg55682962007-09-20 13:09:35 -04002895
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01002896 memset(&params, 0, sizeof(params));
2897
Johannes Berg04a773a2009-04-19 21:24:32 +02002898 otype = ntype = dev->ieee80211_ptr->iftype;
Johannes Berg55682962007-09-20 13:09:35 -04002899
Johannes Berg723b0382008-09-16 20:22:09 +02002900 if (info->attrs[NL80211_ATTR_IFTYPE]) {
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002901 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
Johannes Berg04a773a2009-04-19 21:24:32 +02002902 if (otype != ntype)
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002903 change = true;
Johannes Berg4c476992010-10-04 21:36:35 +02002904 if (ntype > NL80211_IFTYPE_MAX)
2905 return -EINVAL;
Johannes Berg723b0382008-09-16 20:22:09 +02002906 }
2907
Johannes Berg92ffe052008-09-16 20:39:36 +02002908 if (info->attrs[NL80211_ATTR_MESH_ID]) {
Johannes Berg29cbe682010-12-03 09:20:44 +01002909 struct wireless_dev *wdev = dev->ieee80211_ptr;
2910
Johannes Berg4c476992010-10-04 21:36:35 +02002911 if (ntype != NL80211_IFTYPE_MESH_POINT)
2912 return -EINVAL;
Johannes Berg29cbe682010-12-03 09:20:44 +01002913 if (netif_running(dev))
2914 return -EBUSY;
2915
2916 wdev_lock(wdev);
2917 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2918 IEEE80211_MAX_MESH_ID_LEN);
2919 wdev->mesh_id_up_len =
2920 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2921 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2922 wdev->mesh_id_up_len);
2923 wdev_unlock(wdev);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01002924 }
2925
Felix Fietkau8b787642009-11-10 18:53:10 +01002926 if (info->attrs[NL80211_ATTR_4ADDR]) {
2927 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2928 change = true;
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002929 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
Johannes Berg9bc383d2009-11-19 11:55:19 +01002930 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02002931 return err;
Felix Fietkau8b787642009-11-10 18:53:10 +01002932 } else {
2933 params.use_4addr = -1;
2934 }
2935
Johannes Berg1db77592017-04-12 11:36:31 +02002936 err = nl80211_parse_mon_options(rdev, ntype, info, &params);
2937 if (err < 0)
2938 return err;
2939 if (err > 0)
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002940 change = true;
Felix Fietkaue057d3c2013-05-28 13:01:52 +02002941
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002942 if (change)
Johannes Berg818a9862017-04-12 11:23:28 +02002943 err = cfg80211_change_iface(rdev, dev, ntype, &params);
Johannes Bergac7f9cf2009-03-21 17:07:59 +01002944 else
2945 err = 0;
Johannes Berg60719ff2008-09-16 14:55:09 +02002946
Johannes Berg9bc383d2009-11-19 11:55:19 +01002947 if (!err && params.use_4addr != -1)
2948 dev->ieee80211_ptr->use_4addr = params.use_4addr;
2949
Johannes Berg55682962007-09-20 13:09:35 -04002950 return err;
2951}
2952
2953static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
2954{
Johannes Berg4c476992010-10-04 21:36:35 +02002955 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01002956 struct vif_params params;
Johannes Berg84efbb82012-06-16 00:00:26 +02002957 struct wireless_dev *wdev;
Denis Kenzior896ff062016-08-03 16:58:33 -05002958 struct sk_buff *msg;
Johannes Berg55682962007-09-20 13:09:35 -04002959 int err;
2960 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
2961
Johannes Berg78f22b62014-03-24 17:57:27 +01002962 /* to avoid failing a new interface creation due to pending removal */
2963 cfg80211_destroy_ifaces(rdev);
2964
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01002965 memset(&params, 0, sizeof(params));
2966
Johannes Berg55682962007-09-20 13:09:35 -04002967 if (!info->attrs[NL80211_ATTR_IFNAME])
2968 return -EINVAL;
2969
2970 if (info->attrs[NL80211_ATTR_IFTYPE]) {
2971 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2972 if (type > NL80211_IFTYPE_MAX)
2973 return -EINVAL;
2974 }
2975
Johannes Berg79c97e92009-07-07 03:56:12 +02002976 if (!rdev->ops->add_virtual_intf ||
Johannes Berg4c476992010-10-04 21:36:35 +02002977 !(rdev->wiphy.interface_modes & (1 << type)))
2978 return -EOPNOTSUPP;
Johannes Berg55682962007-09-20 13:09:35 -04002979
Ayala Bekercb3b7d82016-09-20 17:31:13 +03002980 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
Ben Greeare8f479b2014-10-22 12:23:05 -07002981 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
2982 info->attrs[NL80211_ATTR_MAC]) {
Arend van Spriel1c18f142013-01-08 10:17:27 +01002983 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
2984 ETH_ALEN);
2985 if (!is_valid_ether_addr(params.macaddr))
2986 return -EADDRNOTAVAIL;
2987 }
2988
Johannes Berg9bc383d2009-11-19 11:55:19 +01002989 if (info->attrs[NL80211_ATTR_4ADDR]) {
Felix Fietkau8b787642009-11-10 18:53:10 +01002990 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
Johannes Bergad4bb6f2009-11-19 00:56:30 +01002991 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
Johannes Berg9bc383d2009-11-19 11:55:19 +01002992 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02002993 return err;
Johannes Berg9bc383d2009-11-19 11:55:19 +01002994 }
Felix Fietkau8b787642009-11-10 18:53:10 +01002995
Johannes Berg1db77592017-04-12 11:36:31 +02002996 err = nl80211_parse_mon_options(rdev, type, info, &params);
2997 if (err < 0)
2998 return err;
Felix Fietkaue057d3c2013-05-28 13:01:52 +02002999
Johannes Berga18c7192015-02-24 10:56:42 +01003000 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3001 if (!msg)
3002 return -ENOMEM;
3003
Hila Gonene35e4d22012-06-27 17:19:42 +03003004 wdev = rdev_add_virtual_intf(rdev,
3005 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
Johannes Berg818a9862017-04-12 11:23:28 +02003006 NET_NAME_USER, type, &params);
Rafał Miłeckid687cbb2014-11-14 18:43:28 +01003007 if (WARN_ON(!wdev)) {
3008 nlmsg_free(msg);
3009 return -EPROTO;
3010 } else if (IS_ERR(wdev)) {
Johannes Berg1c90f9d2012-06-16 00:05:37 +02003011 nlmsg_free(msg);
Johannes Berg84efbb82012-06-16 00:00:26 +02003012 return PTR_ERR(wdev);
Johannes Berg1c90f9d2012-06-16 00:05:37 +02003013 }
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01003014
Jukka Rissanen18e5ca62014-11-13 17:25:14 +02003015 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
Johannes Berg78f22b62014-03-24 17:57:27 +01003016 wdev->owner_nlportid = info->snd_portid;
3017
Johannes Berg98104fde2012-06-16 00:19:54 +02003018 switch (type) {
3019 case NL80211_IFTYPE_MESH_POINT:
3020 if (!info->attrs[NL80211_ATTR_MESH_ID])
3021 break;
Johannes Berg29cbe682010-12-03 09:20:44 +01003022 wdev_lock(wdev);
3023 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
3024 IEEE80211_MAX_MESH_ID_LEN);
3025 wdev->mesh_id_up_len =
3026 nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
3027 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
3028 wdev->mesh_id_up_len);
3029 wdev_unlock(wdev);
Johannes Berg98104fde2012-06-16 00:19:54 +02003030 break;
Ayala Bekercb3b7d82016-09-20 17:31:13 +03003031 case NL80211_IFTYPE_NAN:
Johannes Berg98104fde2012-06-16 00:19:54 +02003032 case NL80211_IFTYPE_P2P_DEVICE:
3033 /*
Ayala Bekercb3b7d82016-09-20 17:31:13 +03003034 * P2P Device and NAN do not have a netdev, so don't go
Johannes Berg98104fde2012-06-16 00:19:54 +02003035 * through the netdev notifier and must be added here
3036 */
3037 mutex_init(&wdev->mtx);
3038 INIT_LIST_HEAD(&wdev->event_list);
3039 spin_lock_init(&wdev->event_lock);
3040 INIT_LIST_HEAD(&wdev->mgmt_registrations);
3041 spin_lock_init(&wdev->mgmt_registrations_lock);
3042
Johannes Berg98104fde2012-06-16 00:19:54 +02003043 wdev->identifier = ++rdev->wdev_id;
Johannes Berg53873f12016-05-03 16:52:04 +03003044 list_add_rcu(&wdev->list, &rdev->wiphy.wdev_list);
Johannes Berg98104fde2012-06-16 00:19:54 +02003045 rdev->devlist_generation++;
Johannes Berg98104fde2012-06-16 00:19:54 +02003046 break;
3047 default:
3048 break;
Johannes Berg29cbe682010-12-03 09:20:44 +01003049 }
3050
Eric W. Biederman15e47302012-09-07 20:12:54 +00003051 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02003052 rdev, wdev, false) < 0) {
Johannes Berg1c90f9d2012-06-16 00:05:37 +02003053 nlmsg_free(msg);
3054 return -ENOBUFS;
3055 }
3056
Denis Kenzior896ff062016-08-03 16:58:33 -05003057 /*
3058 * For wdevs which have no associated netdev object (e.g. of type
3059 * NL80211_IFTYPE_P2P_DEVICE), emit the NEW_INTERFACE event here.
3060 * For all other types, the event will be generated from the
3061 * netdev notifier
3062 */
3063 if (!wdev->netdev)
3064 nl80211_notify_iface(rdev, wdev, NL80211_CMD_NEW_INTERFACE);
Tomasz Bursztyka8f894be2014-11-12 16:26:45 +02003065
Johannes Berg1c90f9d2012-06-16 00:05:37 +02003066 return genlmsg_reply(msg, info);
Johannes Berg55682962007-09-20 13:09:35 -04003067}
3068
3069static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
3070{
Johannes Berg4c476992010-10-04 21:36:35 +02003071 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg84efbb82012-06-16 00:00:26 +02003072 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg55682962007-09-20 13:09:35 -04003073
Johannes Berg4c476992010-10-04 21:36:35 +02003074 if (!rdev->ops->del_virtual_intf)
3075 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01003076
Johannes Berg84efbb82012-06-16 00:00:26 +02003077 /*
3078 * If we remove a wireless device without a netdev then clear
3079 * user_ptr[1] so that nl80211_post_doit won't dereference it
3080 * to check if it needs to do dev_put(). Otherwise it crashes
3081 * since the wdev has been freed, unlike with a netdev where
3082 * we need the dev_put() for the netdev to really be freed.
3083 */
3084 if (!wdev->netdev)
3085 info->user_ptr[1] = NULL;
3086
Denis Kenzior7f8ed012016-08-03 16:58:35 -05003087 return rdev_del_virtual_intf(rdev, wdev);
Johannes Berg55682962007-09-20 13:09:35 -04003088}
3089
Simon Wunderlich1d9d9212011-11-18 14:20:43 +01003090static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
3091{
3092 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3093 struct net_device *dev = info->user_ptr[1];
3094 u16 noack_map;
3095
3096 if (!info->attrs[NL80211_ATTR_NOACK_MAP])
3097 return -EINVAL;
3098
3099 if (!rdev->ops->set_noack_map)
3100 return -EOPNOTSUPP;
3101
3102 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
3103
Hila Gonene35e4d22012-06-27 17:19:42 +03003104 return rdev_set_noack_map(rdev, dev, noack_map);
Simon Wunderlich1d9d9212011-11-18 14:20:43 +01003105}
3106
Johannes Berg41ade002007-12-19 02:03:29 +01003107struct get_key_cookie {
3108 struct sk_buff *msg;
3109 int error;
Johannes Bergb9454e82009-07-08 13:29:08 +02003110 int idx;
Johannes Berg41ade002007-12-19 02:03:29 +01003111};
3112
3113static void get_key_callback(void *c, struct key_params *params)
3114{
Johannes Bergb9454e82009-07-08 13:29:08 +02003115 struct nlattr *key;
Johannes Berg41ade002007-12-19 02:03:29 +01003116 struct get_key_cookie *cookie = c;
3117
David S. Miller9360ffd2012-03-29 04:41:26 -04003118 if ((params->key &&
3119 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
3120 params->key_len, params->key)) ||
3121 (params->seq &&
3122 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
3123 params->seq_len, params->seq)) ||
3124 (params->cipher &&
3125 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
3126 params->cipher)))
3127 goto nla_put_failure;
Johannes Berg41ade002007-12-19 02:03:29 +01003128
Johannes Bergb9454e82009-07-08 13:29:08 +02003129 key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
3130 if (!key)
3131 goto nla_put_failure;
3132
David S. Miller9360ffd2012-03-29 04:41:26 -04003133 if ((params->key &&
3134 nla_put(cookie->msg, NL80211_KEY_DATA,
3135 params->key_len, params->key)) ||
3136 (params->seq &&
3137 nla_put(cookie->msg, NL80211_KEY_SEQ,
3138 params->seq_len, params->seq)) ||
3139 (params->cipher &&
3140 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
3141 params->cipher)))
3142 goto nla_put_failure;
Johannes Bergb9454e82009-07-08 13:29:08 +02003143
David S. Miller9360ffd2012-03-29 04:41:26 -04003144 if (nla_put_u8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx))
3145 goto nla_put_failure;
Johannes Bergb9454e82009-07-08 13:29:08 +02003146
3147 nla_nest_end(cookie->msg, key);
3148
Johannes Berg41ade002007-12-19 02:03:29 +01003149 return;
3150 nla_put_failure:
3151 cookie->error = 1;
3152}
3153
3154static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
3155{
Johannes Berg4c476992010-10-04 21:36:35 +02003156 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg41ade002007-12-19 02:03:29 +01003157 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02003158 struct net_device *dev = info->user_ptr[1];
Johannes Berg41ade002007-12-19 02:03:29 +01003159 u8 key_idx = 0;
Johannes Berge31b8212010-10-05 19:39:30 +02003160 const u8 *mac_addr = NULL;
3161 bool pairwise;
Johannes Berg41ade002007-12-19 02:03:29 +01003162 struct get_key_cookie cookie = {
3163 .error = 0,
3164 };
3165 void *hdr;
3166 struct sk_buff *msg;
3167
3168 if (info->attrs[NL80211_ATTR_KEY_IDX])
3169 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
3170
Jouni Malinen3cfcf6ac2009-01-08 13:32:02 +02003171 if (key_idx > 5)
Johannes Berg41ade002007-12-19 02:03:29 +01003172 return -EINVAL;
3173
3174 if (info->attrs[NL80211_ATTR_MAC])
3175 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3176
Johannes Berge31b8212010-10-05 19:39:30 +02003177 pairwise = !!mac_addr;
3178 if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
3179 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07003180
Johannes Berge31b8212010-10-05 19:39:30 +02003181 if (kt >= NUM_NL80211_KEYTYPES)
3182 return -EINVAL;
3183 if (kt != NL80211_KEYTYPE_GROUP &&
3184 kt != NL80211_KEYTYPE_PAIRWISE)
3185 return -EINVAL;
3186 pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
3187 }
3188
Johannes Berg4c476992010-10-04 21:36:35 +02003189 if (!rdev->ops->get_key)
3190 return -EOPNOTSUPP;
Johannes Berg41ade002007-12-19 02:03:29 +01003191
Johannes Berg0fa7b392015-01-23 11:10:12 +01003192 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3193 return -ENOENT;
3194
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -07003195 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg4c476992010-10-04 21:36:35 +02003196 if (!msg)
3197 return -ENOMEM;
Johannes Berg41ade002007-12-19 02:03:29 +01003198
Eric W. Biederman15e47302012-09-07 20:12:54 +00003199 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Johannes Berg41ade002007-12-19 02:03:29 +01003200 NL80211_CMD_NEW_KEY);
Dan Carpentercb35fba2013-08-14 14:50:01 +03003201 if (!hdr)
Johannes Berg9fe271a2013-10-25 11:15:12 +02003202 goto nla_put_failure;
Johannes Berg41ade002007-12-19 02:03:29 +01003203
3204 cookie.msg = msg;
Johannes Bergb9454e82009-07-08 13:29:08 +02003205 cookie.idx = key_idx;
Johannes Berg41ade002007-12-19 02:03:29 +01003206
David S. Miller9360ffd2012-03-29 04:41:26 -04003207 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3208 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
3209 goto nla_put_failure;
3210 if (mac_addr &&
3211 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
3212 goto nla_put_failure;
Johannes Berg41ade002007-12-19 02:03:29 +01003213
Hila Gonene35e4d22012-06-27 17:19:42 +03003214 err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
3215 get_key_callback);
Johannes Berg41ade002007-12-19 02:03:29 +01003216
3217 if (err)
Niko Jokinen6c95e2a2009-07-15 11:00:53 +03003218 goto free_msg;
Johannes Berg41ade002007-12-19 02:03:29 +01003219
3220 if (cookie.error)
3221 goto nla_put_failure;
3222
3223 genlmsg_end(msg, hdr);
Johannes Berg4c476992010-10-04 21:36:35 +02003224 return genlmsg_reply(msg, info);
Johannes Berg41ade002007-12-19 02:03:29 +01003225
3226 nla_put_failure:
3227 err = -ENOBUFS;
Niko Jokinen6c95e2a2009-07-15 11:00:53 +03003228 free_msg:
Johannes Berg41ade002007-12-19 02:03:29 +01003229 nlmsg_free(msg);
Johannes Berg41ade002007-12-19 02:03:29 +01003230 return err;
3231}
3232
3233static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
3234{
Johannes Berg4c476992010-10-04 21:36:35 +02003235 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Bergb9454e82009-07-08 13:29:08 +02003236 struct key_parse key;
Johannes Berg41ade002007-12-19 02:03:29 +01003237 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02003238 struct net_device *dev = info->user_ptr[1];
Johannes Berg41ade002007-12-19 02:03:29 +01003239
Johannes Bergb9454e82009-07-08 13:29:08 +02003240 err = nl80211_parse_key(info, &key);
3241 if (err)
3242 return err;
3243
3244 if (key.idx < 0)
Johannes Berg41ade002007-12-19 02:03:29 +01003245 return -EINVAL;
3246
Johannes Bergb9454e82009-07-08 13:29:08 +02003247 /* only support setting default key */
3248 if (!key.def && !key.defmgmt)
Johannes Berg41ade002007-12-19 02:03:29 +01003249 return -EINVAL;
3250
Johannes Bergfffd0932009-07-08 14:22:54 +02003251 wdev_lock(dev->ieee80211_ptr);
Johannes Bergdbd2fd62010-12-09 19:58:59 +01003252
3253 if (key.def) {
3254 if (!rdev->ops->set_default_key) {
3255 err = -EOPNOTSUPP;
3256 goto out;
3257 }
3258
3259 err = nl80211_key_allowed(dev->ieee80211_ptr);
3260 if (err)
3261 goto out;
3262
Hila Gonene35e4d22012-06-27 17:19:42 +03003263 err = rdev_set_default_key(rdev, dev, key.idx,
Johannes Bergdbd2fd62010-12-09 19:58:59 +01003264 key.def_uni, key.def_multi);
3265
3266 if (err)
3267 goto out;
Johannes Bergfffd0932009-07-08 14:22:54 +02003268
Johannes Berg3d23e342009-09-29 23:27:28 +02003269#ifdef CONFIG_CFG80211_WEXT
Johannes Bergdbd2fd62010-12-09 19:58:59 +01003270 dev->ieee80211_ptr->wext.default_key = key.idx;
Johannes Berg08645122009-05-11 13:54:58 +02003271#endif
Johannes Bergdbd2fd62010-12-09 19:58:59 +01003272 } else {
3273 if (key.def_uni || !key.def_multi) {
3274 err = -EINVAL;
3275 goto out;
3276 }
3277
3278 if (!rdev->ops->set_default_mgmt_key) {
3279 err = -EOPNOTSUPP;
3280 goto out;
3281 }
3282
3283 err = nl80211_key_allowed(dev->ieee80211_ptr);
3284 if (err)
3285 goto out;
3286
Hila Gonene35e4d22012-06-27 17:19:42 +03003287 err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
Johannes Bergdbd2fd62010-12-09 19:58:59 +01003288 if (err)
3289 goto out;
3290
3291#ifdef CONFIG_CFG80211_WEXT
3292 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
3293#endif
3294 }
3295
3296 out:
Johannes Bergfffd0932009-07-08 14:22:54 +02003297 wdev_unlock(dev->ieee80211_ptr);
Johannes Berg41ade002007-12-19 02:03:29 +01003298
Johannes Berg41ade002007-12-19 02:03:29 +01003299 return err;
3300}
3301
3302static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
3303{
Johannes Berg4c476992010-10-04 21:36:35 +02003304 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Bergfffd0932009-07-08 14:22:54 +02003305 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02003306 struct net_device *dev = info->user_ptr[1];
Johannes Bergb9454e82009-07-08 13:29:08 +02003307 struct key_parse key;
Johannes Berge31b8212010-10-05 19:39:30 +02003308 const u8 *mac_addr = NULL;
Johannes Berg41ade002007-12-19 02:03:29 +01003309
Johannes Bergb9454e82009-07-08 13:29:08 +02003310 err = nl80211_parse_key(info, &key);
3311 if (err)
3312 return err;
Johannes Berg41ade002007-12-19 02:03:29 +01003313
Johannes Bergb9454e82009-07-08 13:29:08 +02003314 if (!key.p.key)
Johannes Berg41ade002007-12-19 02:03:29 +01003315 return -EINVAL;
3316
Johannes Berg41ade002007-12-19 02:03:29 +01003317 if (info->attrs[NL80211_ATTR_MAC])
3318 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3319
Johannes Berge31b8212010-10-05 19:39:30 +02003320 if (key.type == -1) {
3321 if (mac_addr)
3322 key.type = NL80211_KEYTYPE_PAIRWISE;
3323 else
3324 key.type = NL80211_KEYTYPE_GROUP;
3325 }
3326
3327 /* for now */
3328 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3329 key.type != NL80211_KEYTYPE_GROUP)
3330 return -EINVAL;
3331
Johannes Berg4c476992010-10-04 21:36:35 +02003332 if (!rdev->ops->add_key)
3333 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01003334
Johannes Berge31b8212010-10-05 19:39:30 +02003335 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
3336 key.type == NL80211_KEYTYPE_PAIRWISE,
3337 mac_addr))
Johannes Berg4c476992010-10-04 21:36:35 +02003338 return -EINVAL;
Johannes Bergfffd0932009-07-08 14:22:54 +02003339
3340 wdev_lock(dev->ieee80211_ptr);
3341 err = nl80211_key_allowed(dev->ieee80211_ptr);
3342 if (!err)
Hila Gonene35e4d22012-06-27 17:19:42 +03003343 err = rdev_add_key(rdev, dev, key.idx,
3344 key.type == NL80211_KEYTYPE_PAIRWISE,
3345 mac_addr, &key.p);
Johannes Bergfffd0932009-07-08 14:22:54 +02003346 wdev_unlock(dev->ieee80211_ptr);
Johannes Berg41ade002007-12-19 02:03:29 +01003347
Johannes Berg41ade002007-12-19 02:03:29 +01003348 return err;
3349}
3350
3351static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
3352{
Johannes Berg4c476992010-10-04 21:36:35 +02003353 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg41ade002007-12-19 02:03:29 +01003354 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02003355 struct net_device *dev = info->user_ptr[1];
Johannes Berg41ade002007-12-19 02:03:29 +01003356 u8 *mac_addr = NULL;
Johannes Bergb9454e82009-07-08 13:29:08 +02003357 struct key_parse key;
Johannes Berg41ade002007-12-19 02:03:29 +01003358
Johannes Bergb9454e82009-07-08 13:29:08 +02003359 err = nl80211_parse_key(info, &key);
3360 if (err)
3361 return err;
Johannes Berg41ade002007-12-19 02:03:29 +01003362
3363 if (info->attrs[NL80211_ATTR_MAC])
3364 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3365
Johannes Berge31b8212010-10-05 19:39:30 +02003366 if (key.type == -1) {
3367 if (mac_addr)
3368 key.type = NL80211_KEYTYPE_PAIRWISE;
3369 else
3370 key.type = NL80211_KEYTYPE_GROUP;
3371 }
3372
3373 /* for now */
3374 if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3375 key.type != NL80211_KEYTYPE_GROUP)
3376 return -EINVAL;
3377
Johannes Berg4c476992010-10-04 21:36:35 +02003378 if (!rdev->ops->del_key)
3379 return -EOPNOTSUPP;
Johannes Berg41ade002007-12-19 02:03:29 +01003380
Johannes Bergfffd0932009-07-08 14:22:54 +02003381 wdev_lock(dev->ieee80211_ptr);
3382 err = nl80211_key_allowed(dev->ieee80211_ptr);
Johannes Berge31b8212010-10-05 19:39:30 +02003383
Johannes Berg0fa7b392015-01-23 11:10:12 +01003384 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
Johannes Berge31b8212010-10-05 19:39:30 +02003385 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3386 err = -ENOENT;
3387
Johannes Bergfffd0932009-07-08 14:22:54 +02003388 if (!err)
Hila Gonene35e4d22012-06-27 17:19:42 +03003389 err = rdev_del_key(rdev, dev, key.idx,
3390 key.type == NL80211_KEYTYPE_PAIRWISE,
3391 mac_addr);
Johannes Berg41ade002007-12-19 02:03:29 +01003392
Johannes Berg3d23e342009-09-29 23:27:28 +02003393#ifdef CONFIG_CFG80211_WEXT
Johannes Berg08645122009-05-11 13:54:58 +02003394 if (!err) {
Johannes Bergb9454e82009-07-08 13:29:08 +02003395 if (key.idx == dev->ieee80211_ptr->wext.default_key)
Johannes Berg08645122009-05-11 13:54:58 +02003396 dev->ieee80211_ptr->wext.default_key = -1;
Johannes Bergb9454e82009-07-08 13:29:08 +02003397 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
Johannes Berg08645122009-05-11 13:54:58 +02003398 dev->ieee80211_ptr->wext.default_mgmt_key = -1;
3399 }
3400#endif
Johannes Bergfffd0932009-07-08 14:22:54 +02003401 wdev_unlock(dev->ieee80211_ptr);
Johannes Berg08645122009-05-11 13:54:58 +02003402
Johannes Berg41ade002007-12-19 02:03:29 +01003403 return err;
3404}
3405
Vasanthakumar Thiagarajan77765ea2013-01-18 11:18:45 +05303406/* This function returns an error or the number of nested attributes */
3407static int validate_acl_mac_addrs(struct nlattr *nl_attr)
3408{
3409 struct nlattr *attr;
3410 int n_entries = 0, tmp;
3411
3412 nla_for_each_nested(attr, nl_attr, tmp) {
3413 if (nla_len(attr) != ETH_ALEN)
3414 return -EINVAL;
3415
3416 n_entries++;
3417 }
3418
3419 return n_entries;
3420}
3421
3422/*
3423 * This function parses ACL information and allocates memory for ACL data.
3424 * On successful return, the calling function is responsible to free the
3425 * ACL buffer returned by this function.
3426 */
3427static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
3428 struct genl_info *info)
3429{
3430 enum nl80211_acl_policy acl_policy;
3431 struct nlattr *attr;
3432 struct cfg80211_acl_data *acl;
3433 int i = 0, n_entries, tmp;
3434
3435 if (!wiphy->max_acl_mac_addrs)
3436 return ERR_PTR(-EOPNOTSUPP);
3437
3438 if (!info->attrs[NL80211_ATTR_ACL_POLICY])
3439 return ERR_PTR(-EINVAL);
3440
3441 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
3442 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
3443 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
3444 return ERR_PTR(-EINVAL);
3445
3446 if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
3447 return ERR_PTR(-EINVAL);
3448
3449 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
3450 if (n_entries < 0)
3451 return ERR_PTR(n_entries);
3452
3453 if (n_entries > wiphy->max_acl_mac_addrs)
3454 return ERR_PTR(-ENOTSUPP);
3455
3456 acl = kzalloc(sizeof(*acl) + (sizeof(struct mac_address) * n_entries),
3457 GFP_KERNEL);
3458 if (!acl)
3459 return ERR_PTR(-ENOMEM);
3460
3461 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
3462 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
3463 i++;
3464 }
3465
3466 acl->n_acl_entries = n_entries;
3467 acl->acl_policy = acl_policy;
3468
3469 return acl;
3470}
3471
3472static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
3473{
3474 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3475 struct net_device *dev = info->user_ptr[1];
3476 struct cfg80211_acl_data *acl;
3477 int err;
3478
3479 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3480 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3481 return -EOPNOTSUPP;
3482
3483 if (!dev->ieee80211_ptr->beacon_interval)
3484 return -EINVAL;
3485
3486 acl = parse_acl_data(&rdev->wiphy, info);
3487 if (IS_ERR(acl))
3488 return PTR_ERR(acl);
3489
3490 err = rdev_set_mac_acl(rdev, dev, acl);
3491
3492 kfree(acl);
3493
3494 return err;
3495}
3496
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303497static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
3498 u8 *rates, u8 rates_len)
3499{
3500 u8 i;
3501 u32 mask = 0;
3502
3503 for (i = 0; i < rates_len; i++) {
3504 int rate = (rates[i] & 0x7f) * 5;
3505 int ridx;
3506
3507 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
3508 struct ieee80211_rate *srate =
3509 &sband->bitrates[ridx];
3510 if (rate == srate->bitrate) {
3511 mask |= 1 << ridx;
3512 break;
3513 }
3514 }
3515 if (ridx == sband->n_bitrates)
3516 return 0; /* rate not found */
3517 }
3518
3519 return mask;
3520}
3521
3522static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
3523 u8 *rates, u8 rates_len,
3524 u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
3525{
3526 u8 i;
3527
3528 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
3529
3530 for (i = 0; i < rates_len; i++) {
3531 int ridx, rbit;
3532
3533 ridx = rates[i] / 8;
3534 rbit = BIT(rates[i] % 8);
3535
3536 /* check validity */
3537 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
3538 return false;
3539
3540 /* check availability */
3541 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
3542 mcs[ridx] |= rbit;
3543 else
3544 return false;
3545 }
3546
3547 return true;
3548}
3549
3550static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
3551{
3552 u16 mcs_mask = 0;
3553
3554 switch (vht_mcs_map) {
3555 case IEEE80211_VHT_MCS_NOT_SUPPORTED:
3556 break;
3557 case IEEE80211_VHT_MCS_SUPPORT_0_7:
3558 mcs_mask = 0x00FF;
3559 break;
3560 case IEEE80211_VHT_MCS_SUPPORT_0_8:
3561 mcs_mask = 0x01FF;
3562 break;
3563 case IEEE80211_VHT_MCS_SUPPORT_0_9:
3564 mcs_mask = 0x03FF;
3565 break;
3566 default:
3567 break;
3568 }
3569
3570 return mcs_mask;
3571}
3572
3573static void vht_build_mcs_mask(u16 vht_mcs_map,
3574 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
3575{
3576 u8 nss;
3577
3578 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
3579 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
3580 vht_mcs_map >>= 2;
3581 }
3582}
3583
3584static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
3585 struct nl80211_txrate_vht *txrate,
3586 u16 mcs[NL80211_VHT_NSS_MAX])
3587{
3588 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3589 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
3590 u8 i;
3591
3592 if (!sband->vht_cap.vht_supported)
3593 return false;
3594
3595 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
3596
3597 /* Build vht_mcs_mask from VHT capabilities */
3598 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
3599
3600 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
3601 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
3602 mcs[i] = txrate->mcs[i];
3603 else
3604 return false;
3605 }
3606
3607 return true;
3608}
3609
3610static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
3611 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
3612 .len = NL80211_MAX_SUPP_RATES },
3613 [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
3614 .len = NL80211_MAX_SUPP_HT_RATES },
3615 [NL80211_TXRATE_VHT] = { .len = sizeof(struct nl80211_txrate_vht)},
3616 [NL80211_TXRATE_GI] = { .type = NLA_U8 },
3617};
3618
3619static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
3620 struct cfg80211_bitrate_mask *mask)
3621{
3622 struct nlattr *tb[NL80211_TXRATE_MAX + 1];
3623 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3624 int rem, i;
3625 struct nlattr *tx_rates;
3626 struct ieee80211_supported_band *sband;
3627 u16 vht_tx_mcs_map;
3628
3629 memset(mask, 0, sizeof(*mask));
3630 /* Default to all rates enabled */
3631 for (i = 0; i < NUM_NL80211_BANDS; i++) {
3632 sband = rdev->wiphy.bands[i];
3633
3634 if (!sband)
3635 continue;
3636
3637 mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
3638 memcpy(mask->control[i].ht_mcs,
3639 sband->ht_cap.mcs.rx_mask,
3640 sizeof(mask->control[i].ht_mcs));
3641
3642 if (!sband->vht_cap.vht_supported)
3643 continue;
3644
3645 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3646 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
3647 }
3648
3649 /* if no rates are given set it back to the defaults */
3650 if (!info->attrs[NL80211_ATTR_TX_RATES])
3651 goto out;
3652
3653 /* The nested attribute uses enum nl80211_band as the index. This maps
3654 * directly to the enum nl80211_band values used in cfg80211.
3655 */
3656 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
3657 nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
3658 enum nl80211_band band = nla_type(tx_rates);
3659 int err;
3660
3661 if (band < 0 || band >= NUM_NL80211_BANDS)
3662 return -EINVAL;
3663 sband = rdev->wiphy.bands[band];
3664 if (sband == NULL)
3665 return -EINVAL;
Johannes Bergbfe2c7b2016-10-26 14:42:21 +02003666 err = nla_parse_nested(tb, NL80211_TXRATE_MAX, tx_rates,
Johannes Bergfe521452017-04-12 14:34:08 +02003667 nl80211_txattr_policy, info->extack);
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303668 if (err)
3669 return err;
3670 if (tb[NL80211_TXRATE_LEGACY]) {
3671 mask->control[band].legacy = rateset_to_mask(
3672 sband,
3673 nla_data(tb[NL80211_TXRATE_LEGACY]),
3674 nla_len(tb[NL80211_TXRATE_LEGACY]));
3675 if ((mask->control[band].legacy == 0) &&
3676 nla_len(tb[NL80211_TXRATE_LEGACY]))
3677 return -EINVAL;
3678 }
3679 if (tb[NL80211_TXRATE_HT]) {
3680 if (!ht_rateset_to_mask(
3681 sband,
3682 nla_data(tb[NL80211_TXRATE_HT]),
3683 nla_len(tb[NL80211_TXRATE_HT]),
3684 mask->control[band].ht_mcs))
3685 return -EINVAL;
3686 }
3687 if (tb[NL80211_TXRATE_VHT]) {
3688 if (!vht_set_mcs_mask(
3689 sband,
3690 nla_data(tb[NL80211_TXRATE_VHT]),
3691 mask->control[band].vht_mcs))
3692 return -EINVAL;
3693 }
3694 if (tb[NL80211_TXRATE_GI]) {
3695 mask->control[band].gi =
3696 nla_get_u8(tb[NL80211_TXRATE_GI]);
3697 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
3698 return -EINVAL;
3699 }
3700
3701 if (mask->control[band].legacy == 0) {
3702 /* don't allow empty legacy rates if HT or VHT
3703 * are not even supported.
3704 */
3705 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
3706 rdev->wiphy.bands[band]->vht_cap.vht_supported))
3707 return -EINVAL;
3708
3709 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
3710 if (mask->control[band].ht_mcs[i])
3711 goto out;
3712
3713 for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
3714 if (mask->control[band].vht_mcs[i])
3715 goto out;
3716
3717 /* legacy and mcs rates may not be both empty */
3718 return -EINVAL;
3719 }
3720 }
3721
3722out:
3723 return 0;
3724}
3725
Johannes Berg8564e382016-09-19 09:44:44 +02003726static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
3727 enum nl80211_band band,
3728 struct cfg80211_bitrate_mask *beacon_rate)
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303729{
Johannes Berg8564e382016-09-19 09:44:44 +02003730 u32 count_ht, count_vht, i;
3731 u32 rate = beacon_rate->control[band].legacy;
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303732
3733 /* Allow only one rate */
3734 if (hweight32(rate) > 1)
3735 return -EINVAL;
3736
3737 count_ht = 0;
3738 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
Johannes Berg8564e382016-09-19 09:44:44 +02003739 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303740 return -EINVAL;
Johannes Berg8564e382016-09-19 09:44:44 +02003741 } else if (beacon_rate->control[band].ht_mcs[i]) {
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303742 count_ht++;
3743 if (count_ht > 1)
3744 return -EINVAL;
3745 }
3746 if (count_ht && rate)
3747 return -EINVAL;
3748 }
3749
3750 count_vht = 0;
3751 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
Johannes Berg8564e382016-09-19 09:44:44 +02003752 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303753 return -EINVAL;
Johannes Berg8564e382016-09-19 09:44:44 +02003754 } else if (beacon_rate->control[band].vht_mcs[i]) {
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303755 count_vht++;
3756 if (count_vht > 1)
3757 return -EINVAL;
3758 }
3759 if (count_vht && rate)
3760 return -EINVAL;
3761 }
3762
3763 if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
3764 return -EINVAL;
3765
Johannes Berg8564e382016-09-19 09:44:44 +02003766 if (rate &&
3767 !wiphy_ext_feature_isset(&rdev->wiphy,
3768 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
3769 return -EINVAL;
3770 if (count_ht &&
3771 !wiphy_ext_feature_isset(&rdev->wiphy,
3772 NL80211_EXT_FEATURE_BEACON_RATE_HT))
3773 return -EINVAL;
3774 if (count_vht &&
3775 !wiphy_ext_feature_isset(&rdev->wiphy,
3776 NL80211_EXT_FEATURE_BEACON_RATE_VHT))
3777 return -EINVAL;
3778
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05303779 return 0;
3780}
3781
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003782static int nl80211_parse_beacon(struct nlattr *attrs[],
Johannes Berg88600202012-02-13 15:17:18 +01003783 struct cfg80211_beacon_data *bcn)
Johannes Berged1b6cc2007-12-19 02:03:32 +01003784{
Johannes Berg88600202012-02-13 15:17:18 +01003785 bool haveinfo = false;
Johannes Berged1b6cc2007-12-19 02:03:32 +01003786
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003787 if (!is_valid_ie_attr(attrs[NL80211_ATTR_BEACON_TAIL]) ||
3788 !is_valid_ie_attr(attrs[NL80211_ATTR_IE]) ||
3789 !is_valid_ie_attr(attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
3790 !is_valid_ie_attr(attrs[NL80211_ATTR_IE_ASSOC_RESP]))
Johannes Bergf4a11bb2009-03-27 12:40:28 +01003791 return -EINVAL;
3792
Johannes Berg88600202012-02-13 15:17:18 +01003793 memset(bcn, 0, sizeof(*bcn));
Johannes Berged1b6cc2007-12-19 02:03:32 +01003794
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003795 if (attrs[NL80211_ATTR_BEACON_HEAD]) {
3796 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
3797 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
Johannes Berg88600202012-02-13 15:17:18 +01003798 if (!bcn->head_len)
3799 return -EINVAL;
3800 haveinfo = true;
Johannes Berged1b6cc2007-12-19 02:03:32 +01003801 }
3802
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003803 if (attrs[NL80211_ATTR_BEACON_TAIL]) {
3804 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
3805 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
Johannes Berg88600202012-02-13 15:17:18 +01003806 haveinfo = true;
Johannes Berged1b6cc2007-12-19 02:03:32 +01003807 }
3808
Johannes Berg4c476992010-10-04 21:36:35 +02003809 if (!haveinfo)
3810 return -EINVAL;
Johannes Berged1b6cc2007-12-19 02:03:32 +01003811
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003812 if (attrs[NL80211_ATTR_IE]) {
3813 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
3814 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
Jouni Malinen9946ecf2011-08-10 23:55:56 +03003815 }
3816
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003817 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
Johannes Berg88600202012-02-13 15:17:18 +01003818 bcn->proberesp_ies =
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003819 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
Johannes Berg88600202012-02-13 15:17:18 +01003820 bcn->proberesp_ies_len =
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003821 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
Jouni Malinen9946ecf2011-08-10 23:55:56 +03003822 }
3823
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003824 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
Johannes Berg88600202012-02-13 15:17:18 +01003825 bcn->assocresp_ies =
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003826 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
Johannes Berg88600202012-02-13 15:17:18 +01003827 bcn->assocresp_ies_len =
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003828 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
Jouni Malinen9946ecf2011-08-10 23:55:56 +03003829 }
3830
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003831 if (attrs[NL80211_ATTR_PROBE_RESP]) {
3832 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
3833 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
Arik Nemtsov00f740e2011-11-10 11:28:56 +02003834 }
3835
Johannes Berg88600202012-02-13 15:17:18 +01003836 return 0;
3837}
3838
Johannes Berg66cd7942017-02-07 22:40:44 +02003839static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
3840 const u8 *rates)
3841{
3842 int i;
3843
3844 if (!rates)
3845 return;
3846
3847 for (i = 0; i < rates[1]; i++) {
3848 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
3849 params->ht_required = true;
3850 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
3851 params->vht_required = true;
3852 }
3853}
3854
3855/*
3856 * Since the nl80211 API didn't include, from the beginning, attributes about
3857 * HT/VHT requirements/capabilities, we parse them out of the IEs for the
3858 * benefit of drivers that rebuild IEs in the firmware.
3859 */
3860static void nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
3861{
3862 const struct cfg80211_beacon_data *bcn = &params->beacon;
Igor Mitsyankoba83bfb2017-08-30 13:52:25 -07003863 size_t ies_len = bcn->tail_len;
3864 const u8 *ies = bcn->tail;
Johannes Berg66cd7942017-02-07 22:40:44 +02003865 const u8 *rates;
3866 const u8 *cap;
3867
3868 rates = cfg80211_find_ie(WLAN_EID_SUPP_RATES, ies, ies_len);
3869 nl80211_check_ap_rate_selectors(params, rates);
3870
3871 rates = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
3872 nl80211_check_ap_rate_selectors(params, rates);
3873
3874 cap = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies, ies_len);
3875 if (cap && cap[1] >= sizeof(*params->ht_cap))
3876 params->ht_cap = (void *)(cap + 2);
3877 cap = cfg80211_find_ie(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
3878 if (cap && cap[1] >= sizeof(*params->vht_cap))
3879 params->vht_cap = (void *)(cap + 2);
3880}
3881
Felix Fietkau46c1dd02012-06-19 02:50:57 +02003882static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
3883 struct cfg80211_ap_settings *params)
3884{
3885 struct wireless_dev *wdev;
3886 bool ret = false;
3887
Johannes Berg53873f12016-05-03 16:52:04 +03003888 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
Felix Fietkau46c1dd02012-06-19 02:50:57 +02003889 if (wdev->iftype != NL80211_IFTYPE_AP &&
3890 wdev->iftype != NL80211_IFTYPE_P2P_GO)
3891 continue;
3892
Johannes Berg683b6d32012-11-08 21:25:48 +01003893 if (!wdev->preset_chandef.chan)
Felix Fietkau46c1dd02012-06-19 02:50:57 +02003894 continue;
3895
Johannes Berg683b6d32012-11-08 21:25:48 +01003896 params->chandef = wdev->preset_chandef;
Felix Fietkau46c1dd02012-06-19 02:50:57 +02003897 ret = true;
3898 break;
3899 }
3900
Felix Fietkau46c1dd02012-06-19 02:50:57 +02003901 return ret;
3902}
3903
Jouni Malinene39e5b52012-09-30 19:29:39 +03003904static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
3905 enum nl80211_auth_type auth_type,
3906 enum nl80211_commands cmd)
3907{
3908 if (auth_type > NL80211_AUTHTYPE_MAX)
3909 return false;
3910
3911 switch (cmd) {
3912 case NL80211_CMD_AUTHENTICATE:
3913 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
3914 auth_type == NL80211_AUTHTYPE_SAE)
3915 return false;
Jouni Malinen63181062016-10-27 00:42:02 +03003916 if (!wiphy_ext_feature_isset(&rdev->wiphy,
3917 NL80211_EXT_FEATURE_FILS_STA) &&
3918 (auth_type == NL80211_AUTHTYPE_FILS_SK ||
3919 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3920 auth_type == NL80211_AUTHTYPE_FILS_PK))
3921 return false;
Jouni Malinene39e5b52012-09-30 19:29:39 +03003922 return true;
3923 case NL80211_CMD_CONNECT:
Vidyullatha Kanchanapallya3caf742017-03-31 00:22:34 +03003924 /* SAE not supported yet */
3925 if (auth_type == NL80211_AUTHTYPE_SAE)
3926 return false;
3927 /* FILS with SK PFS or PK not supported yet */
3928 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3929 auth_type == NL80211_AUTHTYPE_FILS_PK)
3930 return false;
3931 if (!wiphy_ext_feature_isset(
3932 &rdev->wiphy,
3933 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
3934 auth_type == NL80211_AUTHTYPE_FILS_SK)
3935 return false;
3936 return true;
Jouni Malinene39e5b52012-09-30 19:29:39 +03003937 case NL80211_CMD_START_AP:
3938 /* SAE not supported yet */
3939 if (auth_type == NL80211_AUTHTYPE_SAE)
3940 return false;
Jouni Malinen63181062016-10-27 00:42:02 +03003941 /* FILS not supported yet */
3942 if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
3943 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
3944 auth_type == NL80211_AUTHTYPE_FILS_PK)
3945 return false;
Jouni Malinene39e5b52012-09-30 19:29:39 +03003946 return true;
3947 default:
3948 return false;
3949 }
3950}
3951
Johannes Berg88600202012-02-13 15:17:18 +01003952static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
3953{
3954 struct cfg80211_registered_device *rdev = info->user_ptr[0];
3955 struct net_device *dev = info->user_ptr[1];
3956 struct wireless_dev *wdev = dev->ieee80211_ptr;
3957 struct cfg80211_ap_settings params;
3958 int err;
3959
3960 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3961 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3962 return -EOPNOTSUPP;
3963
3964 if (!rdev->ops->start_ap)
3965 return -EOPNOTSUPP;
3966
3967 if (wdev->beacon_interval)
3968 return -EALREADY;
3969
3970 memset(&params, 0, sizeof(params));
3971
3972 /* these are required for START_AP */
3973 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
3974 !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
3975 !info->attrs[NL80211_ATTR_BEACON_HEAD])
3976 return -EINVAL;
3977
Simon Wunderlicha1193be2013-06-14 14:15:19 +02003978 err = nl80211_parse_beacon(info->attrs, &params.beacon);
Johannes Berg88600202012-02-13 15:17:18 +01003979 if (err)
3980 return err;
3981
3982 params.beacon_interval =
3983 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
3984 params.dtim_period =
3985 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
3986
Purushottam Kushwaha0c317a02016-10-12 18:26:51 +05303987 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
3988 params.beacon_interval);
Johannes Berg88600202012-02-13 15:17:18 +01003989 if (err)
3990 return err;
3991
3992 /*
3993 * In theory, some of these attributes should be required here
3994 * but since they were not used when the command was originally
3995 * added, keep them optional for old user space programs to let
3996 * them continue to work with drivers that do not need the
3997 * additional information -- drivers must check!
3998 */
3999 if (info->attrs[NL80211_ATTR_SSID]) {
4000 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
4001 params.ssid_len =
4002 nla_len(info->attrs[NL80211_ATTR_SSID]);
4003 if (params.ssid_len == 0 ||
4004 params.ssid_len > IEEE80211_MAX_SSID_LEN)
4005 return -EINVAL;
4006 }
4007
4008 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
4009 params.hidden_ssid = nla_get_u32(
4010 info->attrs[NL80211_ATTR_HIDDEN_SSID]);
4011 if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
4012 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
4013 params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
4014 return -EINVAL;
4015 }
4016
4017 params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
4018
4019 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
4020 params.auth_type = nla_get_u32(
4021 info->attrs[NL80211_ATTR_AUTH_TYPE]);
Jouni Malinene39e5b52012-09-30 19:29:39 +03004022 if (!nl80211_valid_auth_type(rdev, params.auth_type,
4023 NL80211_CMD_START_AP))
Johannes Berg88600202012-02-13 15:17:18 +01004024 return -EINVAL;
4025 } else
4026 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
4027
4028 err = nl80211_crypto_settings(rdev, info, &params.crypto,
4029 NL80211_MAX_NR_CIPHER_SUITES);
4030 if (err)
4031 return err;
4032
Vasanthakumar Thiagarajan1b658f12012-03-02 15:50:02 +05304033 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
4034 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
4035 return -EOPNOTSUPP;
4036 params.inactivity_timeout = nla_get_u16(
4037 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
4038 }
4039
Johannes Berg53cabad2012-11-14 15:17:28 +01004040 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
4041 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4042 return -EINVAL;
4043 params.p2p_ctwindow =
4044 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
4045 if (params.p2p_ctwindow > 127)
4046 return -EINVAL;
4047 if (params.p2p_ctwindow != 0 &&
4048 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
4049 return -EINVAL;
4050 }
4051
4052 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
4053 u8 tmp;
4054
4055 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4056 return -EINVAL;
4057 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
4058 if (tmp > 1)
4059 return -EINVAL;
4060 params.p2p_opp_ps = tmp;
4061 if (params.p2p_opp_ps != 0 &&
4062 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
4063 return -EINVAL;
4064 }
4065
Johannes Bergaa430da2012-05-16 23:50:18 +02004066 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
Johannes Berg683b6d32012-11-08 21:25:48 +01004067 err = nl80211_parse_chandef(rdev, info, &params.chandef);
4068 if (err)
4069 return err;
4070 } else if (wdev->preset_chandef.chan) {
4071 params.chandef = wdev->preset_chandef;
Felix Fietkau46c1dd02012-06-19 02:50:57 +02004072 } else if (!nl80211_get_ap_channel(rdev, &params))
Johannes Bergaa430da2012-05-16 23:50:18 +02004073 return -EINVAL;
4074
Arik Nemtsov923b3522015-07-08 15:41:44 +03004075 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
4076 wdev->iftype))
Johannes Bergaa430da2012-05-16 23:50:18 +02004077 return -EINVAL;
4078
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05304079 if (info->attrs[NL80211_ATTR_TX_RATES]) {
4080 err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
4081 if (err)
4082 return err;
4083
Johannes Berg8564e382016-09-19 09:44:44 +02004084 err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
4085 &params.beacon_rate);
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05304086 if (err)
4087 return err;
4088 }
4089
Eliad Peller18998c32014-09-10 14:07:34 +03004090 if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
4091 params.smps_mode =
4092 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
4093 switch (params.smps_mode) {
4094 case NL80211_SMPS_OFF:
4095 break;
4096 case NL80211_SMPS_STATIC:
4097 if (!(rdev->wiphy.features &
4098 NL80211_FEATURE_STATIC_SMPS))
4099 return -EINVAL;
4100 break;
4101 case NL80211_SMPS_DYNAMIC:
4102 if (!(rdev->wiphy.features &
4103 NL80211_FEATURE_DYNAMIC_SMPS))
4104 return -EINVAL;
4105 break;
4106 default:
4107 return -EINVAL;
4108 }
4109 } else {
4110 params.smps_mode = NL80211_SMPS_OFF;
4111 }
4112
Purushottam Kushwaha6e8ef842016-07-05 13:44:51 +05304113 params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
4114 if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
4115 return -EOPNOTSUPP;
4116
Ola Olsson4baf6be2015-10-29 07:04:58 +01004117 if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
4118 params.acl = parse_acl_data(&rdev->wiphy, info);
4119 if (IS_ERR(params.acl))
4120 return PTR_ERR(params.acl);
4121 }
4122
Johannes Berg66cd7942017-02-07 22:40:44 +02004123 nl80211_calculate_ap_params(&params);
4124
Simon Wunderlichc56589e2013-11-21 18:19:49 +01004125 wdev_lock(wdev);
Hila Gonene35e4d22012-06-27 17:19:42 +03004126 err = rdev_start_ap(rdev, dev, &params);
Felix Fietkau46c1dd02012-06-19 02:50:57 +02004127 if (!err) {
Johannes Berg683b6d32012-11-08 21:25:48 +01004128 wdev->preset_chandef = params.chandef;
Johannes Berg88600202012-02-13 15:17:18 +01004129 wdev->beacon_interval = params.beacon_interval;
Michal Kazior9e0e2962014-01-29 14:22:27 +01004130 wdev->chandef = params.chandef;
Antonio Quartulli06e191e2012-11-07 12:52:19 +01004131 wdev->ssid_len = params.ssid_len;
4132 memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
Felix Fietkau46c1dd02012-06-19 02:50:57 +02004133 }
Simon Wunderlichc56589e2013-11-21 18:19:49 +01004134 wdev_unlock(wdev);
Vasanthakumar Thiagarajan77765ea2013-01-18 11:18:45 +05304135
4136 kfree(params.acl);
4137
Johannes Berg56d18932011-05-09 18:41:15 +02004138 return err;
Johannes Berged1b6cc2007-12-19 02:03:32 +01004139}
4140
Johannes Berg88600202012-02-13 15:17:18 +01004141static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
4142{
4143 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4144 struct net_device *dev = info->user_ptr[1];
4145 struct wireless_dev *wdev = dev->ieee80211_ptr;
4146 struct cfg80211_beacon_data params;
4147 int err;
4148
4149 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4150 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4151 return -EOPNOTSUPP;
4152
4153 if (!rdev->ops->change_beacon)
4154 return -EOPNOTSUPP;
4155
4156 if (!wdev->beacon_interval)
4157 return -EINVAL;
4158
Simon Wunderlicha1193be2013-06-14 14:15:19 +02004159 err = nl80211_parse_beacon(info->attrs, &params);
Johannes Berg88600202012-02-13 15:17:18 +01004160 if (err)
4161 return err;
4162
Simon Wunderlichc56589e2013-11-21 18:19:49 +01004163 wdev_lock(wdev);
4164 err = rdev_change_beacon(rdev, dev, &params);
4165 wdev_unlock(wdev);
4166
4167 return err;
Johannes Berg88600202012-02-13 15:17:18 +01004168}
4169
4170static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
Johannes Berged1b6cc2007-12-19 02:03:32 +01004171{
Johannes Berg4c476992010-10-04 21:36:35 +02004172 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4173 struct net_device *dev = info->user_ptr[1];
Johannes Berged1b6cc2007-12-19 02:03:32 +01004174
Ilan Peer7c8d5e02014-02-25 15:33:38 +02004175 return cfg80211_stop_ap(rdev, dev, false);
Johannes Berged1b6cc2007-12-19 02:03:32 +01004176}
4177
Johannes Berg5727ef12007-12-19 02:03:34 +01004178static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
4179 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
4180 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
4181 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
Jouni Malinen0e467242009-05-11 21:57:55 +03004182 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
Javier Cardonab39c48f2011-04-07 15:08:30 -07004183 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
Johannes Bergd83023d2011-12-14 09:29:15 +01004184 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
Johannes Berg5727ef12007-12-19 02:03:34 +01004185};
4186
Johannes Bergeccb8e82009-05-11 21:57:56 +03004187static int parse_station_flags(struct genl_info *info,
Johannes Bergbdd3ae32012-01-02 13:30:03 +01004188 enum nl80211_iftype iftype,
Johannes Bergeccb8e82009-05-11 21:57:56 +03004189 struct station_parameters *params)
Johannes Berg5727ef12007-12-19 02:03:34 +01004190{
4191 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
Johannes Bergeccb8e82009-05-11 21:57:56 +03004192 struct nlattr *nla;
Johannes Berg5727ef12007-12-19 02:03:34 +01004193 int flag;
4194
Johannes Bergeccb8e82009-05-11 21:57:56 +03004195 /*
4196 * Try parsing the new attribute first so userspace
4197 * can specify both for older kernels.
4198 */
4199 nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
4200 if (nla) {
4201 struct nl80211_sta_flag_update *sta_flags;
Johannes Berg5727ef12007-12-19 02:03:34 +01004202
Johannes Bergeccb8e82009-05-11 21:57:56 +03004203 sta_flags = nla_data(nla);
4204 params->sta_flags_mask = sta_flags->mask;
4205 params->sta_flags_set = sta_flags->set;
Johannes Berg77ee7c82013-02-15 00:48:33 +01004206 params->sta_flags_set &= params->sta_flags_mask;
Johannes Bergeccb8e82009-05-11 21:57:56 +03004207 if ((params->sta_flags_mask |
4208 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
4209 return -EINVAL;
4210 return 0;
4211 }
4212
4213 /* if present, parse the old attribute */
4214
4215 nla = info->attrs[NL80211_ATTR_STA_FLAGS];
Johannes Berg5727ef12007-12-19 02:03:34 +01004216 if (!nla)
4217 return 0;
4218
Johannes Bergfceb6432017-04-12 14:34:07 +02004219 if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX, nla,
Johannes Bergfe521452017-04-12 14:34:08 +02004220 sta_flags_policy, info->extack))
Johannes Berg5727ef12007-12-19 02:03:34 +01004221 return -EINVAL;
4222
Johannes Bergbdd3ae32012-01-02 13:30:03 +01004223 /*
4224 * Only allow certain flags for interface types so that
4225 * other attributes are silently ignored. Remember that
4226 * this is backward compatibility code with old userspace
4227 * and shouldn't be hit in other cases anyway.
4228 */
4229 switch (iftype) {
4230 case NL80211_IFTYPE_AP:
4231 case NL80211_IFTYPE_AP_VLAN:
4232 case NL80211_IFTYPE_P2P_GO:
4233 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4234 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4235 BIT(NL80211_STA_FLAG_WME) |
4236 BIT(NL80211_STA_FLAG_MFP);
4237 break;
4238 case NL80211_IFTYPE_P2P_CLIENT:
4239 case NL80211_IFTYPE_STATION:
4240 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4241 BIT(NL80211_STA_FLAG_TDLS_PEER);
4242 break;
4243 case NL80211_IFTYPE_MESH_POINT:
4244 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4245 BIT(NL80211_STA_FLAG_MFP) |
4246 BIT(NL80211_STA_FLAG_AUTHORIZED);
4247 default:
4248 return -EINVAL;
4249 }
Johannes Berg5727ef12007-12-19 02:03:34 +01004250
Johannes Berg3383b5a2012-05-10 20:14:43 +02004251 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
4252 if (flags[flag]) {
Johannes Bergeccb8e82009-05-11 21:57:56 +03004253 params->sta_flags_set |= (1<<flag);
Johannes Berg5727ef12007-12-19 02:03:34 +01004254
Johannes Berg3383b5a2012-05-10 20:14:43 +02004255 /* no longer support new API additions in old API */
4256 if (flag > NL80211_STA_FLAG_MAX_OLD_API)
4257 return -EINVAL;
4258 }
4259 }
4260
Johannes Berg5727ef12007-12-19 02:03:34 +01004261 return 0;
4262}
4263
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004264static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
4265 int attr)
4266{
4267 struct nlattr *rate;
Vladimir Kondratiev8eb41c82012-07-05 14:25:49 +03004268 u32 bitrate;
4269 u16 bitrate_compat;
Matthias Kaehlckebbf67e42017-04-17 15:59:52 -07004270 enum nl80211_rate_info rate_flg;
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004271
4272 rate = nla_nest_start(msg, attr);
4273 if (!rate)
Johannes Bergdb9c64c2012-11-09 14:56:41 +01004274 return false;
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004275
4276 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
4277 bitrate = cfg80211_calculate_bitrate(info);
Vladimir Kondratiev8eb41c82012-07-05 14:25:49 +03004278 /* report 16-bit bitrate only if we can */
4279 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
Johannes Bergdb9c64c2012-11-09 14:56:41 +01004280 if (bitrate > 0 &&
4281 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
4282 return false;
4283 if (bitrate_compat > 0 &&
4284 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
4285 return false;
4286
Johannes Bergb51f3be2015-01-15 16:14:02 +01004287 switch (info->bw) {
4288 case RATE_INFO_BW_5:
4289 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
4290 break;
4291 case RATE_INFO_BW_10:
4292 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
4293 break;
4294 default:
4295 WARN_ON(1);
4296 /* fall through */
4297 case RATE_INFO_BW_20:
4298 rate_flg = 0;
4299 break;
4300 case RATE_INFO_BW_40:
4301 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
4302 break;
4303 case RATE_INFO_BW_80:
4304 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
4305 break;
4306 case RATE_INFO_BW_160:
4307 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
4308 break;
4309 }
4310
4311 if (rate_flg && nla_put_flag(msg, rate_flg))
4312 return false;
4313
Johannes Bergdb9c64c2012-11-09 14:56:41 +01004314 if (info->flags & RATE_INFO_FLAGS_MCS) {
4315 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
4316 return false;
Johannes Bergdb9c64c2012-11-09 14:56:41 +01004317 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4318 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4319 return false;
4320 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
4321 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
4322 return false;
4323 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
4324 return false;
Johannes Bergdb9c64c2012-11-09 14:56:41 +01004325 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4326 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4327 return false;
4328 }
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004329
4330 nla_nest_end(msg, rate);
4331 return true;
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004332}
4333
Felix Fietkau119363c2013-04-22 16:29:30 +02004334static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
4335 int id)
4336{
4337 void *attr;
4338 int i = 0;
4339
4340 if (!mask)
4341 return true;
4342
4343 attr = nla_nest_start(msg, id);
4344 if (!attr)
4345 return false;
4346
4347 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
4348 if (!(mask & BIT(i)))
4349 continue;
4350
4351 if (nla_put_u8(msg, i, signal[i]))
4352 return false;
4353 }
4354
4355 nla_nest_end(msg, attr);
4356
4357 return true;
4358}
4359
Johannes Bergcf5ead82014-11-14 17:14:00 +01004360static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
4361 u32 seq, int flags,
John W. Linville66266b32012-03-15 13:25:41 -04004362 struct cfg80211_registered_device *rdev,
4363 struct net_device *dev,
Johannes Berg98b62182009-12-23 13:15:44 +01004364 const u8 *mac_addr, struct station_info *sinfo)
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004365{
4366 void *hdr;
Paul Stewartf4263c92011-03-31 09:25:41 -07004367 struct nlattr *sinfoattr, *bss_param;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004368
Johannes Bergcf5ead82014-11-14 17:14:00 +01004369 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004370 if (!hdr)
4371 return -1;
4372
David S. Miller9360ffd2012-03-29 04:41:26 -04004373 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
4374 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
4375 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
4376 goto nla_put_failure;
Johannes Bergf5ea9122009-08-07 16:17:38 +02004377
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004378 sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
4379 if (!sinfoattr)
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004380 goto nla_put_failure;
Johannes Berg319090b2014-11-17 14:08:11 +01004381
4382#define PUT_SINFO(attr, memb, type) do { \
Johannes Bergd686b922016-04-26 09:54:11 +02004383 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \
Mohammed Shafi Shajakhan739960f2016-04-07 19:59:34 +05304384 if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
Johannes Berg319090b2014-11-17 14:08:11 +01004385 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \
4386 sinfo->memb)) \
4387 goto nla_put_failure; \
4388 } while (0)
Johannes Bergd686b922016-04-26 09:54:11 +02004389#define PUT_SINFO_U64(attr, memb) do { \
4390 if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
4391 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \
4392 sinfo->memb, NL80211_STA_INFO_PAD)) \
4393 goto nla_put_failure; \
4394 } while (0)
Johannes Berg319090b2014-11-17 14:08:11 +01004395
4396 PUT_SINFO(CONNECTED_TIME, connected_time, u32);
4397 PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
4398
4399 if (sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES) |
4400 BIT(NL80211_STA_INFO_RX_BYTES64)) &&
David S. Miller9360ffd2012-03-29 04:41:26 -04004401 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
Vladimir Kondratiev42745e02013-02-04 13:53:11 +02004402 (u32)sinfo->rx_bytes))
4403 goto nla_put_failure;
Johannes Berg319090b2014-11-17 14:08:11 +01004404
4405 if (sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES) |
4406 BIT(NL80211_STA_INFO_TX_BYTES64)) &&
Vladimir Kondratiev42745e02013-02-04 13:53:11 +02004407 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
4408 (u32)sinfo->tx_bytes))
4409 goto nla_put_failure;
Johannes Berg319090b2014-11-17 14:08:11 +01004410
Johannes Bergd686b922016-04-26 09:54:11 +02004411 PUT_SINFO_U64(RX_BYTES64, rx_bytes);
4412 PUT_SINFO_U64(TX_BYTES64, tx_bytes);
Johannes Berg319090b2014-11-17 14:08:11 +01004413 PUT_SINFO(LLID, llid, u16);
4414 PUT_SINFO(PLID, plid, u16);
4415 PUT_SINFO(PLINK_STATE, plink_state, u8);
Johannes Bergd686b922016-04-26 09:54:11 +02004416 PUT_SINFO_U64(RX_DURATION, rx_duration);
Johannes Berg319090b2014-11-17 14:08:11 +01004417
John W. Linville66266b32012-03-15 13:25:41 -04004418 switch (rdev->wiphy.signal_type) {
4419 case CFG80211_SIGNAL_TYPE_MBM:
Johannes Berg319090b2014-11-17 14:08:11 +01004420 PUT_SINFO(SIGNAL, signal, u8);
4421 PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
John W. Linville66266b32012-03-15 13:25:41 -04004422 break;
4423 default:
4424 break;
4425 }
Johannes Berg319090b2014-11-17 14:08:11 +01004426 if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL)) {
Felix Fietkau119363c2013-04-22 16:29:30 +02004427 if (!nl80211_put_signal(msg, sinfo->chains,
4428 sinfo->chain_signal,
4429 NL80211_STA_INFO_CHAIN_SIGNAL))
4430 goto nla_put_failure;
4431 }
Johannes Berg319090b2014-11-17 14:08:11 +01004432 if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
Felix Fietkau119363c2013-04-22 16:29:30 +02004433 if (!nl80211_put_signal(msg, sinfo->chains,
4434 sinfo->chain_signal_avg,
4435 NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
4436 goto nla_put_failure;
4437 }
Johannes Berg319090b2014-11-17 14:08:11 +01004438 if (sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE)) {
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004439 if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
4440 NL80211_STA_INFO_TX_BITRATE))
Henning Rogge420e7fa2008-12-11 22:04:19 +01004441 goto nla_put_failure;
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004442 }
Johannes Berg319090b2014-11-17 14:08:11 +01004443 if (sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE)) {
Felix Fietkauc8dcfd82011-02-27 22:08:00 +01004444 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
4445 NL80211_STA_INFO_RX_BITRATE))
4446 goto nla_put_failure;
Henning Rogge420e7fa2008-12-11 22:04:19 +01004447 }
Johannes Berg319090b2014-11-17 14:08:11 +01004448
4449 PUT_SINFO(RX_PACKETS, rx_packets, u32);
4450 PUT_SINFO(TX_PACKETS, tx_packets, u32);
4451 PUT_SINFO(TX_RETRIES, tx_retries, u32);
4452 PUT_SINFO(TX_FAILED, tx_failed, u32);
4453 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
4454 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
4455 PUT_SINFO(LOCAL_PM, local_pm, u32);
4456 PUT_SINFO(PEER_PM, peer_pm, u32);
4457 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
4458
4459 if (sinfo->filled & BIT(NL80211_STA_INFO_BSS_PARAM)) {
Paul Stewartf4263c92011-03-31 09:25:41 -07004460 bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
4461 if (!bss_param)
4462 goto nla_put_failure;
4463
David S. Miller9360ffd2012-03-29 04:41:26 -04004464 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
4465 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
4466 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
4467 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
4468 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
4469 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
4470 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
4471 sinfo->bss_param.dtim_period) ||
4472 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
4473 sinfo->bss_param.beacon_interval))
4474 goto nla_put_failure;
Paul Stewartf4263c92011-03-31 09:25:41 -07004475
4476 nla_nest_end(msg, bss_param);
4477 }
Johannes Berg319090b2014-11-17 14:08:11 +01004478 if ((sinfo->filled & BIT(NL80211_STA_INFO_STA_FLAGS)) &&
David S. Miller9360ffd2012-03-29 04:41:26 -04004479 nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
4480 sizeof(struct nl80211_sta_flag_update),
4481 &sinfo->sta_flags))
4482 goto nla_put_failure;
Johannes Berg319090b2014-11-17 14:08:11 +01004483
Johannes Bergd686b922016-04-26 09:54:11 +02004484 PUT_SINFO_U64(T_OFFSET, t_offset);
4485 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
4486 PUT_SINFO_U64(BEACON_RX, rx_beacon);
Johannes Berga76b1942014-11-17 14:12:22 +01004487 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
Johannes Berg319090b2014-11-17 14:08:11 +01004488
4489#undef PUT_SINFO
Johannes Bergd686b922016-04-26 09:54:11 +02004490#undef PUT_SINFO_U64
Johannes Berg6de39802014-12-19 12:34:00 +01004491
4492 if (sinfo->filled & BIT(NL80211_STA_INFO_TID_STATS)) {
4493 struct nlattr *tidsattr;
4494 int tid;
4495
4496 tidsattr = nla_nest_start(msg, NL80211_STA_INFO_TID_STATS);
4497 if (!tidsattr)
4498 goto nla_put_failure;
4499
4500 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
4501 struct cfg80211_tid_stats *tidstats;
4502 struct nlattr *tidattr;
4503
4504 tidstats = &sinfo->pertid[tid];
4505
4506 if (!tidstats->filled)
4507 continue;
4508
4509 tidattr = nla_nest_start(msg, tid + 1);
4510 if (!tidattr)
4511 goto nla_put_failure;
4512
Johannes Bergd686b922016-04-26 09:54:11 +02004513#define PUT_TIDVAL_U64(attr, memb) do { \
Johannes Berg6de39802014-12-19 12:34:00 +01004514 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \
Johannes Bergd686b922016-04-26 09:54:11 +02004515 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \
4516 tidstats->memb, NL80211_TID_STATS_PAD)) \
Johannes Berg6de39802014-12-19 12:34:00 +01004517 goto nla_put_failure; \
4518 } while (0)
4519
Johannes Bergd686b922016-04-26 09:54:11 +02004520 PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
4521 PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
4522 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
4523 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
Johannes Berg6de39802014-12-19 12:34:00 +01004524
Johannes Bergd686b922016-04-26 09:54:11 +02004525#undef PUT_TIDVAL_U64
Johannes Berg6de39802014-12-19 12:34:00 +01004526 nla_nest_end(msg, tidattr);
4527 }
4528
4529 nla_nest_end(msg, tidsattr);
4530 }
4531
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004532 nla_nest_end(msg, sinfoattr);
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004533
Johannes Berg319090b2014-11-17 14:08:11 +01004534 if (sinfo->assoc_req_ies_len &&
David S. Miller9360ffd2012-03-29 04:41:26 -04004535 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
4536 sinfo->assoc_req_ies))
4537 goto nla_put_failure;
Jouni Malinen50d3dfb2011-08-08 12:11:52 +03004538
Johannes Berg053c0952015-01-16 22:09:00 +01004539 genlmsg_end(msg, hdr);
4540 return 0;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004541
4542 nla_put_failure:
Thomas Grafbc3ed282008-06-03 16:36:54 -07004543 genlmsg_cancel(msg, hdr);
4544 return -EMSGSIZE;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004545}
4546
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004547static int nl80211_dump_station(struct sk_buff *skb,
Johannes Bergbba95fe2008-07-29 13:22:51 +02004548 struct netlink_callback *cb)
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004549{
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004550 struct station_info sinfo;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08004551 struct cfg80211_registered_device *rdev;
Johannes Berg97990a02013-04-19 01:02:55 +02004552 struct wireless_dev *wdev;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004553 u8 mac_addr[ETH_ALEN];
Johannes Berg97990a02013-04-19 01:02:55 +02004554 int sta_idx = cb->args[2];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004555 int err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004556
Johannes Bergea90e0d2017-03-15 14:26:04 +01004557 rtnl_lock();
Zhao, Gang1b8ec872014-04-21 12:53:02 +08004558 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
Johannes Berg67748892010-10-04 21:14:06 +02004559 if (err)
Johannes Bergea90e0d2017-03-15 14:26:04 +01004560 goto out_err;
Johannes Bergbba95fe2008-07-29 13:22:51 +02004561
Johannes Berg97990a02013-04-19 01:02:55 +02004562 if (!wdev->netdev) {
4563 err = -EINVAL;
4564 goto out_err;
4565 }
4566
Zhao, Gang1b8ec872014-04-21 12:53:02 +08004567 if (!rdev->ops->dump_station) {
Jouni Malineneec60b02009-03-20 21:21:19 +02004568 err = -EOPNOTSUPP;
Johannes Bergbba95fe2008-07-29 13:22:51 +02004569 goto out_err;
4570 }
4571
Johannes Bergbba95fe2008-07-29 13:22:51 +02004572 while (1) {
Jouni Malinenf612ced2011-08-11 11:46:22 +03004573 memset(&sinfo, 0, sizeof(sinfo));
Zhao, Gang1b8ec872014-04-21 12:53:02 +08004574 err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
Hila Gonene35e4d22012-06-27 17:19:42 +03004575 mac_addr, &sinfo);
Johannes Bergbba95fe2008-07-29 13:22:51 +02004576 if (err == -ENOENT)
4577 break;
4578 if (err)
Johannes Berg3b858752009-03-12 09:55:09 +01004579 goto out_err;
Johannes Bergbba95fe2008-07-29 13:22:51 +02004580
Johannes Bergcf5ead82014-11-14 17:14:00 +01004581 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
Eric W. Biederman15e47302012-09-07 20:12:54 +00004582 NETLINK_CB(cb->skb).portid,
Johannes Bergbba95fe2008-07-29 13:22:51 +02004583 cb->nlh->nlmsg_seq, NLM_F_MULTI,
Zhao, Gang1b8ec872014-04-21 12:53:02 +08004584 rdev, wdev->netdev, mac_addr,
Johannes Bergbba95fe2008-07-29 13:22:51 +02004585 &sinfo) < 0)
4586 goto out;
4587
4588 sta_idx++;
4589 }
4590
Johannes Bergbba95fe2008-07-29 13:22:51 +02004591 out:
Johannes Berg97990a02013-04-19 01:02:55 +02004592 cb->args[2] = sta_idx;
Johannes Bergbba95fe2008-07-29 13:22:51 +02004593 err = skb->len;
Johannes Bergbba95fe2008-07-29 13:22:51 +02004594 out_err:
Johannes Bergea90e0d2017-03-15 14:26:04 +01004595 rtnl_unlock();
Johannes Bergbba95fe2008-07-29 13:22:51 +02004596
4597 return err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004598}
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004599
Johannes Berg5727ef12007-12-19 02:03:34 +01004600static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
4601{
Johannes Berg4c476992010-10-04 21:36:35 +02004602 struct cfg80211_registered_device *rdev = info->user_ptr[0];
4603 struct net_device *dev = info->user_ptr[1];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004604 struct station_info sinfo;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004605 struct sk_buff *msg;
4606 u8 *mac_addr = NULL;
Johannes Berg4c476992010-10-04 21:36:35 +02004607 int err;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004608
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004609 memset(&sinfo, 0, sizeof(sinfo));
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004610
4611 if (!info->attrs[NL80211_ATTR_MAC])
4612 return -EINVAL;
4613
4614 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4615
Johannes Berg4c476992010-10-04 21:36:35 +02004616 if (!rdev->ops->get_station)
4617 return -EOPNOTSUPP;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004618
Hila Gonene35e4d22012-06-27 17:19:42 +03004619 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004620 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02004621 return err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004622
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -07004623 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004624 if (!msg)
Johannes Berg4c476992010-10-04 21:36:35 +02004625 return -ENOMEM;
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004626
Johannes Bergcf5ead82014-11-14 17:14:00 +01004627 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
4628 info->snd_portid, info->snd_seq, 0,
John W. Linville66266b32012-03-15 13:25:41 -04004629 rdev, dev, mac_addr, &sinfo) < 0) {
Johannes Berg4c476992010-10-04 21:36:35 +02004630 nlmsg_free(msg);
4631 return -ENOBUFS;
4632 }
Johannes Bergfd5b74d2007-12-19 02:03:36 +01004633
Johannes Berg4c476992010-10-04 21:36:35 +02004634 return genlmsg_reply(msg, info);
Johannes Berg5727ef12007-12-19 02:03:34 +01004635}
4636
Johannes Berg77ee7c82013-02-15 00:48:33 +01004637int cfg80211_check_station_change(struct wiphy *wiphy,
4638 struct station_parameters *params,
4639 enum cfg80211_station_type statype)
4640{
Ayala Bekere4208422015-10-23 11:20:06 +03004641 if (params->listen_interval != -1 &&
4642 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
Johannes Berg77ee7c82013-02-15 00:48:33 +01004643 return -EINVAL;
Ayala Bekere4208422015-10-23 11:20:06 +03004644
Ayala Beker17b94242016-03-17 15:41:38 +02004645 if (params->support_p2p_ps != -1 &&
4646 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4647 return -EINVAL;
4648
Arik Nemtsovc72e1142014-07-17 17:14:29 +03004649 if (params->aid &&
Ayala Bekere4208422015-10-23 11:20:06 +03004650 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
4651 statype != CFG80211_STA_AP_CLIENT_UNASSOC)
Johannes Berg77ee7c82013-02-15 00:48:33 +01004652 return -EINVAL;
4653
4654 /* When you run into this, adjust the code below for the new flag */
4655 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
4656
4657 switch (statype) {
Thomas Pederseneef941e2013-03-04 13:06:11 -08004658 case CFG80211_STA_MESH_PEER_KERNEL:
4659 case CFG80211_STA_MESH_PEER_USER:
Johannes Berg77ee7c82013-02-15 00:48:33 +01004660 /*
4661 * No ignoring the TDLS flag here -- the userspace mesh
4662 * code doesn't have the bug of including TDLS in the
4663 * mask everywhere.
4664 */
4665 if (params->sta_flags_mask &
4666 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4667 BIT(NL80211_STA_FLAG_MFP) |
4668 BIT(NL80211_STA_FLAG_AUTHORIZED)))
4669 return -EINVAL;
4670 break;
4671 case CFG80211_STA_TDLS_PEER_SETUP:
4672 case CFG80211_STA_TDLS_PEER_ACTIVE:
4673 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
4674 return -EINVAL;
4675 /* ignore since it can't change */
4676 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4677 break;
4678 default:
4679 /* disallow mesh-specific things */
4680 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
4681 return -EINVAL;
4682 if (params->local_pm)
4683 return -EINVAL;
4684 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4685 return -EINVAL;
4686 }
4687
4688 if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4689 statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
4690 /* TDLS can't be set, ... */
4691 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
4692 return -EINVAL;
4693 /*
4694 * ... but don't bother the driver with it. This works around
4695 * a hostapd/wpa_supplicant issue -- it always includes the
4696 * TLDS_PEER flag in the mask even for AP mode.
4697 */
4698 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4699 }
4700
Ayala Beker47edb112015-09-21 15:49:53 +03004701 if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4702 statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
Johannes Berg77ee7c82013-02-15 00:48:33 +01004703 /* reject other things that can't change */
4704 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
4705 return -EINVAL;
4706 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
4707 return -EINVAL;
4708 if (params->supported_rates)
4709 return -EINVAL;
4710 if (params->ext_capab || params->ht_capa || params->vht_capa)
4711 return -EINVAL;
4712 }
4713
Ayala Beker47edb112015-09-21 15:49:53 +03004714 if (statype != CFG80211_STA_AP_CLIENT &&
4715 statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
Johannes Berg77ee7c82013-02-15 00:48:33 +01004716 if (params->vlan)
4717 return -EINVAL;
4718 }
4719
4720 switch (statype) {
4721 case CFG80211_STA_AP_MLME_CLIENT:
4722 /* Use this only for authorizing/unauthorizing a station */
4723 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
4724 return -EOPNOTSUPP;
4725 break;
4726 case CFG80211_STA_AP_CLIENT:
Ayala Beker47edb112015-09-21 15:49:53 +03004727 case CFG80211_STA_AP_CLIENT_UNASSOC:
Johannes Berg77ee7c82013-02-15 00:48:33 +01004728 /* accept only the listed bits */
4729 if (params->sta_flags_mask &
4730 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4731 BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4732 BIT(NL80211_STA_FLAG_ASSOCIATED) |
4733 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4734 BIT(NL80211_STA_FLAG_WME) |
4735 BIT(NL80211_STA_FLAG_MFP)))
4736 return -EINVAL;
4737
4738 /* but authenticated/associated only if driver handles it */
4739 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
4740 params->sta_flags_mask &
4741 (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4742 BIT(NL80211_STA_FLAG_ASSOCIATED)))
4743 return -EINVAL;
4744 break;
4745 case CFG80211_STA_IBSS:
4746 case CFG80211_STA_AP_STA:
4747 /* reject any changes other than AUTHORIZED */
4748 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
4749 return -EINVAL;
4750 break;
4751 case CFG80211_STA_TDLS_PEER_SETUP:
4752 /* reject any changes other than AUTHORIZED or WME */
4753 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4754 BIT(NL80211_STA_FLAG_WME)))
4755 return -EINVAL;
4756 /* force (at least) rates when authorizing */
4757 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
4758 !params->supported_rates)
4759 return -EINVAL;
4760 break;
4761 case CFG80211_STA_TDLS_PEER_ACTIVE:
4762 /* reject any changes */
4763 return -EINVAL;
Thomas Pederseneef941e2013-03-04 13:06:11 -08004764 case CFG80211_STA_MESH_PEER_KERNEL:
Johannes Berg77ee7c82013-02-15 00:48:33 +01004765 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4766 return -EINVAL;
4767 break;
Thomas Pederseneef941e2013-03-04 13:06:11 -08004768 case CFG80211_STA_MESH_PEER_USER:
Chun-Yeow Yeoh42925042015-04-18 01:30:02 +08004769 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
4770 params->plink_action != NL80211_PLINK_ACTION_BLOCK)
Johannes Berg77ee7c82013-02-15 00:48:33 +01004771 return -EINVAL;
4772 break;
4773 }
4774
Beni Lev06f7c882016-07-19 19:28:56 +03004775 /*
4776 * Older kernel versions ignored this attribute entirely, so don't
4777 * reject attempts to update it but mark it as unused instead so the
4778 * driver won't look at the data.
4779 */
4780 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
4781 statype != CFG80211_STA_TDLS_PEER_SETUP)
4782 params->opmode_notif_used = false;
4783
Johannes Berg77ee7c82013-02-15 00:48:33 +01004784 return 0;
4785}
4786EXPORT_SYMBOL(cfg80211_check_station_change);
4787
Johannes Berg5727ef12007-12-19 02:03:34 +01004788/*
Felix Fietkauc258d2d2009-11-11 17:23:31 +01004789 * Get vlan interface making sure it is running and on the right wiphy.
Johannes Berg5727ef12007-12-19 02:03:34 +01004790 */
Johannes Berg80b99892011-11-18 16:23:01 +01004791static struct net_device *get_vlan(struct genl_info *info,
4792 struct cfg80211_registered_device *rdev)
Johannes Berg5727ef12007-12-19 02:03:34 +01004793{
Johannes Berg463d0182009-07-14 00:33:35 +02004794 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
Johannes Berg80b99892011-11-18 16:23:01 +01004795 struct net_device *v;
4796 int ret;
Johannes Berg5727ef12007-12-19 02:03:34 +01004797
Johannes Berg80b99892011-11-18 16:23:01 +01004798 if (!vlanattr)
4799 return NULL;
4800
4801 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
4802 if (!v)
4803 return ERR_PTR(-ENODEV);
4804
4805 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
4806 ret = -EINVAL;
4807 goto error;
Johannes Berg5727ef12007-12-19 02:03:34 +01004808 }
Johannes Berg80b99892011-11-18 16:23:01 +01004809
Johannes Berg77ee7c82013-02-15 00:48:33 +01004810 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
4811 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4812 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
4813 ret = -EINVAL;
4814 goto error;
4815 }
4816
Johannes Berg80b99892011-11-18 16:23:01 +01004817 if (!netif_running(v)) {
4818 ret = -ENETDOWN;
4819 goto error;
4820 }
4821
4822 return v;
4823 error:
4824 dev_put(v);
4825 return ERR_PTR(ret);
Johannes Berg5727ef12007-12-19 02:03:34 +01004826}
4827
Johannes Berg94e860f2014-01-20 23:58:15 +01004828static const struct nla_policy
4829nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
Jouni Malinendf881292013-02-14 21:10:54 +02004830 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
4831 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
4832};
4833
Johannes Bergff276692013-02-15 00:09:01 +01004834static int nl80211_parse_sta_wme(struct genl_info *info,
4835 struct station_parameters *params)
Jouni Malinendf881292013-02-14 21:10:54 +02004836{
Jouni Malinendf881292013-02-14 21:10:54 +02004837 struct nlattr *tb[NL80211_STA_WME_MAX + 1];
4838 struct nlattr *nla;
4839 int err;
4840
Jouni Malinendf881292013-02-14 21:10:54 +02004841 /* parse WME attributes if present */
4842 if (!info->attrs[NL80211_ATTR_STA_WME])
4843 return 0;
4844
4845 nla = info->attrs[NL80211_ATTR_STA_WME];
4846 err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
Johannes Bergfe521452017-04-12 14:34:08 +02004847 nl80211_sta_wme_policy, info->extack);
Jouni Malinendf881292013-02-14 21:10:54 +02004848 if (err)
4849 return err;
4850
4851 if (tb[NL80211_STA_WME_UAPSD_QUEUES])
4852 params->uapsd_queues = nla_get_u8(
4853 tb[NL80211_STA_WME_UAPSD_QUEUES]);
4854 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
4855 return -EINVAL;
4856
4857 if (tb[NL80211_STA_WME_MAX_SP])
4858 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
4859
4860 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
4861 return -EINVAL;
4862
4863 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
4864
4865 return 0;
4866}
4867
Sunil Duttc01fc9a2013-10-09 20:45:21 +05304868static int nl80211_parse_sta_channel_info(struct genl_info *info,
4869 struct station_parameters *params)
4870{
4871 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
4872 params->supported_channels =
4873 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4874 params->supported_channels_len =
4875 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4876 /*
4877 * Need to include at least one (first channel, number of
4878 * channels) tuple for each subband, and must have proper
4879 * tuples for the rest of the data as well.
4880 */
4881 if (params->supported_channels_len < 2)
4882 return -EINVAL;
4883 if (params->supported_channels_len % 2)
4884 return -EINVAL;
4885 }
4886
4887 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
4888 params->supported_oper_classes =
4889 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4890 params->supported_oper_classes_len =
4891 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4892 /*
4893 * The value of the Length field of the Supported Operating
4894 * Classes element is between 2 and 253.
4895 */
4896 if (params->supported_oper_classes_len < 2 ||
4897 params->supported_oper_classes_len > 253)
4898 return -EINVAL;
4899 }
4900 return 0;
4901}
4902
Johannes Bergff276692013-02-15 00:09:01 +01004903static int nl80211_set_station_tdls(struct genl_info *info,
4904 struct station_parameters *params)
4905{
Sunil Duttc01fc9a2013-10-09 20:45:21 +05304906 int err;
Johannes Bergff276692013-02-15 00:09:01 +01004907 /* Dummy STA entry gets updated once the peer capabilities are known */
Jouni Malinen5e4b6f52013-05-16 20:11:08 +03004908 if (info->attrs[NL80211_ATTR_PEER_AID])
4909 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
Johannes Bergff276692013-02-15 00:09:01 +01004910 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
4911 params->ht_capa =
4912 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
4913 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
4914 params->vht_capa =
4915 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
4916
Sunil Duttc01fc9a2013-10-09 20:45:21 +05304917 err = nl80211_parse_sta_channel_info(info, params);
4918 if (err)
4919 return err;
4920
Johannes Bergff276692013-02-15 00:09:01 +01004921 return nl80211_parse_sta_wme(info, params);
4922}
4923
Johannes Berg5727ef12007-12-19 02:03:34 +01004924static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
4925{
Johannes Berg4c476992010-10-04 21:36:35 +02004926 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg4c476992010-10-04 21:36:35 +02004927 struct net_device *dev = info->user_ptr[1];
Johannes Berg5727ef12007-12-19 02:03:34 +01004928 struct station_parameters params;
Johannes Berg77ee7c82013-02-15 00:48:33 +01004929 u8 *mac_addr;
4930 int err;
Johannes Berg5727ef12007-12-19 02:03:34 +01004931
4932 memset(&params, 0, sizeof(params));
4933
Johannes Berg77ee7c82013-02-15 00:48:33 +01004934 if (!rdev->ops->change_station)
4935 return -EOPNOTSUPP;
4936
Ayala Bekere4208422015-10-23 11:20:06 +03004937 /*
4938 * AID and listen_interval properties can be set only for unassociated
4939 * station. Include these parameters here and will check them in
4940 * cfg80211_check_station_change().
4941 */
Ayala Bekera9bc31e2015-11-26 16:26:12 +01004942 if (info->attrs[NL80211_ATTR_STA_AID])
4943 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
Ayala Bekere4208422015-10-23 11:20:06 +03004944
4945 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
4946 params.listen_interval =
4947 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
4948 else
4949 params.listen_interval = -1;
Johannes Berg5727ef12007-12-19 02:03:34 +01004950
Ayala Beker17b94242016-03-17 15:41:38 +02004951 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
4952 u8 tmp;
4953
4954 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
4955 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
4956 return -EINVAL;
4957
4958 params.support_p2p_ps = tmp;
4959 } else {
4960 params.support_p2p_ps = -1;
4961 }
4962
Johannes Berg5727ef12007-12-19 02:03:34 +01004963 if (!info->attrs[NL80211_ATTR_MAC])
4964 return -EINVAL;
4965
4966 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4967
4968 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
4969 params.supported_rates =
4970 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4971 params.supported_rates_len =
4972 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4973 }
4974
Jouni Malinen9d62a982013-02-14 21:10:13 +02004975 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
4976 params.capability =
4977 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
4978 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
4979 }
4980
4981 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
4982 params.ext_capab =
4983 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4984 params.ext_capab_len =
4985 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4986 }
4987
Johannes Bergbdd3ae32012-01-02 13:30:03 +01004988 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
Johannes Berg5727ef12007-12-19 02:03:34 +01004989 return -EINVAL;
4990
Johannes Bergf8bacc22013-02-14 23:27:01 +01004991 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004992 params.plink_action =
Johannes Bergf8bacc22013-02-14 23:27:01 +01004993 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
4994 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
4995 return -EINVAL;
4996 }
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01004997
Johannes Bergf8bacc22013-02-14 23:27:01 +01004998 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
Javier Cardona9c3990a2011-05-03 16:57:11 -07004999 params.plink_state =
Johannes Bergf8bacc22013-02-14 23:27:01 +01005000 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
5001 if (params.plink_state >= NUM_NL80211_PLINK_STATES)
5002 return -EINVAL;
Masashi Honma7d27a0b2016-07-01 10:19:34 +09005003 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) {
5004 params.peer_aid = nla_get_u16(
5005 info->attrs[NL80211_ATTR_MESH_PEER_AID]);
5006 if (params.peer_aid > IEEE80211_MAX_AID)
5007 return -EINVAL;
5008 }
Johannes Bergf8bacc22013-02-14 23:27:01 +01005009 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
5010 }
Javier Cardona9c3990a2011-05-03 16:57:11 -07005011
Marco Porsch3b1c5a52013-01-07 16:04:52 +01005012 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) {
5013 enum nl80211_mesh_power_mode pm = nla_get_u32(
5014 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
5015
5016 if (pm <= NL80211_MESH_POWER_UNKNOWN ||
5017 pm > NL80211_MESH_POWER_MAX)
5018 return -EINVAL;
5019
5020 params.local_pm = pm;
5021 }
5022
Beni Lev06f7c882016-07-19 19:28:56 +03005023 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5024 params.opmode_notif_used = true;
5025 params.opmode_notif =
5026 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5027 }
5028
Johannes Berg77ee7c82013-02-15 00:48:33 +01005029 /* Include parameters for TDLS peer (will check later) */
5030 err = nl80211_set_station_tdls(info, &params);
5031 if (err)
5032 return err;
5033
5034 params.vlan = get_vlan(info, rdev);
5035 if (IS_ERR(params.vlan))
5036 return PTR_ERR(params.vlan);
5037
Johannes Berga97f4422009-06-18 17:23:43 +02005038 switch (dev->ieee80211_ptr->iftype) {
5039 case NL80211_IFTYPE_AP:
5040 case NL80211_IFTYPE_AP_VLAN:
Johannes Berg074ac8d2010-09-16 14:58:22 +02005041 case NL80211_IFTYPE_P2P_GO:
Johannes Berg074ac8d2010-09-16 14:58:22 +02005042 case NL80211_IFTYPE_P2P_CLIENT:
Johannes Berga97f4422009-06-18 17:23:43 +02005043 case NL80211_IFTYPE_STATION:
Antonio Quartulli267335d2012-01-31 20:25:47 +01005044 case NL80211_IFTYPE_ADHOC:
Johannes Berga97f4422009-06-18 17:23:43 +02005045 case NL80211_IFTYPE_MESH_POINT:
Johannes Berga97f4422009-06-18 17:23:43 +02005046 break;
5047 default:
Johannes Berg77ee7c82013-02-15 00:48:33 +01005048 err = -EOPNOTSUPP;
5049 goto out_put_vlan;
Johannes Berg034d6552009-05-27 10:35:29 +02005050 }
5051
Johannes Berg77ee7c82013-02-15 00:48:33 +01005052 /* driver will call cfg80211_check_station_change() */
Hila Gonene35e4d22012-06-27 17:19:42 +03005053 err = rdev_change_station(rdev, dev, mac_addr, &params);
Johannes Berg5727ef12007-12-19 02:03:34 +01005054
Johannes Berg77ee7c82013-02-15 00:48:33 +01005055 out_put_vlan:
Johannes Berg5727ef12007-12-19 02:03:34 +01005056 if (params.vlan)
5057 dev_put(params.vlan);
Johannes Berg3b858752009-03-12 09:55:09 +01005058
Johannes Berg5727ef12007-12-19 02:03:34 +01005059 return err;
5060}
5061
5062static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
5063{
Johannes Berg4c476992010-10-04 21:36:35 +02005064 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg5727ef12007-12-19 02:03:34 +01005065 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02005066 struct net_device *dev = info->user_ptr[1];
Johannes Berg5727ef12007-12-19 02:03:34 +01005067 struct station_parameters params;
5068 u8 *mac_addr = NULL;
Johannes Bergbda95eb2015-11-26 16:26:13 +01005069 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5070 BIT(NL80211_STA_FLAG_ASSOCIATED);
Johannes Berg5727ef12007-12-19 02:03:34 +01005071
5072 memset(&params, 0, sizeof(params));
5073
Johannes Berg984c3112013-02-14 23:43:25 +01005074 if (!rdev->ops->add_station)
5075 return -EOPNOTSUPP;
5076
Johannes Berg5727ef12007-12-19 02:03:34 +01005077 if (!info->attrs[NL80211_ATTR_MAC])
5078 return -EINVAL;
5079
Johannes Berg5727ef12007-12-19 02:03:34 +01005080 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
5081 return -EINVAL;
5082
5083 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
5084 return -EINVAL;
5085
Jouni Malinen5e4b6f52013-05-16 20:11:08 +03005086 if (!info->attrs[NL80211_ATTR_STA_AID] &&
5087 !info->attrs[NL80211_ATTR_PEER_AID])
Thadeu Lima de Souza Cascardo0e956c12010-02-12 12:34:50 -02005088 return -EINVAL;
5089
Johannes Berg5727ef12007-12-19 02:03:34 +01005090 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5091 params.supported_rates =
5092 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5093 params.supported_rates_len =
5094 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5095 params.listen_interval =
5096 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
Johannes Berg51b50fb2009-05-24 16:42:30 +02005097
Ayala Beker17b94242016-03-17 15:41:38 +02005098 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
5099 u8 tmp;
5100
5101 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
5102 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
5103 return -EINVAL;
5104
5105 params.support_p2p_ps = tmp;
5106 } else {
5107 /*
5108 * if not specified, assume it's supported for P2P GO interface,
5109 * and is NOT supported for AP interface
5110 */
5111 params.support_p2p_ps =
5112 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
5113 }
5114
Jouni Malinen3d124ea2013-05-27 18:24:02 +03005115 if (info->attrs[NL80211_ATTR_PEER_AID])
Jouni Malinen5e4b6f52013-05-16 20:11:08 +03005116 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
Jouni Malinen3d124ea2013-05-27 18:24:02 +03005117 else
5118 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
Thadeu Lima de Souza Cascardo0e956c12010-02-12 12:34:50 -02005119 if (!params.aid || params.aid > IEEE80211_MAX_AID)
5120 return -EINVAL;
Johannes Berg51b50fb2009-05-24 16:42:30 +02005121
Jouni Malinen9d62a982013-02-14 21:10:13 +02005122 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
5123 params.capability =
5124 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5125 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5126 }
5127
5128 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5129 params.ext_capab =
5130 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5131 params.ext_capab_len =
5132 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5133 }
5134
Jouni Malinen36aedc92008-08-25 11:58:58 +03005135 if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
5136 params.ht_capa =
5137 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
Johannes Berg5727ef12007-12-19 02:03:34 +01005138
Mahesh Palivelaf461be3e2012-10-11 08:04:52 +00005139 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
5140 params.vht_capa =
5141 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
5142
Marek Kwaczynski60f4a7b2013-12-03 10:04:59 +01005143 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5144 params.opmode_notif_used = true;
5145 params.opmode_notif =
5146 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5147 }
5148
Johannes Bergf8bacc22013-02-14 23:27:01 +01005149 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
Javier Cardona96b78df2011-04-07 15:08:33 -07005150 params.plink_action =
Johannes Bergf8bacc22013-02-14 23:27:01 +01005151 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
5152 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
5153 return -EINVAL;
5154 }
Javier Cardona96b78df2011-04-07 15:08:33 -07005155
Sunil Duttc01fc9a2013-10-09 20:45:21 +05305156 err = nl80211_parse_sta_channel_info(info, &params);
5157 if (err)
5158 return err;
5159
Johannes Bergff276692013-02-15 00:09:01 +01005160 err = nl80211_parse_sta_wme(info, &params);
5161 if (err)
5162 return err;
Johannes Bergbdd90d52011-12-14 12:20:27 +01005163
Johannes Bergbdd3ae32012-01-02 13:30:03 +01005164 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
Johannes Berg5727ef12007-12-19 02:03:34 +01005165 return -EINVAL;
5166
Johannes Berg496fcc22015-03-12 08:53:27 +02005167 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
5168 * as userspace might just pass through the capabilities from the IEs
5169 * directly, rather than enforcing this restriction and returning an
5170 * error in this case.
5171 */
5172 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
5173 params.ht_capa = NULL;
5174 params.vht_capa = NULL;
5175 }
5176
Johannes Berg77ee7c82013-02-15 00:48:33 +01005177 /* When you run into this, adjust the code below for the new flag */
5178 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
5179
Johannes Bergbdd90d52011-12-14 12:20:27 +01005180 switch (dev->ieee80211_ptr->iftype) {
5181 case NL80211_IFTYPE_AP:
5182 case NL80211_IFTYPE_AP_VLAN:
5183 case NL80211_IFTYPE_P2P_GO:
Johannes Berg984c3112013-02-14 23:43:25 +01005184 /* ignore WME attributes if iface/sta is not capable */
5185 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
5186 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
5187 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
Eliad Pellerc75786c2011-08-23 14:37:46 +03005188
Johannes Bergbdd90d52011-12-14 12:20:27 +01005189 /* TDLS peers cannot be added */
Jouni Malinen3d124ea2013-05-27 18:24:02 +03005190 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5191 info->attrs[NL80211_ATTR_PEER_AID])
Johannes Berg4319e192011-09-07 11:50:48 +02005192 return -EINVAL;
Johannes Bergbdd90d52011-12-14 12:20:27 +01005193 /* but don't bother the driver with it */
5194 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
Eliad Pellerc75786c2011-08-23 14:37:46 +03005195
Johannes Bergd582cff2012-10-26 17:53:44 +02005196 /* allow authenticated/associated only if driver handles it */
5197 if (!(rdev->wiphy.features &
5198 NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
Johannes Bergbda95eb2015-11-26 16:26:13 +01005199 params.sta_flags_mask & auth_assoc)
Johannes Bergd582cff2012-10-26 17:53:44 +02005200 return -EINVAL;
5201
Johannes Bergbda95eb2015-11-26 16:26:13 +01005202 /* Older userspace, or userspace wanting to be compatible with
5203 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
5204 * and assoc flags in the mask, but assumes the station will be
5205 * added as associated anyway since this was the required driver
5206 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
5207 * introduced.
5208 * In order to not bother drivers with this quirk in the API
5209 * set the flags in both the mask and set for new stations in
5210 * this case.
5211 */
5212 if (!(params.sta_flags_mask & auth_assoc)) {
5213 params.sta_flags_mask |= auth_assoc;
5214 params.sta_flags_set |= auth_assoc;
5215 }
5216
Johannes Bergbdd90d52011-12-14 12:20:27 +01005217 /* must be last in here for error handling */
5218 params.vlan = get_vlan(info, rdev);
5219 if (IS_ERR(params.vlan))
5220 return PTR_ERR(params.vlan);
5221 break;
5222 case NL80211_IFTYPE_MESH_POINT:
Johannes Berg984c3112013-02-14 23:43:25 +01005223 /* ignore uAPSD data */
5224 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5225
Johannes Bergd582cff2012-10-26 17:53:44 +02005226 /* associated is disallowed */
5227 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
5228 return -EINVAL;
Johannes Bergbdd90d52011-12-14 12:20:27 +01005229 /* TDLS peers cannot be added */
Jouni Malinen3d124ea2013-05-27 18:24:02 +03005230 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5231 info->attrs[NL80211_ATTR_PEER_AID])
Johannes Berg4319e192011-09-07 11:50:48 +02005232 return -EINVAL;
Johannes Bergbdd90d52011-12-14 12:20:27 +01005233 break;
5234 case NL80211_IFTYPE_STATION:
Johannes Berg93d08f02013-03-04 09:29:46 +01005235 case NL80211_IFTYPE_P2P_CLIENT:
Johannes Berg984c3112013-02-14 23:43:25 +01005236 /* ignore uAPSD data */
5237 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5238
Johannes Berg77ee7c82013-02-15 00:48:33 +01005239 /* these are disallowed */
5240 if (params.sta_flags_mask &
5241 (BIT(NL80211_STA_FLAG_ASSOCIATED) |
5242 BIT(NL80211_STA_FLAG_AUTHENTICATED)))
Johannes Bergd582cff2012-10-26 17:53:44 +02005243 return -EINVAL;
Johannes Bergbdd90d52011-12-14 12:20:27 +01005244 /* Only TDLS peers can be added */
5245 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
5246 return -EINVAL;
5247 /* Can only add if TDLS ... */
5248 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
5249 return -EOPNOTSUPP;
5250 /* ... with external setup is supported */
5251 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
5252 return -EOPNOTSUPP;
Johannes Berg77ee7c82013-02-15 00:48:33 +01005253 /*
5254 * Older wpa_supplicant versions always mark the TDLS peer
5255 * as authorized, but it shouldn't yet be.
5256 */
5257 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
Johannes Bergbdd90d52011-12-14 12:20:27 +01005258 break;
5259 default:
5260 return -EOPNOTSUPP;
Eliad Pellerc75786c2011-08-23 14:37:46 +03005261 }
5262
Johannes Bergbdd90d52011-12-14 12:20:27 +01005263 /* be aware of params.vlan when changing code here */
Johannes Berg5727ef12007-12-19 02:03:34 +01005264
Hila Gonene35e4d22012-06-27 17:19:42 +03005265 err = rdev_add_station(rdev, dev, mac_addr, &params);
Johannes Berg5727ef12007-12-19 02:03:34 +01005266
Johannes Berg5727ef12007-12-19 02:03:34 +01005267 if (params.vlan)
5268 dev_put(params.vlan);
Johannes Berg5727ef12007-12-19 02:03:34 +01005269 return err;
5270}
5271
5272static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
5273{
Johannes Berg4c476992010-10-04 21:36:35 +02005274 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5275 struct net_device *dev = info->user_ptr[1];
Jouni Malinen89c771e2014-10-10 20:52:40 +03005276 struct station_del_parameters params;
5277
5278 memset(&params, 0, sizeof(params));
Johannes Berg5727ef12007-12-19 02:03:34 +01005279
5280 if (info->attrs[NL80211_ATTR_MAC])
Jouni Malinen89c771e2014-10-10 20:52:40 +03005281 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
Johannes Berg5727ef12007-12-19 02:03:34 +01005282
Johannes Berge80cf852009-05-11 14:43:13 +02005283 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
Marco Porschd5d9de02010-03-30 10:00:16 +02005284 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
Johannes Berg074ac8d2010-09-16 14:58:22 +02005285 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
Johannes Berg4c476992010-10-04 21:36:35 +02005286 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5287 return -EINVAL;
Johannes Berge80cf852009-05-11 14:43:13 +02005288
Johannes Berg4c476992010-10-04 21:36:35 +02005289 if (!rdev->ops->del_station)
5290 return -EOPNOTSUPP;
Johannes Berg5727ef12007-12-19 02:03:34 +01005291
Jouni Malinen98856862014-10-20 13:20:45 +03005292 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
5293 params.subtype =
5294 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
5295 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
5296 params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
5297 return -EINVAL;
5298 } else {
5299 /* Default to Deauthentication frame */
5300 params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
5301 }
5302
5303 if (info->attrs[NL80211_ATTR_REASON_CODE]) {
5304 params.reason_code =
5305 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5306 if (params.reason_code == 0)
5307 return -EINVAL; /* 0 is reserved */
5308 } else {
5309 /* Default to reason code 2 */
5310 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
5311 }
5312
Jouni Malinen89c771e2014-10-10 20:52:40 +03005313 return rdev_del_station(rdev, dev, &params);
Johannes Berg5727ef12007-12-19 02:03:34 +01005314}
5315
Eric W. Biederman15e47302012-09-07 20:12:54 +00005316static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005317 int flags, struct net_device *dev,
5318 u8 *dst, u8 *next_hop,
5319 struct mpath_info *pinfo)
5320{
5321 void *hdr;
5322 struct nlattr *pinfoattr;
5323
Henning Rogge1ef4c852014-11-04 16:14:58 +01005324 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005325 if (!hdr)
5326 return -1;
5327
David S. Miller9360ffd2012-03-29 04:41:26 -04005328 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5329 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
5330 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
5331 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
5332 goto nla_put_failure;
Johannes Bergf5ea9122009-08-07 16:17:38 +02005333
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005334 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
5335 if (!pinfoattr)
5336 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -04005337 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
5338 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
5339 pinfo->frame_qlen))
5340 goto nla_put_failure;
5341 if (((pinfo->filled & MPATH_INFO_SN) &&
5342 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
5343 ((pinfo->filled & MPATH_INFO_METRIC) &&
5344 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
5345 pinfo->metric)) ||
5346 ((pinfo->filled & MPATH_INFO_EXPTIME) &&
5347 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
5348 pinfo->exptime)) ||
5349 ((pinfo->filled & MPATH_INFO_FLAGS) &&
5350 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
5351 pinfo->flags)) ||
5352 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
5353 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
5354 pinfo->discovery_timeout)) ||
5355 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
5356 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
5357 pinfo->discovery_retries)))
5358 goto nla_put_failure;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005359
5360 nla_nest_end(msg, pinfoattr);
5361
Johannes Berg053c0952015-01-16 22:09:00 +01005362 genlmsg_end(msg, hdr);
5363 return 0;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005364
5365 nla_put_failure:
Thomas Grafbc3ed282008-06-03 16:36:54 -07005366 genlmsg_cancel(msg, hdr);
5367 return -EMSGSIZE;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005368}
5369
5370static int nl80211_dump_mpath(struct sk_buff *skb,
Johannes Bergbba95fe2008-07-29 13:22:51 +02005371 struct netlink_callback *cb)
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005372{
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005373 struct mpath_info pinfo;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08005374 struct cfg80211_registered_device *rdev;
Johannes Berg97990a02013-04-19 01:02:55 +02005375 struct wireless_dev *wdev;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005376 u8 dst[ETH_ALEN];
5377 u8 next_hop[ETH_ALEN];
Johannes Berg97990a02013-04-19 01:02:55 +02005378 int path_idx = cb->args[2];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005379 int err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005380
Johannes Bergea90e0d2017-03-15 14:26:04 +01005381 rtnl_lock();
Zhao, Gang1b8ec872014-04-21 12:53:02 +08005382 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
Johannes Berg67748892010-10-04 21:14:06 +02005383 if (err)
Johannes Bergea90e0d2017-03-15 14:26:04 +01005384 goto out_err;
Johannes Bergbba95fe2008-07-29 13:22:51 +02005385
Zhao, Gang1b8ec872014-04-21 12:53:02 +08005386 if (!rdev->ops->dump_mpath) {
Jouni Malineneec60b02009-03-20 21:21:19 +02005387 err = -EOPNOTSUPP;
Johannes Bergbba95fe2008-07-29 13:22:51 +02005388 goto out_err;
5389 }
5390
Johannes Berg97990a02013-04-19 01:02:55 +02005391 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
Jouni Malineneec60b02009-03-20 21:21:19 +02005392 err = -EOPNOTSUPP;
Roel Kluin0448b5f2009-08-22 21:15:49 +02005393 goto out_err;
Jouni Malineneec60b02009-03-20 21:21:19 +02005394 }
5395
Johannes Bergbba95fe2008-07-29 13:22:51 +02005396 while (1) {
Zhao, Gang1b8ec872014-04-21 12:53:02 +08005397 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
Johannes Berg97990a02013-04-19 01:02:55 +02005398 next_hop, &pinfo);
Johannes Bergbba95fe2008-07-29 13:22:51 +02005399 if (err == -ENOENT)
5400 break;
5401 if (err)
Johannes Berg3b858752009-03-12 09:55:09 +01005402 goto out_err;
Johannes Bergbba95fe2008-07-29 13:22:51 +02005403
Eric W. Biederman15e47302012-09-07 20:12:54 +00005404 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
Johannes Bergbba95fe2008-07-29 13:22:51 +02005405 cb->nlh->nlmsg_seq, NLM_F_MULTI,
Johannes Berg97990a02013-04-19 01:02:55 +02005406 wdev->netdev, dst, next_hop,
Johannes Bergbba95fe2008-07-29 13:22:51 +02005407 &pinfo) < 0)
5408 goto out;
5409
5410 path_idx++;
5411 }
5412
Johannes Bergbba95fe2008-07-29 13:22:51 +02005413 out:
Johannes Berg97990a02013-04-19 01:02:55 +02005414 cb->args[2] = path_idx;
Johannes Bergbba95fe2008-07-29 13:22:51 +02005415 err = skb->len;
Johannes Bergbba95fe2008-07-29 13:22:51 +02005416 out_err:
Johannes Bergea90e0d2017-03-15 14:26:04 +01005417 rtnl_unlock();
Johannes Bergbba95fe2008-07-29 13:22:51 +02005418 return err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005419}
5420
5421static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
5422{
Johannes Berg4c476992010-10-04 21:36:35 +02005423 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005424 int err;
Johannes Berg4c476992010-10-04 21:36:35 +02005425 struct net_device *dev = info->user_ptr[1];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005426 struct mpath_info pinfo;
5427 struct sk_buff *msg;
5428 u8 *dst = NULL;
5429 u8 next_hop[ETH_ALEN];
5430
5431 memset(&pinfo, 0, sizeof(pinfo));
5432
5433 if (!info->attrs[NL80211_ATTR_MAC])
5434 return -EINVAL;
5435
5436 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5437
Johannes Berg4c476992010-10-04 21:36:35 +02005438 if (!rdev->ops->get_mpath)
5439 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01005440
Johannes Berg4c476992010-10-04 21:36:35 +02005441 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5442 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02005443
Hila Gonene35e4d22012-06-27 17:19:42 +03005444 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005445 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02005446 return err;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005447
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -07005448 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005449 if (!msg)
Johannes Berg4c476992010-10-04 21:36:35 +02005450 return -ENOMEM;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005451
Eric W. Biederman15e47302012-09-07 20:12:54 +00005452 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
Johannes Berg4c476992010-10-04 21:36:35 +02005453 dev, dst, next_hop, &pinfo) < 0) {
5454 nlmsg_free(msg);
5455 return -ENOBUFS;
5456 }
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005457
Johannes Berg4c476992010-10-04 21:36:35 +02005458 return genlmsg_reply(msg, info);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005459}
5460
5461static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
5462{
Johannes Berg4c476992010-10-04 21:36:35 +02005463 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5464 struct net_device *dev = info->user_ptr[1];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005465 u8 *dst = NULL;
5466 u8 *next_hop = NULL;
5467
5468 if (!info->attrs[NL80211_ATTR_MAC])
5469 return -EINVAL;
5470
5471 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5472 return -EINVAL;
5473
5474 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5475 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5476
Johannes Berg4c476992010-10-04 21:36:35 +02005477 if (!rdev->ops->change_mpath)
5478 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01005479
Johannes Berg4c476992010-10-04 21:36:35 +02005480 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5481 return -EOPNOTSUPP;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005482
Hila Gonene35e4d22012-06-27 17:19:42 +03005483 return rdev_change_mpath(rdev, dev, dst, next_hop);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005484}
Johannes Berg4c476992010-10-04 21:36:35 +02005485
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005486static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
5487{
Johannes Berg4c476992010-10-04 21:36:35 +02005488 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5489 struct net_device *dev = info->user_ptr[1];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005490 u8 *dst = NULL;
5491 u8 *next_hop = NULL;
5492
5493 if (!info->attrs[NL80211_ATTR_MAC])
5494 return -EINVAL;
5495
5496 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5497 return -EINVAL;
5498
5499 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5500 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5501
Johannes Berg4c476992010-10-04 21:36:35 +02005502 if (!rdev->ops->add_mpath)
5503 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01005504
Johannes Berg4c476992010-10-04 21:36:35 +02005505 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5506 return -EOPNOTSUPP;
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005507
Hila Gonene35e4d22012-06-27 17:19:42 +03005508 return rdev_add_mpath(rdev, dev, dst, next_hop);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005509}
5510
5511static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
5512{
Johannes Berg4c476992010-10-04 21:36:35 +02005513 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5514 struct net_device *dev = info->user_ptr[1];
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005515 u8 *dst = NULL;
5516
5517 if (info->attrs[NL80211_ATTR_MAC])
5518 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5519
Johannes Berg4c476992010-10-04 21:36:35 +02005520 if (!rdev->ops->del_mpath)
5521 return -EOPNOTSUPP;
Johannes Berg3b858752009-03-12 09:55:09 +01005522
Hila Gonene35e4d22012-06-27 17:19:42 +03005523 return rdev_del_mpath(rdev, dev, dst);
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +01005524}
5525
Henning Rogge66be7d22014-09-12 08:58:49 +02005526static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
5527{
5528 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5529 int err;
5530 struct net_device *dev = info->user_ptr[1];
5531 struct mpath_info pinfo;
5532 struct sk_buff *msg;
5533 u8 *dst = NULL;
5534 u8 mpp[ETH_ALEN];
5535
5536 memset(&pinfo, 0, sizeof(pinfo));
5537
5538 if (!info->attrs[NL80211_ATTR_MAC])
5539 return -EINVAL;
5540
5541 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5542
5543 if (!rdev->ops->get_mpp)
5544 return -EOPNOTSUPP;
5545
5546 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5547 return -EOPNOTSUPP;
5548
5549 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
5550 if (err)
5551 return err;
5552
5553 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5554 if (!msg)
5555 return -ENOMEM;
5556
5557 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
5558 dev, dst, mpp, &pinfo) < 0) {
5559 nlmsg_free(msg);
5560 return -ENOBUFS;
5561 }
5562
5563 return genlmsg_reply(msg, info);
5564}
5565
5566static int nl80211_dump_mpp(struct sk_buff *skb,
5567 struct netlink_callback *cb)
5568{
5569 struct mpath_info pinfo;
5570 struct cfg80211_registered_device *rdev;
5571 struct wireless_dev *wdev;
5572 u8 dst[ETH_ALEN];
5573 u8 mpp[ETH_ALEN];
5574 int path_idx = cb->args[2];
5575 int err;
5576
Johannes Bergea90e0d2017-03-15 14:26:04 +01005577 rtnl_lock();
Henning Rogge66be7d22014-09-12 08:58:49 +02005578 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
5579 if (err)
Johannes Bergea90e0d2017-03-15 14:26:04 +01005580 goto out_err;
Henning Rogge66be7d22014-09-12 08:58:49 +02005581
5582 if (!rdev->ops->dump_mpp) {
5583 err = -EOPNOTSUPP;
5584 goto out_err;
5585 }
5586
5587 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5588 err = -EOPNOTSUPP;
5589 goto out_err;
5590 }
5591
5592 while (1) {
5593 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
5594 mpp, &pinfo);
5595 if (err == -ENOENT)
5596 break;
5597 if (err)
5598 goto out_err;
5599
5600 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
5601 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5602 wdev->netdev, dst, mpp,
5603 &pinfo) < 0)
5604 goto out;
5605
5606 path_idx++;
5607 }
5608
5609 out:
5610 cb->args[2] = path_idx;
5611 err = skb->len;
5612 out_err:
Johannes Bergea90e0d2017-03-15 14:26:04 +01005613 rtnl_unlock();
Henning Rogge66be7d22014-09-12 08:58:49 +02005614 return err;
5615}
5616
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005617static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
5618{
Johannes Berg4c476992010-10-04 21:36:35 +02005619 struct cfg80211_registered_device *rdev = info->user_ptr[0];
5620 struct net_device *dev = info->user_ptr[1];
Simon Wunderlichc56589e2013-11-21 18:19:49 +01005621 struct wireless_dev *wdev = dev->ieee80211_ptr;
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005622 struct bss_parameters params;
Simon Wunderlichc56589e2013-11-21 18:19:49 +01005623 int err;
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005624
5625 memset(&params, 0, sizeof(params));
5626 /* default to not changing parameters */
5627 params.use_cts_prot = -1;
5628 params.use_short_preamble = -1;
5629 params.use_short_slot_time = -1;
Felix Fietkaufd8aaaf2010-04-27 01:23:35 +02005630 params.ap_isolate = -1;
Helmut Schaa50b12f52010-11-19 12:40:25 +01005631 params.ht_opmode = -1;
Johannes Berg53cabad2012-11-14 15:17:28 +01005632 params.p2p_ctwindow = -1;
5633 params.p2p_opp_ps = -1;
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005634
5635 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
5636 params.use_cts_prot =
5637 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
5638 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
5639 params.use_short_preamble =
5640 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
5641 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
5642 params.use_short_slot_time =
5643 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
Jouni Malinen90c97a02008-10-30 16:59:22 +02005644 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
5645 params.basic_rates =
5646 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5647 params.basic_rates_len =
5648 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5649 }
Felix Fietkaufd8aaaf2010-04-27 01:23:35 +02005650 if (info->attrs[NL80211_ATTR_AP_ISOLATE])
5651 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
Helmut Schaa50b12f52010-11-19 12:40:25 +01005652 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
5653 params.ht_opmode =
5654 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005655
Johannes Berg53cabad2012-11-14 15:17:28 +01005656 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
5657 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5658 return -EINVAL;
5659 params.p2p_ctwindow =
5660 nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
5661 if (params.p2p_ctwindow < 0)
5662 return -EINVAL;
5663 if (params.p2p_ctwindow != 0 &&
5664 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
5665 return -EINVAL;
5666 }
5667
5668 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
5669 u8 tmp;
5670
5671 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5672 return -EINVAL;
5673 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
5674 if (tmp > 1)
5675 return -EINVAL;
5676 params.p2p_opp_ps = tmp;
5677 if (params.p2p_opp_ps &&
5678 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
5679 return -EINVAL;
5680 }
5681
Johannes Berg4c476992010-10-04 21:36:35 +02005682 if (!rdev->ops->change_bss)
5683 return -EOPNOTSUPP;
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005684
Johannes Berg074ac8d2010-09-16 14:58:22 +02005685 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
Johannes Berg4c476992010-10-04 21:36:35 +02005686 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5687 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02005688
Simon Wunderlichc56589e2013-11-21 18:19:49 +01005689 wdev_lock(wdev);
5690 err = rdev_change_bss(rdev, dev, &params);
5691 wdev_unlock(wdev);
5692
5693 return err;
Jouni Malinen9f1ba902008-08-07 20:07:01 +03005694}
5695
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07005696static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
5697{
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07005698 char *data = NULL;
Ilan peer05050752015-03-04 00:32:06 -05005699 bool is_indoor;
Luis R. Rodriguez57b5ce02012-07-12 11:49:18 -07005700 enum nl80211_user_reg_hint_type user_reg_hint_type;
Ilan peer05050752015-03-04 00:32:06 -05005701 u32 owner_nlportid;
5702
Luis R. Rodriguez80778f12009-02-21 00:04:22 -05005703 /*
5704 * You should only get this when cfg80211 hasn't yet initialized
5705 * completely when built-in to the kernel right between the time
5706 * window between nl80211_init() and regulatory_init(), if that is
5707 * even possible.
5708 */
Johannes Berg458f4f92012-12-06 15:47:38 +01005709 if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
Luis R. Rodriguezfe33eb32009-02-21 00:04:30 -05005710 return -EINPROGRESS;
Luis R. Rodriguez80778f12009-02-21 00:04:22 -05005711
Luis R. Rodriguez57b5ce02012-07-12 11:49:18 -07005712 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
5713 user_reg_hint_type =
5714 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
5715 else
5716 user_reg_hint_type = NL80211_USER_REG_HINT_USER;
5717
5718 switch (user_reg_hint_type) {
5719 case NL80211_USER_REG_HINT_USER:
5720 case NL80211_USER_REG_HINT_CELL_BASE:
Ilan Peer52616f22014-02-25 16:26:00 +02005721 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
5722 return -EINVAL;
5723
5724 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
5725 return regulatory_hint_user(data, user_reg_hint_type);
5726 case NL80211_USER_REG_HINT_INDOOR:
Ilan peer05050752015-03-04 00:32:06 -05005727 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
5728 owner_nlportid = info->snd_portid;
5729 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
5730 } else {
5731 owner_nlportid = 0;
5732 is_indoor = true;
5733 }
5734
5735 return regulatory_hint_indoor(is_indoor, owner_nlportid);
Luis R. Rodriguez57b5ce02012-07-12 11:49:18 -07005736 default:
5737 return -EINVAL;
5738 }
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07005739}
5740
Johannes Berg1ea4ff32017-09-13 16:07:22 +02005741static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info)
5742{
5743 return reg_reload_regdb();
5744}
5745
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005746static int nl80211_get_mesh_config(struct sk_buff *skb,
Johannes Berg29cbe682010-12-03 09:20:44 +01005747 struct genl_info *info)
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005748{
Johannes Berg4c476992010-10-04 21:36:35 +02005749 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg4c476992010-10-04 21:36:35 +02005750 struct net_device *dev = info->user_ptr[1];
Johannes Berg29cbe682010-12-03 09:20:44 +01005751 struct wireless_dev *wdev = dev->ieee80211_ptr;
5752 struct mesh_config cur_params;
5753 int err = 0;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005754 void *hdr;
5755 struct nlattr *pinfoattr;
5756 struct sk_buff *msg;
5757
Johannes Berg29cbe682010-12-03 09:20:44 +01005758 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
5759 return -EOPNOTSUPP;
5760
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005761 if (!rdev->ops->get_mesh_config)
Johannes Berg4c476992010-10-04 21:36:35 +02005762 return -EOPNOTSUPP;
Jouni Malinenf3f92582009-03-20 17:57:36 +02005763
Johannes Berg29cbe682010-12-03 09:20:44 +01005764 wdev_lock(wdev);
5765 /* If not connected, get default parameters */
5766 if (!wdev->mesh_id_len)
5767 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
5768 else
Hila Gonene35e4d22012-06-27 17:19:42 +03005769 err = rdev_get_mesh_config(rdev, dev, &cur_params);
Johannes Berg29cbe682010-12-03 09:20:44 +01005770 wdev_unlock(wdev);
5771
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005772 if (err)
Johannes Berg4c476992010-10-04 21:36:35 +02005773 return err;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005774
5775 /* Draw up a netlink message to send back */
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -07005776 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg4c476992010-10-04 21:36:35 +02005777 if (!msg)
5778 return -ENOMEM;
Eric W. Biederman15e47302012-09-07 20:12:54 +00005779 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005780 NL80211_CMD_GET_MESH_CONFIG);
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005781 if (!hdr)
Julia Lawallefe1cf02011-01-28 15:17:11 +01005782 goto out;
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005783 pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005784 if (!pinfoattr)
5785 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -04005786 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5787 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
5788 cur_params.dot11MeshRetryTimeout) ||
5789 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
5790 cur_params.dot11MeshConfirmTimeout) ||
5791 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
5792 cur_params.dot11MeshHoldingTimeout) ||
5793 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
5794 cur_params.dot11MeshMaxPeerLinks) ||
5795 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
5796 cur_params.dot11MeshMaxRetries) ||
5797 nla_put_u8(msg, NL80211_MESHCONF_TTL,
5798 cur_params.dot11MeshTTL) ||
5799 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
5800 cur_params.element_ttl) ||
5801 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
5802 cur_params.auto_open_plinks) ||
John W. Linville7eab0f62012-04-12 14:25:14 -04005803 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
5804 cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
David S. Miller9360ffd2012-03-29 04:41:26 -04005805 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
5806 cur_params.dot11MeshHWMPmaxPREQretries) ||
5807 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
5808 cur_params.path_refresh_time) ||
5809 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
5810 cur_params.min_discovery_timeout) ||
5811 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
5812 cur_params.dot11MeshHWMPactivePathTimeout) ||
5813 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
5814 cur_params.dot11MeshHWMPpreqMinInterval) ||
5815 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
5816 cur_params.dot11MeshHWMPperrMinInterval) ||
5817 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
5818 cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
5819 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
5820 cur_params.dot11MeshHWMPRootMode) ||
5821 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
5822 cur_params.dot11MeshHWMPRannInterval) ||
5823 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
5824 cur_params.dot11MeshGateAnnouncementProtocol) ||
5825 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
5826 cur_params.dot11MeshForwarding) ||
Masashi Honma335d5342017-03-16 10:57:17 +09005827 nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
Ashok Nagarajan70c33ea2012-04-30 14:20:32 -07005828 cur_params.rssi_threshold) ||
5829 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
Chun-Yeow Yeohac1073a2012-06-14 02:06:06 +08005830 cur_params.ht_opmode) ||
5831 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
5832 cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
5833 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
Chun-Yeow Yeoh728b19e2012-06-14 02:06:10 +08005834 cur_params.dot11MeshHWMProotInterval) ||
5835 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
Marco Porsch3b1c5a52013-01-07 16:04:52 +01005836 cur_params.dot11MeshHWMPconfirmationInterval) ||
5837 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
5838 cur_params.power_mode) ||
5839 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
Colleen Twitty8e7c0532013-06-03 09:53:39 -07005840 cur_params.dot11MeshAwakeWindowDuration) ||
5841 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
5842 cur_params.plink_timeout))
David S. Miller9360ffd2012-03-29 04:41:26 -04005843 goto nla_put_failure;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005844 nla_nest_end(msg, pinfoattr);
5845 genlmsg_end(msg, hdr);
Johannes Berg4c476992010-10-04 21:36:35 +02005846 return genlmsg_reply(msg, info);
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005847
Johannes Berg3b858752009-03-12 09:55:09 +01005848 nla_put_failure:
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005849 genlmsg_cancel(msg, hdr);
Julia Lawallefe1cf02011-01-28 15:17:11 +01005850 out:
Yuri Ershovd080e272010-06-29 15:08:07 +04005851 nlmsg_free(msg);
Johannes Berg4c476992010-10-04 21:36:35 +02005852 return -ENOBUFS;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005853}
5854
Alexey Dobriyanb54452b2010-02-18 08:14:31 +00005855static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005856 [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
5857 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
5858 [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
5859 [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
5860 [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
5861 [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
Javier Cardona45904f22010-12-03 09:20:40 +01005862 [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005863 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
Javier Cardonad299a1f2012-03-31 11:31:33 -07005864 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005865 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
5866 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
5867 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
5868 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
5869 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
Thomas Pedersendca7e942011-11-24 17:15:24 -08005870 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005871 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
Javier Cardona699403d2011-08-09 16:45:09 -07005872 [NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
Javier Cardona0507e152011-08-09 16:45:10 -07005873 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
Javier Cardona16dd7262011-08-09 16:45:11 -07005874 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
Chun-Yeow Yeoh94f90652012-01-21 01:02:16 +08005875 [NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005876 [NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
5877 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
Chun-Yeow Yeohac1073a2012-06-14 02:06:06 +08005878 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
5879 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
Chun-Yeow Yeoh728b19e2012-06-14 02:06:10 +08005880 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
Marco Porsch3b1c5a52013-01-07 16:04:52 +01005881 [NL80211_MESHCONF_POWER_MODE] = { .type = NLA_U32 },
5882 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
Colleen Twitty8e7c0532013-06-03 09:53:39 -07005883 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005884};
5885
Javier Cardonac80d5452010-12-16 17:37:49 -08005886static const struct nla_policy
5887 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
Javier Cardonad299a1f2012-03-31 11:31:33 -07005888 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
Javier Cardonac80d5452010-12-16 17:37:49 -08005889 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
5890 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
Javier Cardona15d5dda2011-04-07 15:08:28 -07005891 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
Colleen Twitty6e16d902013-05-08 11:45:59 -07005892 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
Thomas Pedersenbb2798d2013-03-04 13:06:10 -08005893 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
Javier Cardona581a8b02011-04-07 15:08:27 -07005894 [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005895 .len = IEEE80211_MAX_DATA_LEN },
Javier Cardonab130e5c2011-05-03 16:57:07 -07005896 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
Javier Cardonac80d5452010-12-16 17:37:49 -08005897};
5898
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005899static int nl80211_check_bool(const struct nlattr *nla, u8 min, u8 max, bool *out)
5900{
5901 u8 val = nla_get_u8(nla);
5902 if (val < min || val > max)
5903 return -EINVAL;
5904 *out = val;
5905 return 0;
5906}
5907
5908static int nl80211_check_u8(const struct nlattr *nla, u8 min, u8 max, u8 *out)
5909{
5910 u8 val = nla_get_u8(nla);
5911 if (val < min || val > max)
5912 return -EINVAL;
5913 *out = val;
5914 return 0;
5915}
5916
5917static int nl80211_check_u16(const struct nlattr *nla, u16 min, u16 max, u16 *out)
5918{
5919 u16 val = nla_get_u16(nla);
5920 if (val < min || val > max)
5921 return -EINVAL;
5922 *out = val;
5923 return 0;
5924}
5925
5926static int nl80211_check_u32(const struct nlattr *nla, u32 min, u32 max, u32 *out)
5927{
5928 u32 val = nla_get_u32(nla);
5929 if (val < min || val > max)
5930 return -EINVAL;
5931 *out = val;
5932 return 0;
5933}
5934
5935static int nl80211_check_s32(const struct nlattr *nla, s32 min, s32 max, s32 *out)
5936{
5937 s32 val = nla_get_s32(nla);
5938 if (val < min || val > max)
5939 return -EINVAL;
5940 *out = val;
5941 return 0;
5942}
5943
Johannes Bergff9a71a2016-08-11 14:59:53 +02005944static int nl80211_check_power_mode(const struct nlattr *nla,
5945 enum nl80211_mesh_power_mode min,
5946 enum nl80211_mesh_power_mode max,
5947 enum nl80211_mesh_power_mode *out)
5948{
5949 u32 val = nla_get_u32(nla);
5950 if (val < min || val > max)
5951 return -EINVAL;
5952 *out = val;
5953 return 0;
5954}
5955
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005956static int nl80211_parse_mesh_config(struct genl_info *info,
Johannes Bergbd90fdc2010-12-03 09:20:43 +01005957 struct mesh_config *cfg,
5958 u32 *mask_out)
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005959{
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005960 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
Johannes Bergbd90fdc2010-12-03 09:20:43 +01005961 u32 mask = 0;
Masashi Honma97572352016-08-03 10:07:44 +09005962 u16 ht_opmode;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005963
Marco Porschea54fba2013-01-07 16:04:48 +01005964#define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, min, max, mask, attr, fn) \
5965do { \
5966 if (tb[attr]) { \
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005967 if (fn(tb[attr], min, max, &cfg->param)) \
Marco Porschea54fba2013-01-07 16:04:48 +01005968 return -EINVAL; \
Marco Porschea54fba2013-01-07 16:04:48 +01005969 mask |= (1 << (attr - 1)); \
5970 } \
5971} while (0)
Johannes Bergbd90fdc2010-12-03 09:20:43 +01005972
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005973 if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005974 return -EINVAL;
5975 if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
Javier Cardona24bdd9f2010-12-16 17:37:48 -08005976 info->attrs[NL80211_ATTR_MESH_CONFIG],
Johannes Bergfe521452017-04-12 14:34:08 +02005977 nl80211_meshconf_params_policy, info->extack))
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005978 return -EINVAL;
5979
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07005980 /* This makes sure that there aren't more than 32 mesh config
5981 * parameters (otherwise our bitfield scheme would not work.) */
5982 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
5983
5984 /* Fill in the params struct */
Marco Porschea54fba2013-01-07 16:04:48 +01005985 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, 1, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005986 mask, NL80211_MESHCONF_RETRY_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005987 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01005988 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, 1, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005989 mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005990 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01005991 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, 1, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005992 mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005993 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01005994 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, 0, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005995 mask, NL80211_MESHCONF_MAX_PEER_LINKS,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005996 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01005997 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, 0, 16,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08005998 mask, NL80211_MESHCONF_MAX_RETRIES,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02005999 nl80211_check_u8);
Marco Porschea54fba2013-01-07 16:04:48 +01006000 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, 1, 255,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006001 mask, NL80211_MESHCONF_TTL, nl80211_check_u8);
Marco Porschea54fba2013-01-07 16:04:48 +01006002 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, 1, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006003 mask, NL80211_MESHCONF_ELEMENT_TTL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006004 nl80211_check_u8);
Marco Porschea54fba2013-01-07 16:04:48 +01006005 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, 0, 1,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006006 mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006007 nl80211_check_bool);
Marco Porschea54fba2013-01-07 16:04:48 +01006008 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
6009 1, 255, mask,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006010 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006011 nl80211_check_u32);
Marco Porschea54fba2013-01-07 16:04:48 +01006012 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, 0, 255,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006013 mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
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, path_refresh_time, 1, 65535,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006016 mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006017 nl80211_check_u32);
Marco Porschea54fba2013-01-07 16:04:48 +01006018 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, 1, 65535,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006019 mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006020 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01006021 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
6022 1, 65535, mask,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006023 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006024 nl80211_check_u32);
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07006025 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
Marco Porschea54fba2013-01-07 16:04:48 +01006026 1, 65535, mask,
6027 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006028 nl80211_check_u16);
Thomas Pedersendca7e942011-11-24 17:15:24 -08006029 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
Marco Porschea54fba2013-01-07 16:04:48 +01006030 1, 65535, mask,
6031 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006032 nl80211_check_u16);
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07006033 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
Marco Porschea54fba2013-01-07 16:04:48 +01006034 dot11MeshHWMPnetDiameterTraversalTime,
6035 1, 65535, mask,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006036 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006037 nl80211_check_u16);
Marco Porschea54fba2013-01-07 16:04:48 +01006038 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, 0, 4,
6039 mask, NL80211_MESHCONF_HWMP_ROOTMODE,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006040 nl80211_check_u8);
Marco Porschea54fba2013-01-07 16:04:48 +01006041 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, 1, 65535,
6042 mask, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006043 nl80211_check_u16);
Rui Paulo63c57232009-11-09 23:46:57 +00006044 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
Marco Porschea54fba2013-01-07 16:04:48 +01006045 dot11MeshGateAnnouncementProtocol, 0, 1,
6046 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006047 nl80211_check_bool);
Marco Porschea54fba2013-01-07 16:04:48 +01006048 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, 0, 1,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006049 mask, NL80211_MESHCONF_FORWARDING,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006050 nl80211_check_bool);
Chun-Yeow Yeoh83374fe2013-07-11 18:24:03 +08006051 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, -255, 0,
Chun-Yeow Yeoha4f606e2012-06-11 11:59:36 +08006052 mask, NL80211_MESHCONF_RSSI_THRESHOLD,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006053 nl80211_check_s32);
Masashi Honma97572352016-08-03 10:07:44 +09006054 /*
6055 * Check HT operation mode based on
6056 * IEEE 802.11 2012 8.4.2.59 HT Operation element.
6057 */
6058 if (tb[NL80211_MESHCONF_HT_OPMODE]) {
6059 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
6060
6061 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
6062 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
6063 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
6064 return -EINVAL;
6065
6066 if ((ht_opmode & IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT) &&
6067 (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
6068 return -EINVAL;
6069
6070 switch (ht_opmode & IEEE80211_HT_OP_MODE_PROTECTION) {
6071 case IEEE80211_HT_OP_MODE_PROTECTION_NONE:
6072 case IEEE80211_HT_OP_MODE_PROTECTION_20MHZ:
6073 if (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)
6074 return -EINVAL;
6075 break;
6076 case IEEE80211_HT_OP_MODE_PROTECTION_NONMEMBER:
6077 case IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED:
6078 if (!(ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
6079 return -EINVAL;
6080 break;
6081 }
6082 cfg->ht_opmode = ht_opmode;
Masashi Honmafd551ba2017-01-26 08:56:13 +09006083 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
Masashi Honma97572352016-08-03 10:07:44 +09006084 }
Chun-Yeow Yeohac1073a2012-06-14 02:06:06 +08006085 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
Marco Porschea54fba2013-01-07 16:04:48 +01006086 1, 65535, mask,
Chun-Yeow Yeohac1073a2012-06-14 02:06:06 +08006087 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006088 nl80211_check_u32);
Marco Porschea54fba2013-01-07 16:04:48 +01006089 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, 1, 65535,
Chun-Yeow Yeohac1073a2012-06-14 02:06:06 +08006090 mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006091 nl80211_check_u16);
Chun-Yeow Yeoh728b19e2012-06-14 02:06:10 +08006092 FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
Marco Porschea54fba2013-01-07 16:04:48 +01006093 dot11MeshHWMPconfirmationInterval,
6094 1, 65535, mask,
Chun-Yeow Yeoh728b19e2012-06-14 02:06:10 +08006095 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006096 nl80211_check_u16);
Marco Porsch3b1c5a52013-01-07 16:04:52 +01006097 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode,
6098 NL80211_MESH_POWER_ACTIVE,
6099 NL80211_MESH_POWER_MAX,
6100 mask, NL80211_MESHCONF_POWER_MODE,
Johannes Bergff9a71a2016-08-11 14:59:53 +02006101 nl80211_check_power_mode);
Marco Porsch3b1c5a52013-01-07 16:04:52 +01006102 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration,
6103 0, 65535, mask,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006104 NL80211_MESHCONF_AWAKE_WINDOW, nl80211_check_u16);
Masashi Honma31f909a2015-02-24 22:42:16 +09006105 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, 0, 0xffffffff,
Colleen Twitty8e7c0532013-06-03 09:53:39 -07006106 mask, NL80211_MESHCONF_PLINK_TIMEOUT,
Arnd Bergmannf151d9d2016-06-15 22:29:41 +02006107 nl80211_check_u32);
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006108 if (mask_out)
6109 *mask_out = mask;
Javier Cardonac80d5452010-12-16 17:37:49 -08006110
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006111 return 0;
6112
6113#undef FILL_IN_MESH_PARAM_IF_SET
6114}
6115
Javier Cardonac80d5452010-12-16 17:37:49 -08006116static int nl80211_parse_mesh_setup(struct genl_info *info,
6117 struct mesh_setup *setup)
6118{
Thomas Pedersenbb2798d2013-03-04 13:06:10 -08006119 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Javier Cardonac80d5452010-12-16 17:37:49 -08006120 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
6121
6122 if (!info->attrs[NL80211_ATTR_MESH_SETUP])
6123 return -EINVAL;
6124 if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
6125 info->attrs[NL80211_ATTR_MESH_SETUP],
Johannes Bergfe521452017-04-12 14:34:08 +02006126 nl80211_mesh_setup_params_policy, info->extack))
Javier Cardonac80d5452010-12-16 17:37:49 -08006127 return -EINVAL;
6128
Javier Cardonad299a1f2012-03-31 11:31:33 -07006129 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
6130 setup->sync_method =
6131 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
6132 IEEE80211_SYNC_METHOD_VENDOR :
6133 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
6134
Javier Cardonac80d5452010-12-16 17:37:49 -08006135 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
6136 setup->path_sel_proto =
6137 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
6138 IEEE80211_PATH_PROTOCOL_VENDOR :
6139 IEEE80211_PATH_PROTOCOL_HWMP;
6140
6141 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
6142 setup->path_metric =
6143 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
6144 IEEE80211_PATH_METRIC_VENDOR :
6145 IEEE80211_PATH_METRIC_AIRTIME;
6146
Javier Cardona581a8b02011-04-07 15:08:27 -07006147 if (tb[NL80211_MESH_SETUP_IE]) {
Javier Cardonac80d5452010-12-16 17:37:49 -08006148 struct nlattr *ieattr =
Javier Cardona581a8b02011-04-07 15:08:27 -07006149 tb[NL80211_MESH_SETUP_IE];
Javier Cardonac80d5452010-12-16 17:37:49 -08006150 if (!is_valid_ie_attr(ieattr))
6151 return -EINVAL;
Javier Cardona581a8b02011-04-07 15:08:27 -07006152 setup->ie = nla_data(ieattr);
6153 setup->ie_len = nla_len(ieattr);
Javier Cardonac80d5452010-12-16 17:37:49 -08006154 }
Thomas Pedersenbb2798d2013-03-04 13:06:10 -08006155 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
6156 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
6157 return -EINVAL;
6158 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
Javier Cardonab130e5c2011-05-03 16:57:07 -07006159 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
6160 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
Thomas Pedersenbb2798d2013-03-04 13:06:10 -08006161 if (setup->is_secure)
6162 setup->user_mpm = true;
Javier Cardonac80d5452010-12-16 17:37:49 -08006163
Colleen Twitty6e16d902013-05-08 11:45:59 -07006164 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
6165 if (!setup->user_mpm)
6166 return -EINVAL;
6167 setup->auth_id =
6168 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
6169 }
6170
Javier Cardonac80d5452010-12-16 17:37:49 -08006171 return 0;
6172}
6173
Javier Cardona24bdd9f2010-12-16 17:37:48 -08006174static int nl80211_update_mesh_config(struct sk_buff *skb,
Johannes Berg29cbe682010-12-03 09:20:44 +01006175 struct genl_info *info)
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006176{
6177 struct cfg80211_registered_device *rdev = info->user_ptr[0];
6178 struct net_device *dev = info->user_ptr[1];
Johannes Berg29cbe682010-12-03 09:20:44 +01006179 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006180 struct mesh_config cfg;
6181 u32 mask;
6182 int err;
6183
Johannes Berg29cbe682010-12-03 09:20:44 +01006184 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
6185 return -EOPNOTSUPP;
6186
Javier Cardona24bdd9f2010-12-16 17:37:48 -08006187 if (!rdev->ops->update_mesh_config)
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006188 return -EOPNOTSUPP;
6189
Javier Cardona24bdd9f2010-12-16 17:37:48 -08006190 err = nl80211_parse_mesh_config(info, &cfg, &mask);
Johannes Bergbd90fdc2010-12-03 09:20:43 +01006191 if (err)
6192 return err;
6193
Johannes Berg29cbe682010-12-03 09:20:44 +01006194 wdev_lock(wdev);
6195 if (!wdev->mesh_id_len)
6196 err = -ENOLINK;
6197
6198 if (!err)
Hila Gonene35e4d22012-06-27 17:19:42 +03006199 err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
Johannes Berg29cbe682010-12-03 09:20:44 +01006200
6201 wdev_unlock(wdev);
6202
6203 return err;
colin@cozybit.com93da9cc2008-10-21 12:03:48 -07006204}
6205
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006206static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
6207 struct sk_buff *msg)
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006208{
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006209 struct nlattr *nl_reg_rules;
6210 unsigned int i;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006211
Johannes Berg458f4f92012-12-06 15:47:38 +01006212 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
6213 (regdom->dfs_region &&
6214 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006215 goto nla_put_failure;
Johannes Berg458f4f92012-12-06 15:47:38 +01006216
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006217 nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
6218 if (!nl_reg_rules)
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006219 goto nla_put_failure;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006220
Johannes Berg458f4f92012-12-06 15:47:38 +01006221 for (i = 0; i < regdom->n_reg_rules; i++) {
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006222 struct nlattr *nl_reg_rule;
6223 const struct ieee80211_reg_rule *reg_rule;
6224 const struct ieee80211_freq_range *freq_range;
6225 const struct ieee80211_power_rule *power_rule;
Janusz Dziedzic97524822014-01-30 09:52:20 +01006226 unsigned int max_bandwidth_khz;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006227
Johannes Berg458f4f92012-12-06 15:47:38 +01006228 reg_rule = &regdom->reg_rules[i];
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006229 freq_range = &reg_rule->freq_range;
6230 power_rule = &reg_rule->power_rule;
6231
6232 nl_reg_rule = nla_nest_start(msg, i);
6233 if (!nl_reg_rule)
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006234 goto nla_put_failure;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006235
Janusz Dziedzic97524822014-01-30 09:52:20 +01006236 max_bandwidth_khz = freq_range->max_bandwidth_khz;
6237 if (!max_bandwidth_khz)
6238 max_bandwidth_khz = reg_get_max_bandwidth(regdom,
6239 reg_rule);
6240
David S. Miller9360ffd2012-03-29 04:41:26 -04006241 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
6242 reg_rule->flags) ||
6243 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
6244 freq_range->start_freq_khz) ||
6245 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
6246 freq_range->end_freq_khz) ||
6247 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
Janusz Dziedzic97524822014-01-30 09:52:20 +01006248 max_bandwidth_khz) ||
David S. Miller9360ffd2012-03-29 04:41:26 -04006249 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
6250 power_rule->max_antenna_gain) ||
6251 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
Janusz Dziedzic089027e2014-02-21 19:46:12 +01006252 power_rule->max_eirp) ||
6253 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
6254 reg_rule->dfs_cac_ms))
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006255 goto nla_put_failure;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006256
6257 nla_nest_end(msg, nl_reg_rule);
6258 }
6259
6260 nla_nest_end(msg, nl_reg_rules);
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006261 return 0;
6262
6263nla_put_failure:
6264 return -EMSGSIZE;
6265}
6266
6267static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
6268{
6269 const struct ieee80211_regdomain *regdom = NULL;
6270 struct cfg80211_registered_device *rdev;
6271 struct wiphy *wiphy = NULL;
6272 struct sk_buff *msg;
6273 void *hdr;
6274
6275 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6276 if (!msg)
6277 return -ENOBUFS;
6278
6279 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6280 NL80211_CMD_GET_REG);
6281 if (!hdr)
6282 goto put_failure;
6283
6284 if (info->attrs[NL80211_ATTR_WIPHY]) {
Arik Nemtsov1bdd7162014-12-15 19:26:01 +02006285 bool self_managed;
6286
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006287 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
6288 if (IS_ERR(rdev)) {
6289 nlmsg_free(msg);
6290 return PTR_ERR(rdev);
6291 }
6292
6293 wiphy = &rdev->wiphy;
Arik Nemtsov1bdd7162014-12-15 19:26:01 +02006294 self_managed = wiphy->regulatory_flags &
6295 REGULATORY_WIPHY_SELF_MANAGED;
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006296 regdom = get_wiphy_regdom(wiphy);
6297
Arik Nemtsov1bdd7162014-12-15 19:26:01 +02006298 /* a self-managed-reg device must have a private regdom */
6299 if (WARN_ON(!regdom && self_managed)) {
6300 nlmsg_free(msg);
6301 return -EINVAL;
6302 }
6303
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006304 if (regdom &&
6305 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6306 goto nla_put_failure;
6307 }
6308
6309 if (!wiphy && reg_last_request_cell_base() &&
6310 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6311 NL80211_USER_REG_HINT_CELL_BASE))
6312 goto nla_put_failure;
6313
6314 rcu_read_lock();
6315
6316 if (!regdom)
6317 regdom = rcu_dereference(cfg80211_regdomain);
6318
6319 if (nl80211_put_regdom(regdom, msg))
6320 goto nla_put_failure_rcu;
6321
6322 rcu_read_unlock();
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006323
6324 genlmsg_end(msg, hdr);
Johannes Berg5fe231e2013-05-08 21:45:15 +02006325 return genlmsg_reply(msg, info);
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006326
Johannes Berg458f4f92012-12-06 15:47:38 +01006327nla_put_failure_rcu:
6328 rcu_read_unlock();
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006329nla_put_failure:
6330 genlmsg_cancel(msg, hdr);
Julia Lawallefe1cf02011-01-28 15:17:11 +01006331put_failure:
Yuri Ershovd080e272010-06-29 15:08:07 +04006332 nlmsg_free(msg);
Johannes Berg5fe231e2013-05-08 21:45:15 +02006333 return -EMSGSIZE;
Luis R. Rodriguezf1303472009-01-30 09:26:42 -08006334}
6335
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006336static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
6337 u32 seq, int flags, struct wiphy *wiphy,
6338 const struct ieee80211_regdomain *regdom)
6339{
6340 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
6341 NL80211_CMD_GET_REG);
6342
6343 if (!hdr)
6344 return -1;
6345
Michal Kubecek0a833c22017-11-15 13:09:32 +01006346 genl_dump_check_consistent(cb, hdr);
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006347
6348 if (nl80211_put_regdom(regdom, msg))
6349 goto nla_put_failure;
6350
6351 if (!wiphy && reg_last_request_cell_base() &&
6352 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6353 NL80211_USER_REG_HINT_CELL_BASE))
6354 goto nla_put_failure;
6355
6356 if (wiphy &&
6357 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6358 goto nla_put_failure;
6359
Arik Nemtsov1bdd7162014-12-15 19:26:01 +02006360 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
6361 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
6362 goto nla_put_failure;
6363
Johannes Berg053c0952015-01-16 22:09:00 +01006364 genlmsg_end(msg, hdr);
6365 return 0;
Arik Nemtsovad30ca22014-12-15 19:25:59 +02006366
6367nla_put_failure:
6368 genlmsg_cancel(msg, hdr);
6369 return -EMSGSIZE;
6370}
6371
6372static int nl80211_get_reg_dump(struct sk_buff *skb,
6373 struct netlink_callback *cb)
6374{
6375 const struct ieee80211_regdomain *regdom = NULL;
6376 struct cfg80211_registered_device *rdev;
6377 int err, reg_idx, start = cb->args[2];
6378
6379 rtnl_lock();
6380
6381 if (cfg80211_regdomain && start == 0) {
6382 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6383 NLM_F_MULTI, NULL,
6384 rtnl_dereference(cfg80211_regdomain));
6385 if (err < 0)
6386 goto out_err;
6387 }
6388
6389 /* the global regdom is idx 0 */
6390 reg_idx = 1;
6391 list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
6392 regdom = get_wiphy_regdom(&rdev->wiphy);
6393 if (!regdom)
6394 continue;
6395
6396 if (++reg_idx <= start)
6397 continue;
6398
6399 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6400 NLM_F_MULTI, &rdev->wiphy, regdom);
6401 if (err < 0) {
6402 reg_idx--;
6403 break;
6404 }
6405 }
6406
6407 cb->args[2] = reg_idx;
6408 err = skb->len;
6409out_err:
6410 rtnl_unlock();
6411 return err;
6412}
6413
Johannes Bergb6863032015-10-15 09:25:18 +02006414#ifdef CONFIG_CFG80211_CRDA_SUPPORT
6415static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
6416 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
6417 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
6418 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
6419 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
6420 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
6421 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
6422 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 },
6423};
6424
6425static int parse_reg_rule(struct nlattr *tb[],
6426 struct ieee80211_reg_rule *reg_rule)
6427{
6428 struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
6429 struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
6430
6431 if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
6432 return -EINVAL;
6433 if (!tb[NL80211_ATTR_FREQ_RANGE_START])
6434 return -EINVAL;
6435 if (!tb[NL80211_ATTR_FREQ_RANGE_END])
6436 return -EINVAL;
6437 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
6438 return -EINVAL;
6439 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
6440 return -EINVAL;
6441
6442 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
6443
6444 freq_range->start_freq_khz =
6445 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
6446 freq_range->end_freq_khz =
6447 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
6448 freq_range->max_bandwidth_khz =
6449 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
6450
6451 power_rule->max_eirp =
6452 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
6453
6454 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
6455 power_rule->max_antenna_gain =
6456 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
6457
6458 if (tb[NL80211_ATTR_DFS_CAC_TIME])
6459 reg_rule->dfs_cac_ms =
6460 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
6461
6462 return 0;
6463}
6464
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006465static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
6466{
6467 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
6468 struct nlattr *nl_reg_rule;
Johannes Bergea372c52014-11-28 14:54:31 +01006469 char *alpha2;
6470 int rem_reg_rules, r;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006471 u32 num_rules = 0, rule_idx = 0, size_of_regd;
Luis R. Rodriguez4c7d3982013-11-13 18:54:02 +01006472 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
Johannes Bergea372c52014-11-28 14:54:31 +01006473 struct ieee80211_regdomain *rd;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006474
6475 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
6476 return -EINVAL;
6477
6478 if (!info->attrs[NL80211_ATTR_REG_RULES])
6479 return -EINVAL;
6480
6481 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
6482
Luis R. Rodriguez8b60b072011-10-11 10:59:02 -07006483 if (info->attrs[NL80211_ATTR_DFS_REGION])
6484 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
6485
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006486 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
Johannes Berg1a919312012-12-03 17:21:11 +01006487 rem_reg_rules) {
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006488 num_rules++;
6489 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
Luis R. Rodriguez4776c6e2009-05-13 17:04:39 -04006490 return -EINVAL;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006491 }
6492
Luis R. Rodrigueze4387682013-11-05 09:18:01 -08006493 if (!reg_is_valid_request(alpha2))
6494 return -EINVAL;
6495
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006496 size_of_regd = sizeof(struct ieee80211_regdomain) +
Johannes Berg1a919312012-12-03 17:21:11 +01006497 num_rules * sizeof(struct ieee80211_reg_rule);
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006498
6499 rd = kzalloc(size_of_regd, GFP_KERNEL);
Johannes Berg6913b492012-12-04 00:48:59 +01006500 if (!rd)
6501 return -ENOMEM;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006502
6503 rd->n_reg_rules = num_rules;
6504 rd->alpha2[0] = alpha2[0];
6505 rd->alpha2[1] = alpha2[1];
6506
Luis R. Rodriguez8b60b072011-10-11 10:59:02 -07006507 /*
6508 * Disable DFS master mode if the DFS region was
6509 * not supported or known on this kernel.
6510 */
6511 if (reg_supported_dfs_region(dfs_region))
6512 rd->dfs_region = dfs_region;
6513
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006514 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
Johannes Berg1a919312012-12-03 17:21:11 +01006515 rem_reg_rules) {
Johannes Bergbfe2c7b2016-10-26 14:42:21 +02006516 r = nla_parse_nested(tb, NL80211_REG_RULE_ATTR_MAX,
Johannes Bergfe521452017-04-12 14:34:08 +02006517 nl_reg_rule, reg_rule_policy,
6518 info->extack);
Johannes Bergae811e22014-01-24 10:17:47 +01006519 if (r)
6520 goto bad_reg;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006521 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
6522 if (r)
6523 goto bad_reg;
6524
6525 rule_idx++;
6526
Luis R. Rodriguezd0e18f82009-05-13 17:04:40 -04006527 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
6528 r = -EINVAL;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006529 goto bad_reg;
Luis R. Rodriguezd0e18f82009-05-13 17:04:40 -04006530 }
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006531 }
6532
Johannes Berg06627992016-06-09 10:40:09 +02006533 /* set_regdom takes ownership of rd */
6534 return set_regdom(rd, REGD_SOURCE_CRDA);
Johannes Bergd2372b32008-10-24 20:32:20 +02006535 bad_reg:
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006536 kfree(rd);
Luis R. Rodriguezd0e18f82009-05-13 17:04:40 -04006537 return r;
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006538}
Johannes Bergb6863032015-10-15 09:25:18 +02006539#endif /* CONFIG_CFG80211_CRDA_SUPPORT */
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -07006540
Johannes Berg83f5e2c2009-06-17 17:41:49 +02006541static int validate_scan_freqs(struct nlattr *freqs)
6542{
6543 struct nlattr *attr1, *attr2;
6544 int n_channels = 0, tmp1, tmp2;
6545
Srinivas Dasarid7f13f72017-07-07 01:43:42 +03006546 nla_for_each_nested(attr1, freqs, tmp1)
6547 if (nla_len(attr1) != sizeof(u32))
6548 return 0;
6549
Johannes Berg83f5e2c2009-06-17 17:41:49 +02006550 nla_for_each_nested(attr1, freqs, tmp1) {
6551 n_channels++;
6552 /*
6553 * Some hardware has a limited channel list for
6554 * scanning, and it is pretty much nonsensical
6555 * to scan for a channel twice, so disallow that
6556 * and don't require drivers to check that the
6557 * channel list they get isn't longer than what
6558 * they can scan, as long as they can scan all
6559 * the channels they registered at once.
6560 */
6561 nla_for_each_nested(attr2, freqs, tmp2)
6562 if (attr1 != attr2 &&
6563 nla_get_u32(attr1) == nla_get_u32(attr2))
6564 return 0;
6565 }
6566
6567 return n_channels;
6568}
6569
Johannes Berg57fbcce2016-04-12 15:56:15 +02006570static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
Arend van Spriel38de03d2016-03-02 20:37:18 +01006571{
Johannes Berg57fbcce2016-04-12 15:56:15 +02006572 return b < NUM_NL80211_BANDS && wiphy->bands[b];
Arend van Spriel38de03d2016-03-02 20:37:18 +01006573}
6574
6575static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
6576 struct cfg80211_bss_selection *bss_select)
6577{
6578 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
6579 struct nlattr *nest;
6580 int err;
6581 bool found = false;
6582 int i;
6583
6584 /* only process one nested attribute */
6585 nest = nla_data(nla);
6586 if (!nla_ok(nest, nla_len(nest)))
6587 return -EINVAL;
6588
Johannes Bergbfe2c7b2016-10-26 14:42:21 +02006589 err = nla_parse_nested(attr, NL80211_BSS_SELECT_ATTR_MAX, nest,
Johannes Bergfceb6432017-04-12 14:34:07 +02006590 nl80211_bss_select_policy, NULL);
Arend van Spriel38de03d2016-03-02 20:37:18 +01006591 if (err)
6592 return err;
6593
6594 /* only one attribute may be given */
6595 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
6596 if (attr[i]) {
6597 if (found)
6598 return -EINVAL;
6599 found = true;
6600 }
6601 }
6602
6603 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
6604
6605 if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
6606 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
6607
6608 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
6609 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
6610 bss_select->param.band_pref =
6611 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
6612 if (!is_band_valid(wiphy, bss_select->param.band_pref))
6613 return -EINVAL;
6614 }
6615
6616 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
6617 struct nl80211_bss_select_rssi_adjust *adj_param;
6618
6619 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
6620 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
6621 bss_select->param.adjust.band = adj_param->band;
6622 bss_select->param.adjust.delta = adj_param->delta;
6623 if (!is_band_valid(wiphy, bss_select->param.adjust.band))
6624 return -EINVAL;
6625 }
6626
6627 /* user-space did not provide behaviour attribute */
6628 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
6629 return -EINVAL;
6630
6631 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
6632 return -EINVAL;
6633
6634 return 0;
6635}
6636
Johannes Bergad2b26a2014-06-12 21:39:05 +02006637static int nl80211_parse_random_mac(struct nlattr **attrs,
6638 u8 *mac_addr, u8 *mac_addr_mask)
6639{
6640 int i;
6641
6642 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
Joe Perchesd2beae12015-03-02 19:54:58 -08006643 eth_zero_addr(mac_addr);
6644 eth_zero_addr(mac_addr_mask);
Johannes Bergad2b26a2014-06-12 21:39:05 +02006645 mac_addr[0] = 0x2;
6646 mac_addr_mask[0] = 0x3;
6647
6648 return 0;
6649 }
6650
6651 /* need both or none */
6652 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
6653 return -EINVAL;
6654
6655 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
6656 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
6657
6658 /* don't allow or configure an mcast address */
6659 if (!is_multicast_ether_addr(mac_addr_mask) ||
6660 is_multicast_ether_addr(mac_addr))
6661 return -EINVAL;
6662
6663 /*
6664 * allow users to pass a MAC address that has bits set outside
6665 * of the mask, but don't bother drivers with having to deal
6666 * with such bits
6667 */
6668 for (i = 0; i < ETH_ALEN; i++)
6669 mac_addr[i] &= mac_addr_mask[i];
6670
6671 return 0;
6672}
6673
Vasanthakumar Thiagarajan34373d12017-02-27 17:04:34 +05306674static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev)
6675{
6676 ASSERT_WDEV_LOCK(wdev);
6677
6678 if (!cfg80211_beaconing_iface_active(wdev))
6679 return true;
6680
6681 if (!(wdev->chandef.chan->flags & IEEE80211_CHAN_RADAR))
6682 return true;
6683
6684 return regulatory_pre_cac_allowed(wdev->wiphy);
6685}
6686
Roee Zamir2d23d072017-08-06 11:38:22 +03006687static int
6688nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev,
6689 void *request, struct nlattr **attrs,
6690 bool is_sched_scan)
6691{
6692 u8 *mac_addr, *mac_addr_mask;
6693 u32 *flags;
6694 enum nl80211_feature_flags randomness_flag;
6695
6696 if (!attrs[NL80211_ATTR_SCAN_FLAGS])
6697 return 0;
6698
6699 if (is_sched_scan) {
6700 struct cfg80211_sched_scan_request *req = request;
6701
6702 randomness_flag = wdev ?
6703 NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR :
6704 NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
6705 flags = &req->flags;
6706 mac_addr = req->mac_addr;
6707 mac_addr_mask = req->mac_addr_mask;
6708 } else {
6709 struct cfg80211_scan_request *req = request;
6710
6711 randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
6712 flags = &req->flags;
6713 mac_addr = req->mac_addr;
6714 mac_addr_mask = req->mac_addr_mask;
6715 }
6716
6717 *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]);
6718
Sunil Dutt5037a002018-01-25 17:13:37 +02006719 if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
6720 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
6721 ((*flags & NL80211_SCAN_FLAG_LOW_SPAN) &&
6722 !wiphy_ext_feature_isset(wiphy,
6723 NL80211_EXT_FEATURE_LOW_SPAN_SCAN)) ||
6724 ((*flags & NL80211_SCAN_FLAG_LOW_POWER) &&
6725 !wiphy_ext_feature_isset(wiphy,
6726 NL80211_EXT_FEATURE_LOW_POWER_SCAN)) ||
6727 ((*flags & NL80211_SCAN_FLAG_HIGH_ACCURACY) &&
6728 !wiphy_ext_feature_isset(wiphy,
6729 NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN)))
Roee Zamir2d23d072017-08-06 11:38:22 +03006730 return -EOPNOTSUPP;
6731
6732 if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
6733 int err;
6734
6735 if (!(wiphy->features & randomness_flag) ||
6736 (wdev && wdev->current_bss))
6737 return -EOPNOTSUPP;
6738
6739 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask);
6740 if (err)
6741 return err;
6742 }
6743
6744 if ((*flags & NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME) &&
6745 !wiphy_ext_feature_isset(wiphy,
6746 NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME))
6747 return -EOPNOTSUPP;
6748
6749 if ((*flags & NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP) &&
6750 !wiphy_ext_feature_isset(wiphy,
6751 NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP))
6752 return -EOPNOTSUPP;
6753
6754 if ((*flags & NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) &&
6755 !wiphy_ext_feature_isset(wiphy,
6756 NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION))
6757 return -EOPNOTSUPP;
6758
6759 if ((*flags & NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE) &&
6760 !wiphy_ext_feature_isset(wiphy,
6761 NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE))
6762 return -EOPNOTSUPP;
6763
6764 return 0;
6765}
6766
Johannes Berg2a519312009-02-10 21:25:55 +01006767static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
6768{
Johannes Berg4c476992010-10-04 21:36:35 +02006769 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Bergfd014282012-06-18 19:17:03 +02006770 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg2a519312009-02-10 21:25:55 +01006771 struct cfg80211_scan_request *request;
Johannes Berg2a519312009-02-10 21:25:55 +01006772 struct nlattr *attr;
6773 struct wiphy *wiphy;
Johannes Berg83f5e2c2009-06-17 17:41:49 +02006774 int err, tmp, n_ssids = 0, n_channels, i;
Jouni Malinen70692ad2009-02-16 19:39:13 +02006775 size_t ie_len;
Johannes Berg2a519312009-02-10 21:25:55 +01006776
Johannes Bergf4a11bb2009-03-27 12:40:28 +01006777 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
6778 return -EINVAL;
6779
Johannes Berg79c97e92009-07-07 03:56:12 +02006780 wiphy = &rdev->wiphy;
Johannes Berg2a519312009-02-10 21:25:55 +01006781
Ayala Bekercb3b7d82016-09-20 17:31:13 +03006782 if (wdev->iftype == NL80211_IFTYPE_NAN)
6783 return -EOPNOTSUPP;
6784
Johannes Berg4c476992010-10-04 21:36:35 +02006785 if (!rdev->ops->scan)
6786 return -EOPNOTSUPP;
Johannes Berg2a519312009-02-10 21:25:55 +01006787
Johannes Bergf9d15d12014-01-22 11:14:19 +02006788 if (rdev->scan_req || rdev->scan_msg) {
Johannes Bergf9f47522013-03-19 15:04:07 +01006789 err = -EBUSY;
6790 goto unlock;
6791 }
Johannes Berg2a519312009-02-10 21:25:55 +01006792
6793 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
Johannes Berg83f5e2c2009-06-17 17:41:49 +02006794 n_channels = validate_scan_freqs(
6795 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
Johannes Bergf9f47522013-03-19 15:04:07 +01006796 if (!n_channels) {
6797 err = -EINVAL;
6798 goto unlock;
6799 }
Johannes Berg2a519312009-02-10 21:25:55 +01006800 } else {
Ilan Peerbdfbec22014-01-09 11:37:23 +02006801 n_channels = ieee80211_get_num_supported_channels(wiphy);
Johannes Berg2a519312009-02-10 21:25:55 +01006802 }
6803
6804 if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
6805 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
6806 n_ssids++;
6807
Johannes Bergf9f47522013-03-19 15:04:07 +01006808 if (n_ssids > wiphy->max_scan_ssids) {
6809 err = -EINVAL;
6810 goto unlock;
6811 }
Johannes Berg2a519312009-02-10 21:25:55 +01006812
Jouni Malinen70692ad2009-02-16 19:39:13 +02006813 if (info->attrs[NL80211_ATTR_IE])
6814 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
6815 else
6816 ie_len = 0;
6817
Johannes Bergf9f47522013-03-19 15:04:07 +01006818 if (ie_len > wiphy->max_scan_ie_len) {
6819 err = -EINVAL;
6820 goto unlock;
6821 }
Johannes Berg18a83652009-03-31 12:12:05 +02006822
Johannes Berg2a519312009-02-10 21:25:55 +01006823 request = kzalloc(sizeof(*request)
Luciano Coelhoa2cd43c2011-05-18 11:42:03 +03006824 + sizeof(*request->ssids) * n_ssids
6825 + sizeof(*request->channels) * n_channels
Jouni Malinen70692ad2009-02-16 19:39:13 +02006826 + ie_len, GFP_KERNEL);
Johannes Bergf9f47522013-03-19 15:04:07 +01006827 if (!request) {
6828 err = -ENOMEM;
6829 goto unlock;
6830 }
Johannes Berg2a519312009-02-10 21:25:55 +01006831
Johannes Berg2a519312009-02-10 21:25:55 +01006832 if (n_ssids)
Johannes Berg5ba63532009-08-07 17:54:07 +02006833 request->ssids = (void *)&request->channels[n_channels];
Johannes Berg2a519312009-02-10 21:25:55 +01006834 request->n_ssids = n_ssids;
Jouni Malinen70692ad2009-02-16 19:39:13 +02006835 if (ie_len) {
Johannes Berg13874e42015-01-23 11:25:20 +01006836 if (n_ssids)
Jouni Malinen70692ad2009-02-16 19:39:13 +02006837 request->ie = (void *)(request->ssids + n_ssids);
6838 else
6839 request->ie = (void *)(request->channels + n_channels);
6840 }
Johannes Berg2a519312009-02-10 21:25:55 +01006841
Johannes Berg584991d2009-11-02 13:32:03 +01006842 i = 0;
Johannes Berg2a519312009-02-10 21:25:55 +01006843 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6844 /* user specified, bail out if channel not found */
Johannes Berg2a519312009-02-10 21:25:55 +01006845 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
Johannes Berg584991d2009-11-02 13:32:03 +01006846 struct ieee80211_channel *chan;
6847
6848 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
6849
6850 if (!chan) {
Johannes Berg2a519312009-02-10 21:25:55 +01006851 err = -EINVAL;
6852 goto out_free;
6853 }
Johannes Berg584991d2009-11-02 13:32:03 +01006854
6855 /* ignore disabled channels */
6856 if (chan->flags & IEEE80211_CHAN_DISABLED)
6857 continue;
6858
6859 request->channels[i] = chan;
Johannes Berg2a519312009-02-10 21:25:55 +01006860 i++;
6861 }
6862 } else {
Johannes Berg57fbcce2016-04-12 15:56:15 +02006863 enum nl80211_band band;
Johannes Berg34850ab2011-07-18 18:08:35 +02006864
Johannes Berg2a519312009-02-10 21:25:55 +01006865 /* all channels */
Johannes Berg57fbcce2016-04-12 15:56:15 +02006866 for (band = 0; band < NUM_NL80211_BANDS; band++) {
Johannes Berg2a519312009-02-10 21:25:55 +01006867 int j;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07006868
Johannes Berg2a519312009-02-10 21:25:55 +01006869 if (!wiphy->bands[band])
6870 continue;
6871 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
Johannes Berg584991d2009-11-02 13:32:03 +01006872 struct ieee80211_channel *chan;
6873
6874 chan = &wiphy->bands[band]->channels[j];
6875
6876 if (chan->flags & IEEE80211_CHAN_DISABLED)
6877 continue;
6878
6879 request->channels[i] = chan;
Johannes Berg2a519312009-02-10 21:25:55 +01006880 i++;
6881 }
6882 }
6883 }
6884
Johannes Berg584991d2009-11-02 13:32:03 +01006885 if (!i) {
6886 err = -EINVAL;
6887 goto out_free;
6888 }
6889
6890 request->n_channels = i;
6891
Vasanthakumar Thiagarajan34373d12017-02-27 17:04:34 +05306892 wdev_lock(wdev);
6893 if (!cfg80211_off_channel_oper_allowed(wdev)) {
6894 struct ieee80211_channel *chan;
6895
6896 if (request->n_channels != 1) {
6897 wdev_unlock(wdev);
6898 err = -EBUSY;
6899 goto out_free;
6900 }
6901
6902 chan = request->channels[0];
6903 if (chan->center_freq != wdev->chandef.chan->center_freq) {
6904 wdev_unlock(wdev);
6905 err = -EBUSY;
6906 goto out_free;
6907 }
6908 }
6909 wdev_unlock(wdev);
6910
Johannes Berg2a519312009-02-10 21:25:55 +01006911 i = 0;
Johannes Berg13874e42015-01-23 11:25:20 +01006912 if (n_ssids) {
Johannes Berg2a519312009-02-10 21:25:55 +01006913 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
Luciano Coelho57a27e12011-06-07 20:42:26 +03006914 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
Johannes Berg2a519312009-02-10 21:25:55 +01006915 err = -EINVAL;
6916 goto out_free;
6917 }
Luciano Coelho57a27e12011-06-07 20:42:26 +03006918 request->ssids[i].ssid_len = nla_len(attr);
Johannes Berg2a519312009-02-10 21:25:55 +01006919 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
Johannes Berg2a519312009-02-10 21:25:55 +01006920 i++;
6921 }
6922 }
6923
Jouni Malinen70692ad2009-02-16 19:39:13 +02006924 if (info->attrs[NL80211_ATTR_IE]) {
6925 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
Johannes Bergde95a542009-04-01 11:58:36 +02006926 memcpy((void *)request->ie,
6927 nla_data(info->attrs[NL80211_ATTR_IE]),
Jouni Malinen70692ad2009-02-16 19:39:13 +02006928 request->ie_len);
6929 }
6930
Johannes Berg57fbcce2016-04-12 15:56:15 +02006931 for (i = 0; i < NUM_NL80211_BANDS; i++)
Johannes Berga401d2b2011-07-20 00:52:16 +02006932 if (wiphy->bands[i])
6933 request->rates[i] =
6934 (1 << wiphy->bands[i]->n_bitrates) - 1;
Johannes Berg34850ab2011-07-18 18:08:35 +02006935
6936 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
6937 nla_for_each_nested(attr,
6938 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
6939 tmp) {
Johannes Berg57fbcce2016-04-12 15:56:15 +02006940 enum nl80211_band band = nla_type(attr);
Johannes Berg34850ab2011-07-18 18:08:35 +02006941
Johannes Berg57fbcce2016-04-12 15:56:15 +02006942 if (band < 0 || band >= NUM_NL80211_BANDS) {
Johannes Berg34850ab2011-07-18 18:08:35 +02006943 err = -EINVAL;
6944 goto out_free;
6945 }
Felix Fietkau1b09cd82013-11-20 19:40:41 +01006946
6947 if (!wiphy->bands[band])
6948 continue;
6949
Johannes Berg34850ab2011-07-18 18:08:35 +02006950 err = ieee80211_get_ratemask(wiphy->bands[band],
6951 nla_data(attr),
6952 nla_len(attr),
6953 &request->rates[band]);
6954 if (err)
6955 goto out_free;
6956 }
6957 }
6958
Avraham Stern1d762502016-07-05 17:10:13 +03006959 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
6960 if (!wiphy_ext_feature_isset(wiphy,
6961 NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
6962 err = -EOPNOTSUPP;
6963 goto out_free;
6964 }
6965
6966 request->duration =
6967 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
6968 request->duration_mandatory =
6969 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
6970 }
6971
Roee Zamir2d23d072017-08-06 11:38:22 +03006972 err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs,
6973 false);
6974 if (err)
6975 goto out_free;
Sam Lefflered4737712012-10-11 21:03:31 -07006976
Rajkumar Manoharane9f935e2011-09-25 14:53:30 +05306977 request->no_cck =
6978 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
6979
Vamsi Krishna2fa436b2016-12-02 23:59:08 +02006980 /* Initial implementation used NL80211_ATTR_MAC to set the specific
6981 * BSSID to scan for. This was problematic because that same attribute
6982 * was already used for another purpose (local random MAC address). The
6983 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
6984 * compatibility with older userspace components, also use the
6985 * NL80211_ATTR_MAC value here if it can be determined to be used for
6986 * the specific BSSID use case instead of the random MAC address
6987 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
6988 */
6989 if (info->attrs[NL80211_ATTR_BSSID])
6990 memcpy(request->bssid,
6991 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
6992 else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
6993 info->attrs[NL80211_ATTR_MAC])
Jouni Malinen818965d2016-02-26 22:12:47 +02006994 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
6995 ETH_ALEN);
6996 else
6997 eth_broadcast_addr(request->bssid);
6998
Johannes Bergfd014282012-06-18 19:17:03 +02006999 request->wdev = wdev;
Johannes Berg79c97e92009-07-07 03:56:12 +02007000 request->wiphy = &rdev->wiphy;
Sam Leffler15d60302012-10-11 21:03:34 -07007001 request->scan_start = jiffies;
Johannes Berg2a519312009-02-10 21:25:55 +01007002
Johannes Berg79c97e92009-07-07 03:56:12 +02007003 rdev->scan_req = request;
Hila Gonene35e4d22012-06-27 17:19:42 +03007004 err = rdev_scan(rdev, request);
Johannes Berg2a519312009-02-10 21:25:55 +01007005
Johannes Berg463d0182009-07-14 00:33:35 +02007006 if (!err) {
Johannes Bergfd014282012-06-18 19:17:03 +02007007 nl80211_send_scan_start(rdev, wdev);
7008 if (wdev->netdev)
7009 dev_hold(wdev->netdev);
Johannes Berg4c476992010-10-04 21:36:35 +02007010 } else {
Johannes Berg2a519312009-02-10 21:25:55 +01007011 out_free:
Johannes Berg79c97e92009-07-07 03:56:12 +02007012 rdev->scan_req = NULL;
Johannes Berg2a519312009-02-10 21:25:55 +01007013 kfree(request);
7014 }
Johannes Berg3b858752009-03-12 09:55:09 +01007015
Johannes Bergf9f47522013-03-19 15:04:07 +01007016 unlock:
Johannes Berg2a519312009-02-10 21:25:55 +01007017 return err;
7018}
7019
Vidyullatha Kanchanapally91d3ab42015-10-30 19:14:49 +05307020static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
7021{
7022 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7023 struct wireless_dev *wdev = info->user_ptr[1];
7024
7025 if (!rdev->ops->abort_scan)
7026 return -EOPNOTSUPP;
7027
7028 if (rdev->scan_msg)
7029 return 0;
7030
7031 if (!rdev->scan_req)
7032 return -ENOENT;
7033
7034 rdev_abort_scan(rdev, wdev);
7035 return 0;
7036}
7037
Avraham Stern3b06d272015-10-12 09:51:34 +03007038static int
7039nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
7040 struct cfg80211_sched_scan_request *request,
7041 struct nlattr **attrs)
7042{
7043 int tmp, err, i = 0;
7044 struct nlattr *attr;
7045
7046 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7047 u32 interval;
7048
7049 /*
7050 * If scan plans are not specified,
Arend Van Spriel5a88de52016-11-17 09:02:40 +00007051 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
Avraham Stern3b06d272015-10-12 09:51:34 +03007052 * case one scan plan will be set with the specified scan
7053 * interval and infinite number of iterations.
7054 */
Avraham Stern3b06d272015-10-12 09:51:34 +03007055 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
7056 if (!interval)
7057 return -EINVAL;
7058
7059 request->scan_plans[0].interval =
7060 DIV_ROUND_UP(interval, MSEC_PER_SEC);
7061 if (!request->scan_plans[0].interval)
7062 return -EINVAL;
7063
7064 if (request->scan_plans[0].interval >
7065 wiphy->max_sched_scan_plan_interval)
7066 request->scan_plans[0].interval =
7067 wiphy->max_sched_scan_plan_interval;
7068
7069 return 0;
7070 }
7071
7072 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
7073 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
7074
7075 if (WARN_ON(i >= n_plans))
7076 return -EINVAL;
7077
Johannes Bergbfe2c7b2016-10-26 14:42:21 +02007078 err = nla_parse_nested(plan, NL80211_SCHED_SCAN_PLAN_MAX,
Johannes Bergfceb6432017-04-12 14:34:07 +02007079 attr, nl80211_plan_policy, NULL);
Avraham Stern3b06d272015-10-12 09:51:34 +03007080 if (err)
7081 return err;
7082
7083 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
7084 return -EINVAL;
7085
7086 request->scan_plans[i].interval =
7087 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
7088 if (!request->scan_plans[i].interval ||
7089 request->scan_plans[i].interval >
7090 wiphy->max_sched_scan_plan_interval)
7091 return -EINVAL;
7092
7093 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
7094 request->scan_plans[i].iterations =
7095 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
7096 if (!request->scan_plans[i].iterations ||
7097 (request->scan_plans[i].iterations >
7098 wiphy->max_sched_scan_plan_iterations))
7099 return -EINVAL;
7100 } else if (i < n_plans - 1) {
7101 /*
7102 * All scan plans but the last one must specify
7103 * a finite number of iterations
7104 */
7105 return -EINVAL;
7106 }
7107
7108 i++;
7109 }
7110
7111 /*
7112 * The last scan plan must not specify the number of
7113 * iterations, it is supposed to run infinitely
7114 */
7115 if (request->scan_plans[n_plans - 1].iterations)
7116 return -EINVAL;
7117
7118 return 0;
7119}
7120
Luciano Coelho256da022014-11-10 16:13:46 +02007121static struct cfg80211_sched_scan_request *
Johannes Bergad2b26a2014-06-12 21:39:05 +02007122nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
Arend Van Sprielaad1e812017-01-27 12:27:44 +00007123 struct nlattr **attrs, int max_match_sets)
Luciano Coelho807f8a82011-05-11 17:09:35 +03007124{
7125 struct cfg80211_sched_scan_request *request;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007126 struct nlattr *attr;
Avraham Stern3b06d272015-10-12 09:51:34 +03007127 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
Johannes Berg57fbcce2016-04-12 15:56:15 +02007128 enum nl80211_band band;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007129 size_t ie_len;
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007130 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
Johannes Bergea73cbc2014-01-24 10:53:53 +01007131 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007132
Luciano Coelho256da022014-11-10 16:13:46 +02007133 if (!is_valid_ie_attr(attrs[NL80211_ATTR_IE]))
7134 return ERR_PTR(-EINVAL);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007135
Luciano Coelho256da022014-11-10 16:13:46 +02007136 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
Luciano Coelho807f8a82011-05-11 17:09:35 +03007137 n_channels = validate_scan_freqs(
Luciano Coelho256da022014-11-10 16:13:46 +02007138 attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007139 if (!n_channels)
Luciano Coelho256da022014-11-10 16:13:46 +02007140 return ERR_PTR(-EINVAL);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007141 } else {
Ilan Peerbdfbec22014-01-09 11:37:23 +02007142 n_channels = ieee80211_get_num_supported_channels(wiphy);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007143 }
7144
Luciano Coelho256da022014-11-10 16:13:46 +02007145 if (attrs[NL80211_ATTR_SCAN_SSIDS])
7146 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
Luciano Coelho807f8a82011-05-11 17:09:35 +03007147 tmp)
7148 n_ssids++;
7149
Luciano Coelho93b6aa62011-07-13 14:57:28 +03007150 if (n_ssids > wiphy->max_sched_scan_ssids)
Luciano Coelho256da022014-11-10 16:13:46 +02007151 return ERR_PTR(-EINVAL);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007152
Johannes Bergea73cbc2014-01-24 10:53:53 +01007153 /*
7154 * First, count the number of 'real' matchsets. Due to an issue with
7155 * the old implementation, matchsets containing only the RSSI attribute
7156 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
7157 * RSSI for all matchsets, rather than their own matchset for reporting
7158 * all APs with a strong RSSI. This is needed to be compatible with
7159 * older userspace that treated a matchset with only the RSSI as the
7160 * global RSSI for all other matchsets - if there are other matchsets.
7161 */
Luciano Coelho256da022014-11-10 16:13:46 +02007162 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007163 nla_for_each_nested(attr,
Luciano Coelho256da022014-11-10 16:13:46 +02007164 attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
Johannes Bergea73cbc2014-01-24 10:53:53 +01007165 tmp) {
7166 struct nlattr *rssi;
7167
Johannes Bergbfe2c7b2016-10-26 14:42:21 +02007168 err = nla_parse_nested(tb,
7169 NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
Johannes Bergfceb6432017-04-12 14:34:07 +02007170 attr, nl80211_match_policy,
7171 NULL);
Johannes Bergea73cbc2014-01-24 10:53:53 +01007172 if (err)
Luciano Coelho256da022014-11-10 16:13:46 +02007173 return ERR_PTR(err);
Arend Van Spriel3007e352017-04-21 13:05:01 +01007174
7175 /* SSID and BSSID are mutually exclusive */
7176 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] &&
7177 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID])
7178 return ERR_PTR(-EINVAL);
7179
Johannes Bergea73cbc2014-01-24 10:53:53 +01007180 /* add other standalone attributes here */
Arend Van Spriel3007e352017-04-21 13:05:01 +01007181 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] ||
7182 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) {
Johannes Bergea73cbc2014-01-24 10:53:53 +01007183 n_match_sets++;
7184 continue;
7185 }
7186 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7187 if (rssi)
7188 default_match_rssi = nla_get_s32(rssi);
7189 }
7190 }
7191
7192 /* However, if there's no other matchset, add the RSSI one */
7193 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
7194 n_match_sets = 1;
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007195
Arend Van Sprielaad1e812017-01-27 12:27:44 +00007196 if (n_match_sets > max_match_sets)
Luciano Coelho256da022014-11-10 16:13:46 +02007197 return ERR_PTR(-EINVAL);
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007198
Luciano Coelho256da022014-11-10 16:13:46 +02007199 if (attrs[NL80211_ATTR_IE])
7200 ie_len = nla_len(attrs[NL80211_ATTR_IE]);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007201 else
7202 ie_len = 0;
7203
Luciano Coelho5a865ba2011-07-13 14:57:29 +03007204 if (ie_len > wiphy->max_sched_scan_ie_len)
Luciano Coelho256da022014-11-10 16:13:46 +02007205 return ERR_PTR(-EINVAL);
Luciano Coelhoc10841c2011-06-30 08:32:41 +03007206
Avraham Stern3b06d272015-10-12 09:51:34 +03007207 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7208 /*
7209 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
7210 * each scan plan already specifies its own interval
7211 */
7212 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7213 return ERR_PTR(-EINVAL);
7214
7215 nla_for_each_nested(attr,
7216 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
7217 n_plans++;
7218 } else {
7219 /*
7220 * The scan interval attribute is kept for backward
7221 * compatibility. If no scan plans are specified and sched scan
7222 * interval is specified, one scan plan will be set with this
7223 * scan interval and infinite number of iterations.
7224 */
7225 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7226 return ERR_PTR(-EINVAL);
7227
7228 n_plans = 1;
7229 }
7230
7231 if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
7232 return ERR_PTR(-EINVAL);
7233
vamsi krishnabf95ecd2017-01-13 01:12:20 +02007234 if (!wiphy_ext_feature_isset(
7235 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
7236 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
7237 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
7238 return ERR_PTR(-EINVAL);
7239
Luciano Coelho807f8a82011-05-11 17:09:35 +03007240 request = kzalloc(sizeof(*request)
Luciano Coelhoa2cd43c2011-05-18 11:42:03 +03007241 + sizeof(*request->ssids) * n_ssids
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007242 + sizeof(*request->match_sets) * n_match_sets
Avraham Stern3b06d272015-10-12 09:51:34 +03007243 + sizeof(*request->scan_plans) * n_plans
Luciano Coelhoa2cd43c2011-05-18 11:42:03 +03007244 + sizeof(*request->channels) * n_channels
Luciano Coelho807f8a82011-05-11 17:09:35 +03007245 + ie_len, GFP_KERNEL);
Luciano Coelho256da022014-11-10 16:13:46 +02007246 if (!request)
7247 return ERR_PTR(-ENOMEM);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007248
7249 if (n_ssids)
7250 request->ssids = (void *)&request->channels[n_channels];
7251 request->n_ssids = n_ssids;
7252 if (ie_len) {
Johannes Berg13874e42015-01-23 11:25:20 +01007253 if (n_ssids)
Luciano Coelho807f8a82011-05-11 17:09:35 +03007254 request->ie = (void *)(request->ssids + n_ssids);
7255 else
7256 request->ie = (void *)(request->channels + n_channels);
7257 }
7258
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007259 if (n_match_sets) {
7260 if (request->ie)
7261 request->match_sets = (void *)(request->ie + ie_len);
Johannes Berg13874e42015-01-23 11:25:20 +01007262 else if (n_ssids)
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007263 request->match_sets =
7264 (void *)(request->ssids + n_ssids);
7265 else
7266 request->match_sets =
7267 (void *)(request->channels + n_channels);
7268 }
7269 request->n_match_sets = n_match_sets;
7270
Avraham Stern3b06d272015-10-12 09:51:34 +03007271 if (n_match_sets)
7272 request->scan_plans = (void *)(request->match_sets +
7273 n_match_sets);
7274 else if (request->ie)
7275 request->scan_plans = (void *)(request->ie + ie_len);
7276 else if (n_ssids)
7277 request->scan_plans = (void *)(request->ssids + n_ssids);
7278 else
7279 request->scan_plans = (void *)(request->channels + n_channels);
7280
7281 request->n_scan_plans = n_plans;
7282
Luciano Coelho807f8a82011-05-11 17:09:35 +03007283 i = 0;
Luciano Coelho256da022014-11-10 16:13:46 +02007284 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
Luciano Coelho807f8a82011-05-11 17:09:35 +03007285 /* user specified, bail out if channel not found */
7286 nla_for_each_nested(attr,
Luciano Coelho256da022014-11-10 16:13:46 +02007287 attrs[NL80211_ATTR_SCAN_FREQUENCIES],
Luciano Coelho807f8a82011-05-11 17:09:35 +03007288 tmp) {
7289 struct ieee80211_channel *chan;
7290
7291 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
7292
7293 if (!chan) {
7294 err = -EINVAL;
7295 goto out_free;
7296 }
7297
7298 /* ignore disabled channels */
7299 if (chan->flags & IEEE80211_CHAN_DISABLED)
7300 continue;
7301
7302 request->channels[i] = chan;
7303 i++;
7304 }
7305 } else {
7306 /* all channels */
Johannes Berg57fbcce2016-04-12 15:56:15 +02007307 for (band = 0; band < NUM_NL80211_BANDS; band++) {
Luciano Coelho807f8a82011-05-11 17:09:35 +03007308 int j;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07007309
Luciano Coelho807f8a82011-05-11 17:09:35 +03007310 if (!wiphy->bands[band])
7311 continue;
7312 for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
7313 struct ieee80211_channel *chan;
7314
7315 chan = &wiphy->bands[band]->channels[j];
7316
7317 if (chan->flags & IEEE80211_CHAN_DISABLED)
7318 continue;
7319
7320 request->channels[i] = chan;
7321 i++;
7322 }
7323 }
7324 }
7325
7326 if (!i) {
7327 err = -EINVAL;
7328 goto out_free;
7329 }
7330
7331 request->n_channels = i;
7332
7333 i = 0;
Johannes Berg13874e42015-01-23 11:25:20 +01007334 if (n_ssids) {
Luciano Coelho256da022014-11-10 16:13:46 +02007335 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
Luciano Coelho807f8a82011-05-11 17:09:35 +03007336 tmp) {
Luciano Coelho57a27e12011-06-07 20:42:26 +03007337 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
Luciano Coelho807f8a82011-05-11 17:09:35 +03007338 err = -EINVAL;
7339 goto out_free;
7340 }
Luciano Coelho57a27e12011-06-07 20:42:26 +03007341 request->ssids[i].ssid_len = nla_len(attr);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007342 memcpy(request->ssids[i].ssid, nla_data(attr),
7343 nla_len(attr));
Luciano Coelho807f8a82011-05-11 17:09:35 +03007344 i++;
7345 }
7346 }
7347
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007348 i = 0;
Luciano Coelho256da022014-11-10 16:13:46 +02007349 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007350 nla_for_each_nested(attr,
Luciano Coelho256da022014-11-10 16:13:46 +02007351 attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007352 tmp) {
Arend Van Spriel3007e352017-04-21 13:05:01 +01007353 struct nlattr *ssid, *bssid, *rssi;
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007354
Johannes Bergbfe2c7b2016-10-26 14:42:21 +02007355 err = nla_parse_nested(tb,
7356 NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
Johannes Bergfceb6432017-04-12 14:34:07 +02007357 attr, nl80211_match_policy,
7358 NULL);
Johannes Bergae811e22014-01-24 10:17:47 +01007359 if (err)
7360 goto out_free;
Johannes Berg4a4ab0d2012-06-13 11:17:11 +02007361 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
Arend Van Spriel3007e352017-04-21 13:05:01 +01007362 bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID];
7363 if (ssid || bssid) {
Johannes Bergea73cbc2014-01-24 10:53:53 +01007364 if (WARN_ON(i >= n_match_sets)) {
7365 /* this indicates a programming error,
7366 * the loop above should have verified
7367 * things properly
7368 */
7369 err = -EINVAL;
7370 goto out_free;
7371 }
7372
Arend Van Spriel3007e352017-04-21 13:05:01 +01007373 if (ssid) {
7374 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
7375 err = -EINVAL;
7376 goto out_free;
7377 }
7378 memcpy(request->match_sets[i].ssid.ssid,
7379 nla_data(ssid), nla_len(ssid));
7380 request->match_sets[i].ssid.ssid_len =
7381 nla_len(ssid);
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007382 }
Arend Van Spriel3007e352017-04-21 13:05:01 +01007383 if (bssid) {
7384 if (nla_len(bssid) != ETH_ALEN) {
7385 err = -EINVAL;
7386 goto out_free;
7387 }
7388 memcpy(request->match_sets[i].bssid,
7389 nla_data(bssid), ETH_ALEN);
7390 }
7391
Kirtika Ruchandani56ab3642016-05-29 19:54:10 -07007392 /* special attribute - old implementation w/a */
Johannes Bergea73cbc2014-01-24 10:53:53 +01007393 request->match_sets[i].rssi_thold =
7394 default_match_rssi;
7395 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7396 if (rssi)
7397 request->match_sets[i].rssi_thold =
7398 nla_get_s32(rssi);
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007399 }
7400 i++;
7401 }
Johannes Bergea73cbc2014-01-24 10:53:53 +01007402
7403 /* there was no other matchset, so the RSSI one is alone */
Luciano Coelhof89f46c2014-12-01 11:32:09 +02007404 if (i == 0 && n_match_sets)
Johannes Bergea73cbc2014-01-24 10:53:53 +01007405 request->match_sets[0].rssi_thold = default_match_rssi;
7406
7407 request->min_rssi_thold = INT_MAX;
7408 for (i = 0; i < n_match_sets; i++)
7409 request->min_rssi_thold =
7410 min(request->match_sets[i].rssi_thold,
7411 request->min_rssi_thold);
7412 } else {
7413 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
Luciano Coelhoa1f1c212011-08-31 16:01:48 +03007414 }
7415
Johannes Berg9900e482014-02-04 21:01:25 +01007416 if (ie_len) {
7417 request->ie_len = ie_len;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007418 memcpy((void *)request->ie,
Luciano Coelho256da022014-11-10 16:13:46 +02007419 nla_data(attrs[NL80211_ATTR_IE]),
Luciano Coelho807f8a82011-05-11 17:09:35 +03007420 request->ie_len);
7421 }
7422
Roee Zamir2d23d072017-08-06 11:38:22 +03007423 err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true);
7424 if (err)
7425 goto out_free;
Sam Lefflered4737712012-10-11 21:03:31 -07007426
Luciano Coelho9c748932015-01-16 16:04:09 +02007427 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
7428 request->delay =
7429 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
7430
vamsi krishnabf95ecd2017-01-13 01:12:20 +02007431 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
7432 request->relative_rssi = nla_get_s8(
7433 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
7434 request->relative_rssi_set = true;
7435 }
7436
7437 if (request->relative_rssi_set &&
7438 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
7439 struct nl80211_bss_select_rssi_adjust *rssi_adjust;
7440
7441 rssi_adjust = nla_data(
7442 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
7443 request->rssi_adjust.band = rssi_adjust->band;
7444 request->rssi_adjust.delta = rssi_adjust->delta;
7445 if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
7446 err = -EINVAL;
7447 goto out_free;
7448 }
7449 }
7450
Avraham Stern3b06d272015-10-12 09:51:34 +03007451 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
7452 if (err)
7453 goto out_free;
7454
Sam Leffler15d60302012-10-11 21:03:34 -07007455 request->scan_start = jiffies;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007456
Luciano Coelho256da022014-11-10 16:13:46 +02007457 return request;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007458
7459out_free:
7460 kfree(request);
Luciano Coelho256da022014-11-10 16:13:46 +02007461 return ERR_PTR(err);
7462}
7463
7464static int nl80211_start_sched_scan(struct sk_buff *skb,
7465 struct genl_info *info)
7466{
7467 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7468 struct net_device *dev = info->user_ptr[1];
Johannes Bergad2b26a2014-06-12 21:39:05 +02007469 struct wireless_dev *wdev = dev->ieee80211_ptr;
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007470 struct cfg80211_sched_scan_request *sched_scan_req;
Arend Van Sprielca986ad2017-04-21 13:05:00 +01007471 bool want_multi;
Luciano Coelho256da022014-11-10 16:13:46 +02007472 int err;
7473
Arend Van Sprielca986ad2017-04-21 13:05:00 +01007474 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
Luciano Coelho256da022014-11-10 16:13:46 +02007475 return -EOPNOTSUPP;
7476
Arend Van Sprielca986ad2017-04-21 13:05:00 +01007477 want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
7478 err = cfg80211_sched_scan_req_possible(rdev, want_multi);
7479 if (err)
7480 return err;
Luciano Coelho256da022014-11-10 16:13:46 +02007481
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007482 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
Arend Van Sprielaad1e812017-01-27 12:27:44 +00007483 info->attrs,
7484 rdev->wiphy.max_match_sets);
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007485
7486 err = PTR_ERR_OR_ZERO(sched_scan_req);
Luciano Coelho256da022014-11-10 16:13:46 +02007487 if (err)
7488 goto out_err;
7489
Arend Van Sprielca986ad2017-04-21 13:05:00 +01007490 /* leave request id zero for legacy request
7491 * or if driver does not support multi-scheduled scan
7492 */
7493 if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) {
7494 while (!sched_scan_req->reqid)
7495 sched_scan_req->reqid = rdev->wiphy.cookie_counter++;
7496 }
7497
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007498 err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
Luciano Coelho256da022014-11-10 16:13:46 +02007499 if (err)
7500 goto out_free;
7501
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007502 sched_scan_req->dev = dev;
7503 sched_scan_req->wiphy = &rdev->wiphy;
7504
Jukka Rissanen93a1e862014-12-15 13:25:39 +02007505 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
7506 sched_scan_req->owner_nlportid = info->snd_portid;
7507
Arend Van Sprielca986ad2017-04-21 13:05:00 +01007508 cfg80211_add_sched_scan_req(rdev, sched_scan_req);
Luciano Coelho256da022014-11-10 16:13:46 +02007509
Arend Van Spriel96b08fd2017-04-13 13:06:27 +01007510 nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
Luciano Coelho256da022014-11-10 16:13:46 +02007511 return 0;
7512
7513out_free:
Jukka Rissanen31a60ed2014-12-15 13:25:38 +02007514 kfree(sched_scan_req);
Luciano Coelho256da022014-11-10 16:13:46 +02007515out_err:
Luciano Coelho807f8a82011-05-11 17:09:35 +03007516 return err;
7517}
7518
7519static int nl80211_stop_sched_scan(struct sk_buff *skb,
7520 struct genl_info *info)
7521{
Arend Van Sprielca986ad2017-04-21 13:05:00 +01007522 struct cfg80211_sched_scan_request *req;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007523 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Arend Van Sprielca986ad2017-04-21 13:05:00 +01007524 u64 cookie;
Luciano Coelho807f8a82011-05-11 17:09:35 +03007525
Arend Van Sprielca986ad2017-04-21 13:05:00 +01007526 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
Luciano Coelho807f8a82011-05-11 17:09:35 +03007527 return -EOPNOTSUPP;
7528
Arend Van Sprielca986ad2017-04-21 13:05:00 +01007529 if (info->attrs[NL80211_ATTR_COOKIE]) {
7530 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
7531 return __cfg80211_stop_sched_scan(rdev, cookie, false);
7532 }
7533
7534 req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
7535 struct cfg80211_sched_scan_request,
7536 list);
7537 if (!req || req->reqid ||
7538 (req->owner_nlportid &&
7539 req->owner_nlportid != info->snd_portid))
7540 return -ENOENT;
7541
7542 return cfg80211_stop_sched_scan_req(rdev, req, false);
Luciano Coelho807f8a82011-05-11 17:09:35 +03007543}
7544
Simon Wunderlich04f39042013-02-08 18:16:19 +01007545static int nl80211_start_radar_detection(struct sk_buff *skb,
7546 struct genl_info *info)
7547{
7548 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7549 struct net_device *dev = info->user_ptr[1];
7550 struct wireless_dev *wdev = dev->ieee80211_ptr;
7551 struct cfg80211_chan_def chandef;
Luis R. Rodriguez55f74352013-11-25 20:56:10 +01007552 enum nl80211_dfs_regions dfs_region;
Janusz Dziedzic31559f32014-02-21 19:46:13 +01007553 unsigned int cac_time_ms;
Simon Wunderlich04f39042013-02-08 18:16:19 +01007554 int err;
7555
Luis R. Rodriguez55f74352013-11-25 20:56:10 +01007556 dfs_region = reg_get_dfs_region(wdev->wiphy);
7557 if (dfs_region == NL80211_DFS_UNSET)
7558 return -EINVAL;
7559
Simon Wunderlich04f39042013-02-08 18:16:19 +01007560 err = nl80211_parse_chandef(rdev, info, &chandef);
7561 if (err)
7562 return err;
7563
Simon Wunderlichff311bc2013-09-03 19:43:18 +02007564 if (netif_carrier_ok(dev))
7565 return -EBUSY;
7566
Simon Wunderlich04f39042013-02-08 18:16:19 +01007567 if (wdev->cac_started)
7568 return -EBUSY;
7569
Luciano Coelho2beb6dab2014-02-18 11:40:36 +02007570 err = cfg80211_chandef_dfs_required(wdev->wiphy, &chandef,
Luciano Coelho00ec75f2014-05-15 13:05:39 +03007571 wdev->iftype);
Simon Wunderlich04f39042013-02-08 18:16:19 +01007572 if (err < 0)
7573 return err;
7574
7575 if (err == 0)
7576 return -EINVAL;
7577
Janusz Dziedzicfe7c3a12013-11-05 14:48:48 +01007578 if (!cfg80211_chandef_dfs_usable(wdev->wiphy, &chandef))
Simon Wunderlich04f39042013-02-08 18:16:19 +01007579 return -EINVAL;
7580
7581 if (!rdev->ops->start_radar_detection)
7582 return -EOPNOTSUPP;
7583
Janusz Dziedzic31559f32014-02-21 19:46:13 +01007584 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
7585 if (WARN_ON(!cac_time_ms))
7586 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
7587
Ilan Peera1056b1b2015-10-22 22:27:46 +03007588 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
Simon Wunderlich04f39042013-02-08 18:16:19 +01007589 if (!err) {
Michal Kazior9e0e2962014-01-29 14:22:27 +01007590 wdev->chandef = chandef;
Simon Wunderlich04f39042013-02-08 18:16:19 +01007591 wdev->cac_started = true;
7592 wdev->cac_start_time = jiffies;
Janusz Dziedzic31559f32014-02-21 19:46:13 +01007593 wdev->cac_time_ms = cac_time_ms;
Simon Wunderlich04f39042013-02-08 18:16:19 +01007594 }
Simon Wunderlich04f39042013-02-08 18:16:19 +01007595 return err;
7596}
7597
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007598static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
7599{
7600 struct cfg80211_registered_device *rdev = info->user_ptr[0];
7601 struct net_device *dev = info->user_ptr[1];
7602 struct wireless_dev *wdev = dev->ieee80211_ptr;
7603 struct cfg80211_csa_settings params;
7604 /* csa_attrs is defined static to avoid waste of stack size - this
7605 * function is called under RTNL lock, so this should not be a problem.
7606 */
7607 static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007608 int err;
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007609 bool need_new_beacon = false;
Benjamin Berg8d9de162017-05-16 11:23:12 +02007610 bool need_handle_dfs_flag = true;
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007611 int len, i;
Luciano Coelho252e07c2014-10-08 09:48:34 +03007612 u32 cs_count;
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007613
7614 if (!rdev->ops->channel_switch ||
7615 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
7616 return -EOPNOTSUPP;
7617
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007618 switch (dev->ieee80211_ptr->iftype) {
7619 case NL80211_IFTYPE_AP:
7620 case NL80211_IFTYPE_P2P_GO:
7621 need_new_beacon = true;
Benjamin Berg8d9de162017-05-16 11:23:12 +02007622 /* For all modes except AP the handle_dfs flag needs to be
7623 * supplied to tell the kernel that userspace will handle radar
7624 * events when they happen. Otherwise a switch to a channel
7625 * requiring DFS will be rejected.
7626 */
7627 need_handle_dfs_flag = false;
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007628
7629 /* useless if AP is not running */
7630 if (!wdev->beacon_interval)
Johannes Berg1ff79df2014-01-22 10:05:27 +01007631 return -ENOTCONN;
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007632 break;
7633 case NL80211_IFTYPE_ADHOC:
Johannes Berg1ff79df2014-01-22 10:05:27 +01007634 if (!wdev->ssid_len)
7635 return -ENOTCONN;
7636 break;
Chun-Yeow Yeohc6da6742013-10-14 19:08:28 -07007637 case NL80211_IFTYPE_MESH_POINT:
Johannes Berg1ff79df2014-01-22 10:05:27 +01007638 if (!wdev->mesh_id_len)
7639 return -ENOTCONN;
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007640 break;
7641 default:
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007642 return -EOPNOTSUPP;
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007643 }
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007644
7645 memset(&params, 0, sizeof(params));
7646
7647 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
7648 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
7649 return -EINVAL;
7650
7651 /* only important for AP, IBSS and mesh create IEs internally */
Andrei Otcheretianskid0a361a2013-10-17 10:52:17 +02007652 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007653 return -EINVAL;
7654
Luciano Coelho252e07c2014-10-08 09:48:34 +03007655 /* Even though the attribute is u32, the specification says
7656 * u8, so let's make sure we don't overflow.
7657 */
7658 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
7659 if (cs_count > 255)
7660 return -EINVAL;
7661
7662 params.count = cs_count;
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007663
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007664 if (!need_new_beacon)
7665 goto skip_beacons;
7666
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007667 err = nl80211_parse_beacon(info->attrs, &params.beacon_after);
7668 if (err)
7669 return err;
7670
7671 err = nla_parse_nested(csa_attrs, NL80211_ATTR_MAX,
7672 info->attrs[NL80211_ATTR_CSA_IES],
Johannes Bergfe521452017-04-12 14:34:08 +02007673 nl80211_policy, info->extack);
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007674 if (err)
7675 return err;
7676
7677 err = nl80211_parse_beacon(csa_attrs, &params.beacon_csa);
7678 if (err)
7679 return err;
7680
7681 if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
7682 return -EINVAL;
7683
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007684 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7685 if (!len || (len % sizeof(u16)))
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007686 return -EINVAL;
7687
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007688 params.n_counter_offsets_beacon = len / sizeof(u16);
7689 if (rdev->wiphy.max_num_csa_counters &&
7690 (params.n_counter_offsets_beacon >
7691 rdev->wiphy.max_num_csa_counters))
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007692 return -EINVAL;
7693
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007694 params.counter_offsets_beacon =
7695 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7696
7697 /* sanity checks - counters should fit and be the same */
7698 for (i = 0; i < params.n_counter_offsets_beacon; i++) {
7699 u16 offset = params.counter_offsets_beacon[i];
7700
7701 if (offset >= params.beacon_csa.tail_len)
7702 return -EINVAL;
7703
7704 if (params.beacon_csa.tail[offset] != params.count)
7705 return -EINVAL;
7706 }
7707
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007708 if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007709 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7710 if (!len || (len % sizeof(u16)))
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007711 return -EINVAL;
7712
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007713 params.n_counter_offsets_presp = len / sizeof(u16);
7714 if (rdev->wiphy.max_num_csa_counters &&
Johannes Bergad5987b2016-09-13 15:53:55 +02007715 (params.n_counter_offsets_presp >
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007716 rdev->wiphy.max_num_csa_counters))
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007717 return -EINVAL;
Andrei Otcheretianski9a774c72014-05-09 14:11:46 +03007718
7719 params.counter_offsets_presp =
7720 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7721
7722 /* sanity checks - counters should fit and be the same */
7723 for (i = 0; i < params.n_counter_offsets_presp; i++) {
7724 u16 offset = params.counter_offsets_presp[i];
7725
7726 if (offset >= params.beacon_csa.probe_resp_len)
7727 return -EINVAL;
7728
7729 if (params.beacon_csa.probe_resp[offset] !=
7730 params.count)
7731 return -EINVAL;
7732 }
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007733 }
7734
Simon Wunderlichee4bc9e2013-08-28 13:41:33 +02007735skip_beacons:
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007736 err = nl80211_parse_chandef(rdev, info, &params.chandef);
7737 if (err)
7738 return err;
7739
Arik Nemtsov923b3522015-07-08 15:41:44 +03007740 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
7741 wdev->iftype))
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007742 return -EINVAL;
7743
Luciano Coelho2beb6dab2014-02-18 11:40:36 +02007744 err = cfg80211_chandef_dfs_required(wdev->wiphy,
7745 &params.chandef,
7746 wdev->iftype);
7747 if (err < 0)
7748 return err;
7749
Benjamin Berg8d9de162017-05-16 11:23:12 +02007750 if (err > 0) {
Luciano Coelho2beb6dab2014-02-18 11:40:36 +02007751 params.radar_required = true;
Benjamin Berg8d9de162017-05-16 11:23:12 +02007752 if (need_handle_dfs_flag &&
7753 !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) {
7754 return -EINVAL;
7755 }
7756 }
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007757
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007758 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
7759 params.block_tx = true;
7760
Simon Wunderlichc56589e2013-11-21 18:19:49 +01007761 wdev_lock(wdev);
7762 err = rdev_channel_switch(rdev, dev, &params);
7763 wdev_unlock(wdev);
7764
7765 return err;
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +02007766}
7767
Johannes Berg9720bb32011-06-21 09:45:33 +02007768static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
7769 u32 seq, int flags,
Johannes Berg2a519312009-02-10 21:25:55 +01007770 struct cfg80211_registered_device *rdev,
Johannes Berg48ab9052009-07-10 18:42:31 +02007771 struct wireless_dev *wdev,
7772 struct cfg80211_internal_bss *intbss)
Johannes Berg2a519312009-02-10 21:25:55 +01007773{
Johannes Berg48ab9052009-07-10 18:42:31 +02007774 struct cfg80211_bss *res = &intbss->pub;
Johannes Berg9caf0362012-11-29 01:25:20 +01007775 const struct cfg80211_bss_ies *ies;
Johannes Berg2a519312009-02-10 21:25:55 +01007776 void *hdr;
7777 struct nlattr *bss;
Johannes Berg48ab9052009-07-10 18:42:31 +02007778
7779 ASSERT_WDEV_LOCK(wdev);
Johannes Berg2a519312009-02-10 21:25:55 +01007780
Eric W. Biederman15e47302012-09-07 20:12:54 +00007781 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
Johannes Berg2a519312009-02-10 21:25:55 +01007782 NL80211_CMD_NEW_SCAN_RESULTS);
7783 if (!hdr)
7784 return -1;
7785
Michal Kubecek0a833c22017-11-15 13:09:32 +01007786 genl_dump_check_consistent(cb, hdr);
Johannes Berg9720bb32011-06-21 09:45:33 +02007787
Johannes Berg97990a02013-04-19 01:02:55 +02007788 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
7789 goto nla_put_failure;
7790 if (wdev->netdev &&
David S. Miller9360ffd2012-03-29 04:41:26 -04007791 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
7792 goto nla_put_failure;
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007793 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
7794 NL80211_ATTR_PAD))
Johannes Berg97990a02013-04-19 01:02:55 +02007795 goto nla_put_failure;
Johannes Berg2a519312009-02-10 21:25:55 +01007796
7797 bss = nla_nest_start(msg, NL80211_ATTR_BSS);
7798 if (!bss)
7799 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -04007800 if ((!is_zero_ether_addr(res->bssid) &&
Johannes Berg9caf0362012-11-29 01:25:20 +01007801 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
David S. Miller9360ffd2012-03-29 04:41:26 -04007802 goto nla_put_failure;
Johannes Berg9caf0362012-11-29 01:25:20 +01007803
7804 rcu_read_lock();
Johannes Berg0e227082014-08-12 20:34:30 +02007805 /* indicate whether we have probe response data or not */
7806 if (rcu_access_pointer(res->proberesp_ies) &&
7807 nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
7808 goto fail_unlock_rcu;
7809
7810 /* this pointer prefers to be pointed to probe response data
7811 * but is always valid
7812 */
Johannes Berg9caf0362012-11-29 01:25:20 +01007813 ies = rcu_dereference(res->ies);
Johannes Berg8cef2c92013-02-05 16:54:31 +01007814 if (ies) {
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007815 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
7816 NL80211_BSS_PAD))
Johannes Berg8cef2c92013-02-05 16:54:31 +01007817 goto fail_unlock_rcu;
Johannes Berg8cef2c92013-02-05 16:54:31 +01007818 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
7819 ies->len, ies->data))
7820 goto fail_unlock_rcu;
Johannes Berg9caf0362012-11-29 01:25:20 +01007821 }
Johannes Berg0e227082014-08-12 20:34:30 +02007822
7823 /* and this pointer is always (unless driver didn't know) beacon data */
Johannes Berg9caf0362012-11-29 01:25:20 +01007824 ies = rcu_dereference(res->beacon_ies);
Johannes Berg0e227082014-08-12 20:34:30 +02007825 if (ies && ies->from_beacon) {
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007826 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
7827 NL80211_BSS_PAD))
Johannes Berg8cef2c92013-02-05 16:54:31 +01007828 goto fail_unlock_rcu;
7829 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
7830 ies->len, ies->data))
7831 goto fail_unlock_rcu;
Johannes Berg9caf0362012-11-29 01:25:20 +01007832 }
7833 rcu_read_unlock();
7834
David S. Miller9360ffd2012-03-29 04:41:26 -04007835 if (res->beacon_interval &&
7836 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
7837 goto nla_put_failure;
7838 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
7839 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
Simon Wunderlichdcd6eac2013-07-08 16:55:49 +02007840 nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
David S. Miller9360ffd2012-03-29 04:41:26 -04007841 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
7842 jiffies_to_msecs(jiffies - intbss->ts)))
7843 goto nla_put_failure;
Johannes Berg2a519312009-02-10 21:25:55 +01007844
Avraham Stern1d762502016-07-05 17:10:13 +03007845 if (intbss->parent_tsf &&
7846 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
7847 intbss->parent_tsf, NL80211_BSS_PAD) ||
7848 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
7849 intbss->parent_bssid)))
7850 goto nla_put_failure;
7851
Dmitry Shmidt6e19bc42015-10-07 11:32:53 +02007852 if (intbss->ts_boottime &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007853 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
7854 intbss->ts_boottime, NL80211_BSS_PAD))
Dmitry Shmidt6e19bc42015-10-07 11:32:53 +02007855 goto nla_put_failure;
7856
Sunil Dutt983dafa2017-12-13 19:51:36 +02007857 if (!nl80211_put_signal(msg, intbss->pub.chains,
7858 intbss->pub.chain_signal,
7859 NL80211_BSS_CHAIN_SIGNAL))
7860 goto nla_put_failure;
7861
Johannes Berg77965c92009-02-18 18:45:06 +01007862 switch (rdev->wiphy.signal_type) {
Johannes Berg2a519312009-02-10 21:25:55 +01007863 case CFG80211_SIGNAL_TYPE_MBM:
David S. Miller9360ffd2012-03-29 04:41:26 -04007864 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
7865 goto nla_put_failure;
Johannes Berg2a519312009-02-10 21:25:55 +01007866 break;
7867 case CFG80211_SIGNAL_TYPE_UNSPEC:
David S. Miller9360ffd2012-03-29 04:41:26 -04007868 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
7869 goto nla_put_failure;
Johannes Berg2a519312009-02-10 21:25:55 +01007870 break;
7871 default:
7872 break;
7873 }
7874
Johannes Berg48ab9052009-07-10 18:42:31 +02007875 switch (wdev->iftype) {
Johannes Berg074ac8d2010-09-16 14:58:22 +02007876 case NL80211_IFTYPE_P2P_CLIENT:
Johannes Berg48ab9052009-07-10 18:42:31 +02007877 case NL80211_IFTYPE_STATION:
David S. Miller9360ffd2012-03-29 04:41:26 -04007878 if (intbss == wdev->current_bss &&
7879 nla_put_u32(msg, NL80211_BSS_STATUS,
7880 NL80211_BSS_STATUS_ASSOCIATED))
7881 goto nla_put_failure;
Johannes Berg48ab9052009-07-10 18:42:31 +02007882 break;
7883 case NL80211_IFTYPE_ADHOC:
David S. Miller9360ffd2012-03-29 04:41:26 -04007884 if (intbss == wdev->current_bss &&
7885 nla_put_u32(msg, NL80211_BSS_STATUS,
7886 NL80211_BSS_STATUS_IBSS_JOINED))
7887 goto nla_put_failure;
Johannes Berg48ab9052009-07-10 18:42:31 +02007888 break;
7889 default:
7890 break;
7891 }
7892
Johannes Berg2a519312009-02-10 21:25:55 +01007893 nla_nest_end(msg, bss);
7894
Johannes Berg053c0952015-01-16 22:09:00 +01007895 genlmsg_end(msg, hdr);
7896 return 0;
Johannes Berg2a519312009-02-10 21:25:55 +01007897
Johannes Berg8cef2c92013-02-05 16:54:31 +01007898 fail_unlock_rcu:
7899 rcu_read_unlock();
Johannes Berg2a519312009-02-10 21:25:55 +01007900 nla_put_failure:
7901 genlmsg_cancel(msg, hdr);
7902 return -EMSGSIZE;
7903}
7904
Johannes Berg97990a02013-04-19 01:02:55 +02007905static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
Johannes Berg2a519312009-02-10 21:25:55 +01007906{
Johannes Berg48ab9052009-07-10 18:42:31 +02007907 struct cfg80211_registered_device *rdev;
Johannes Berg2a519312009-02-10 21:25:55 +01007908 struct cfg80211_internal_bss *scan;
Johannes Berg48ab9052009-07-10 18:42:31 +02007909 struct wireless_dev *wdev;
Johannes Berg97990a02013-04-19 01:02:55 +02007910 int start = cb->args[2], idx = 0;
Johannes Berg2a519312009-02-10 21:25:55 +01007911 int err;
7912
Johannes Bergea90e0d2017-03-15 14:26:04 +01007913 rtnl_lock();
Johannes Berg97990a02013-04-19 01:02:55 +02007914 err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
Johannes Bergea90e0d2017-03-15 14:26:04 +01007915 if (err) {
7916 rtnl_unlock();
Johannes Berg67748892010-10-04 21:14:06 +02007917 return err;
Johannes Bergea90e0d2017-03-15 14:26:04 +01007918 }
Johannes Berg2a519312009-02-10 21:25:55 +01007919
Johannes Berg48ab9052009-07-10 18:42:31 +02007920 wdev_lock(wdev);
7921 spin_lock_bh(&rdev->bss_lock);
7922 cfg80211_bss_expire(rdev);
7923
Johannes Berg9720bb32011-06-21 09:45:33 +02007924 cb->seq = rdev->bss_generation;
7925
Johannes Berg48ab9052009-07-10 18:42:31 +02007926 list_for_each_entry(scan, &rdev->bss_list, list) {
Johannes Berg2a519312009-02-10 21:25:55 +01007927 if (++idx <= start)
7928 continue;
Johannes Berg9720bb32011-06-21 09:45:33 +02007929 if (nl80211_send_bss(skb, cb,
Johannes Berg2a519312009-02-10 21:25:55 +01007930 cb->nlh->nlmsg_seq, NLM_F_MULTI,
Johannes Berg48ab9052009-07-10 18:42:31 +02007931 rdev, wdev, scan) < 0) {
Johannes Berg2a519312009-02-10 21:25:55 +01007932 idx--;
Johannes Berg67748892010-10-04 21:14:06 +02007933 break;
Johannes Berg2a519312009-02-10 21:25:55 +01007934 }
7935 }
7936
Johannes Berg48ab9052009-07-10 18:42:31 +02007937 spin_unlock_bh(&rdev->bss_lock);
7938 wdev_unlock(wdev);
Johannes Berg2a519312009-02-10 21:25:55 +01007939
Johannes Berg97990a02013-04-19 01:02:55 +02007940 cb->args[2] = idx;
Johannes Bergea90e0d2017-03-15 14:26:04 +01007941 rtnl_unlock();
Johannes Berg2a519312009-02-10 21:25:55 +01007942
Johannes Berg67748892010-10-04 21:14:06 +02007943 return skb->len;
Johannes Berg2a519312009-02-10 21:25:55 +01007944}
7945
Eric W. Biederman15e47302012-09-07 20:12:54 +00007946static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
Johannes Berg11f78ac2014-11-14 16:43:50 +01007947 int flags, struct net_device *dev,
7948 bool allow_radio_stats,
7949 struct survey_info *survey)
Holger Schurig61fa7132009-11-11 12:25:40 +01007950{
7951 void *hdr;
7952 struct nlattr *infoattr;
7953
Johannes Berg11f78ac2014-11-14 16:43:50 +01007954 /* skip radio stats if userspace didn't request them */
7955 if (!survey->channel && !allow_radio_stats)
7956 return 0;
7957
Eric W. Biederman15e47302012-09-07 20:12:54 +00007958 hdr = nl80211hdr_put(msg, portid, seq, flags,
Holger Schurig61fa7132009-11-11 12:25:40 +01007959 NL80211_CMD_NEW_SURVEY_RESULTS);
7960 if (!hdr)
7961 return -ENOMEM;
7962
David S. Miller9360ffd2012-03-29 04:41:26 -04007963 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
7964 goto nla_put_failure;
Holger Schurig61fa7132009-11-11 12:25:40 +01007965
7966 infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
7967 if (!infoattr)
7968 goto nla_put_failure;
7969
Johannes Berg11f78ac2014-11-14 16:43:50 +01007970 if (survey->channel &&
7971 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
David S. Miller9360ffd2012-03-29 04:41:26 -04007972 survey->channel->center_freq))
7973 goto nla_put_failure;
7974
7975 if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
7976 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
7977 goto nla_put_failure;
7978 if ((survey->filled & SURVEY_INFO_IN_USE) &&
7979 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
7980 goto nla_put_failure;
Johannes Berg4ed20be2014-11-14 16:35:34 +01007981 if ((survey->filled & SURVEY_INFO_TIME) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007982 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
7983 survey->time, NL80211_SURVEY_INFO_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04007984 goto nla_put_failure;
Johannes Berg4ed20be2014-11-14 16:35:34 +01007985 if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007986 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
7987 survey->time_busy, NL80211_SURVEY_INFO_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04007988 goto nla_put_failure;
Johannes Berg4ed20be2014-11-14 16:35:34 +01007989 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007990 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
7991 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04007992 goto nla_put_failure;
Johannes Berg4ed20be2014-11-14 16:35:34 +01007993 if ((survey->filled & SURVEY_INFO_TIME_RX) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007994 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
7995 survey->time_rx, NL80211_SURVEY_INFO_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04007996 goto nla_put_failure;
Johannes Berg4ed20be2014-11-14 16:35:34 +01007997 if ((survey->filled & SURVEY_INFO_TIME_TX) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02007998 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
7999 survey->time_tx, NL80211_SURVEY_INFO_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04008000 goto nla_put_failure;
Johannes Berg052536a2014-11-14 16:44:11 +01008001 if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02008002 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
8003 survey->time_scan, NL80211_SURVEY_INFO_PAD))
Johannes Berg052536a2014-11-14 16:44:11 +01008004 goto nla_put_failure;
Holger Schurig61fa7132009-11-11 12:25:40 +01008005
8006 nla_nest_end(msg, infoattr);
8007
Johannes Berg053c0952015-01-16 22:09:00 +01008008 genlmsg_end(msg, hdr);
8009 return 0;
Holger Schurig61fa7132009-11-11 12:25:40 +01008010
8011 nla_put_failure:
8012 genlmsg_cancel(msg, hdr);
8013 return -EMSGSIZE;
8014}
8015
Johannes Berg11f78ac2014-11-14 16:43:50 +01008016static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
Holger Schurig61fa7132009-11-11 12:25:40 +01008017{
Johannes Bergc90c39d2016-10-24 14:40:01 +02008018 struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
Holger Schurig61fa7132009-11-11 12:25:40 +01008019 struct survey_info survey;
Zhao, Gang1b8ec872014-04-21 12:53:02 +08008020 struct cfg80211_registered_device *rdev;
Johannes Berg97990a02013-04-19 01:02:55 +02008021 struct wireless_dev *wdev;
8022 int survey_idx = cb->args[2];
Holger Schurig61fa7132009-11-11 12:25:40 +01008023 int res;
Johannes Berg11f78ac2014-11-14 16:43:50 +01008024 bool radio_stats;
Holger Schurig61fa7132009-11-11 12:25:40 +01008025
Johannes Bergea90e0d2017-03-15 14:26:04 +01008026 rtnl_lock();
Zhao, Gang1b8ec872014-04-21 12:53:02 +08008027 res = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
Johannes Berg67748892010-10-04 21:14:06 +02008028 if (res)
Johannes Bergea90e0d2017-03-15 14:26:04 +01008029 goto out_err;
Holger Schurig61fa7132009-11-11 12:25:40 +01008030
Johannes Berg11f78ac2014-11-14 16:43:50 +01008031 /* prepare_wdev_dump parsed the attributes */
Johannes Bergc90c39d2016-10-24 14:40:01 +02008032 radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
Johannes Berg11f78ac2014-11-14 16:43:50 +01008033
Johannes Berg97990a02013-04-19 01:02:55 +02008034 if (!wdev->netdev) {
8035 res = -EINVAL;
8036 goto out_err;
8037 }
8038
Zhao, Gang1b8ec872014-04-21 12:53:02 +08008039 if (!rdev->ops->dump_survey) {
Holger Schurig61fa7132009-11-11 12:25:40 +01008040 res = -EOPNOTSUPP;
8041 goto out_err;
8042 }
8043
8044 while (1) {
Zhao, Gang1b8ec872014-04-21 12:53:02 +08008045 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
Holger Schurig61fa7132009-11-11 12:25:40 +01008046 if (res == -ENOENT)
8047 break;
8048 if (res)
8049 goto out_err;
8050
Johannes Berg11f78ac2014-11-14 16:43:50 +01008051 /* don't send disabled channels, but do send non-channel data */
8052 if (survey.channel &&
8053 survey.channel->flags & IEEE80211_CHAN_DISABLED) {
Luis R. Rodriguez180cdc72011-05-27 07:24:02 -07008054 survey_idx++;
8055 continue;
8056 }
8057
Holger Schurig61fa7132009-11-11 12:25:40 +01008058 if (nl80211_send_survey(skb,
Eric W. Biederman15e47302012-09-07 20:12:54 +00008059 NETLINK_CB(cb->skb).portid,
Holger Schurig61fa7132009-11-11 12:25:40 +01008060 cb->nlh->nlmsg_seq, NLM_F_MULTI,
Johannes Berg11f78ac2014-11-14 16:43:50 +01008061 wdev->netdev, radio_stats, &survey) < 0)
Holger Schurig61fa7132009-11-11 12:25:40 +01008062 goto out;
8063 survey_idx++;
8064 }
8065
8066 out:
Johannes Berg97990a02013-04-19 01:02:55 +02008067 cb->args[2] = survey_idx;
Holger Schurig61fa7132009-11-11 12:25:40 +01008068 res = skb->len;
8069 out_err:
Johannes Bergea90e0d2017-03-15 14:26:04 +01008070 rtnl_unlock();
Holger Schurig61fa7132009-11-11 12:25:40 +01008071 return res;
8072}
8073
Samuel Ortizb23aa672009-07-01 21:26:54 +02008074static bool nl80211_valid_wpa_versions(u32 wpa_versions)
8075{
8076 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
8077 NL80211_WPA_VERSION_2));
8078}
8079
Jouni Malinen636a5d32009-03-19 13:39:22 +02008080static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
8081{
Johannes Berg4c476992010-10-04 21:36:35 +02008082 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8083 struct net_device *dev = info->user_ptr[1];
Johannes Berg19957bb2009-07-02 17:20:43 +02008084 struct ieee80211_channel *chan;
Jouni Malinen11b6b5a2016-10-27 00:41:58 +03008085 const u8 *bssid, *ssid, *ie = NULL, *auth_data = NULL;
8086 int err, ssid_len, ie_len = 0, auth_data_len = 0;
Johannes Berg19957bb2009-07-02 17:20:43 +02008087 enum nl80211_auth_type auth_type;
Johannes Bergfffd0932009-07-08 14:22:54 +02008088 struct key_parse key;
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008089 bool local_state_change;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008090
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008091 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8092 return -EINVAL;
8093
8094 if (!info->attrs[NL80211_ATTR_MAC])
8095 return -EINVAL;
8096
Jouni Malinen17780922009-03-27 20:52:47 +02008097 if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
8098 return -EINVAL;
8099
Johannes Berg19957bb2009-07-02 17:20:43 +02008100 if (!info->attrs[NL80211_ATTR_SSID])
8101 return -EINVAL;
8102
8103 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
8104 return -EINVAL;
8105
Johannes Bergfffd0932009-07-08 14:22:54 +02008106 err = nl80211_parse_key(info, &key);
8107 if (err)
8108 return err;
8109
8110 if (key.idx >= 0) {
Johannes Berge31b8212010-10-05 19:39:30 +02008111 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
8112 return -EINVAL;
Johannes Bergfffd0932009-07-08 14:22:54 +02008113 if (!key.p.key || !key.p.key_len)
8114 return -EINVAL;
8115 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
8116 key.p.key_len != WLAN_KEY_LEN_WEP40) &&
8117 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
8118 key.p.key_len != WLAN_KEY_LEN_WEP104))
8119 return -EINVAL;
Johannes Bergb6b55552016-09-13 16:25:58 +02008120 if (key.idx > 3)
Johannes Bergfffd0932009-07-08 14:22:54 +02008121 return -EINVAL;
8122 } else {
8123 key.p.key_len = 0;
8124 key.p.key = NULL;
8125 }
8126
Johannes Bergafea0b72010-08-10 09:46:42 +02008127 if (key.idx >= 0) {
8128 int i;
8129 bool ok = false;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07008130
Johannes Bergafea0b72010-08-10 09:46:42 +02008131 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
8132 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
8133 ok = true;
8134 break;
8135 }
8136 }
Johannes Berg4c476992010-10-04 21:36:35 +02008137 if (!ok)
8138 return -EINVAL;
Johannes Bergafea0b72010-08-10 09:46:42 +02008139 }
8140
Johannes Berg4c476992010-10-04 21:36:35 +02008141 if (!rdev->ops->auth)
8142 return -EOPNOTSUPP;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008143
Johannes Berg074ac8d2010-09-16 14:58:22 +02008144 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02008145 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8146 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02008147
Johannes Berg19957bb2009-07-02 17:20:43 +02008148 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Jouni Malinen664834d2014-01-15 00:01:44 +02008149 chan = nl80211_get_valid_chan(&rdev->wiphy,
8150 info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8151 if (!chan)
Johannes Berg4c476992010-10-04 21:36:35 +02008152 return -EINVAL;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008153
Johannes Berg19957bb2009-07-02 17:20:43 +02008154 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8155 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8156
8157 if (info->attrs[NL80211_ATTR_IE]) {
8158 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8159 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8160 }
8161
8162 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
Jouni Malinene39e5b52012-09-30 19:29:39 +03008163 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
Johannes Berg4c476992010-10-04 21:36:35 +02008164 return -EINVAL;
Johannes Berg19957bb2009-07-02 17:20:43 +02008165
Jouni Malinen63181062016-10-27 00:42:02 +03008166 if ((auth_type == NL80211_AUTHTYPE_SAE ||
8167 auth_type == NL80211_AUTHTYPE_FILS_SK ||
8168 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
8169 auth_type == NL80211_AUTHTYPE_FILS_PK) &&
Jouni Malinen11b6b5a2016-10-27 00:41:58 +03008170 !info->attrs[NL80211_ATTR_AUTH_DATA])
Jouni Malinene39e5b52012-09-30 19:29:39 +03008171 return -EINVAL;
8172
Jouni Malinen11b6b5a2016-10-27 00:41:58 +03008173 if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
Jouni Malinen63181062016-10-27 00:42:02 +03008174 if (auth_type != NL80211_AUTHTYPE_SAE &&
8175 auth_type != NL80211_AUTHTYPE_FILS_SK &&
8176 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
8177 auth_type != NL80211_AUTHTYPE_FILS_PK)
Jouni Malinene39e5b52012-09-30 19:29:39 +03008178 return -EINVAL;
Jouni Malinen11b6b5a2016-10-27 00:41:58 +03008179 auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
8180 auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
Jouni Malinene39e5b52012-09-30 19:29:39 +03008181 /* need to include at least Auth Transaction and Status Code */
Jouni Malinen11b6b5a2016-10-27 00:41:58 +03008182 if (auth_data_len < 4)
Jouni Malinene39e5b52012-09-30 19:29:39 +03008183 return -EINVAL;
8184 }
8185
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008186 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8187
Johannes Berg95de8172012-01-20 13:55:25 +01008188 /*
8189 * Since we no longer track auth state, ignore
8190 * requests to only change local state.
8191 */
8192 if (local_state_change)
8193 return 0;
8194
Johannes Berg91bf9b22013-05-15 17:44:01 +02008195 wdev_lock(dev->ieee80211_ptr);
8196 err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
8197 ssid, ssid_len, ie, ie_len,
8198 key.p.key, key.p.key_len, key.idx,
Jouni Malinen11b6b5a2016-10-27 00:41:58 +03008199 auth_data, auth_data_len);
Johannes Berg91bf9b22013-05-15 17:44:01 +02008200 wdev_unlock(dev->ieee80211_ptr);
8201 return err;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008202}
8203
Johannes Bergc0692b82010-08-27 14:26:53 +03008204static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
8205 struct genl_info *info,
Johannes Berg3dc27d22009-07-02 21:36:37 +02008206 struct cfg80211_crypto_settings *settings,
8207 int cipher_limit)
Samuel Ortizb23aa672009-07-01 21:26:54 +02008208{
Johannes Bergc0b2bbd2009-07-25 16:54:36 +02008209 memset(settings, 0, sizeof(*settings));
8210
Samuel Ortizb23aa672009-07-01 21:26:54 +02008211 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
8212
Johannes Bergc0692b82010-08-27 14:26:53 +03008213 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
8214 u16 proto;
Kirtika Ruchandani7a087e72016-05-29 19:51:23 -07008215
Johannes Bergc0692b82010-08-27 14:26:53 +03008216 proto = nla_get_u16(
8217 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
8218 settings->control_port_ethertype = cpu_to_be16(proto);
8219 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
8220 proto != ETH_P_PAE)
8221 return -EINVAL;
8222 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
8223 settings->control_port_no_encrypt = true;
8224 } else
8225 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
8226
Samuel Ortizb23aa672009-07-01 21:26:54 +02008227 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
8228 void *data;
8229 int len, i;
8230
8231 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
8232 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
8233 settings->n_ciphers_pairwise = len / sizeof(u32);
8234
8235 if (len % sizeof(u32))
8236 return -EINVAL;
8237
Johannes Berg3dc27d22009-07-02 21:36:37 +02008238 if (settings->n_ciphers_pairwise > cipher_limit)
Samuel Ortizb23aa672009-07-01 21:26:54 +02008239 return -EINVAL;
8240
8241 memcpy(settings->ciphers_pairwise, data, len);
8242
8243 for (i = 0; i < settings->n_ciphers_pairwise; i++)
Jouni Malinen38ba3c52011-09-21 18:14:56 +03008244 if (!cfg80211_supported_cipher_suite(
8245 &rdev->wiphy,
Samuel Ortizb23aa672009-07-01 21:26:54 +02008246 settings->ciphers_pairwise[i]))
8247 return -EINVAL;
8248 }
8249
8250 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
8251 settings->cipher_group =
8252 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
Jouni Malinen38ba3c52011-09-21 18:14:56 +03008253 if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
8254 settings->cipher_group))
Samuel Ortizb23aa672009-07-01 21:26:54 +02008255 return -EINVAL;
8256 }
8257
8258 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
8259 settings->wpa_versions =
8260 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
8261 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
8262 return -EINVAL;
8263 }
8264
8265 if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
8266 void *data;
Jouni Malinen6d302402011-09-21 18:11:33 +03008267 int len;
Samuel Ortizb23aa672009-07-01 21:26:54 +02008268
8269 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
8270 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
8271 settings->n_akm_suites = len / sizeof(u32);
8272
8273 if (len % sizeof(u32))
8274 return -EINVAL;
8275
Jouni Malinen1b9ca022011-09-21 16:13:07 +03008276 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
8277 return -EINVAL;
8278
Samuel Ortizb23aa672009-07-01 21:26:54 +02008279 memcpy(settings->akm_suites, data, len);
Samuel Ortizb23aa672009-07-01 21:26:54 +02008280 }
8281
Eliad Peller91b5ab62017-06-09 13:08:42 +01008282 if (info->attrs[NL80211_ATTR_PMK]) {
8283 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN)
8284 return -EINVAL;
8285 if (!wiphy_ext_feature_isset(&rdev->wiphy,
8286 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK))
8287 return -EINVAL;
8288 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]);
8289 }
8290
Samuel Ortizb23aa672009-07-01 21:26:54 +02008291 return 0;
8292}
8293
Jouni Malinen636a5d32009-03-19 13:39:22 +02008294static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
8295{
Johannes Berg4c476992010-10-04 21:36:35 +02008296 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8297 struct net_device *dev = info->user_ptr[1];
Johannes Bergf444de02010-05-05 15:25:02 +02008298 struct ieee80211_channel *chan;
Johannes Bergf62fab72013-02-21 20:09:09 +01008299 struct cfg80211_assoc_request req = {};
8300 const u8 *bssid, *ssid;
8301 int err, ssid_len = 0;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008302
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008303 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8304 return -EINVAL;
8305
8306 if (!info->attrs[NL80211_ATTR_MAC] ||
Johannes Berg19957bb2009-07-02 17:20:43 +02008307 !info->attrs[NL80211_ATTR_SSID] ||
8308 !info->attrs[NL80211_ATTR_WIPHY_FREQ])
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008309 return -EINVAL;
8310
Johannes Berg4c476992010-10-04 21:36:35 +02008311 if (!rdev->ops->assoc)
8312 return -EOPNOTSUPP;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008313
Johannes Berg074ac8d2010-09-16 14:58:22 +02008314 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02008315 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8316 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02008317
Johannes Berg19957bb2009-07-02 17:20:43 +02008318 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008319
Jouni Malinen664834d2014-01-15 00:01:44 +02008320 chan = nl80211_get_valid_chan(&rdev->wiphy,
8321 info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8322 if (!chan)
Johannes Berg4c476992010-10-04 21:36:35 +02008323 return -EINVAL;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008324
Johannes Berg19957bb2009-07-02 17:20:43 +02008325 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8326 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008327
8328 if (info->attrs[NL80211_ATTR_IE]) {
Johannes Bergf62fab72013-02-21 20:09:09 +01008329 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8330 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008331 }
8332
Jouni Malinendc6382ce2009-05-06 22:09:37 +03008333 if (info->attrs[NL80211_ATTR_USE_MFP]) {
Johannes Berg4f5dadc2009-07-07 03:56:10 +02008334 enum nl80211_mfp mfp =
Jouni Malinendc6382ce2009-05-06 22:09:37 +03008335 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
Johannes Berg4f5dadc2009-07-07 03:56:10 +02008336 if (mfp == NL80211_MFP_REQUIRED)
Johannes Bergf62fab72013-02-21 20:09:09 +01008337 req.use_mfp = true;
Johannes Berg4c476992010-10-04 21:36:35 +02008338 else if (mfp != NL80211_MFP_NO)
8339 return -EINVAL;
Jouni Malinendc6382ce2009-05-06 22:09:37 +03008340 }
8341
Johannes Berg3e5d7642009-07-07 14:37:26 +02008342 if (info->attrs[NL80211_ATTR_PREV_BSSID])
Johannes Bergf62fab72013-02-21 20:09:09 +01008343 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
Johannes Berg3e5d7642009-07-07 14:37:26 +02008344
Ben Greear7e7c8922011-11-18 11:31:59 -08008345 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
Johannes Bergf62fab72013-02-21 20:09:09 +01008346 req.flags |= ASSOC_REQ_DISABLE_HT;
Ben Greear7e7c8922011-11-18 11:31:59 -08008347
8348 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
Johannes Bergf62fab72013-02-21 20:09:09 +01008349 memcpy(&req.ht_capa_mask,
8350 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8351 sizeof(req.ht_capa_mask));
Ben Greear7e7c8922011-11-18 11:31:59 -08008352
8353 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
Johannes Bergf62fab72013-02-21 20:09:09 +01008354 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
Ben Greear7e7c8922011-11-18 11:31:59 -08008355 return -EINVAL;
Johannes Bergf62fab72013-02-21 20:09:09 +01008356 memcpy(&req.ht_capa,
8357 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8358 sizeof(req.ht_capa));
Ben Greear7e7c8922011-11-18 11:31:59 -08008359 }
8360
Johannes Bergee2aca32013-02-21 17:36:01 +01008361 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
Johannes Bergf62fab72013-02-21 20:09:09 +01008362 req.flags |= ASSOC_REQ_DISABLE_VHT;
Johannes Bergee2aca32013-02-21 17:36:01 +01008363
8364 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
Johannes Bergf62fab72013-02-21 20:09:09 +01008365 memcpy(&req.vht_capa_mask,
8366 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
8367 sizeof(req.vht_capa_mask));
Johannes Bergee2aca32013-02-21 17:36:01 +01008368
8369 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
Johannes Bergf62fab72013-02-21 20:09:09 +01008370 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
Johannes Bergee2aca32013-02-21 17:36:01 +01008371 return -EINVAL;
Johannes Bergf62fab72013-02-21 20:09:09 +01008372 memcpy(&req.vht_capa,
8373 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
8374 sizeof(req.vht_capa));
Johannes Bergee2aca32013-02-21 17:36:01 +01008375 }
8376
Assaf Kraussbab5ab72014-09-03 15:25:01 +03008377 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
Beni Lev0c9ca112016-02-17 20:30:00 +02008378 if (!((rdev->wiphy.features &
8379 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
8380 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
8381 !wiphy_ext_feature_isset(&rdev->wiphy,
8382 NL80211_EXT_FEATURE_RRM))
Assaf Kraussbab5ab72014-09-03 15:25:01 +03008383 return -EINVAL;
8384 req.flags |= ASSOC_REQ_USE_RRM;
8385 }
8386
Jouni Malinen348bd452016-10-27 00:42:03 +03008387 if (info->attrs[NL80211_ATTR_FILS_KEK]) {
8388 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
8389 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
8390 if (!info->attrs[NL80211_ATTR_FILS_NONCES])
8391 return -EINVAL;
8392 req.fils_nonces =
8393 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
8394 }
8395
Johannes Bergf62fab72013-02-21 20:09:09 +01008396 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
Johannes Berg91bf9b22013-05-15 17:44:01 +02008397 if (!err) {
8398 wdev_lock(dev->ieee80211_ptr);
Andrzej Zaborowskibd2522b2017-01-06 16:33:43 -05008399
Johannes Bergf62fab72013-02-21 20:09:09 +01008400 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
8401 ssid, ssid_len, &req);
Andrzej Zaborowskibd2522b2017-01-06 16:33:43 -05008402
8403 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
8404 dev->ieee80211_ptr->conn_owner_nlportid =
8405 info->snd_portid;
8406 memcpy(dev->ieee80211_ptr->disconnect_bssid,
8407 bssid, ETH_ALEN);
8408 }
8409
Johannes Berg91bf9b22013-05-15 17:44:01 +02008410 wdev_unlock(dev->ieee80211_ptr);
8411 }
Jouni Malinen636a5d32009-03-19 13:39:22 +02008412
Jouni Malinen636a5d32009-03-19 13:39:22 +02008413 return err;
8414}
8415
8416static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
8417{
Johannes Berg4c476992010-10-04 21:36:35 +02008418 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8419 struct net_device *dev = info->user_ptr[1];
Johannes Berg19957bb2009-07-02 17:20:43 +02008420 const u8 *ie = NULL, *bssid;
Johannes Berg91bf9b22013-05-15 17:44:01 +02008421 int ie_len = 0, err;
Johannes Berg19957bb2009-07-02 17:20:43 +02008422 u16 reason_code;
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008423 bool local_state_change;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008424
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008425 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8426 return -EINVAL;
8427
8428 if (!info->attrs[NL80211_ATTR_MAC])
8429 return -EINVAL;
8430
8431 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8432 return -EINVAL;
8433
Johannes Berg4c476992010-10-04 21:36:35 +02008434 if (!rdev->ops->deauth)
8435 return -EOPNOTSUPP;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008436
Johannes Berg074ac8d2010-09-16 14:58:22 +02008437 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02008438 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8439 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02008440
Johannes Berg19957bb2009-07-02 17:20:43 +02008441 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008442
Johannes Berg19957bb2009-07-02 17:20:43 +02008443 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8444 if (reason_code == 0) {
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008445 /* Reason Code 0 is reserved */
Johannes Berg4c476992010-10-04 21:36:35 +02008446 return -EINVAL;
Jouni Malinen255e7372009-03-20 21:21:17 +02008447 }
Jouni Malinen636a5d32009-03-19 13:39:22 +02008448
8449 if (info->attrs[NL80211_ATTR_IE]) {
Johannes Berg19957bb2009-07-02 17:20:43 +02008450 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8451 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008452 }
8453
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008454 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8455
Johannes Berg91bf9b22013-05-15 17:44:01 +02008456 wdev_lock(dev->ieee80211_ptr);
8457 err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
8458 local_state_change);
8459 wdev_unlock(dev->ieee80211_ptr);
8460 return err;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008461}
8462
8463static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
8464{
Johannes Berg4c476992010-10-04 21:36:35 +02008465 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8466 struct net_device *dev = info->user_ptr[1];
Johannes Berg19957bb2009-07-02 17:20:43 +02008467 const u8 *ie = NULL, *bssid;
Johannes Berg91bf9b22013-05-15 17:44:01 +02008468 int ie_len = 0, err;
Johannes Berg19957bb2009-07-02 17:20:43 +02008469 u16 reason_code;
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008470 bool local_state_change;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008471
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008472 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8473 return -EINVAL;
8474
8475 if (!info->attrs[NL80211_ATTR_MAC])
8476 return -EINVAL;
8477
8478 if (!info->attrs[NL80211_ATTR_REASON_CODE])
8479 return -EINVAL;
8480
Johannes Berg4c476992010-10-04 21:36:35 +02008481 if (!rdev->ops->disassoc)
8482 return -EOPNOTSUPP;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008483
Johannes Berg074ac8d2010-09-16 14:58:22 +02008484 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02008485 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8486 return -EOPNOTSUPP;
Jouni Malineneec60b02009-03-20 21:21:19 +02008487
Johannes Berg19957bb2009-07-02 17:20:43 +02008488 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008489
Johannes Berg19957bb2009-07-02 17:20:43 +02008490 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8491 if (reason_code == 0) {
Johannes Bergf4a11bb2009-03-27 12:40:28 +01008492 /* Reason Code 0 is reserved */
Johannes Berg4c476992010-10-04 21:36:35 +02008493 return -EINVAL;
Jouni Malinen255e7372009-03-20 21:21:17 +02008494 }
Jouni Malinen636a5d32009-03-19 13:39:22 +02008495
8496 if (info->attrs[NL80211_ATTR_IE]) {
Johannes Berg19957bb2009-07-02 17:20:43 +02008497 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8498 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
Jouni Malinen636a5d32009-03-19 13:39:22 +02008499 }
8500
Jouni Malinend5cdfac2010-04-04 09:37:19 +03008501 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8502
Johannes Berg91bf9b22013-05-15 17:44:01 +02008503 wdev_lock(dev->ieee80211_ptr);
8504 err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
8505 local_state_change);
8506 wdev_unlock(dev->ieee80211_ptr);
8507 return err;
Jouni Malinen636a5d32009-03-19 13:39:22 +02008508}
8509
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01008510static bool
8511nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
Johannes Berg57fbcce2016-04-12 15:56:15 +02008512 int mcast_rate[NUM_NL80211_BANDS],
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01008513 int rateval)
8514{
8515 struct wiphy *wiphy = &rdev->wiphy;
8516 bool found = false;
8517 int band, i;
8518
Johannes Berg57fbcce2016-04-12 15:56:15 +02008519 for (band = 0; band < NUM_NL80211_BANDS; band++) {
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01008520 struct ieee80211_supported_band *sband;
8521
8522 sband = wiphy->bands[band];
8523 if (!sband)
8524 continue;
8525
8526 for (i = 0; i < sband->n_bitrates; i++) {
8527 if (sband->bitrates[i].bitrate == rateval) {
8528 mcast_rate[band] = i + 1;
8529 found = true;
8530 break;
8531 }
8532 }
8533 }
8534
8535 return found;
8536}
8537
Johannes Berg04a773a2009-04-19 21:24:32 +02008538static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
8539{
Johannes Berg4c476992010-10-04 21:36:35 +02008540 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8541 struct net_device *dev = info->user_ptr[1];
Johannes Berg04a773a2009-04-19 21:24:32 +02008542 struct cfg80211_ibss_params ibss;
8543 struct wiphy *wiphy;
Johannes Bergfffd0932009-07-08 14:22:54 +02008544 struct cfg80211_cached_keys *connkeys = NULL;
Johannes Berg04a773a2009-04-19 21:24:32 +02008545 int err;
8546
Johannes Berg8e30bc52009-04-22 17:45:38 +02008547 memset(&ibss, 0, sizeof(ibss));
8548
Johannes Berg04a773a2009-04-19 21:24:32 +02008549 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8550 return -EINVAL;
8551
Johannes Berg683b6d32012-11-08 21:25:48 +01008552 if (!info->attrs[NL80211_ATTR_SSID] ||
Johannes Berg04a773a2009-04-19 21:24:32 +02008553 !nla_len(info->attrs[NL80211_ATTR_SSID]))
8554 return -EINVAL;
8555
Johannes Berg8e30bc52009-04-22 17:45:38 +02008556 ibss.beacon_interval = 100;
8557
Purushottam Kushwaha12d20fc92016-08-11 15:14:02 +05308558 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
Johannes Berg8e30bc52009-04-22 17:45:38 +02008559 ibss.beacon_interval =
8560 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
Purushottam Kushwaha12d20fc92016-08-11 15:14:02 +05308561
Purushottam Kushwaha0c317a02016-10-12 18:26:51 +05308562 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
8563 ibss.beacon_interval);
Purushottam Kushwaha12d20fc92016-08-11 15:14:02 +05308564 if (err)
8565 return err;
Johannes Berg8e30bc52009-04-22 17:45:38 +02008566
Johannes Berg4c476992010-10-04 21:36:35 +02008567 if (!rdev->ops->join_ibss)
8568 return -EOPNOTSUPP;
Johannes Berg04a773a2009-04-19 21:24:32 +02008569
Johannes Berg4c476992010-10-04 21:36:35 +02008570 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8571 return -EOPNOTSUPP;
Johannes Berg04a773a2009-04-19 21:24:32 +02008572
Johannes Berg79c97e92009-07-07 03:56:12 +02008573 wiphy = &rdev->wiphy;
Johannes Berg04a773a2009-04-19 21:24:32 +02008574
Johannes Berg39193492011-09-16 13:45:25 +02008575 if (info->attrs[NL80211_ATTR_MAC]) {
Johannes Berg04a773a2009-04-19 21:24:32 +02008576 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Johannes Berg39193492011-09-16 13:45:25 +02008577
8578 if (!is_valid_ether_addr(ibss.bssid))
8579 return -EINVAL;
8580 }
Johannes Berg04a773a2009-04-19 21:24:32 +02008581 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8582 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8583
8584 if (info->attrs[NL80211_ATTR_IE]) {
8585 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8586 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8587 }
8588
Johannes Berg683b6d32012-11-08 21:25:48 +01008589 err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
8590 if (err)
8591 return err;
Alexander Simon54858ee5b2011-11-30 16:56:32 +01008592
Ilan Peer174e0cd2014-02-23 09:13:01 +02008593 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
8594 NL80211_IFTYPE_ADHOC))
Alexander Simon54858ee5b2011-11-30 16:56:32 +01008595 return -EINVAL;
8596
Simon Wunderlich2f301ab2013-05-16 13:00:28 +02008597 switch (ibss.chandef.width) {
Simon Wunderlichbf372642013-07-08 16:55:58 +02008598 case NL80211_CHAN_WIDTH_5:
8599 case NL80211_CHAN_WIDTH_10:
Simon Wunderlich2f301ab2013-05-16 13:00:28 +02008600 case NL80211_CHAN_WIDTH_20_NOHT:
8601 break;
8602 case NL80211_CHAN_WIDTH_20:
8603 case NL80211_CHAN_WIDTH_40:
Janusz.Dziedzic@tieto.comffc11992015-02-21 16:52:39 +01008604 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8605 return -EINVAL;
8606 break;
8607 case NL80211_CHAN_WIDTH_80:
8608 case NL80211_CHAN_WIDTH_80P80:
8609 case NL80211_CHAN_WIDTH_160:
8610 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8611 return -EINVAL;
8612 if (!wiphy_ext_feature_isset(&rdev->wiphy,
8613 NL80211_EXT_FEATURE_VHT_IBSS))
8614 return -EINVAL;
8615 break;
Simon Wunderlich2f301ab2013-05-16 13:00:28 +02008616 default:
Johannes Bergdb9c64c2012-11-09 14:56:41 +01008617 return -EINVAL;
Simon Wunderlich2f301ab2013-05-16 13:00:28 +02008618 }
Johannes Bergdb9c64c2012-11-09 14:56:41 +01008619
Johannes Berg04a773a2009-04-19 21:24:32 +02008620 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
Johannes Bergfffd0932009-07-08 14:22:54 +02008621 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
Johannes Berg04a773a2009-04-19 21:24:32 +02008622
Teemu Paasikivifbd2c8d2010-06-14 12:55:31 +03008623 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
8624 u8 *rates =
8625 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8626 int n_rates =
8627 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8628 struct ieee80211_supported_band *sband =
Johannes Berg683b6d32012-11-08 21:25:48 +01008629 wiphy->bands[ibss.chandef.chan->band];
Teemu Paasikivifbd2c8d2010-06-14 12:55:31 +03008630
Johannes Berg34850ab2011-07-18 18:08:35 +02008631 err = ieee80211_get_ratemask(sband, rates, n_rates,
8632 &ibss.basic_rates);
8633 if (err)
8634 return err;
Teemu Paasikivifbd2c8d2010-06-14 12:55:31 +03008635 }
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01008636
Simon Wunderlich803768f2013-06-28 10:39:58 +02008637 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8638 memcpy(&ibss.ht_capa_mask,
8639 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8640 sizeof(ibss.ht_capa_mask));
8641
8642 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8643 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8644 return -EINVAL;
8645 memcpy(&ibss.ht_capa,
8646 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8647 sizeof(ibss.ht_capa));
8648 }
8649
Felix Fietkaudd5b4cc2010-11-22 20:58:24 +01008650 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
8651 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
8652 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
8653 return -EINVAL;
Teemu Paasikivifbd2c8d2010-06-14 12:55:31 +03008654
Johannes Berg4c476992010-10-04 21:36:35 +02008655 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
Sujith Manoharande7044e2012-10-18 10:19:28 +05308656 bool no_ht = false;
8657
Johannes Berg768075e2017-11-13 15:35:06 +01008658 connkeys = nl80211_parse_connkeys(rdev, info, &no_ht);
Johannes Berg4c476992010-10-04 21:36:35 +02008659 if (IS_ERR(connkeys))
8660 return PTR_ERR(connkeys);
Sujith Manoharande7044e2012-10-18 10:19:28 +05308661
Johannes Berg3d9d1d62012-11-08 23:14:50 +01008662 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
8663 no_ht) {
Ola Olsson5e950a72016-02-11 01:00:22 +01008664 kzfree(connkeys);
Sujith Manoharande7044e2012-10-18 10:19:28 +05308665 return -EINVAL;
8666 }
Johannes Berg4c476992010-10-04 21:36:35 +02008667 }
Johannes Berg04a773a2009-04-19 21:24:32 +02008668
Antonio Quartulli267335d2012-01-31 20:25:47 +01008669 ibss.control_port =
8670 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
8671
Simon Wunderlich5336fa82013-10-07 18:41:05 +02008672 ibss.userspace_handles_dfs =
8673 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
8674
Johannes Berg4c476992010-10-04 21:36:35 +02008675 err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
Johannes Bergfffd0932009-07-08 14:22:54 +02008676 if (err)
Johannes Bergb47f6102014-09-10 13:39:54 +03008677 kzfree(connkeys);
Johannes Berg04a773a2009-04-19 21:24:32 +02008678 return err;
8679}
8680
8681static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
8682{
Johannes Berg4c476992010-10-04 21:36:35 +02008683 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8684 struct net_device *dev = info->user_ptr[1];
Johannes Berg04a773a2009-04-19 21:24:32 +02008685
Johannes Berg4c476992010-10-04 21:36:35 +02008686 if (!rdev->ops->leave_ibss)
8687 return -EOPNOTSUPP;
Johannes Berg04a773a2009-04-19 21:24:32 +02008688
Johannes Berg4c476992010-10-04 21:36:35 +02008689 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8690 return -EOPNOTSUPP;
Johannes Berg04a773a2009-04-19 21:24:32 +02008691
Johannes Berg4c476992010-10-04 21:36:35 +02008692 return cfg80211_leave_ibss(rdev, dev, false);
Johannes Berg04a773a2009-04-19 21:24:32 +02008693}
8694
Antonio Quartullif4e583c2012-11-02 13:27:48 +01008695static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
8696{
8697 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8698 struct net_device *dev = info->user_ptr[1];
Johannes Berg57fbcce2016-04-12 15:56:15 +02008699 int mcast_rate[NUM_NL80211_BANDS];
Antonio Quartullif4e583c2012-11-02 13:27:48 +01008700 u32 nla_rate;
8701 int err;
8702
8703 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
Bertold Van den Bergh876dc932015-08-05 16:02:21 +02008704 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
8705 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
Antonio Quartullif4e583c2012-11-02 13:27:48 +01008706 return -EOPNOTSUPP;
8707
8708 if (!rdev->ops->set_mcast_rate)
8709 return -EOPNOTSUPP;
8710
8711 memset(mcast_rate, 0, sizeof(mcast_rate));
8712
8713 if (!info->attrs[NL80211_ATTR_MCAST_RATE])
8714 return -EINVAL;
8715
8716 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
8717 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
8718 return -EINVAL;
8719
Ilan Peera1056b1b2015-10-22 22:27:46 +03008720 err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
Antonio Quartullif4e583c2012-11-02 13:27:48 +01008721
8722 return err;
8723}
8724
Johannes Bergad7e7182013-11-13 13:37:47 +01008725static struct sk_buff *
8726__cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
Ahmad Kholaif6c09e792015-02-26 15:26:53 +02008727 struct wireless_dev *wdev, int approxlen,
8728 u32 portid, u32 seq, enum nl80211_commands cmd,
Johannes Berg567ffc32013-12-18 14:43:31 +01008729 enum nl80211_attrs attr,
8730 const struct nl80211_vendor_cmd_info *info,
8731 gfp_t gfp)
Johannes Bergad7e7182013-11-13 13:37:47 +01008732{
8733 struct sk_buff *skb;
8734 void *hdr;
8735 struct nlattr *data;
8736
8737 skb = nlmsg_new(approxlen + 100, gfp);
8738 if (!skb)
8739 return NULL;
8740
8741 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
8742 if (!hdr) {
8743 kfree_skb(skb);
8744 return NULL;
8745 }
8746
8747 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
8748 goto nla_put_failure;
Johannes Berg567ffc32013-12-18 14:43:31 +01008749
8750 if (info) {
8751 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
8752 info->vendor_id))
8753 goto nla_put_failure;
8754 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
8755 info->subcmd))
8756 goto nla_put_failure;
8757 }
8758
Ahmad Kholaif6c09e792015-02-26 15:26:53 +02008759 if (wdev) {
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02008760 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
8761 wdev_id(wdev), NL80211_ATTR_PAD))
Ahmad Kholaif6c09e792015-02-26 15:26:53 +02008762 goto nla_put_failure;
8763 if (wdev->netdev &&
8764 nla_put_u32(skb, NL80211_ATTR_IFINDEX,
8765 wdev->netdev->ifindex))
8766 goto nla_put_failure;
8767 }
8768
Johannes Bergad7e7182013-11-13 13:37:47 +01008769 data = nla_nest_start(skb, attr);
Johannes Berg76e1fb42016-09-14 09:55:57 +02008770 if (!data)
8771 goto nla_put_failure;
Johannes Bergad7e7182013-11-13 13:37:47 +01008772
8773 ((void **)skb->cb)[0] = rdev;
8774 ((void **)skb->cb)[1] = hdr;
8775 ((void **)skb->cb)[2] = data;
8776
8777 return skb;
8778
8779 nla_put_failure:
8780 kfree_skb(skb);
8781 return NULL;
8782}
Antonio Quartullif4e583c2012-11-02 13:27:48 +01008783
Johannes Berge03ad6e2014-01-01 17:22:30 +01008784struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
Ahmad Kholaif6c09e792015-02-26 15:26:53 +02008785 struct wireless_dev *wdev,
Johannes Berge03ad6e2014-01-01 17:22:30 +01008786 enum nl80211_commands cmd,
8787 enum nl80211_attrs attr,
8788 int vendor_event_idx,
8789 int approxlen, gfp_t gfp)
8790{
Zhao, Gangf26cbf42014-04-21 12:53:03 +08008791 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berge03ad6e2014-01-01 17:22:30 +01008792 const struct nl80211_vendor_cmd_info *info;
8793
8794 switch (cmd) {
8795 case NL80211_CMD_TESTMODE:
8796 if (WARN_ON(vendor_event_idx != -1))
8797 return NULL;
8798 info = NULL;
8799 break;
8800 case NL80211_CMD_VENDOR:
8801 if (WARN_ON(vendor_event_idx < 0 ||
8802 vendor_event_idx >= wiphy->n_vendor_events))
8803 return NULL;
8804 info = &wiphy->vendor_events[vendor_event_idx];
8805 break;
8806 default:
8807 WARN_ON(1);
8808 return NULL;
8809 }
8810
Ahmad Kholaif6c09e792015-02-26 15:26:53 +02008811 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, 0, 0,
Johannes Berge03ad6e2014-01-01 17:22:30 +01008812 cmd, attr, info, gfp);
8813}
8814EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
8815
8816void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
8817{
8818 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
8819 void *hdr = ((void **)skb->cb)[1];
8820 struct nlattr *data = ((void **)skb->cb)[2];
8821 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
8822
Johannes Bergbd8c78e2014-07-30 14:55:26 +02008823 /* clear CB data for netlink core to own from now on */
8824 memset(skb->cb, 0, sizeof(skb->cb));
8825
Johannes Berge03ad6e2014-01-01 17:22:30 +01008826 nla_nest_end(skb, data);
8827 genlmsg_end(skb, hdr);
8828
8829 if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
8830 mcgrp = NL80211_MCGRP_VENDOR;
8831
8832 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), skb, 0,
8833 mcgrp, gfp);
8834}
8835EXPORT_SYMBOL(__cfg80211_send_event_skb);
8836
Johannes Bergaff89a92009-07-01 21:26:51 +02008837#ifdef CONFIG_NL80211_TESTMODE
Johannes Bergaff89a92009-07-01 21:26:51 +02008838static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
8839{
Johannes Berg4c476992010-10-04 21:36:35 +02008840 struct cfg80211_registered_device *rdev = info->user_ptr[0];
David Spinadelfc73f112013-07-31 18:04:15 +03008841 struct wireless_dev *wdev =
8842 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
Johannes Bergaff89a92009-07-01 21:26:51 +02008843 int err;
8844
David Spinadelfc73f112013-07-31 18:04:15 +03008845 if (!rdev->ops->testmode_cmd)
8846 return -EOPNOTSUPP;
8847
8848 if (IS_ERR(wdev)) {
8849 err = PTR_ERR(wdev);
8850 if (err != -EINVAL)
8851 return err;
8852 wdev = NULL;
8853 } else if (wdev->wiphy != &rdev->wiphy) {
8854 return -EINVAL;
8855 }
8856
Johannes Bergaff89a92009-07-01 21:26:51 +02008857 if (!info->attrs[NL80211_ATTR_TESTDATA])
8858 return -EINVAL;
8859
Johannes Bergad7e7182013-11-13 13:37:47 +01008860 rdev->cur_cmd_info = info;
David Spinadelfc73f112013-07-31 18:04:15 +03008861 err = rdev_testmode_cmd(rdev, wdev,
Johannes Bergaff89a92009-07-01 21:26:51 +02008862 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
8863 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
Johannes Bergad7e7182013-11-13 13:37:47 +01008864 rdev->cur_cmd_info = NULL;
Johannes Bergaff89a92009-07-01 21:26:51 +02008865
Johannes Bergaff89a92009-07-01 21:26:51 +02008866 return err;
8867}
8868
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008869static int nl80211_testmode_dump(struct sk_buff *skb,
8870 struct netlink_callback *cb)
8871{
Johannes Berg00918d32011-12-13 17:22:05 +01008872 struct cfg80211_registered_device *rdev;
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008873 int err;
8874 long phy_idx;
8875 void *data = NULL;
8876 int data_len = 0;
8877
Johannes Berg5fe231e2013-05-08 21:45:15 +02008878 rtnl_lock();
8879
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008880 if (cb->args[0]) {
8881 /*
8882 * 0 is a valid index, but not valid for args[0],
8883 * so we need to offset by 1.
8884 */
8885 phy_idx = cb->args[0] - 1;
Luca Coelhoa4956dc2017-02-07 22:13:56 +02008886
8887 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
8888 if (!rdev) {
8889 err = -ENOENT;
8890 goto out_err;
8891 }
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008892 } else {
Johannes Bergc90c39d2016-10-24 14:40:01 +02008893 struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
8894
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008895 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
Johannes Bergfceb6432017-04-12 14:34:07 +02008896 attrbuf, nl80211_fam.maxattr,
8897 nl80211_policy, NULL);
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008898 if (err)
Johannes Berg5fe231e2013-05-08 21:45:15 +02008899 goto out_err;
Johannes Berg00918d32011-12-13 17:22:05 +01008900
Johannes Bergc90c39d2016-10-24 14:40:01 +02008901 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
Johannes Berg2bd7e352012-06-15 14:23:16 +02008902 if (IS_ERR(rdev)) {
Johannes Berg5fe231e2013-05-08 21:45:15 +02008903 err = PTR_ERR(rdev);
8904 goto out_err;
Johannes Berg00918d32011-12-13 17:22:05 +01008905 }
Johannes Berg2bd7e352012-06-15 14:23:16 +02008906 phy_idx = rdev->wiphy_idx;
Johannes Berg2bd7e352012-06-15 14:23:16 +02008907
Johannes Bergc90c39d2016-10-24 14:40:01 +02008908 if (attrbuf[NL80211_ATTR_TESTDATA])
8909 cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008910 }
8911
8912 if (cb->args[1]) {
8913 data = nla_data((void *)cb->args[1]);
8914 data_len = nla_len((void *)cb->args[1]);
8915 }
8916
Johannes Berg00918d32011-12-13 17:22:05 +01008917 if (!rdev->ops->testmode_dump) {
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008918 err = -EOPNOTSUPP;
8919 goto out_err;
8920 }
8921
8922 while (1) {
Eric W. Biederman15e47302012-09-07 20:12:54 +00008923 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008924 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8925 NL80211_CMD_TESTMODE);
8926 struct nlattr *tmdata;
8927
Dan Carpentercb35fba2013-08-14 14:50:01 +03008928 if (!hdr)
8929 break;
8930
David S. Miller9360ffd2012-03-29 04:41:26 -04008931 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008932 genlmsg_cancel(skb, hdr);
8933 break;
8934 }
8935
8936 tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
8937 if (!tmdata) {
8938 genlmsg_cancel(skb, hdr);
8939 break;
8940 }
Hila Gonene35e4d22012-06-27 17:19:42 +03008941 err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008942 nla_nest_end(skb, tmdata);
8943
8944 if (err == -ENOBUFS || err == -ENOENT) {
8945 genlmsg_cancel(skb, hdr);
8946 break;
8947 } else if (err) {
8948 genlmsg_cancel(skb, hdr);
8949 goto out_err;
8950 }
8951
8952 genlmsg_end(skb, hdr);
8953 }
8954
8955 err = skb->len;
8956 /* see above */
8957 cb->args[0] = phy_idx + 1;
8958 out_err:
Johannes Berg5fe231e2013-05-08 21:45:15 +02008959 rtnl_unlock();
Wey-Yi Guy71063f02011-05-20 09:05:54 -07008960 return err;
8961}
Johannes Bergaff89a92009-07-01 21:26:51 +02008962#endif
8963
Samuel Ortizb23aa672009-07-01 21:26:54 +02008964static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
8965{
Johannes Berg4c476992010-10-04 21:36:35 +02008966 struct cfg80211_registered_device *rdev = info->user_ptr[0];
8967 struct net_device *dev = info->user_ptr[1];
Samuel Ortizb23aa672009-07-01 21:26:54 +02008968 struct cfg80211_connect_params connect;
8969 struct wiphy *wiphy;
Johannes Bergfffd0932009-07-08 14:22:54 +02008970 struct cfg80211_cached_keys *connkeys = NULL;
Samuel Ortizb23aa672009-07-01 21:26:54 +02008971 int err;
8972
8973 memset(&connect, 0, sizeof(connect));
8974
8975 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8976 return -EINVAL;
8977
8978 if (!info->attrs[NL80211_ATTR_SSID] ||
8979 !nla_len(info->attrs[NL80211_ATTR_SSID]))
8980 return -EINVAL;
8981
8982 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
8983 connect.auth_type =
8984 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
Jouni Malinene39e5b52012-09-30 19:29:39 +03008985 if (!nl80211_valid_auth_type(rdev, connect.auth_type,
8986 NL80211_CMD_CONNECT))
Samuel Ortizb23aa672009-07-01 21:26:54 +02008987 return -EINVAL;
8988 } else
8989 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
8990
8991 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
8992
Avraham Stern3a00df52017-06-09 13:08:43 +01008993 if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] &&
8994 !wiphy_ext_feature_isset(&rdev->wiphy,
8995 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
8996 return -EINVAL;
8997 connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS];
8998
Johannes Bergc0692b82010-08-27 14:26:53 +03008999 err = nl80211_crypto_settings(rdev, info, &connect.crypto,
Johannes Berg3dc27d22009-07-02 21:36:37 +02009000 NL80211_MAX_NR_CIPHER_SUITES);
Samuel Ortizb23aa672009-07-01 21:26:54 +02009001 if (err)
9002 return err;
Samuel Ortizb23aa672009-07-01 21:26:54 +02009003
Johannes Berg074ac8d2010-09-16 14:58:22 +02009004 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02009005 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9006 return -EOPNOTSUPP;
Samuel Ortizb23aa672009-07-01 21:26:54 +02009007
Johannes Berg79c97e92009-07-07 03:56:12 +02009008 wiphy = &rdev->wiphy;
Samuel Ortizb23aa672009-07-01 21:26:54 +02009009
Bala Shanmugam4486ea92012-03-07 17:27:12 +05309010 connect.bg_scan_period = -1;
9011 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
9012 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
9013 connect.bg_scan_period =
9014 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
9015 }
9016
Samuel Ortizb23aa672009-07-01 21:26:54 +02009017 if (info->attrs[NL80211_ATTR_MAC])
9018 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
Jouni Malinen1df4a512014-01-15 00:00:47 +02009019 else if (info->attrs[NL80211_ATTR_MAC_HINT])
9020 connect.bssid_hint =
9021 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
Samuel Ortizb23aa672009-07-01 21:26:54 +02009022 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9023 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9024
9025 if (info->attrs[NL80211_ATTR_IE]) {
9026 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9027 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9028 }
9029
Jouni Malinencee00a92013-01-15 17:15:57 +02009030 if (info->attrs[NL80211_ATTR_USE_MFP]) {
9031 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
Emmanuel Grumbach65026002017-08-18 15:31:41 +03009032 if (connect.mfp == NL80211_MFP_OPTIONAL &&
9033 !wiphy_ext_feature_isset(&rdev->wiphy,
9034 NL80211_EXT_FEATURE_MFP_OPTIONAL))
9035 return -EOPNOTSUPP;
9036
Jouni Malinencee00a92013-01-15 17:15:57 +02009037 if (connect.mfp != NL80211_MFP_REQUIRED &&
Emmanuel Grumbach65026002017-08-18 15:31:41 +03009038 connect.mfp != NL80211_MFP_NO &&
9039 connect.mfp != NL80211_MFP_OPTIONAL)
Jouni Malinencee00a92013-01-15 17:15:57 +02009040 return -EINVAL;
9041 } else {
9042 connect.mfp = NL80211_MFP_NO;
9043 }
9044
Jouni Malinenba6fbac2016-03-29 13:53:27 +03009045 if (info->attrs[NL80211_ATTR_PREV_BSSID])
9046 connect.prev_bssid =
9047 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
9048
Samuel Ortizb23aa672009-07-01 21:26:54 +02009049 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
Jouni Malinen664834d2014-01-15 00:01:44 +02009050 connect.channel = nl80211_get_valid_chan(
9051 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
9052 if (!connect.channel)
Johannes Berg4c476992010-10-04 21:36:35 +02009053 return -EINVAL;
Jouni Malinen1df4a512014-01-15 00:00:47 +02009054 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
Jouni Malinen664834d2014-01-15 00:01:44 +02009055 connect.channel_hint = nl80211_get_valid_chan(
9056 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
9057 if (!connect.channel_hint)
Jouni Malinen1df4a512014-01-15 00:00:47 +02009058 return -EINVAL;
Samuel Ortizb23aa672009-07-01 21:26:54 +02009059 }
9060
Johannes Bergfffd0932009-07-08 14:22:54 +02009061 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
Johannes Berg768075e2017-11-13 15:35:06 +01009062 connkeys = nl80211_parse_connkeys(rdev, info, NULL);
Johannes Berg4c476992010-10-04 21:36:35 +02009063 if (IS_ERR(connkeys))
9064 return PTR_ERR(connkeys);
Johannes Bergfffd0932009-07-08 14:22:54 +02009065 }
9066
Ben Greear7e7c8922011-11-18 11:31:59 -08009067 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
9068 connect.flags |= ASSOC_REQ_DISABLE_HT;
9069
9070 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9071 memcpy(&connect.ht_capa_mask,
9072 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
9073 sizeof(connect.ht_capa_mask));
9074
9075 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
Wei Yongjunb4e4f472012-09-02 21:41:04 +08009076 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
Johannes Bergb47f6102014-09-10 13:39:54 +03009077 kzfree(connkeys);
Ben Greear7e7c8922011-11-18 11:31:59 -08009078 return -EINVAL;
Wei Yongjunb4e4f472012-09-02 21:41:04 +08009079 }
Ben Greear7e7c8922011-11-18 11:31:59 -08009080 memcpy(&connect.ht_capa,
9081 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
9082 sizeof(connect.ht_capa));
9083 }
9084
Johannes Bergee2aca32013-02-21 17:36:01 +01009085 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
9086 connect.flags |= ASSOC_REQ_DISABLE_VHT;
9087
9088 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
9089 memcpy(&connect.vht_capa_mask,
9090 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
9091 sizeof(connect.vht_capa_mask));
9092
9093 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
9094 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
Johannes Bergb47f6102014-09-10 13:39:54 +03009095 kzfree(connkeys);
Johannes Bergee2aca32013-02-21 17:36:01 +01009096 return -EINVAL;
9097 }
9098 memcpy(&connect.vht_capa,
9099 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
9100 sizeof(connect.vht_capa));
9101 }
9102
Assaf Kraussbab5ab72014-09-03 15:25:01 +03009103 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
Beni Lev0c9ca112016-02-17 20:30:00 +02009104 if (!((rdev->wiphy.features &
9105 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
9106 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
9107 !wiphy_ext_feature_isset(&rdev->wiphy,
9108 NL80211_EXT_FEATURE_RRM)) {
Ola Olsson707554b2015-12-11 21:04:52 +01009109 kzfree(connkeys);
Assaf Kraussbab5ab72014-09-03 15:25:01 +03009110 return -EINVAL;
Ola Olsson707554b2015-12-11 21:04:52 +01009111 }
Assaf Kraussbab5ab72014-09-03 15:25:01 +03009112 connect.flags |= ASSOC_REQ_USE_RRM;
9113 }
9114
Lior David34d50512016-01-28 10:58:25 +02009115 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
Johannes Berg57fbcce2016-04-12 15:56:15 +02009116 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
Lior David34d50512016-01-28 10:58:25 +02009117 kzfree(connkeys);
9118 return -EOPNOTSUPP;
9119 }
9120
Arend van Spriel38de03d2016-03-02 20:37:18 +01009121 if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
9122 /* bss selection makes no sense if bssid is set */
9123 if (connect.bssid) {
9124 kzfree(connkeys);
9125 return -EINVAL;
9126 }
9127
9128 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
9129 wiphy, &connect.bss_select);
9130 if (err) {
9131 kzfree(connkeys);
9132 return err;
9133 }
9134 }
9135
Vidyullatha Kanchanapallya3caf742017-03-31 00:22:34 +03009136 if (wiphy_ext_feature_isset(&rdev->wiphy,
9137 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
9138 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
9139 info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
9140 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
9141 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9142 connect.fils_erp_username =
9143 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
9144 connect.fils_erp_username_len =
9145 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
9146 connect.fils_erp_realm =
9147 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
9148 connect.fils_erp_realm_len =
9149 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
9150 connect.fils_erp_next_seq_num =
9151 nla_get_u16(
9152 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
9153 connect.fils_erp_rrk =
9154 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
9155 connect.fils_erp_rrk_len =
9156 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
9157 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
9158 info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
9159 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
9160 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9161 kzfree(connkeys);
9162 return -EINVAL;
9163 }
9164
Srinivas Dasari40cbfa92018-01-25 17:13:38 +02009165 if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) {
9166 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9167 GENL_SET_ERR_MSG(info,
9168 "external auth requires connection ownership");
9169 return -EINVAL;
9170 }
9171 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT;
9172 }
9173
Johannes Berg83739b02013-05-15 17:44:01 +02009174 wdev_lock(dev->ieee80211_ptr);
Andrzej Zaborowskibd2522b2017-01-06 16:33:43 -05009175
Jouni Malinen4ce2bd9c42016-03-29 13:53:28 +03009176 err = cfg80211_connect(rdev, dev, &connect, connkeys,
9177 connect.prev_bssid);
Johannes Bergfffd0932009-07-08 14:22:54 +02009178 if (err)
Johannes Bergb47f6102014-09-10 13:39:54 +03009179 kzfree(connkeys);
Andrzej Zaborowskibd2522b2017-01-06 16:33:43 -05009180
9181 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9182 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
9183 if (connect.bssid)
9184 memcpy(dev->ieee80211_ptr->disconnect_bssid,
9185 connect.bssid, ETH_ALEN);
9186 else
9187 memset(dev->ieee80211_ptr->disconnect_bssid,
9188 0, ETH_ALEN);
9189 }
9190
9191 wdev_unlock(dev->ieee80211_ptr);
9192
Samuel Ortizb23aa672009-07-01 21:26:54 +02009193 return err;
9194}
9195
vamsi krishna088e8df2016-10-27 16:51:11 +03009196static int nl80211_update_connect_params(struct sk_buff *skb,
9197 struct genl_info *info)
9198{
9199 struct cfg80211_connect_params connect = {};
9200 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9201 struct net_device *dev = info->user_ptr[1];
9202 struct wireless_dev *wdev = dev->ieee80211_ptr;
9203 u32 changed = 0;
9204 int ret;
9205
9206 if (!rdev->ops->update_connect_params)
9207 return -EOPNOTSUPP;
9208
9209 if (info->attrs[NL80211_ATTR_IE]) {
9210 if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
9211 return -EINVAL;
9212 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9213 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9214 changed |= UPDATE_ASSOC_IES;
9215 }
9216
9217 wdev_lock(dev->ieee80211_ptr);
9218 if (!wdev->current_bss)
9219 ret = -ENOLINK;
9220 else
9221 ret = rdev_update_connect_params(rdev, dev, &connect, changed);
9222 wdev_unlock(dev->ieee80211_ptr);
9223
9224 return ret;
9225}
9226
Samuel Ortizb23aa672009-07-01 21:26:54 +02009227static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
9228{
Johannes Berg4c476992010-10-04 21:36:35 +02009229 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9230 struct net_device *dev = info->user_ptr[1];
Samuel Ortizb23aa672009-07-01 21:26:54 +02009231 u16 reason;
Johannes Berg83739b02013-05-15 17:44:01 +02009232 int ret;
Samuel Ortizb23aa672009-07-01 21:26:54 +02009233
9234 if (!info->attrs[NL80211_ATTR_REASON_CODE])
9235 reason = WLAN_REASON_DEAUTH_LEAVING;
9236 else
9237 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9238
9239 if (reason == 0)
9240 return -EINVAL;
9241
Johannes Berg074ac8d2010-09-16 14:58:22 +02009242 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02009243 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9244 return -EOPNOTSUPP;
Samuel Ortizb23aa672009-07-01 21:26:54 +02009245
Johannes Berg83739b02013-05-15 17:44:01 +02009246 wdev_lock(dev->ieee80211_ptr);
9247 ret = cfg80211_disconnect(rdev, dev, reason, true);
9248 wdev_unlock(dev->ieee80211_ptr);
9249 return ret;
Samuel Ortizb23aa672009-07-01 21:26:54 +02009250}
9251
Johannes Berg463d0182009-07-14 00:33:35 +02009252static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
9253{
Johannes Berg4c476992010-10-04 21:36:35 +02009254 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg463d0182009-07-14 00:33:35 +02009255 struct net *net;
9256 int err;
Johannes Berg463d0182009-07-14 00:33:35 +02009257
Vadim Kochan4b681c82015-01-12 16:34:05 +02009258 if (info->attrs[NL80211_ATTR_PID]) {
9259 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
9260
9261 net = get_net_ns_by_pid(pid);
9262 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
9263 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
9264
9265 net = get_net_ns_by_fd(fd);
9266 } else {
Johannes Berg463d0182009-07-14 00:33:35 +02009267 return -EINVAL;
Vadim Kochan4b681c82015-01-12 16:34:05 +02009268 }
Johannes Berg463d0182009-07-14 00:33:35 +02009269
Johannes Berg4c476992010-10-04 21:36:35 +02009270 if (IS_ERR(net))
9271 return PTR_ERR(net);
Johannes Berg463d0182009-07-14 00:33:35 +02009272
9273 err = 0;
9274
9275 /* check if anything to do */
Johannes Berg4c476992010-10-04 21:36:35 +02009276 if (!net_eq(wiphy_net(&rdev->wiphy), net))
9277 err = cfg80211_switch_netns(rdev, net);
Johannes Berg463d0182009-07-14 00:33:35 +02009278
Johannes Berg463d0182009-07-14 00:33:35 +02009279 put_net(net);
Johannes Berg463d0182009-07-14 00:33:35 +02009280 return err;
9281}
9282
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009283static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
9284{
Johannes Berg4c476992010-10-04 21:36:35 +02009285 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009286 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
9287 struct cfg80211_pmksa *pmksa) = NULL;
Johannes Berg4c476992010-10-04 21:36:35 +02009288 struct net_device *dev = info->user_ptr[1];
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009289 struct cfg80211_pmksa pmksa;
9290
9291 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
9292
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009293 if (!info->attrs[NL80211_ATTR_PMKID])
9294 return -EINVAL;
9295
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009296 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
Vidyullatha Kanchanapallya3caf742017-03-31 00:22:34 +03009297
9298 if (info->attrs[NL80211_ATTR_MAC]) {
9299 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9300 } else if (info->attrs[NL80211_ATTR_SSID] &&
9301 info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
9302 (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA ||
9303 info->attrs[NL80211_ATTR_PMK])) {
9304 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9305 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9306 pmksa.cache_id =
9307 nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
9308 } else {
9309 return -EINVAL;
9310 }
9311 if (info->attrs[NL80211_ATTR_PMK]) {
9312 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
9313 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
9314 }
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009315
Johannes Berg074ac8d2010-09-16 14:58:22 +02009316 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02009317 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9318 return -EOPNOTSUPP;
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009319
9320 switch (info->genlhdr->cmd) {
9321 case NL80211_CMD_SET_PMKSA:
9322 rdev_ops = rdev->ops->set_pmksa;
9323 break;
9324 case NL80211_CMD_DEL_PMKSA:
9325 rdev_ops = rdev->ops->del_pmksa;
9326 break;
9327 default:
9328 WARN_ON(1);
9329 break;
9330 }
9331
Johannes Berg4c476992010-10-04 21:36:35 +02009332 if (!rdev_ops)
9333 return -EOPNOTSUPP;
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009334
Johannes Berg4c476992010-10-04 21:36:35 +02009335 return rdev_ops(&rdev->wiphy, dev, &pmksa);
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009336}
9337
9338static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
9339{
Johannes Berg4c476992010-10-04 21:36:35 +02009340 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9341 struct net_device *dev = info->user_ptr[1];
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009342
Johannes Berg074ac8d2010-09-16 14:58:22 +02009343 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02009344 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9345 return -EOPNOTSUPP;
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009346
Johannes Berg4c476992010-10-04 21:36:35 +02009347 if (!rdev->ops->flush_pmksa)
9348 return -EOPNOTSUPP;
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009349
Hila Gonene35e4d22012-06-27 17:19:42 +03009350 return rdev_flush_pmksa(rdev, dev);
Samuel Ortiz67fbb162009-11-24 23:59:15 +01009351}
9352
Arik Nemtsov109086c2011-09-28 14:12:50 +03009353static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
9354{
9355 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9356 struct net_device *dev = info->user_ptr[1];
9357 u8 action_code, dialog_token;
Sunil Dutt Undekaridf942e72014-02-20 16:22:09 +05309358 u32 peer_capability = 0;
Arik Nemtsov109086c2011-09-28 14:12:50 +03009359 u16 status_code;
9360 u8 *peer;
Arik Nemtsov31fa97c2014-06-11 17:18:21 +03009361 bool initiator;
Arik Nemtsov109086c2011-09-28 14:12:50 +03009362
9363 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
9364 !rdev->ops->tdls_mgmt)
9365 return -EOPNOTSUPP;
9366
9367 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
9368 !info->attrs[NL80211_ATTR_STATUS_CODE] ||
9369 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
9370 !info->attrs[NL80211_ATTR_IE] ||
9371 !info->attrs[NL80211_ATTR_MAC])
9372 return -EINVAL;
9373
9374 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
9375 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
9376 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
9377 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
Arik Nemtsov31fa97c2014-06-11 17:18:21 +03009378 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
Sunil Dutt Undekaridf942e72014-02-20 16:22:09 +05309379 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
9380 peer_capability =
9381 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
Arik Nemtsov109086c2011-09-28 14:12:50 +03009382
Hila Gonene35e4d22012-06-27 17:19:42 +03009383 return rdev_tdls_mgmt(rdev, dev, peer, action_code,
Sunil Dutt Undekaridf942e72014-02-20 16:22:09 +05309384 dialog_token, status_code, peer_capability,
Arik Nemtsov31fa97c2014-06-11 17:18:21 +03009385 initiator,
Hila Gonene35e4d22012-06-27 17:19:42 +03009386 nla_data(info->attrs[NL80211_ATTR_IE]),
9387 nla_len(info->attrs[NL80211_ATTR_IE]));
Arik Nemtsov109086c2011-09-28 14:12:50 +03009388}
9389
9390static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
9391{
9392 struct cfg80211_registered_device *rdev = info->user_ptr[0];
9393 struct net_device *dev = info->user_ptr[1];
9394 enum nl80211_tdls_operation operation;
9395 u8 *peer;
9396
9397 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
9398 !rdev->ops->tdls_oper)
9399 return -EOPNOTSUPP;
9400
9401 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
9402 !info->attrs[NL80211_ATTR_MAC])
9403 return -EINVAL;
9404
9405 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
9406 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
9407
Hila Gonene35e4d22012-06-27 17:19:42 +03009408 return rdev_tdls_oper(rdev, dev, peer, operation);
Arik Nemtsov109086c2011-09-28 14:12:50 +03009409}
9410
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009411static int nl80211_remain_on_channel(struct sk_buff *skb,
9412 struct genl_info *info)
9413{
Johannes Berg4c476992010-10-04 21:36:35 +02009414 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg71bbc992012-06-15 15:30:18 +02009415 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg683b6d32012-11-08 21:25:48 +01009416 struct cfg80211_chan_def chandef;
Vasanthakumar Thiagarajan34373d12017-02-27 17:04:34 +05309417 const struct cfg80211_chan_def *compat_chandef;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009418 struct sk_buff *msg;
9419 void *hdr;
9420 u64 cookie;
Johannes Berg683b6d32012-11-08 21:25:48 +01009421 u32 duration;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009422 int err;
9423
9424 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
9425 !info->attrs[NL80211_ATTR_DURATION])
9426 return -EINVAL;
9427
9428 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
9429
Johannes Berg7c4ef712011-11-18 15:33:48 +01009430 if (!rdev->ops->remain_on_channel ||
9431 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
Johannes Berg4c476992010-10-04 21:36:35 +02009432 return -EOPNOTSUPP;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009433
Johannes Bergebf348f2012-06-01 12:50:54 +02009434 /*
9435 * We should be on that channel for at least a minimum amount of
9436 * time (10ms) but no longer than the driver supports.
9437 */
9438 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9439 duration > rdev->wiphy.max_remain_on_channel_duration)
9440 return -EINVAL;
9441
Johannes Berg683b6d32012-11-08 21:25:48 +01009442 err = nl80211_parse_chandef(rdev, info, &chandef);
9443 if (err)
9444 return err;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009445
Vasanthakumar Thiagarajan34373d12017-02-27 17:04:34 +05309446 wdev_lock(wdev);
9447 if (!cfg80211_off_channel_oper_allowed(wdev) &&
9448 !cfg80211_chandef_identical(&wdev->chandef, &chandef)) {
9449 compat_chandef = cfg80211_chandef_compatible(&wdev->chandef,
9450 &chandef);
9451 if (compat_chandef != &chandef) {
9452 wdev_unlock(wdev);
9453 return -EBUSY;
9454 }
9455 }
9456 wdev_unlock(wdev);
9457
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009458 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg4c476992010-10-04 21:36:35 +02009459 if (!msg)
9460 return -ENOMEM;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009461
Eric W. Biederman15e47302012-09-07 20:12:54 +00009462 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009463 NL80211_CMD_REMAIN_ON_CHANNEL);
Dan Carpentercb35fba2013-08-14 14:50:01 +03009464 if (!hdr) {
9465 err = -ENOBUFS;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009466 goto free_msg;
9467 }
9468
Johannes Berg683b6d32012-11-08 21:25:48 +01009469 err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
9470 duration, &cookie);
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009471
9472 if (err)
9473 goto free_msg;
9474
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02009475 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
9476 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04009477 goto nla_put_failure;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009478
9479 genlmsg_end(msg, hdr);
Johannes Berg4c476992010-10-04 21:36:35 +02009480
9481 return genlmsg_reply(msg, info);
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009482
9483 nla_put_failure:
9484 err = -ENOBUFS;
9485 free_msg:
9486 nlmsg_free(msg);
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009487 return err;
9488}
9489
9490static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
9491 struct genl_info *info)
9492{
Johannes Berg4c476992010-10-04 21:36:35 +02009493 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg71bbc992012-06-15 15:30:18 +02009494 struct wireless_dev *wdev = info->user_ptr[1];
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009495 u64 cookie;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009496
9497 if (!info->attrs[NL80211_ATTR_COOKIE])
9498 return -EINVAL;
9499
Johannes Berg4c476992010-10-04 21:36:35 +02009500 if (!rdev->ops->cancel_remain_on_channel)
9501 return -EOPNOTSUPP;
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009502
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009503 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
9504
Hila Gonene35e4d22012-06-27 17:19:42 +03009505 return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
Jouni Malinen9588bbd2009-12-23 13:15:41 +01009506}
9507
Jouni Malinen13ae75b2009-12-29 12:59:45 +02009508static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
9509 struct genl_info *info)
9510{
Jouni Malinen13ae75b2009-12-29 12:59:45 +02009511 struct cfg80211_bitrate_mask mask;
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05309512 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg4c476992010-10-04 21:36:35 +02009513 struct net_device *dev = info->user_ptr[1];
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05309514 int err;
Jouni Malinen13ae75b2009-12-29 12:59:45 +02009515
Johannes Berg4c476992010-10-04 21:36:35 +02009516 if (!rdev->ops->set_bitrate_mask)
9517 return -EOPNOTSUPP;
Jouni Malinen13ae75b2009-12-29 12:59:45 +02009518
Purushottam Kushwahaa7c7fbf2016-09-14 17:38:44 +05309519 err = nl80211_parse_tx_bitrate_mask(info, &mask);
9520 if (err)
9521 return err;
Janusz Dziedzic78693032013-12-03 09:50:44 +01009522
Hila Gonene35e4d22012-06-27 17:19:42 +03009523 return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
Jouni Malinen13ae75b2009-12-29 12:59:45 +02009524}
9525
Johannes Berg2e161f72010-08-12 15:38:38 +02009526static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
Jouni Malinen026331c2010-02-15 12:53:10 +02009527{
Johannes Berg4c476992010-10-04 21:36:35 +02009528 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg71bbc992012-06-15 15:30:18 +02009529 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg2e161f72010-08-12 15:38:38 +02009530 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
Jouni Malinen026331c2010-02-15 12:53:10 +02009531
9532 if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
9533 return -EINVAL;
9534
Johannes Berg2e161f72010-08-12 15:38:38 +02009535 if (info->attrs[NL80211_ATTR_FRAME_TYPE])
9536 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
Jouni Malinen026331c2010-02-15 12:53:10 +02009537
Johannes Berg71bbc992012-06-15 15:30:18 +02009538 switch (wdev->iftype) {
9539 case NL80211_IFTYPE_STATION:
9540 case NL80211_IFTYPE_ADHOC:
9541 case NL80211_IFTYPE_P2P_CLIENT:
9542 case NL80211_IFTYPE_AP:
9543 case NL80211_IFTYPE_AP_VLAN:
9544 case NL80211_IFTYPE_MESH_POINT:
9545 case NL80211_IFTYPE_P2P_GO:
Johannes Berg98104fde2012-06-16 00:19:54 +02009546 case NL80211_IFTYPE_P2P_DEVICE:
Johannes Berg71bbc992012-06-15 15:30:18 +02009547 break;
Ayala Bekercb3b7d82016-09-20 17:31:13 +03009548 case NL80211_IFTYPE_NAN:
Johannes Berg71bbc992012-06-15 15:30:18 +02009549 default:
Johannes Berg4c476992010-10-04 21:36:35 +02009550 return -EOPNOTSUPP;
Johannes Berg71bbc992012-06-15 15:30:18 +02009551 }
Jouni Malinen026331c2010-02-15 12:53:10 +02009552
9553 /* not much point in registering if we can't reply */
Johannes Berg4c476992010-10-04 21:36:35 +02009554 if (!rdev->ops->mgmt_tx)
9555 return -EOPNOTSUPP;
Jouni Malinen026331c2010-02-15 12:53:10 +02009556
Eric W. Biederman15e47302012-09-07 20:12:54 +00009557 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
Jouni Malinen026331c2010-02-15 12:53:10 +02009558 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
9559 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
Jouni Malinen026331c2010-02-15 12:53:10 +02009560}
9561
Johannes Berg2e161f72010-08-12 15:38:38 +02009562static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
Jouni Malinen026331c2010-02-15 12:53:10 +02009563{
Johannes Berg4c476992010-10-04 21:36:35 +02009564 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg71bbc992012-06-15 15:30:18 +02009565 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Berg683b6d32012-11-08 21:25:48 +01009566 struct cfg80211_chan_def chandef;
Jouni Malinen026331c2010-02-15 12:53:10 +02009567 int err;
Johannes Bergd64d3732011-11-10 09:44:46 +01009568 void *hdr = NULL;
Jouni Malinen026331c2010-02-15 12:53:10 +02009569 u64 cookie;
Johannes Berge247bd902011-11-04 11:18:21 +01009570 struct sk_buff *msg = NULL;
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009571 struct cfg80211_mgmt_tx_params params = {
9572 .dont_wait_for_ack =
9573 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
9574 };
Jouni Malinen026331c2010-02-15 12:53:10 +02009575
Johannes Berg683b6d32012-11-08 21:25:48 +01009576 if (!info->attrs[NL80211_ATTR_FRAME])
Jouni Malinen026331c2010-02-15 12:53:10 +02009577 return -EINVAL;
9578
Johannes Berg4c476992010-10-04 21:36:35 +02009579 if (!rdev->ops->mgmt_tx)
9580 return -EOPNOTSUPP;
Jouni Malinen026331c2010-02-15 12:53:10 +02009581
Johannes Berg71bbc992012-06-15 15:30:18 +02009582 switch (wdev->iftype) {
Antonio Quartulliea141b752013-06-11 14:20:03 +02009583 case NL80211_IFTYPE_P2P_DEVICE:
9584 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
9585 return -EINVAL;
Johannes Berg71bbc992012-06-15 15:30:18 +02009586 case NL80211_IFTYPE_STATION:
9587 case NL80211_IFTYPE_ADHOC:
9588 case NL80211_IFTYPE_P2P_CLIENT:
9589 case NL80211_IFTYPE_AP:
9590 case NL80211_IFTYPE_AP_VLAN:
9591 case NL80211_IFTYPE_MESH_POINT:
9592 case NL80211_IFTYPE_P2P_GO:
9593 break;
Ayala Bekercb3b7d82016-09-20 17:31:13 +03009594 case NL80211_IFTYPE_NAN:
Johannes Berg71bbc992012-06-15 15:30:18 +02009595 default:
Johannes Berg4c476992010-10-04 21:36:35 +02009596 return -EOPNOTSUPP;
Johannes Berg71bbc992012-06-15 15:30:18 +02009597 }
Jouni Malinen026331c2010-02-15 12:53:10 +02009598
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009599 if (info->attrs[NL80211_ATTR_DURATION]) {
Johannes Berg7c4ef712011-11-18 15:33:48 +01009600 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009601 return -EINVAL;
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009602 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
Johannes Bergebf348f2012-06-01 12:50:54 +02009603
9604 /*
9605 * We should wait on the channel for at least a minimum amount
9606 * of time (10ms) but no longer than the driver supports.
9607 */
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009608 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9609 params.wait > rdev->wiphy.max_remain_on_channel_duration)
Johannes Bergebf348f2012-06-01 12:50:54 +02009610 return -EINVAL;
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009611 }
9612
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009613 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009614
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009615 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
Johannes Berg7c4ef712011-11-18 15:33:48 +01009616 return -EINVAL;
9617
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009618 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
Rajkumar Manoharane9f935e2011-09-25 14:53:30 +05309619
Antonio Quartulliea141b752013-06-11 14:20:03 +02009620 /* get the channel if any has been specified, otherwise pass NULL to
9621 * the driver. The latter will use the current one
9622 */
9623 chandef.chan = NULL;
9624 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9625 err = nl80211_parse_chandef(rdev, info, &chandef);
9626 if (err)
9627 return err;
9628 }
9629
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009630 if (!chandef.chan && params.offchan)
Antonio Quartulliea141b752013-06-11 14:20:03 +02009631 return -EINVAL;
Jouni Malinen026331c2010-02-15 12:53:10 +02009632
Vasanthakumar Thiagarajan34373d12017-02-27 17:04:34 +05309633 wdev_lock(wdev);
9634 if (params.offchan && !cfg80211_off_channel_oper_allowed(wdev)) {
9635 wdev_unlock(wdev);
9636 return -EBUSY;
9637 }
9638 wdev_unlock(wdev);
9639
Andrei Otcheretianski34d22ce2014-05-09 14:11:44 +03009640 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
9641 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
9642
9643 if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
9644 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9645 int i;
9646
9647 if (len % sizeof(u16))
9648 return -EINVAL;
9649
9650 params.n_csa_offsets = len / sizeof(u16);
9651 params.csa_offsets =
9652 nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9653
9654 /* check that all the offsets fit the frame */
9655 for (i = 0; i < params.n_csa_offsets; i++) {
9656 if (params.csa_offsets[i] >= params.len)
9657 return -EINVAL;
9658 }
9659 }
9660
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009661 if (!params.dont_wait_for_ack) {
Johannes Berge247bd902011-11-04 11:18:21 +01009662 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9663 if (!msg)
9664 return -ENOMEM;
Jouni Malinen026331c2010-02-15 12:53:10 +02009665
Eric W. Biederman15e47302012-09-07 20:12:54 +00009666 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Johannes Berge247bd902011-11-04 11:18:21 +01009667 NL80211_CMD_FRAME);
Dan Carpentercb35fba2013-08-14 14:50:01 +03009668 if (!hdr) {
9669 err = -ENOBUFS;
Johannes Berge247bd902011-11-04 11:18:21 +01009670 goto free_msg;
9671 }
Jouni Malinen026331c2010-02-15 12:53:10 +02009672 }
Johannes Berge247bd902011-11-04 11:18:21 +01009673
Andrei Otcheretianskib176e622013-11-18 19:06:49 +02009674 params.chan = chandef.chan;
9675 err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
Jouni Malinen026331c2010-02-15 12:53:10 +02009676 if (err)
9677 goto free_msg;
9678
Johannes Berge247bd902011-11-04 11:18:21 +01009679 if (msg) {
Nicolas Dichtel2dad6242016-04-25 10:25:22 +02009680 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
9681 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -04009682 goto nla_put_failure;
Jouni Malinen026331c2010-02-15 12:53:10 +02009683
Johannes Berge247bd902011-11-04 11:18:21 +01009684 genlmsg_end(msg, hdr);
9685 return genlmsg_reply(msg, info);
9686 }
9687
9688 return 0;
Jouni Malinen026331c2010-02-15 12:53:10 +02009689
9690 nla_put_failure:
9691 err = -ENOBUFS;
9692 free_msg:
9693 nlmsg_free(msg);
Jouni Malinen026331c2010-02-15 12:53:10 +02009694 return err;
9695}
9696
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009697static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
9698{
9699 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg71bbc992012-06-15 15:30:18 +02009700 struct wireless_dev *wdev = info->user_ptr[1];
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009701 u64 cookie;
9702
9703 if (!info->attrs[NL80211_ATTR_COOKIE])
9704 return -EINVAL;
9705
9706 if (!rdev->ops->mgmt_tx_cancel_wait)
9707 return -EOPNOTSUPP;
9708
Johannes Berg71bbc992012-06-15 15:30:18 +02009709 switch (wdev->iftype) {
9710 case NL80211_IFTYPE_STATION:
9711 case NL80211_IFTYPE_ADHOC:
9712 case NL80211_IFTYPE_P2P_CLIENT:
9713 case NL80211_IFTYPE_AP:
9714 case NL80211_IFTYPE_AP_VLAN:
9715 case NL80211_IFTYPE_P2P_GO:
Johannes Berg98104fde2012-06-16 00:19:54 +02009716 case NL80211_IFTYPE_P2P_DEVICE:
Johannes Berg71bbc992012-06-15 15:30:18 +02009717 break;
Ayala Bekercb3b7d82016-09-20 17:31:13 +03009718 case NL80211_IFTYPE_NAN:
Johannes Berg71bbc992012-06-15 15:30:18 +02009719 default:
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009720 return -EOPNOTSUPP;
Johannes Berg71bbc992012-06-15 15:30:18 +02009721 }
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009722
9723 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
9724
Hila Gonene35e4d22012-06-27 17:19:42 +03009725 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
Johannes Bergf7ca38d2010-11-25 10:02:29 +01009726}
9727
Kalle Valoffb9eb32010-02-17 17:58:10 +02009728static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
9729{
Johannes Berg4c476992010-10-04 21:36:35 +02009730 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Kalle Valoffb9eb32010-02-17 17:58:10 +02009731 struct wireless_dev *wdev;
Johannes Berg4c476992010-10-04 21:36:35 +02009732 struct net_device *dev = info->user_ptr[1];
Kalle Valoffb9eb32010-02-17 17:58:10 +02009733 u8 ps_state;
9734 bool state;
9735 int err;
9736
Johannes Berg4c476992010-10-04 21:36:35 +02009737 if (!info->attrs[NL80211_ATTR_PS_STATE])
9738 return -EINVAL;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009739
9740 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
9741
Johannes Berg4c476992010-10-04 21:36:35 +02009742 if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
9743 return -EINVAL;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009744
9745 wdev = dev->ieee80211_ptr;
9746
Johannes Berg4c476992010-10-04 21:36:35 +02009747 if (!rdev->ops->set_power_mgmt)
9748 return -EOPNOTSUPP;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009749
9750 state = (ps_state == NL80211_PS_ENABLED) ? true : false;
9751
9752 if (state == wdev->ps)
Johannes Berg4c476992010-10-04 21:36:35 +02009753 return 0;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009754
Hila Gonene35e4d22012-06-27 17:19:42 +03009755 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
Johannes Berg4c476992010-10-04 21:36:35 +02009756 if (!err)
9757 wdev->ps = state;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009758 return err;
9759}
9760
9761static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
9762{
Johannes Berg4c476992010-10-04 21:36:35 +02009763 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Kalle Valoffb9eb32010-02-17 17:58:10 +02009764 enum nl80211_ps_state ps_state;
9765 struct wireless_dev *wdev;
Johannes Berg4c476992010-10-04 21:36:35 +02009766 struct net_device *dev = info->user_ptr[1];
Kalle Valoffb9eb32010-02-17 17:58:10 +02009767 struct sk_buff *msg;
9768 void *hdr;
9769 int err;
9770
Kalle Valoffb9eb32010-02-17 17:58:10 +02009771 wdev = dev->ieee80211_ptr;
9772
Johannes Berg4c476992010-10-04 21:36:35 +02009773 if (!rdev->ops->set_power_mgmt)
9774 return -EOPNOTSUPP;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009775
9776 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg4c476992010-10-04 21:36:35 +02009777 if (!msg)
9778 return -ENOMEM;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009779
Eric W. Biederman15e47302012-09-07 20:12:54 +00009780 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Kalle Valoffb9eb32010-02-17 17:58:10 +02009781 NL80211_CMD_GET_POWER_SAVE);
9782 if (!hdr) {
Johannes Berg4c476992010-10-04 21:36:35 +02009783 err = -ENOBUFS;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009784 goto free_msg;
9785 }
9786
9787 if (wdev->ps)
9788 ps_state = NL80211_PS_ENABLED;
9789 else
9790 ps_state = NL80211_PS_DISABLED;
9791
David S. Miller9360ffd2012-03-29 04:41:26 -04009792 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
9793 goto nla_put_failure;
Kalle Valoffb9eb32010-02-17 17:58:10 +02009794
9795 genlmsg_end(msg, hdr);
Johannes Berg4c476992010-10-04 21:36:35 +02009796 return genlmsg_reply(msg, info);
Kalle Valoffb9eb32010-02-17 17:58:10 +02009797
Johannes Berg4c476992010-10-04 21:36:35 +02009798 nla_put_failure:
Kalle Valoffb9eb32010-02-17 17:58:10 +02009799 err = -ENOBUFS;
Johannes Berg4c476992010-10-04 21:36:35 +02009800 free_msg:
Kalle Valoffb9eb32010-02-17 17:58:10 +02009801 nlmsg_free(msg);
Kalle Valoffb9eb32010-02-17 17:58:10 +02009802 return err;
9803}
9804
Johannes Berg94e860f2014-01-20 23:58:15 +01009805static const struct nla_policy
9806nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +01009807 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009808 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
9809 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
Thomas Pedersen84f10702012-07-12 16:17:33 -07009810 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
9811 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
9812 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
Andrzej Zaborowskibee427b2017-01-25 12:43:41 +01009813 [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009814};
9815
Thomas Pedersen84f10702012-07-12 16:17:33 -07009816static int nl80211_set_cqm_txe(struct genl_info *info,
Johannes Bergd9d8b012012-11-26 12:51:52 +01009817 u32 rate, u32 pkts, u32 intvl)
Thomas Pedersen84f10702012-07-12 16:17:33 -07009818{
9819 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Thomas Pedersen84f10702012-07-12 16:17:33 -07009820 struct net_device *dev = info->user_ptr[1];
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009821 struct wireless_dev *wdev = dev->ieee80211_ptr;
Thomas Pedersen84f10702012-07-12 16:17:33 -07009822
Johannes Bergd9d8b012012-11-26 12:51:52 +01009823 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
Thomas Pedersen84f10702012-07-12 16:17:33 -07009824 return -EINVAL;
9825
Thomas Pedersen84f10702012-07-12 16:17:33 -07009826 if (!rdev->ops->set_cqm_txe_config)
9827 return -EOPNOTSUPP;
9828
9829 if (wdev->iftype != NL80211_IFTYPE_STATION &&
9830 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9831 return -EOPNOTSUPP;
9832
Hila Gonene35e4d22012-06-27 17:19:42 +03009833 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
Thomas Pedersen84f10702012-07-12 16:17:33 -07009834}
9835
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +01009836static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
9837 struct net_device *dev)
9838{
9839 struct wireless_dev *wdev = dev->ieee80211_ptr;
9840 s32 last, low, high;
9841 u32 hyst;
9842 int i, n;
9843 int err;
9844
9845 /* RSSI reporting disabled? */
9846 if (!wdev->cqm_config)
9847 return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);
9848
9849 /*
9850 * Obtain current RSSI value if possible, if not and no RSSI threshold
9851 * event has been received yet, we should receive an event after a
9852 * connection is established and enough beacons received to calculate
9853 * the average.
9854 */
9855 if (!wdev->cqm_config->last_rssi_event_value && wdev->current_bss &&
9856 rdev->ops->get_station) {
Johannes Berg5762d7d2018-01-16 23:20:22 +01009857 struct station_info sinfo = {};
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +01009858 u8 *mac_addr;
9859
9860 mac_addr = wdev->current_bss->pub.bssid;
9861
9862 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
9863 if (err)
9864 return err;
9865
9866 if (sinfo.filled & BIT(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
9867 wdev->cqm_config->last_rssi_event_value =
9868 (s8) sinfo.rx_beacon_signal_avg;
9869 }
9870
9871 last = wdev->cqm_config->last_rssi_event_value;
9872 hyst = wdev->cqm_config->rssi_hyst;
9873 n = wdev->cqm_config->n_rssi_thresholds;
9874
9875 for (i = 0; i < n; i++)
9876 if (last < wdev->cqm_config->rssi_thresholds[i])
9877 break;
9878
9879 low = i > 0 ?
9880 (wdev->cqm_config->rssi_thresholds[i - 1] - hyst) : S32_MIN;
9881 high = i < n ?
9882 (wdev->cqm_config->rssi_thresholds[i] + hyst - 1) : S32_MAX;
9883
9884 return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
9885}
9886
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009887static int nl80211_set_cqm_rssi(struct genl_info *info,
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +01009888 const s32 *thresholds, int n_thresholds,
9889 u32 hysteresis)
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009890{
Johannes Berg4c476992010-10-04 21:36:35 +02009891 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Johannes Berg4c476992010-10-04 21:36:35 +02009892 struct net_device *dev = info->user_ptr[1];
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009893 struct wireless_dev *wdev = dev->ieee80211_ptr;
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +01009894 int i, err;
9895 s32 prev = S32_MIN;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009896
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +01009897 /* Check all values negative and sorted */
9898 for (i = 0; i < n_thresholds; i++) {
9899 if (thresholds[i] > 0 || thresholds[i] <= prev)
9900 return -EINVAL;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009901
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +01009902 prev = thresholds[i];
9903 }
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009904
Johannes Berg074ac8d2010-09-16 14:58:22 +02009905 if (wdev->iftype != NL80211_IFTYPE_STATION &&
Johannes Berg4c476992010-10-04 21:36:35 +02009906 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9907 return -EOPNOTSUPP;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009908
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +01009909 wdev_lock(wdev);
9910 cfg80211_cqm_config_free(wdev);
9911 wdev_unlock(wdev);
9912
9913 if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) {
9914 if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */
9915 return rdev_set_cqm_rssi_config(rdev, dev, 0, 0);
9916
9917 return rdev_set_cqm_rssi_config(rdev, dev,
9918 thresholds[0], hysteresis);
9919 }
9920
9921 if (!wiphy_ext_feature_isset(&rdev->wiphy,
9922 NL80211_EXT_FEATURE_CQM_RSSI_LIST))
9923 return -EOPNOTSUPP;
9924
9925 if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
9926 n_thresholds = 0;
9927
9928 wdev_lock(wdev);
9929 if (n_thresholds) {
9930 struct cfg80211_cqm_config *cqm_config;
9931
9932 cqm_config = kzalloc(sizeof(struct cfg80211_cqm_config) +
9933 n_thresholds * sizeof(s32), GFP_KERNEL);
9934 if (!cqm_config) {
9935 err = -ENOMEM;
9936 goto unlock;
9937 }
9938
9939 cqm_config->rssi_hyst = hysteresis;
9940 cqm_config->n_rssi_thresholds = n_thresholds;
9941 memcpy(cqm_config->rssi_thresholds, thresholds,
9942 n_thresholds * sizeof(s32));
9943
9944 wdev->cqm_config = cqm_config;
9945 }
9946
9947 err = cfg80211_cqm_rssi_update(rdev, dev);
9948
9949unlock:
9950 wdev_unlock(wdev);
9951
9952 return err;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009953}
9954
9955static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
9956{
9957 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
9958 struct nlattr *cqm;
9959 int err;
9960
9961 cqm = info->attrs[NL80211_ATTR_CQM];
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009962 if (!cqm)
9963 return -EINVAL;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009964
9965 err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
Johannes Bergfe521452017-04-12 14:34:08 +02009966 nl80211_attr_cqm_policy, info->extack);
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009967 if (err)
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009968 return err;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009969
9970 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
9971 attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +01009972 const s32 *thresholds =
9973 nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
9974 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009975 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009976
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +01009977 if (len % 4)
9978 return -EINVAL;
9979
9980 return nl80211_set_cqm_rssi(info, thresholds, len / 4,
9981 hysteresis);
Johannes Berg1da5fcc2013-08-06 14:10:48 +02009982 }
9983
9984 if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
9985 attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
9986 attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
9987 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
9988 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
9989 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
9990
9991 return nl80211_set_cqm_txe(info, rate, pkts, intvl);
9992 }
9993
9994 return -EINVAL;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +02009995}
9996
Rostislav Lisovy6e0bd6c2014-11-03 10:33:18 +01009997static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
9998{
9999 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10000 struct net_device *dev = info->user_ptr[1];
10001 struct ocb_setup setup = {};
10002 int err;
10003
10004 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
10005 if (err)
10006 return err;
10007
10008 return cfg80211_join_ocb(rdev, dev, &setup);
10009}
10010
10011static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
10012{
10013 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10014 struct net_device *dev = info->user_ptr[1];
10015
10016 return cfg80211_leave_ocb(rdev, dev);
10017}
10018
Johannes Berg29cbe682010-12-03 09:20:44 +010010019static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
10020{
10021 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10022 struct net_device *dev = info->user_ptr[1];
10023 struct mesh_config cfg;
Javier Cardonac80d5452010-12-16 17:37:49 -080010024 struct mesh_setup setup;
Johannes Berg29cbe682010-12-03 09:20:44 +010010025 int err;
10026
10027 /* start with default */
10028 memcpy(&cfg, &default_mesh_config, sizeof(cfg));
Javier Cardonac80d5452010-12-16 17:37:49 -080010029 memcpy(&setup, &default_mesh_setup, sizeof(setup));
Johannes Berg29cbe682010-12-03 09:20:44 +010010030
Javier Cardona24bdd9f2010-12-16 17:37:48 -080010031 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
Johannes Berg29cbe682010-12-03 09:20:44 +010010032 /* and parse parameters if given */
Javier Cardona24bdd9f2010-12-16 17:37:48 -080010033 err = nl80211_parse_mesh_config(info, &cfg, NULL);
Johannes Berg29cbe682010-12-03 09:20:44 +010010034 if (err)
10035 return err;
10036 }
10037
10038 if (!info->attrs[NL80211_ATTR_MESH_ID] ||
10039 !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
10040 return -EINVAL;
10041
Javier Cardonac80d5452010-12-16 17:37:49 -080010042 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
10043 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
10044
Chun-Yeow Yeoh4bb62342011-11-24 17:15:20 -080010045 if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
10046 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
10047 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
10048 return -EINVAL;
10049
Marco Porsch9bdbf042013-01-07 16:04:51 +010010050 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
10051 setup.beacon_interval =
10052 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
Purushottam Kushwaha12d20fc92016-08-11 15:14:02 +053010053
Purushottam Kushwaha0c317a02016-10-12 18:26:51 +053010054 err = cfg80211_validate_beacon_int(rdev,
10055 NL80211_IFTYPE_MESH_POINT,
10056 setup.beacon_interval);
Purushottam Kushwaha12d20fc92016-08-11 15:14:02 +053010057 if (err)
10058 return err;
Marco Porsch9bdbf042013-01-07 16:04:51 +010010059 }
10060
10061 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
10062 setup.dtim_period =
10063 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
10064 if (setup.dtim_period < 1 || setup.dtim_period > 100)
10065 return -EINVAL;
10066 }
10067
Javier Cardonac80d5452010-12-16 17:37:49 -080010068 if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
10069 /* parse additional setup parameters if given */
10070 err = nl80211_parse_mesh_setup(info, &setup);
10071 if (err)
10072 return err;
10073 }
10074
Thomas Pedersend37bb182013-03-04 13:06:13 -080010075 if (setup.user_mpm)
10076 cfg.auto_open_plinks = false;
10077
Johannes Bergcc1d2802012-05-16 23:50:20 +020010078 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
Johannes Berg683b6d32012-11-08 21:25:48 +010010079 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
10080 if (err)
10081 return err;
Johannes Bergcc1d2802012-05-16 23:50:20 +020010082 } else {
10083 /* cfg80211_join_mesh() will sort it out */
Johannes Berg683b6d32012-11-08 21:25:48 +010010084 setup.chandef.chan = NULL;
Johannes Bergcc1d2802012-05-16 23:50:20 +020010085 }
10086
Ashok Nagarajanffb3cf32013-06-03 10:33:36 -070010087 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
10088 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
10089 int n_rates =
10090 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
10091 struct ieee80211_supported_band *sband;
10092
10093 if (!setup.chandef.chan)
10094 return -EINVAL;
10095
10096 sband = rdev->wiphy.bands[setup.chandef.chan->band];
10097
10098 err = ieee80211_get_ratemask(sband, rates, n_rates,
10099 &setup.basic_rates);
10100 if (err)
10101 return err;
10102 }
10103
Johannes Berg8564e382016-09-19 09:44:44 +020010104 if (info->attrs[NL80211_ATTR_TX_RATES]) {
10105 err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
10106 if (err)
10107 return err;
10108
Johannes Berg265698d2017-09-18 22:46:36 +020010109 if (!setup.chandef.chan)
10110 return -EINVAL;
10111
Johannes Berg8564e382016-09-19 09:44:44 +020010112 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
10113 &setup.beacon_rate);
10114 if (err)
10115 return err;
10116 }
10117
Benjamin Bergd37d49c2017-05-16 11:23:11 +020010118 setup.userspace_handles_dfs =
10119 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
10120
Javier Cardonac80d5452010-12-16 17:37:49 -080010121 return cfg80211_join_mesh(rdev, dev, &setup, &cfg);
Johannes Berg29cbe682010-12-03 09:20:44 +010010122}
10123
10124static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
10125{
10126 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10127 struct net_device *dev = info->user_ptr[1];
10128
10129 return cfg80211_leave_mesh(rdev, dev);
10130}
10131
Johannes Bergdfb89c52012-06-27 09:23:48 +020010132#ifdef CONFIG_PM
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010133static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
10134 struct cfg80211_registered_device *rdev)
10135{
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010136 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010137 struct nlattr *nl_pats, *nl_pat;
10138 int i, pat_len;
10139
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010140 if (!wowlan->n_patterns)
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010141 return 0;
10142
10143 nl_pats = nla_nest_start(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
10144 if (!nl_pats)
10145 return -ENOBUFS;
10146
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010147 for (i = 0; i < wowlan->n_patterns; i++) {
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010148 nl_pat = nla_nest_start(msg, i + 1);
10149 if (!nl_pat)
10150 return -ENOBUFS;
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010151 pat_len = wowlan->patterns[i].pattern_len;
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010152 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010153 wowlan->patterns[i].mask) ||
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010154 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
10155 wowlan->patterns[i].pattern) ||
10156 nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010157 wowlan->patterns[i].pkt_offset))
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010158 return -ENOBUFS;
10159 nla_nest_end(msg, nl_pat);
10160 }
10161 nla_nest_end(msg, nl_pats);
10162
10163 return 0;
10164}
10165
Johannes Berg2a0e0472013-01-23 22:57:40 +010010166static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
10167 struct cfg80211_wowlan_tcp *tcp)
10168{
10169 struct nlattr *nl_tcp;
10170
10171 if (!tcp)
10172 return 0;
10173
10174 nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
10175 if (!nl_tcp)
10176 return -ENOBUFS;
10177
Jiri Benc930345e2015-03-29 16:59:25 +020010178 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
10179 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
Johannes Berg2a0e0472013-01-23 22:57:40 +010010180 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
10181 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
10182 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
10183 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
10184 tcp->payload_len, tcp->payload) ||
10185 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
10186 tcp->data_interval) ||
10187 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
10188 tcp->wake_len, tcp->wake_data) ||
10189 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
10190 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
10191 return -ENOBUFS;
10192
10193 if (tcp->payload_seq.len &&
10194 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
10195 sizeof(tcp->payload_seq), &tcp->payload_seq))
10196 return -ENOBUFS;
10197
10198 if (tcp->payload_tok.len &&
10199 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
10200 sizeof(tcp->payload_tok) + tcp->tokens_size,
10201 &tcp->payload_tok))
10202 return -ENOBUFS;
10203
Johannes Berge248ad32013-05-16 10:24:28 +020010204 nla_nest_end(msg, nl_tcp);
10205
Johannes Berg2a0e0472013-01-23 22:57:40 +010010206 return 0;
10207}
10208
Luciano Coelho75453cc2015-01-09 14:06:37 +020010209static int nl80211_send_wowlan_nd(struct sk_buff *msg,
10210 struct cfg80211_sched_scan_request *req)
10211{
Avraham Stern3b06d272015-10-12 09:51:34 +030010212 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
Luciano Coelho75453cc2015-01-09 14:06:37 +020010213 int i;
10214
10215 if (!req)
10216 return 0;
10217
10218 nd = nla_nest_start(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
10219 if (!nd)
10220 return -ENOBUFS;
10221
Avraham Stern3b06d272015-10-12 09:51:34 +030010222 if (req->n_scan_plans == 1 &&
10223 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
10224 req->scan_plans[0].interval * 1000))
Luciano Coelho75453cc2015-01-09 14:06:37 +020010225 return -ENOBUFS;
10226
Luciano Coelho21fea562015-03-17 16:36:01 +020010227 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
10228 return -ENOBUFS;
10229
vamsi krishnabf95ecd2017-01-13 01:12:20 +020010230 if (req->relative_rssi_set) {
10231 struct nl80211_bss_select_rssi_adjust rssi_adjust;
10232
10233 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
10234 req->relative_rssi))
10235 return -ENOBUFS;
10236
10237 rssi_adjust.band = req->rssi_adjust.band;
10238 rssi_adjust.delta = req->rssi_adjust.delta;
10239 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
10240 sizeof(rssi_adjust), &rssi_adjust))
10241 return -ENOBUFS;
10242 }
10243
Luciano Coelho75453cc2015-01-09 14:06:37 +020010244 freqs = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
10245 if (!freqs)
10246 return -ENOBUFS;
10247
Johannes Berg53b18982016-09-14 09:59:21 +020010248 for (i = 0; i < req->n_channels; i++) {
10249 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
10250 return -ENOBUFS;
10251 }
Luciano Coelho75453cc2015-01-09 14:06:37 +020010252
10253 nla_nest_end(msg, freqs);
10254
10255 if (req->n_match_sets) {
10256 matches = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_MATCH);
Johannes Berg76e1fb42016-09-14 09:55:57 +020010257 if (!matches)
10258 return -ENOBUFS;
10259
Luciano Coelho75453cc2015-01-09 14:06:37 +020010260 for (i = 0; i < req->n_match_sets; i++) {
10261 match = nla_nest_start(msg, i);
Johannes Berg76e1fb42016-09-14 09:55:57 +020010262 if (!match)
10263 return -ENOBUFS;
10264
Johannes Berg53b18982016-09-14 09:59:21 +020010265 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
10266 req->match_sets[i].ssid.ssid_len,
10267 req->match_sets[i].ssid.ssid))
10268 return -ENOBUFS;
Luciano Coelho75453cc2015-01-09 14:06:37 +020010269 nla_nest_end(msg, match);
10270 }
10271 nla_nest_end(msg, matches);
10272 }
10273
Avraham Stern3b06d272015-10-12 09:51:34 +030010274 scan_plans = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
10275 if (!scan_plans)
10276 return -ENOBUFS;
10277
10278 for (i = 0; i < req->n_scan_plans; i++) {
10279 scan_plan = nla_nest_start(msg, i + 1);
Johannes Berg76e1fb42016-09-14 09:55:57 +020010280 if (!scan_plan)
10281 return -ENOBUFS;
10282
Avraham Stern3b06d272015-10-12 09:51:34 +030010283 if (!scan_plan ||
10284 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
10285 req->scan_plans[i].interval) ||
10286 (req->scan_plans[i].iterations &&
10287 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
10288 req->scan_plans[i].iterations)))
10289 return -ENOBUFS;
10290 nla_nest_end(msg, scan_plan);
10291 }
10292 nla_nest_end(msg, scan_plans);
10293
Luciano Coelho75453cc2015-01-09 14:06:37 +020010294 nla_nest_end(msg, nd);
10295
10296 return 0;
10297}
10298
Johannes Bergff1b6e62011-05-04 15:37:28 +020010299static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
10300{
10301 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10302 struct sk_buff *msg;
10303 void *hdr;
Johannes Berg2a0e0472013-01-23 22:57:40 +010010304 u32 size = NLMSG_DEFAULT_SIZE;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010305
Johannes Berg964dc9e2013-06-03 17:25:34 +020010306 if (!rdev->wiphy.wowlan)
Johannes Bergff1b6e62011-05-04 15:37:28 +020010307 return -EOPNOTSUPP;
10308
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010309 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
Johannes Berg2a0e0472013-01-23 22:57:40 +010010310 /* adjust size to have room for all the data */
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010311 size += rdev->wiphy.wowlan_config->tcp->tokens_size +
10312 rdev->wiphy.wowlan_config->tcp->payload_len +
10313 rdev->wiphy.wowlan_config->tcp->wake_len +
10314 rdev->wiphy.wowlan_config->tcp->wake_len / 8;
Johannes Berg2a0e0472013-01-23 22:57:40 +010010315 }
10316
10317 msg = nlmsg_new(size, GFP_KERNEL);
Johannes Bergff1b6e62011-05-04 15:37:28 +020010318 if (!msg)
10319 return -ENOMEM;
10320
Eric W. Biederman15e47302012-09-07 20:12:54 +000010321 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Johannes Bergff1b6e62011-05-04 15:37:28 +020010322 NL80211_CMD_GET_WOWLAN);
10323 if (!hdr)
10324 goto nla_put_failure;
10325
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010326 if (rdev->wiphy.wowlan_config) {
Johannes Bergff1b6e62011-05-04 15:37:28 +020010327 struct nlattr *nl_wowlan;
10328
10329 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
10330 if (!nl_wowlan)
10331 goto nla_put_failure;
10332
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010333 if ((rdev->wiphy.wowlan_config->any &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010334 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010335 (rdev->wiphy.wowlan_config->disconnect &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010336 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010337 (rdev->wiphy.wowlan_config->magic_pkt &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010338 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010339 (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010340 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010341 (rdev->wiphy.wowlan_config->eap_identity_req &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010342 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010343 (rdev->wiphy.wowlan_config->four_way_handshake &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010344 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010345 (rdev->wiphy.wowlan_config->rfkill_release &&
David S. Miller9360ffd2012-03-29 04:41:26 -040010346 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
10347 goto nla_put_failure;
Johannes Berg2a0e0472013-01-23 22:57:40 +010010348
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010349 if (nl80211_send_wowlan_patterns(msg, rdev))
10350 goto nla_put_failure;
Johannes Berg2a0e0472013-01-23 22:57:40 +010010351
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010352 if (nl80211_send_wowlan_tcp(msg,
10353 rdev->wiphy.wowlan_config->tcp))
Johannes Berg2a0e0472013-01-23 22:57:40 +010010354 goto nla_put_failure;
10355
Luciano Coelho75453cc2015-01-09 14:06:37 +020010356 if (nl80211_send_wowlan_nd(
10357 msg,
10358 rdev->wiphy.wowlan_config->nd_config))
10359 goto nla_put_failure;
10360
Johannes Bergff1b6e62011-05-04 15:37:28 +020010361 nla_nest_end(msg, nl_wowlan);
10362 }
10363
10364 genlmsg_end(msg, hdr);
10365 return genlmsg_reply(msg, info);
10366
10367nla_put_failure:
10368 nlmsg_free(msg);
10369 return -ENOBUFS;
10370}
10371
Johannes Berg2a0e0472013-01-23 22:57:40 +010010372static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
10373 struct nlattr *attr,
10374 struct cfg80211_wowlan *trig)
10375{
10376 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
10377 struct cfg80211_wowlan_tcp *cfg;
10378 struct nl80211_wowlan_tcp_data_token *tok = NULL;
10379 struct nl80211_wowlan_tcp_data_seq *seq = NULL;
10380 u32 size;
10381 u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
10382 int err, port;
10383
Johannes Berg964dc9e2013-06-03 17:25:34 +020010384 if (!rdev->wiphy.wowlan->tcp)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010385 return -EINVAL;
10386
Johannes Bergbfe2c7b2016-10-26 14:42:21 +020010387 err = nla_parse_nested(tb, MAX_NL80211_WOWLAN_TCP, attr,
Johannes Bergfceb6432017-04-12 14:34:07 +020010388 nl80211_wowlan_tcp_policy, NULL);
Johannes Berg2a0e0472013-01-23 22:57:40 +010010389 if (err)
10390 return err;
10391
10392 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
10393 !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
10394 !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
10395 !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
10396 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
10397 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
10398 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
10399 !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
10400 return -EINVAL;
10401
10402 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
Johannes Berg964dc9e2013-06-03 17:25:34 +020010403 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010404 return -EINVAL;
10405
10406 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
Johannes Berg964dc9e2013-06-03 17:25:34 +020010407 rdev->wiphy.wowlan->tcp->data_interval_max ||
Johannes Berg723d5682013-02-26 13:56:40 +010010408 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010409 return -EINVAL;
10410
10411 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
Johannes Berg964dc9e2013-06-03 17:25:34 +020010412 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010413 return -EINVAL;
10414
10415 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
10416 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
10417 return -EINVAL;
10418
10419 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
10420 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
10421
10422 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
10423 tokens_size = tokln - sizeof(*tok);
10424
10425 if (!tok->len || tokens_size % tok->len)
10426 return -EINVAL;
Johannes Berg964dc9e2013-06-03 17:25:34 +020010427 if (!rdev->wiphy.wowlan->tcp->tok)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010428 return -EINVAL;
Johannes Berg964dc9e2013-06-03 17:25:34 +020010429 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010430 return -EINVAL;
Johannes Berg964dc9e2013-06-03 17:25:34 +020010431 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010432 return -EINVAL;
Johannes Berg964dc9e2013-06-03 17:25:34 +020010433 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010434 return -EINVAL;
10435 if (tok->offset + tok->len > data_size)
10436 return -EINVAL;
10437 }
10438
10439 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
10440 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
Johannes Berg964dc9e2013-06-03 17:25:34 +020010441 if (!rdev->wiphy.wowlan->tcp->seq)
Johannes Berg2a0e0472013-01-23 22:57:40 +010010442 return -EINVAL;
10443 if (seq->len == 0 || seq->len > 4)
10444 return -EINVAL;
10445 if (seq->len + seq->offset > data_size)
10446 return -EINVAL;
10447 }
10448
10449 size = sizeof(*cfg);
10450 size += data_size;
10451 size += wake_size + wake_mask_size;
10452 size += tokens_size;
10453
10454 cfg = kzalloc(size, GFP_KERNEL);
10455 if (!cfg)
10456 return -ENOMEM;
Jiri Benc67b61f62015-03-29 16:59:26 +020010457 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
10458 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
Johannes Berg2a0e0472013-01-23 22:57:40 +010010459 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
10460 ETH_ALEN);
10461 if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
10462 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
10463 else
10464 port = 0;
10465#ifdef CONFIG_INET
10466 /* allocate a socket and port for it and use it */
10467 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
10468 IPPROTO_TCP, &cfg->sock, 1);
10469 if (err) {
10470 kfree(cfg);
10471 return err;
10472 }
10473 if (inet_csk_get_port(cfg->sock->sk, port)) {
10474 sock_release(cfg->sock);
10475 kfree(cfg);
10476 return -EADDRINUSE;
10477 }
10478 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
10479#else
10480 if (!port) {
10481 kfree(cfg);
10482 return -EINVAL;
10483 }
10484 cfg->src_port = port;
10485#endif
10486
10487 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
10488 cfg->payload_len = data_size;
10489 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
10490 memcpy((void *)cfg->payload,
10491 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
10492 data_size);
10493 if (seq)
10494 cfg->payload_seq = *seq;
10495 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
10496 cfg->wake_len = wake_size;
10497 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
10498 memcpy((void *)cfg->wake_data,
10499 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
10500 wake_size);
10501 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
10502 data_size + wake_size;
10503 memcpy((void *)cfg->wake_mask,
10504 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
10505 wake_mask_size);
10506 if (tok) {
10507 cfg->tokens_size = tokens_size;
10508 memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
10509 }
10510
10511 trig->tcp = cfg;
10512
10513 return 0;
10514}
10515
Luciano Coelho8cd4d452014-09-17 11:55:28 +030010516static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
10517 const struct wiphy_wowlan_support *wowlan,
10518 struct nlattr *attr,
10519 struct cfg80211_wowlan *trig)
10520{
10521 struct nlattr **tb;
10522 int err;
10523
10524 tb = kzalloc(NUM_NL80211_ATTR * sizeof(*tb), GFP_KERNEL);
10525 if (!tb)
10526 return -ENOMEM;
10527
10528 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
10529 err = -EOPNOTSUPP;
10530 goto out;
10531 }
10532
Johannes Bergfceb6432017-04-12 14:34:07 +020010533 err = nla_parse_nested(tb, NL80211_ATTR_MAX, attr, nl80211_policy,
10534 NULL);
Luciano Coelho8cd4d452014-09-17 11:55:28 +030010535 if (err)
10536 goto out;
10537
Arend Van Sprielaad1e812017-01-27 12:27:44 +000010538 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
10539 wowlan->max_nd_match_sets);
Luciano Coelho8cd4d452014-09-17 11:55:28 +030010540 err = PTR_ERR_OR_ZERO(trig->nd_config);
10541 if (err)
10542 trig->nd_config = NULL;
10543
10544out:
10545 kfree(tb);
10546 return err;
10547}
10548
Johannes Bergff1b6e62011-05-04 15:37:28 +020010549static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
10550{
10551 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10552 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
Johannes Bergff1b6e62011-05-04 15:37:28 +020010553 struct cfg80211_wowlan new_triggers = {};
Johannes Bergae33bd82012-07-12 16:25:02 +020010554 struct cfg80211_wowlan *ntrig;
Johannes Berg964dc9e2013-06-03 17:25:34 +020010555 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010556 int err, i;
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010557 bool prev_enabled = rdev->wiphy.wowlan_config;
Johannes Berg98fc4382015-03-01 09:10:13 +020010558 bool regular = false;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010559
Johannes Berg964dc9e2013-06-03 17:25:34 +020010560 if (!wowlan)
Johannes Bergff1b6e62011-05-04 15:37:28 +020010561 return -EOPNOTSUPP;
10562
Johannes Bergae33bd82012-07-12 16:25:02 +020010563 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
10564 cfg80211_rdev_free_wowlan(rdev);
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010565 rdev->wiphy.wowlan_config = NULL;
Johannes Bergae33bd82012-07-12 16:25:02 +020010566 goto set_wakeup;
10567 }
Johannes Bergff1b6e62011-05-04 15:37:28 +020010568
Johannes Bergbfe2c7b2016-10-26 14:42:21 +020010569 err = nla_parse_nested(tb, MAX_NL80211_WOWLAN_TRIG,
10570 info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
Johannes Bergfe521452017-04-12 14:34:08 +020010571 nl80211_wowlan_policy, info->extack);
Johannes Bergff1b6e62011-05-04 15:37:28 +020010572 if (err)
10573 return err;
10574
10575 if (tb[NL80211_WOWLAN_TRIG_ANY]) {
10576 if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
10577 return -EINVAL;
10578 new_triggers.any = true;
10579 }
10580
10581 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
10582 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
10583 return -EINVAL;
10584 new_triggers.disconnect = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010585 regular = true;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010586 }
10587
10588 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
10589 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
10590 return -EINVAL;
10591 new_triggers.magic_pkt = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010592 regular = true;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010593 }
10594
Johannes Berg77dbbb12011-07-13 10:48:55 +020010595 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
10596 return -EINVAL;
10597
10598 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
10599 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
10600 return -EINVAL;
10601 new_triggers.gtk_rekey_failure = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010602 regular = true;
Johannes Berg77dbbb12011-07-13 10:48:55 +020010603 }
10604
10605 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
10606 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
10607 return -EINVAL;
10608 new_triggers.eap_identity_req = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010609 regular = true;
Johannes Berg77dbbb12011-07-13 10:48:55 +020010610 }
10611
10612 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
10613 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
10614 return -EINVAL;
10615 new_triggers.four_way_handshake = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010616 regular = true;
Johannes Berg77dbbb12011-07-13 10:48:55 +020010617 }
10618
10619 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
10620 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
10621 return -EINVAL;
10622 new_triggers.rfkill_release = true;
Johannes Berg98fc4382015-03-01 09:10:13 +020010623 regular = true;
Johannes Berg77dbbb12011-07-13 10:48:55 +020010624 }
10625
Johannes Bergff1b6e62011-05-04 15:37:28 +020010626 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
10627 struct nlattr *pat;
10628 int n_patterns = 0;
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010629 int rem, pat_len, mask_len, pkt_offset;
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010630 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
Johannes Bergff1b6e62011-05-04 15:37:28 +020010631
Johannes Berg98fc4382015-03-01 09:10:13 +020010632 regular = true;
10633
Johannes Bergff1b6e62011-05-04 15:37:28 +020010634 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
10635 rem)
10636 n_patterns++;
10637 if (n_patterns > wowlan->n_patterns)
10638 return -EINVAL;
10639
10640 new_triggers.patterns = kcalloc(n_patterns,
10641 sizeof(new_triggers.patterns[0]),
10642 GFP_KERNEL);
10643 if (!new_triggers.patterns)
10644 return -ENOMEM;
10645
10646 new_triggers.n_patterns = n_patterns;
10647 i = 0;
10648
10649 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
10650 rem) {
Johannes Berg922bd802014-05-19 17:59:50 +020010651 u8 *mask_pat;
10652
Johannes Bergbfe2c7b2016-10-26 14:42:21 +020010653 nla_parse_nested(pat_tb, MAX_NL80211_PKTPAT, pat,
Peng Xuad670232017-10-03 23:21:51 +030010654 nl80211_packet_pattern_policy,
10655 info->extack);
Johannes Bergff1b6e62011-05-04 15:37:28 +020010656 err = -EINVAL;
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010657 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10658 !pat_tb[NL80211_PKTPAT_PATTERN])
Johannes Bergff1b6e62011-05-04 15:37:28 +020010659 goto error;
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010660 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
Johannes Bergff1b6e62011-05-04 15:37:28 +020010661 mask_len = DIV_ROUND_UP(pat_len, 8);
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010662 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
Johannes Bergff1b6e62011-05-04 15:37:28 +020010663 goto error;
10664 if (pat_len > wowlan->pattern_max_len ||
10665 pat_len < wowlan->pattern_min_len)
10666 goto error;
10667
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010668 if (!pat_tb[NL80211_PKTPAT_OFFSET])
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010669 pkt_offset = 0;
10670 else
10671 pkt_offset = nla_get_u32(
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010672 pat_tb[NL80211_PKTPAT_OFFSET]);
Amitkumar Karwarbb92d192013-02-12 12:16:26 -080010673 if (pkt_offset > wowlan->max_pkt_offset)
10674 goto error;
10675 new_triggers.patterns[i].pkt_offset = pkt_offset;
10676
Johannes Berg922bd802014-05-19 17:59:50 +020010677 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10678 if (!mask_pat) {
Johannes Bergff1b6e62011-05-04 15:37:28 +020010679 err = -ENOMEM;
10680 goto error;
10681 }
Johannes Berg922bd802014-05-19 17:59:50 +020010682 new_triggers.patterns[i].mask = mask_pat;
10683 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
Johannes Bergff1b6e62011-05-04 15:37:28 +020010684 mask_len);
Johannes Berg922bd802014-05-19 17:59:50 +020010685 mask_pat += mask_len;
10686 new_triggers.patterns[i].pattern = mask_pat;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010687 new_triggers.patterns[i].pattern_len = pat_len;
Johannes Berg922bd802014-05-19 17:59:50 +020010688 memcpy(mask_pat,
Amitkumar Karwar50ac6602013-06-25 19:03:56 -070010689 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
Johannes Bergff1b6e62011-05-04 15:37:28 +020010690 pat_len);
10691 i++;
10692 }
10693 }
10694
Johannes Berg2a0e0472013-01-23 22:57:40 +010010695 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
Johannes Berg98fc4382015-03-01 09:10:13 +020010696 regular = true;
Johannes Berg2a0e0472013-01-23 22:57:40 +010010697 err = nl80211_parse_wowlan_tcp(
10698 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
10699 &new_triggers);
10700 if (err)
10701 goto error;
10702 }
10703
Luciano Coelho8cd4d452014-09-17 11:55:28 +030010704 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
Johannes Berg98fc4382015-03-01 09:10:13 +020010705 regular = true;
Luciano Coelho8cd4d452014-09-17 11:55:28 +030010706 err = nl80211_parse_wowlan_nd(
10707 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
10708 &new_triggers);
10709 if (err)
10710 goto error;
10711 }
10712
Johannes Berg98fc4382015-03-01 09:10:13 +020010713 /* The 'any' trigger means the device continues operating more or less
10714 * as in its normal operation mode and wakes up the host on most of the
10715 * normal interrupts (like packet RX, ...)
10716 * It therefore makes little sense to combine with the more constrained
10717 * wakeup trigger modes.
10718 */
10719 if (new_triggers.any && regular) {
10720 err = -EINVAL;
10721 goto error;
10722 }
10723
Johannes Bergae33bd82012-07-12 16:25:02 +020010724 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
10725 if (!ntrig) {
10726 err = -ENOMEM;
10727 goto error;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010728 }
Johannes Bergae33bd82012-07-12 16:25:02 +020010729 cfg80211_rdev_free_wowlan(rdev);
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010730 rdev->wiphy.wowlan_config = ntrig;
Johannes Bergff1b6e62011-05-04 15:37:28 +020010731
Johannes Bergae33bd82012-07-12 16:25:02 +020010732 set_wakeup:
Johannes Berg6abb9cb2013-05-15 09:30:07 +020010733 if (rdev->ops->set_wakeup &&
10734 prev_enabled != !!rdev->wiphy.wowlan_config)
10735 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
Johannes Berg6d525632012-04-04 15:05:25 +020010736
Johannes Bergff1b6e62011-05-04 15:37:28 +020010737 return 0;
10738 error:
10739 for (i = 0; i < new_triggers.n_patterns; i++)
10740 kfree(new_triggers.patterns[i].mask);
10741 kfree(new_triggers.patterns);
Johannes Berg2a0e0472013-01-23 22:57:40 +010010742 if (new_triggers.tcp && new_triggers.tcp->sock)
10743 sock_release(new_triggers.tcp->sock);
10744 kfree(new_triggers.tcp);
Ola Olssone5dbe072015-12-12 23:17:17 +010010745 kfree(new_triggers.nd_config);
Johannes Bergff1b6e62011-05-04 15:37:28 +020010746 return err;
10747}
Johannes Bergdfb89c52012-06-27 09:23:48 +020010748#endif
Johannes Bergff1b6e62011-05-04 15:37:28 +020010749
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -070010750static int nl80211_send_coalesce_rules(struct sk_buff *msg,
10751 struct cfg80211_registered_device *rdev)
10752{
10753 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
10754 int i, j, pat_len;
10755 struct cfg80211_coalesce_rules *rule;
10756
10757 if (!rdev->coalesce->n_rules)
10758 return 0;
10759
10760 nl_rules = nla_nest_start(msg, NL80211_ATTR_COALESCE_RULE);
10761 if (!nl_rules)
10762 return -ENOBUFS;
10763
10764 for (i = 0; i < rdev->coalesce->n_rules; i++) {
10765 nl_rule = nla_nest_start(msg, i + 1);
10766 if (!nl_rule)
10767 return -ENOBUFS;
10768
10769 rule = &rdev->coalesce->rules[i];
10770 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
10771 rule->delay))
10772 return -ENOBUFS;
10773
10774 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
10775 rule->condition))
10776 return -ENOBUFS;
10777
10778 nl_pats = nla_nest_start(msg,
10779 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
10780 if (!nl_pats)
10781 return -ENOBUFS;
10782
10783 for (j = 0; j < rule->n_patterns; j++) {
10784 nl_pat = nla_nest_start(msg, j + 1);
10785 if (!nl_pat)
10786 return -ENOBUFS;
10787 pat_len = rule->patterns[j].pattern_len;
10788 if (nla_put(msg, NL80211_PKTPAT_MASK,
10789 DIV_ROUND_UP(pat_len, 8),
10790 rule->patterns[j].mask) ||
10791 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
10792 rule->patterns[j].pattern) ||
10793 nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
10794 rule->patterns[j].pkt_offset))
10795 return -ENOBUFS;
10796 nla_nest_end(msg, nl_pat);
10797 }
10798 nla_nest_end(msg, nl_pats);
10799 nla_nest_end(msg, nl_rule);
10800 }
10801 nla_nest_end(msg, nl_rules);
10802
10803 return 0;
10804}
10805
10806static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
10807{
10808 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10809 struct sk_buff *msg;
10810 void *hdr;
10811
10812 if (!rdev->wiphy.coalesce)
10813 return -EOPNOTSUPP;
10814
10815 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10816 if (!msg)
10817 return -ENOMEM;
10818
10819 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10820 NL80211_CMD_GET_COALESCE);
10821 if (!hdr)
10822 goto nla_put_failure;
10823
10824 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
10825 goto nla_put_failure;
10826
10827 genlmsg_end(msg, hdr);
10828 return genlmsg_reply(msg, info);
10829
10830nla_put_failure:
10831 nlmsg_free(msg);
10832 return -ENOBUFS;
10833}
10834
10835void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
10836{
10837 struct cfg80211_coalesce *coalesce = rdev->coalesce;
10838 int i, j;
10839 struct cfg80211_coalesce_rules *rule;
10840
10841 if (!coalesce)
10842 return;
10843
10844 for (i = 0; i < coalesce->n_rules; i++) {
10845 rule = &coalesce->rules[i];
10846 for (j = 0; j < rule->n_patterns; j++)
10847 kfree(rule->patterns[j].mask);
10848 kfree(rule->patterns);
10849 }
10850 kfree(coalesce->rules);
10851 kfree(coalesce);
10852 rdev->coalesce = NULL;
10853}
10854
10855static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
10856 struct nlattr *rule,
10857 struct cfg80211_coalesce_rules *new_rule)
10858{
10859 int err, i;
10860 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10861 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
10862 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
10863 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
10864
Johannes Bergbfe2c7b2016-10-26 14:42:21 +020010865 err = nla_parse_nested(tb, NL80211_ATTR_COALESCE_RULE_MAX, rule,
Johannes Bergfceb6432017-04-12 14:34:07 +020010866 nl80211_coalesce_policy, NULL);
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -070010867 if (err)
10868 return err;
10869
10870 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
10871 new_rule->delay =
10872 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
10873 if (new_rule->delay > coalesce->max_delay)
10874 return -EINVAL;
10875
10876 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
10877 new_rule->condition =
10878 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
10879 if (new_rule->condition != NL80211_COALESCE_CONDITION_MATCH &&
10880 new_rule->condition != NL80211_COALESCE_CONDITION_NO_MATCH)
10881 return -EINVAL;
10882
10883 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
10884 return -EINVAL;
10885
10886 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10887 rem)
10888 n_patterns++;
10889 if (n_patterns > coalesce->n_patterns)
10890 return -EINVAL;
10891
10892 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
10893 GFP_KERNEL);
10894 if (!new_rule->patterns)
10895 return -ENOMEM;
10896
10897 new_rule->n_patterns = n_patterns;
10898 i = 0;
10899
10900 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10901 rem) {
Johannes Berg922bd802014-05-19 17:59:50 +020010902 u8 *mask_pat;
10903
Peng Xuad670232017-10-03 23:21:51 +030010904 nla_parse_nested(pat_tb, MAX_NL80211_PKTPAT, pat,
10905 nl80211_packet_pattern_policy, NULL);
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -070010906 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10907 !pat_tb[NL80211_PKTPAT_PATTERN])
10908 return -EINVAL;
10909 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
10910 mask_len = DIV_ROUND_UP(pat_len, 8);
10911 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
10912 return -EINVAL;
10913 if (pat_len > coalesce->pattern_max_len ||
10914 pat_len < coalesce->pattern_min_len)
10915 return -EINVAL;
10916
10917 if (!pat_tb[NL80211_PKTPAT_OFFSET])
10918 pkt_offset = 0;
10919 else
10920 pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
10921 if (pkt_offset > coalesce->max_pkt_offset)
10922 return -EINVAL;
10923 new_rule->patterns[i].pkt_offset = pkt_offset;
10924
Johannes Berg922bd802014-05-19 17:59:50 +020010925 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10926 if (!mask_pat)
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -070010927 return -ENOMEM;
Johannes Berg922bd802014-05-19 17:59:50 +020010928
10929 new_rule->patterns[i].mask = mask_pat;
10930 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
10931 mask_len);
10932
10933 mask_pat += mask_len;
10934 new_rule->patterns[i].pattern = mask_pat;
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -070010935 new_rule->patterns[i].pattern_len = pat_len;
Johannes Berg922bd802014-05-19 17:59:50 +020010936 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
10937 pat_len);
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -070010938 i++;
10939 }
10940
10941 return 0;
10942}
10943
10944static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
10945{
10946 struct cfg80211_registered_device *rdev = info->user_ptr[0];
10947 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10948 struct cfg80211_coalesce new_coalesce = {};
10949 struct cfg80211_coalesce *n_coalesce;
10950 int err, rem_rule, n_rules = 0, i, j;
10951 struct nlattr *rule;
10952 struct cfg80211_coalesce_rules *tmp_rule;
10953
10954 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
10955 return -EOPNOTSUPP;
10956
10957 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
10958 cfg80211_rdev_free_coalesce(rdev);
Ilan Peera1056b1b2015-10-22 22:27:46 +030010959 rdev_set_coalesce(rdev, NULL);
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -070010960 return 0;
10961 }
10962
10963 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10964 rem_rule)
10965 n_rules++;
10966 if (n_rules > coalesce->n_rules)
10967 return -EINVAL;
10968
10969 new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
10970 GFP_KERNEL);
10971 if (!new_coalesce.rules)
10972 return -ENOMEM;
10973
10974 new_coalesce.n_rules = n_rules;
10975 i = 0;
10976
10977 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10978 rem_rule) {
10979 err = nl80211_parse_coalesce_rule(rdev, rule,
10980 &new_coalesce.rules[i]);
10981 if (err)
10982 goto error;
10983
10984 i++;
10985 }
10986
Ilan Peera1056b1b2015-10-22 22:27:46 +030010987 err = rdev_set_coalesce(rdev, &new_coalesce);
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -070010988 if (err)
10989 goto error;
10990
10991 n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
10992 if (!n_coalesce) {
10993 err = -ENOMEM;
10994 goto error;
10995 }
10996 cfg80211_rdev_free_coalesce(rdev);
10997 rdev->coalesce = n_coalesce;
10998
10999 return 0;
11000error:
11001 for (i = 0; i < new_coalesce.n_rules; i++) {
11002 tmp_rule = &new_coalesce.rules[i];
11003 for (j = 0; j < tmp_rule->n_patterns; j++)
11004 kfree(tmp_rule->patterns[j].mask);
11005 kfree(tmp_rule->patterns);
11006 }
11007 kfree(new_coalesce.rules);
11008
11009 return err;
11010}
11011
Johannes Berge5497d72011-07-05 16:35:40 +020011012static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
11013{
11014 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11015 struct net_device *dev = info->user_ptr[1];
11016 struct wireless_dev *wdev = dev->ieee80211_ptr;
11017 struct nlattr *tb[NUM_NL80211_REKEY_DATA];
11018 struct cfg80211_gtk_rekey_data rekey_data;
11019 int err;
11020
11021 if (!info->attrs[NL80211_ATTR_REKEY_DATA])
11022 return -EINVAL;
11023
Johannes Bergbfe2c7b2016-10-26 14:42:21 +020011024 err = nla_parse_nested(tb, MAX_NL80211_REKEY_DATA,
11025 info->attrs[NL80211_ATTR_REKEY_DATA],
Johannes Bergfe521452017-04-12 14:34:08 +020011026 nl80211_rekey_policy, info->extack);
Johannes Berge5497d72011-07-05 16:35:40 +020011027 if (err)
11028 return err;
11029
Vladis Dronove785fa02017-09-13 00:21:21 +020011030 if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] ||
11031 !tb[NL80211_REKEY_DATA_KCK])
11032 return -EINVAL;
Johannes Berge5497d72011-07-05 16:35:40 +020011033 if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
11034 return -ERANGE;
11035 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
11036 return -ERANGE;
11037 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
11038 return -ERANGE;
11039
Johannes Berg78f686c2014-09-10 22:28:06 +030011040 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
11041 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
11042 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
Johannes Berge5497d72011-07-05 16:35:40 +020011043
11044 wdev_lock(wdev);
11045 if (!wdev->current_bss) {
11046 err = -ENOTCONN;
11047 goto out;
11048 }
11049
11050 if (!rdev->ops->set_rekey_data) {
11051 err = -EOPNOTSUPP;
11052 goto out;
11053 }
11054
Hila Gonene35e4d22012-06-27 17:19:42 +030011055 err = rdev_set_rekey_data(rdev, dev, &rekey_data);
Johannes Berge5497d72011-07-05 16:35:40 +020011056 out:
11057 wdev_unlock(wdev);
11058 return err;
11059}
11060
Johannes Berg28946da2011-11-04 11:18:12 +010011061static int nl80211_register_unexpected_frame(struct sk_buff *skb,
11062 struct genl_info *info)
11063{
11064 struct net_device *dev = info->user_ptr[1];
11065 struct wireless_dev *wdev = dev->ieee80211_ptr;
11066
11067 if (wdev->iftype != NL80211_IFTYPE_AP &&
11068 wdev->iftype != NL80211_IFTYPE_P2P_GO)
11069 return -EINVAL;
11070
Eric W. Biederman15e47302012-09-07 20:12:54 +000011071 if (wdev->ap_unexpected_nlportid)
Johannes Berg28946da2011-11-04 11:18:12 +010011072 return -EBUSY;
11073
Eric W. Biederman15e47302012-09-07 20:12:54 +000011074 wdev->ap_unexpected_nlportid = info->snd_portid;
Johannes Berg28946da2011-11-04 11:18:12 +010011075 return 0;
11076}
11077
Johannes Berg7f6cf312011-11-04 11:18:15 +010011078static int nl80211_probe_client(struct sk_buff *skb,
11079 struct genl_info *info)
11080{
11081 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11082 struct net_device *dev = info->user_ptr[1];
11083 struct wireless_dev *wdev = dev->ieee80211_ptr;
11084 struct sk_buff *msg;
11085 void *hdr;
11086 const u8 *addr;
11087 u64 cookie;
11088 int err;
11089
11090 if (wdev->iftype != NL80211_IFTYPE_AP &&
11091 wdev->iftype != NL80211_IFTYPE_P2P_GO)
11092 return -EOPNOTSUPP;
11093
11094 if (!info->attrs[NL80211_ATTR_MAC])
11095 return -EINVAL;
11096
11097 if (!rdev->ops->probe_client)
11098 return -EOPNOTSUPP;
11099
11100 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11101 if (!msg)
11102 return -ENOMEM;
11103
Eric W. Biederman15e47302012-09-07 20:12:54 +000011104 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
Johannes Berg7f6cf312011-11-04 11:18:15 +010011105 NL80211_CMD_PROBE_CLIENT);
Dan Carpentercb35fba2013-08-14 14:50:01 +030011106 if (!hdr) {
11107 err = -ENOBUFS;
Johannes Berg7f6cf312011-11-04 11:18:15 +010011108 goto free_msg;
11109 }
11110
11111 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
11112
Hila Gonene35e4d22012-06-27 17:19:42 +030011113 err = rdev_probe_client(rdev, dev, addr, &cookie);
Johannes Berg7f6cf312011-11-04 11:18:15 +010011114 if (err)
11115 goto free_msg;
11116
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020011117 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
11118 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -040011119 goto nla_put_failure;
Johannes Berg7f6cf312011-11-04 11:18:15 +010011120
11121 genlmsg_end(msg, hdr);
11122
11123 return genlmsg_reply(msg, info);
11124
11125 nla_put_failure:
11126 err = -ENOBUFS;
11127 free_msg:
11128 nlmsg_free(msg);
11129 return err;
11130}
11131
Johannes Berg5e760232011-11-04 11:18:17 +010011132static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
11133{
11134 struct cfg80211_registered_device *rdev = info->user_ptr[0];
Ben Greear37c73b52012-10-26 14:49:25 -070011135 struct cfg80211_beacon_registration *reg, *nreg;
11136 int rv;
Johannes Berg5e760232011-11-04 11:18:17 +010011137
11138 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
11139 return -EOPNOTSUPP;
11140
Ben Greear37c73b52012-10-26 14:49:25 -070011141 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
11142 if (!nreg)
11143 return -ENOMEM;
Johannes Berg5e760232011-11-04 11:18:17 +010011144
Ben Greear37c73b52012-10-26 14:49:25 -070011145 /* First, check if already registered. */
11146 spin_lock_bh(&rdev->beacon_registrations_lock);
11147 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
11148 if (reg->nlportid == info->snd_portid) {
11149 rv = -EALREADY;
11150 goto out_err;
11151 }
11152 }
11153 /* Add it to the list */
11154 nreg->nlportid = info->snd_portid;
11155 list_add(&nreg->list, &rdev->beacon_registrations);
11156
11157 spin_unlock_bh(&rdev->beacon_registrations_lock);
Johannes Berg5e760232011-11-04 11:18:17 +010011158
11159 return 0;
Ben Greear37c73b52012-10-26 14:49:25 -070011160out_err:
11161 spin_unlock_bh(&rdev->beacon_registrations_lock);
11162 kfree(nreg);
11163 return rv;
Johannes Berg5e760232011-11-04 11:18:17 +010011164}
11165
Johannes Berg98104fde2012-06-16 00:19:54 +020011166static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
11167{
11168 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11169 struct wireless_dev *wdev = info->user_ptr[1];
11170 int err;
11171
11172 if (!rdev->ops->start_p2p_device)
11173 return -EOPNOTSUPP;
11174
11175 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
11176 return -EOPNOTSUPP;
11177
Arend Van Spriel73c7da32016-10-20 20:08:22 +010011178 if (wdev_running(wdev))
Johannes Berg98104fde2012-06-16 00:19:54 +020011179 return 0;
11180
Luciano Coelhob6a55012014-02-27 11:07:21 +020011181 if (rfkill_blocked(rdev->rfkill))
11182 return -ERFKILL;
Johannes Berg98104fde2012-06-16 00:19:54 +020011183
Johannes Bergeeb126e2012-10-23 15:16:50 +020011184 err = rdev_start_p2p_device(rdev, wdev);
Johannes Berg98104fde2012-06-16 00:19:54 +020011185 if (err)
11186 return err;
11187
Arend Van Spriel73c7da32016-10-20 20:08:22 +010011188 wdev->is_running = true;
Johannes Berg98104fde2012-06-16 00:19:54 +020011189 rdev->opencount++;
Johannes Berg98104fde2012-06-16 00:19:54 +020011190
11191 return 0;
11192}
11193
11194static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
11195{
11196 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11197 struct wireless_dev *wdev = info->user_ptr[1];
11198
11199 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
11200 return -EOPNOTSUPP;
11201
11202 if (!rdev->ops->stop_p2p_device)
11203 return -EOPNOTSUPP;
11204
Johannes Bergf9f47522013-03-19 15:04:07 +010011205 cfg80211_stop_p2p_device(rdev, wdev);
Johannes Berg98104fde2012-06-16 00:19:54 +020011206
11207 return 0;
11208}
11209
Ayala Bekercb3b7d82016-09-20 17:31:13 +030011210static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
11211{
11212 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11213 struct wireless_dev *wdev = info->user_ptr[1];
11214 struct cfg80211_nan_conf conf = {};
11215 int err;
11216
11217 if (wdev->iftype != NL80211_IFTYPE_NAN)
11218 return -EOPNOTSUPP;
11219
Johannes Bergeeb04a92016-11-21 13:55:48 +010011220 if (wdev_running(wdev))
Ayala Bekercb3b7d82016-09-20 17:31:13 +030011221 return -EEXIST;
11222
11223 if (rfkill_blocked(rdev->rfkill))
11224 return -ERFKILL;
11225
11226 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
11227 return -EINVAL;
11228
Ayala Bekercb3b7d82016-09-20 17:31:13 +030011229 conf.master_pref =
11230 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
11231 if (!conf.master_pref)
11232 return -EINVAL;
11233
Luca Coelho85859892017-02-08 15:00:34 +020011234 if (info->attrs[NL80211_ATTR_BANDS]) {
11235 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
11236
11237 if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
11238 return -EOPNOTSUPP;
11239
11240 if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
11241 return -EINVAL;
11242
11243 conf.bands = bands;
11244 }
Ayala Bekercb3b7d82016-09-20 17:31:13 +030011245
11246 err = rdev_start_nan(rdev, wdev, &conf);
11247 if (err)
11248 return err;
11249
Arend Van Spriel73c7da32016-10-20 20:08:22 +010011250 wdev->is_running = true;
Ayala Bekercb3b7d82016-09-20 17:31:13 +030011251 rdev->opencount++;
11252
11253 return 0;
11254}
11255
11256static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
11257{
11258 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11259 struct wireless_dev *wdev = info->user_ptr[1];
11260
11261 if (wdev->iftype != NL80211_IFTYPE_NAN)
11262 return -EOPNOTSUPP;
11263
11264 cfg80211_stop_nan(rdev, wdev);
11265
11266 return 0;
11267}
11268
Ayala Bekera442b762016-09-20 17:31:15 +030011269static int validate_nan_filter(struct nlattr *filter_attr)
11270{
11271 struct nlattr *attr;
11272 int len = 0, n_entries = 0, rem;
11273
11274 nla_for_each_nested(attr, filter_attr, rem) {
11275 len += nla_len(attr);
11276 n_entries++;
11277 }
11278
11279 if (len >= U8_MAX)
11280 return -EINVAL;
11281
11282 return n_entries;
11283}
11284
11285static int handle_nan_filter(struct nlattr *attr_filter,
11286 struct cfg80211_nan_func *func,
11287 bool tx)
11288{
11289 struct nlattr *attr;
11290 int n_entries, rem, i;
11291 struct cfg80211_nan_func_filter *filter;
11292
11293 n_entries = validate_nan_filter(attr_filter);
11294 if (n_entries < 0)
11295 return n_entries;
11296
11297 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
11298
11299 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
11300 if (!filter)
11301 return -ENOMEM;
11302
11303 i = 0;
11304 nla_for_each_nested(attr, attr_filter, rem) {
Thomas Grafb15ca182016-10-26 10:53:16 +020011305 filter[i].filter = nla_memdup(attr, GFP_KERNEL);
Ayala Bekera442b762016-09-20 17:31:15 +030011306 filter[i].len = nla_len(attr);
11307 i++;
11308 }
11309 if (tx) {
11310 func->num_tx_filters = n_entries;
11311 func->tx_filters = filter;
11312 } else {
11313 func->num_rx_filters = n_entries;
11314 func->rx_filters = filter;
11315 }
11316
11317 return 0;
11318}
11319
11320static int nl80211_nan_add_func(struct sk_buff *skb,
11321 struct genl_info *info)
11322{
11323 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11324 struct wireless_dev *wdev = info->user_ptr[1];
11325 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
11326 struct cfg80211_nan_func *func;
11327 struct sk_buff *msg = NULL;
11328 void *hdr = NULL;
11329 int err = 0;
11330
11331 if (wdev->iftype != NL80211_IFTYPE_NAN)
11332 return -EOPNOTSUPP;
11333
Arend Van Spriel73c7da32016-10-20 20:08:22 +010011334 if (!wdev_running(wdev))
Ayala Bekera442b762016-09-20 17:31:15 +030011335 return -ENOTCONN;
11336
11337 if (!info->attrs[NL80211_ATTR_NAN_FUNC])
11338 return -EINVAL;
11339
Johannes Bergbfe2c7b2016-10-26 14:42:21 +020011340 err = nla_parse_nested(tb, NL80211_NAN_FUNC_ATTR_MAX,
11341 info->attrs[NL80211_ATTR_NAN_FUNC],
Johannes Bergfe521452017-04-12 14:34:08 +020011342 nl80211_nan_func_policy, info->extack);
Ayala Bekera442b762016-09-20 17:31:15 +030011343 if (err)
11344 return err;
11345
11346 func = kzalloc(sizeof(*func), GFP_KERNEL);
11347 if (!func)
11348 return -ENOMEM;
11349
11350 func->cookie = wdev->wiphy->cookie_counter++;
11351
11352 if (!tb[NL80211_NAN_FUNC_TYPE] ||
11353 nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
11354 err = -EINVAL;
11355 goto out;
11356 }
11357
11358
11359 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
11360
11361 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
11362 err = -EINVAL;
11363 goto out;
11364 }
11365
11366 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
11367 sizeof(func->service_id));
11368
11369 func->close_range =
11370 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
11371
11372 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
11373 func->serv_spec_info_len =
11374 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
11375 func->serv_spec_info =
11376 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
11377 func->serv_spec_info_len,
11378 GFP_KERNEL);
11379 if (!func->serv_spec_info) {
11380 err = -ENOMEM;
11381 goto out;
11382 }
11383 }
11384
11385 if (tb[NL80211_NAN_FUNC_TTL])
11386 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
11387
11388 switch (func->type) {
11389 case NL80211_NAN_FUNC_PUBLISH:
11390 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
11391 err = -EINVAL;
11392 goto out;
11393 }
11394
11395 func->publish_type =
11396 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
11397 func->publish_bcast =
11398 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
11399
11400 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
11401 func->publish_bcast) {
11402 err = -EINVAL;
11403 goto out;
11404 }
11405 break;
11406 case NL80211_NAN_FUNC_SUBSCRIBE:
11407 func->subscribe_active =
11408 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
11409 break;
11410 case NL80211_NAN_FUNC_FOLLOW_UP:
11411 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
Hao Chen3ea15452018-01-03 11:00:31 +080011412 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
11413 !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
Ayala Bekera442b762016-09-20 17:31:15 +030011414 err = -EINVAL;
11415 goto out;
11416 }
11417
11418 func->followup_id =
11419 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
11420 func->followup_reqid =
11421 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
11422 memcpy(func->followup_dest.addr,
11423 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
11424 sizeof(func->followup_dest.addr));
11425 if (func->ttl) {
11426 err = -EINVAL;
11427 goto out;
11428 }
11429 break;
11430 default:
11431 err = -EINVAL;
11432 goto out;
11433 }
11434
11435 if (tb[NL80211_NAN_FUNC_SRF]) {
11436 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
11437
Johannes Bergbfe2c7b2016-10-26 14:42:21 +020011438 err = nla_parse_nested(srf_tb, NL80211_NAN_SRF_ATTR_MAX,
11439 tb[NL80211_NAN_FUNC_SRF],
Johannes Bergfe521452017-04-12 14:34:08 +020011440 nl80211_nan_srf_policy, info->extack);
Ayala Bekera442b762016-09-20 17:31:15 +030011441 if (err)
11442 goto out;
11443
11444 func->srf_include =
11445 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
11446
11447 if (srf_tb[NL80211_NAN_SRF_BF]) {
11448 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
11449 !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
11450 err = -EINVAL;
11451 goto out;
11452 }
11453
11454 func->srf_bf_len =
11455 nla_len(srf_tb[NL80211_NAN_SRF_BF]);
11456 func->srf_bf =
11457 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
11458 func->srf_bf_len, GFP_KERNEL);
11459 if (!func->srf_bf) {
11460 err = -ENOMEM;
11461 goto out;
11462 }
11463
11464 func->srf_bf_idx =
11465 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
11466 } else {
11467 struct nlattr *attr, *mac_attr =
11468 srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
11469 int n_entries, rem, i = 0;
11470
11471 if (!mac_attr) {
11472 err = -EINVAL;
11473 goto out;
11474 }
11475
11476 n_entries = validate_acl_mac_addrs(mac_attr);
11477 if (n_entries <= 0) {
11478 err = -EINVAL;
11479 goto out;
11480 }
11481
11482 func->srf_num_macs = n_entries;
11483 func->srf_macs =
11484 kzalloc(sizeof(*func->srf_macs) * n_entries,
11485 GFP_KERNEL);
11486 if (!func->srf_macs) {
11487 err = -ENOMEM;
11488 goto out;
11489 }
11490
11491 nla_for_each_nested(attr, mac_attr, rem)
11492 memcpy(func->srf_macs[i++].addr, nla_data(attr),
11493 sizeof(*func->srf_macs));
11494 }
11495 }
11496
11497 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
11498 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
11499 func, true);
11500 if (err)
11501 goto out;
11502 }
11503
11504 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
11505 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
11506 func, false);
11507 if (err)
11508 goto out;
11509 }
11510
11511 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11512 if (!msg) {
11513 err = -ENOMEM;
11514 goto out;
11515 }
11516
11517 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11518 NL80211_CMD_ADD_NAN_FUNCTION);
11519 /* This can't really happen - we just allocated 4KB */
11520 if (WARN_ON(!hdr)) {
11521 err = -ENOMEM;
11522 goto out;
11523 }
11524
11525 err = rdev_add_nan_func(rdev, wdev, func);
11526out:
11527 if (err < 0) {
11528 cfg80211_free_nan_func(func);
11529 nlmsg_free(msg);
11530 return err;
11531 }
11532
11533 /* propagate the instance id and cookie to userspace */
11534 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
11535 NL80211_ATTR_PAD))
11536 goto nla_put_failure;
11537
11538 func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
11539 if (!func_attr)
11540 goto nla_put_failure;
11541
11542 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
11543 func->instance_id))
11544 goto nla_put_failure;
11545
11546 nla_nest_end(msg, func_attr);
11547
11548 genlmsg_end(msg, hdr);
11549 return genlmsg_reply(msg, info);
11550
11551nla_put_failure:
11552 nlmsg_free(msg);
11553 return -ENOBUFS;
11554}
11555
11556static int nl80211_nan_del_func(struct sk_buff *skb,
11557 struct genl_info *info)
11558{
11559 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11560 struct wireless_dev *wdev = info->user_ptr[1];
11561 u64 cookie;
11562
11563 if (wdev->iftype != NL80211_IFTYPE_NAN)
11564 return -EOPNOTSUPP;
11565
Arend Van Spriel73c7da32016-10-20 20:08:22 +010011566 if (!wdev_running(wdev))
Ayala Bekera442b762016-09-20 17:31:15 +030011567 return -ENOTCONN;
11568
11569 if (!info->attrs[NL80211_ATTR_COOKIE])
11570 return -EINVAL;
11571
Ayala Bekera442b762016-09-20 17:31:15 +030011572 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
11573
11574 rdev_del_nan_func(rdev, wdev, cookie);
11575
11576 return 0;
11577}
11578
Ayala Bekera5a9dcf2016-09-20 17:31:16 +030011579static int nl80211_nan_change_config(struct sk_buff *skb,
11580 struct genl_info *info)
11581{
11582 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11583 struct wireless_dev *wdev = info->user_ptr[1];
11584 struct cfg80211_nan_conf conf = {};
11585 u32 changed = 0;
11586
11587 if (wdev->iftype != NL80211_IFTYPE_NAN)
11588 return -EOPNOTSUPP;
11589
Arend Van Spriel73c7da32016-10-20 20:08:22 +010011590 if (!wdev_running(wdev))
Ayala Bekera5a9dcf2016-09-20 17:31:16 +030011591 return -ENOTCONN;
11592
11593 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
11594 conf.master_pref =
11595 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
11596 if (conf.master_pref <= 1 || conf.master_pref == 255)
11597 return -EINVAL;
11598
11599 changed |= CFG80211_NAN_CONF_CHANGED_PREF;
11600 }
11601
Luca Coelho85859892017-02-08 15:00:34 +020011602 if (info->attrs[NL80211_ATTR_BANDS]) {
11603 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
11604
11605 if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
11606 return -EOPNOTSUPP;
11607
11608 if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
11609 return -EINVAL;
11610
11611 conf.bands = bands;
11612 changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
Ayala Bekera5a9dcf2016-09-20 17:31:16 +030011613 }
11614
11615 if (!changed)
11616 return -EINVAL;
11617
11618 return rdev_nan_change_conf(rdev, wdev, &conf, changed);
11619}
11620
Ayala Beker50bcd312016-09-20 17:31:17 +030011621void cfg80211_nan_match(struct wireless_dev *wdev,
11622 struct cfg80211_nan_match_params *match, gfp_t gfp)
11623{
11624 struct wiphy *wiphy = wdev->wiphy;
11625 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11626 struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
11627 struct sk_buff *msg;
11628 void *hdr;
11629
11630 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
11631 return;
11632
11633 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
11634 if (!msg)
11635 return;
11636
11637 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
11638 if (!hdr) {
11639 nlmsg_free(msg);
11640 return;
11641 }
11642
11643 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11644 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
11645 wdev->netdev->ifindex)) ||
11646 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
11647 NL80211_ATTR_PAD))
11648 goto nla_put_failure;
11649
11650 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
11651 NL80211_ATTR_PAD) ||
11652 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
11653 goto nla_put_failure;
11654
11655 match_attr = nla_nest_start(msg, NL80211_ATTR_NAN_MATCH);
11656 if (!match_attr)
11657 goto nla_put_failure;
11658
11659 local_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_LOCAL);
11660 if (!local_func_attr)
11661 goto nla_put_failure;
11662
11663 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
11664 goto nla_put_failure;
11665
11666 nla_nest_end(msg, local_func_attr);
11667
11668 peer_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_PEER);
11669 if (!peer_func_attr)
11670 goto nla_put_failure;
11671
11672 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
11673 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
11674 goto nla_put_failure;
11675
11676 if (match->info && match->info_len &&
11677 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
11678 match->info))
11679 goto nla_put_failure;
11680
11681 nla_nest_end(msg, peer_func_attr);
11682 nla_nest_end(msg, match_attr);
11683 genlmsg_end(msg, hdr);
11684
11685 if (!wdev->owner_nlportid)
11686 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11687 msg, 0, NL80211_MCGRP_NAN, gfp);
11688 else
11689 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11690 wdev->owner_nlportid);
11691
11692 return;
11693
11694nla_put_failure:
11695 nlmsg_free(msg);
11696}
11697EXPORT_SYMBOL(cfg80211_nan_match);
11698
Ayala Beker368e5a72016-09-20 17:31:18 +030011699void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
11700 u8 inst_id,
11701 enum nl80211_nan_func_term_reason reason,
11702 u64 cookie, gfp_t gfp)
11703{
11704 struct wiphy *wiphy = wdev->wiphy;
11705 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11706 struct sk_buff *msg;
11707 struct nlattr *func_attr;
11708 void *hdr;
11709
11710 if (WARN_ON(!inst_id))
11711 return;
11712
11713 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
11714 if (!msg)
11715 return;
11716
11717 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
11718 if (!hdr) {
11719 nlmsg_free(msg);
11720 return;
11721 }
11722
11723 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11724 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
11725 wdev->netdev->ifindex)) ||
11726 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
11727 NL80211_ATTR_PAD))
11728 goto nla_put_failure;
11729
11730 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
11731 NL80211_ATTR_PAD))
11732 goto nla_put_failure;
11733
11734 func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
11735 if (!func_attr)
11736 goto nla_put_failure;
11737
11738 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
11739 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
11740 goto nla_put_failure;
11741
11742 nla_nest_end(msg, func_attr);
11743 genlmsg_end(msg, hdr);
11744
11745 if (!wdev->owner_nlportid)
11746 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11747 msg, 0, NL80211_MCGRP_NAN, gfp);
11748 else
11749 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11750 wdev->owner_nlportid);
11751
11752 return;
11753
11754nla_put_failure:
11755 nlmsg_free(msg);
11756}
11757EXPORT_SYMBOL(cfg80211_nan_func_terminated);
11758
Johannes Berg3713b4e2013-02-14 16:19:38 +010011759static int nl80211_get_protocol_features(struct sk_buff *skb,
11760 struct genl_info *info)
11761{
11762 void *hdr;
11763 struct sk_buff *msg;
11764
11765 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11766 if (!msg)
11767 return -ENOMEM;
11768
11769 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11770 NL80211_CMD_GET_PROTOCOL_FEATURES);
11771 if (!hdr)
11772 goto nla_put_failure;
11773
11774 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
11775 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
11776 goto nla_put_failure;
11777
11778 genlmsg_end(msg, hdr);
11779 return genlmsg_reply(msg, info);
11780
11781 nla_put_failure:
11782 kfree_skb(msg);
11783 return -ENOBUFS;
11784}
11785
Jouni Malinen355199e2013-02-27 17:14:27 +020011786static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
11787{
11788 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11789 struct cfg80211_update_ft_ies_params ft_params;
11790 struct net_device *dev = info->user_ptr[1];
11791
11792 if (!rdev->ops->update_ft_ies)
11793 return -EOPNOTSUPP;
11794
11795 if (!info->attrs[NL80211_ATTR_MDID] ||
11796 !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
11797 return -EINVAL;
11798
11799 memset(&ft_params, 0, sizeof(ft_params));
11800 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
11801 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
11802 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
11803
11804 return rdev_update_ft_ies(rdev, dev, &ft_params);
11805}
11806
Arend van Spriel5de17982013-04-18 15:49:00 +020011807static int nl80211_crit_protocol_start(struct sk_buff *skb,
11808 struct genl_info *info)
11809{
11810 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11811 struct wireless_dev *wdev = info->user_ptr[1];
11812 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
11813 u16 duration;
11814 int ret;
11815
11816 if (!rdev->ops->crit_proto_start)
11817 return -EOPNOTSUPP;
11818
11819 if (WARN_ON(!rdev->ops->crit_proto_stop))
11820 return -EINVAL;
11821
11822 if (rdev->crit_proto_nlportid)
11823 return -EBUSY;
11824
11825 /* determine protocol if provided */
11826 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
11827 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
11828
11829 if (proto >= NUM_NL80211_CRIT_PROTO)
11830 return -EINVAL;
11831
11832 /* timeout must be provided */
11833 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
11834 return -EINVAL;
11835
11836 duration =
11837 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
11838
11839 if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
11840 return -ERANGE;
11841
11842 ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
11843 if (!ret)
11844 rdev->crit_proto_nlportid = info->snd_portid;
11845
11846 return ret;
11847}
11848
11849static int nl80211_crit_protocol_stop(struct sk_buff *skb,
11850 struct genl_info *info)
11851{
11852 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11853 struct wireless_dev *wdev = info->user_ptr[1];
11854
11855 if (!rdev->ops->crit_proto_stop)
11856 return -EOPNOTSUPP;
11857
11858 if (rdev->crit_proto_nlportid) {
11859 rdev->crit_proto_nlportid = 0;
11860 rdev_crit_proto_stop(rdev, wdev);
11861 }
11862 return 0;
11863}
11864
Johannes Bergad7e7182013-11-13 13:37:47 +010011865static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
11866{
11867 struct cfg80211_registered_device *rdev = info->user_ptr[0];
11868 struct wireless_dev *wdev =
11869 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
11870 int i, err;
11871 u32 vid, subcmd;
11872
11873 if (!rdev->wiphy.vendor_commands)
11874 return -EOPNOTSUPP;
11875
11876 if (IS_ERR(wdev)) {
11877 err = PTR_ERR(wdev);
11878 if (err != -EINVAL)
11879 return err;
11880 wdev = NULL;
11881 } else if (wdev->wiphy != &rdev->wiphy) {
11882 return -EINVAL;
11883 }
11884
11885 if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
11886 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
11887 return -EINVAL;
11888
11889 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
11890 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
11891 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
11892 const struct wiphy_vendor_command *vcmd;
11893 void *data = NULL;
11894 int len = 0;
11895
11896 vcmd = &rdev->wiphy.vendor_commands[i];
11897
11898 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11899 continue;
11900
11901 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
11902 WIPHY_VENDOR_CMD_NEED_NETDEV)) {
11903 if (!wdev)
11904 return -EINVAL;
11905 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
11906 !wdev->netdev)
11907 return -EINVAL;
11908
11909 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
Arend Van Spriel73c7da32016-10-20 20:08:22 +010011910 if (!wdev_running(wdev))
Johannes Bergad7e7182013-11-13 13:37:47 +010011911 return -ENETDOWN;
11912 }
Johannes Berg7bdbe402015-08-15 22:39:49 +030011913
11914 if (!vcmd->doit)
11915 return -EOPNOTSUPP;
Johannes Bergad7e7182013-11-13 13:37:47 +010011916 } else {
11917 wdev = NULL;
11918 }
11919
11920 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
11921 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11922 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11923 }
11924
11925 rdev->cur_cmd_info = info;
11926 err = rdev->wiphy.vendor_commands[i].doit(&rdev->wiphy, wdev,
11927 data, len);
11928 rdev->cur_cmd_info = NULL;
11929 return err;
11930 }
11931
11932 return -EOPNOTSUPP;
11933}
11934
Johannes Berg7bdbe402015-08-15 22:39:49 +030011935static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
11936 struct netlink_callback *cb,
11937 struct cfg80211_registered_device **rdev,
11938 struct wireless_dev **wdev)
11939{
Johannes Bergc90c39d2016-10-24 14:40:01 +020011940 struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
Johannes Berg7bdbe402015-08-15 22:39:49 +030011941 u32 vid, subcmd;
11942 unsigned int i;
11943 int vcmd_idx = -1;
11944 int err;
11945 void *data = NULL;
11946 unsigned int data_len = 0;
11947
Johannes Berg7bdbe402015-08-15 22:39:49 +030011948 if (cb->args[0]) {
11949 /* subtract the 1 again here */
11950 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
11951 struct wireless_dev *tmp;
11952
Johannes Bergea90e0d2017-03-15 14:26:04 +010011953 if (!wiphy)
11954 return -ENODEV;
Johannes Berg7bdbe402015-08-15 22:39:49 +030011955 *rdev = wiphy_to_rdev(wiphy);
11956 *wdev = NULL;
11957
11958 if (cb->args[1]) {
Johannes Berg53873f12016-05-03 16:52:04 +030011959 list_for_each_entry(tmp, &wiphy->wdev_list, list) {
Johannes Berg7bdbe402015-08-15 22:39:49 +030011960 if (tmp->identifier == cb->args[1] - 1) {
11961 *wdev = tmp;
11962 break;
11963 }
11964 }
11965 }
11966
11967 /* keep rtnl locked in successful case */
11968 return 0;
11969 }
11970
Johannes Bergfceb6432017-04-12 14:34:07 +020011971 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize, attrbuf,
11972 nl80211_fam.maxattr, nl80211_policy, NULL);
Johannes Berg7bdbe402015-08-15 22:39:49 +030011973 if (err)
Johannes Bergea90e0d2017-03-15 14:26:04 +010011974 return err;
Johannes Berg7bdbe402015-08-15 22:39:49 +030011975
Johannes Bergc90c39d2016-10-24 14:40:01 +020011976 if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
Johannes Bergea90e0d2017-03-15 14:26:04 +010011977 !attrbuf[NL80211_ATTR_VENDOR_SUBCMD])
11978 return -EINVAL;
Johannes Berg7bdbe402015-08-15 22:39:49 +030011979
Johannes Bergc90c39d2016-10-24 14:40:01 +020011980 *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk), attrbuf);
Johannes Berg7bdbe402015-08-15 22:39:49 +030011981 if (IS_ERR(*wdev))
11982 *wdev = NULL;
11983
Johannes Bergc90c39d2016-10-24 14:40:01 +020011984 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
Johannes Bergea90e0d2017-03-15 14:26:04 +010011985 if (IS_ERR(*rdev))
11986 return PTR_ERR(*rdev);
Johannes Berg7bdbe402015-08-15 22:39:49 +030011987
Johannes Bergc90c39d2016-10-24 14:40:01 +020011988 vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
11989 subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
Johannes Berg7bdbe402015-08-15 22:39:49 +030011990
11991 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
11992 const struct wiphy_vendor_command *vcmd;
11993
11994 vcmd = &(*rdev)->wiphy.vendor_commands[i];
11995
11996 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11997 continue;
11998
Johannes Bergea90e0d2017-03-15 14:26:04 +010011999 if (!vcmd->dumpit)
12000 return -EOPNOTSUPP;
Johannes Berg7bdbe402015-08-15 22:39:49 +030012001
12002 vcmd_idx = i;
12003 break;
12004 }
12005
Johannes Bergea90e0d2017-03-15 14:26:04 +010012006 if (vcmd_idx < 0)
12007 return -EOPNOTSUPP;
Johannes Berg7bdbe402015-08-15 22:39:49 +030012008
Johannes Bergc90c39d2016-10-24 14:40:01 +020012009 if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
12010 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
12011 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
Johannes Berg7bdbe402015-08-15 22:39:49 +030012012 }
12013
12014 /* 0 is the first index - add 1 to parse only once */
12015 cb->args[0] = (*rdev)->wiphy_idx + 1;
12016 /* add 1 to know if it was NULL */
12017 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
12018 cb->args[2] = vcmd_idx;
12019 cb->args[3] = (unsigned long)data;
12020 cb->args[4] = data_len;
12021
12022 /* keep rtnl locked in successful case */
12023 return 0;
Johannes Berg7bdbe402015-08-15 22:39:49 +030012024}
12025
12026static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
12027 struct netlink_callback *cb)
12028{
12029 struct cfg80211_registered_device *rdev;
12030 struct wireless_dev *wdev;
12031 unsigned int vcmd_idx;
12032 const struct wiphy_vendor_command *vcmd;
12033 void *data;
12034 int data_len;
12035 int err;
12036 struct nlattr *vendor_data;
12037
Johannes Bergea90e0d2017-03-15 14:26:04 +010012038 rtnl_lock();
Johannes Berg7bdbe402015-08-15 22:39:49 +030012039 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
12040 if (err)
Johannes Bergea90e0d2017-03-15 14:26:04 +010012041 goto out;
Johannes Berg7bdbe402015-08-15 22:39:49 +030012042
12043 vcmd_idx = cb->args[2];
12044 data = (void *)cb->args[3];
12045 data_len = cb->args[4];
12046 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
12047
12048 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
12049 WIPHY_VENDOR_CMD_NEED_NETDEV)) {
Johannes Bergea90e0d2017-03-15 14:26:04 +010012050 if (!wdev) {
12051 err = -EINVAL;
12052 goto out;
12053 }
Johannes Berg7bdbe402015-08-15 22:39:49 +030012054 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
Johannes Bergea90e0d2017-03-15 14:26:04 +010012055 !wdev->netdev) {
12056 err = -EINVAL;
12057 goto out;
12058 }
Johannes Berg7bdbe402015-08-15 22:39:49 +030012059
12060 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
Johannes Bergea90e0d2017-03-15 14:26:04 +010012061 if (!wdev_running(wdev)) {
12062 err = -ENETDOWN;
12063 goto out;
12064 }
Johannes Berg7bdbe402015-08-15 22:39:49 +030012065 }
12066 }
12067
12068 while (1) {
12069 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
12070 cb->nlh->nlmsg_seq, NLM_F_MULTI,
12071 NL80211_CMD_VENDOR);
12072 if (!hdr)
12073 break;
12074
12075 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020012076 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
12077 wdev_id(wdev),
12078 NL80211_ATTR_PAD))) {
Johannes Berg7bdbe402015-08-15 22:39:49 +030012079 genlmsg_cancel(skb, hdr);
12080 break;
12081 }
12082
12083 vendor_data = nla_nest_start(skb, NL80211_ATTR_VENDOR_DATA);
12084 if (!vendor_data) {
12085 genlmsg_cancel(skb, hdr);
12086 break;
12087 }
12088
12089 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
12090 (unsigned long *)&cb->args[5]);
12091 nla_nest_end(skb, vendor_data);
12092
12093 if (err == -ENOBUFS || err == -ENOENT) {
12094 genlmsg_cancel(skb, hdr);
12095 break;
12096 } else if (err) {
12097 genlmsg_cancel(skb, hdr);
12098 goto out;
12099 }
12100
12101 genlmsg_end(skb, hdr);
12102 }
12103
12104 err = skb->len;
12105 out:
12106 rtnl_unlock();
12107 return err;
12108}
12109
Johannes Bergad7e7182013-11-13 13:37:47 +010012110struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
12111 enum nl80211_commands cmd,
12112 enum nl80211_attrs attr,
12113 int approxlen)
12114{
Zhao, Gangf26cbf42014-04-21 12:53:03 +080012115 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Bergad7e7182013-11-13 13:37:47 +010012116
12117 if (WARN_ON(!rdev->cur_cmd_info))
12118 return NULL;
12119
Ahmad Kholaif6c09e792015-02-26 15:26:53 +020012120 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
Johannes Bergad7e7182013-11-13 13:37:47 +010012121 rdev->cur_cmd_info->snd_portid,
12122 rdev->cur_cmd_info->snd_seq,
Johannes Berg567ffc32013-12-18 14:43:31 +010012123 cmd, attr, NULL, GFP_KERNEL);
Johannes Bergad7e7182013-11-13 13:37:47 +010012124}
12125EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
12126
12127int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
12128{
12129 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
12130 void *hdr = ((void **)skb->cb)[1];
12131 struct nlattr *data = ((void **)skb->cb)[2];
12132
Johannes Bergbd8c78e2014-07-30 14:55:26 +020012133 /* clear CB data for netlink core to own from now on */
12134 memset(skb->cb, 0, sizeof(skb->cb));
12135
Johannes Bergad7e7182013-11-13 13:37:47 +010012136 if (WARN_ON(!rdev->cur_cmd_info)) {
12137 kfree_skb(skb);
12138 return -EINVAL;
12139 }
12140
12141 nla_nest_end(skb, data);
12142 genlmsg_end(skb, hdr);
12143 return genlmsg_reply(skb, rdev->cur_cmd_info);
12144}
12145EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
12146
Kyeyoon Parkfa9ffc72013-12-16 23:01:30 -080012147static int nl80211_set_qos_map(struct sk_buff *skb,
12148 struct genl_info *info)
12149{
12150 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12151 struct cfg80211_qos_map *qos_map = NULL;
12152 struct net_device *dev = info->user_ptr[1];
12153 u8 *pos, len, num_des, des_len, des;
12154 int ret;
12155
12156 if (!rdev->ops->set_qos_map)
12157 return -EOPNOTSUPP;
12158
12159 if (info->attrs[NL80211_ATTR_QOS_MAP]) {
12160 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
12161 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
12162
12163 if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
12164 len > IEEE80211_QOS_MAP_LEN_MAX)
12165 return -EINVAL;
12166
12167 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
12168 if (!qos_map)
12169 return -ENOMEM;
12170
12171 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
12172 if (num_des) {
12173 des_len = num_des *
12174 sizeof(struct cfg80211_dscp_exception);
12175 memcpy(qos_map->dscp_exception, pos, des_len);
12176 qos_map->num_des = num_des;
12177 for (des = 0; des < num_des; des++) {
12178 if (qos_map->dscp_exception[des].up > 7) {
12179 kfree(qos_map);
12180 return -EINVAL;
12181 }
12182 }
12183 pos += des_len;
12184 }
12185 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
12186 }
12187
12188 wdev_lock(dev->ieee80211_ptr);
12189 ret = nl80211_key_allowed(dev->ieee80211_ptr);
12190 if (!ret)
12191 ret = rdev_set_qos_map(rdev, dev, qos_map);
12192 wdev_unlock(dev->ieee80211_ptr);
12193
12194 kfree(qos_map);
12195 return ret;
12196}
12197
Johannes Berg960d01a2014-09-09 22:55:35 +030012198static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
12199{
12200 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12201 struct net_device *dev = info->user_ptr[1];
12202 struct wireless_dev *wdev = dev->ieee80211_ptr;
12203 const u8 *peer;
12204 u8 tsid, up;
12205 u16 admitted_time = 0;
12206 int err;
12207
Johannes Berg723e73a2014-10-22 09:25:06 +020012208 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
Johannes Berg960d01a2014-09-09 22:55:35 +030012209 return -EOPNOTSUPP;
12210
12211 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
12212 !info->attrs[NL80211_ATTR_USER_PRIO])
12213 return -EINVAL;
12214
12215 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
12216 if (tsid >= IEEE80211_NUM_TIDS)
12217 return -EINVAL;
12218
12219 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
12220 if (up >= IEEE80211_NUM_UPS)
12221 return -EINVAL;
12222
12223 /* WMM uses TIDs 0-7 even for TSPEC */
Johannes Berg723e73a2014-10-22 09:25:06 +020012224 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
Johannes Berg960d01a2014-09-09 22:55:35 +030012225 /* TODO: handle 802.11 TSPEC/admission control
Johannes Berg723e73a2014-10-22 09:25:06 +020012226 * need more attributes for that (e.g. BA session requirement);
12227 * change the WMM adminssion test above to allow both then
Johannes Berg960d01a2014-09-09 22:55:35 +030012228 */
12229 return -EINVAL;
12230 }
12231
12232 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12233
12234 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
12235 admitted_time =
12236 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
12237 if (!admitted_time)
12238 return -EINVAL;
12239 }
12240
12241 wdev_lock(wdev);
12242 switch (wdev->iftype) {
12243 case NL80211_IFTYPE_STATION:
12244 case NL80211_IFTYPE_P2P_CLIENT:
12245 if (wdev->current_bss)
12246 break;
12247 err = -ENOTCONN;
12248 goto out;
12249 default:
12250 err = -EOPNOTSUPP;
12251 goto out;
12252 }
12253
12254 err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
12255
12256 out:
12257 wdev_unlock(wdev);
12258 return err;
12259}
12260
12261static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
12262{
12263 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12264 struct net_device *dev = info->user_ptr[1];
12265 struct wireless_dev *wdev = dev->ieee80211_ptr;
12266 const u8 *peer;
12267 u8 tsid;
12268 int err;
12269
12270 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
12271 return -EINVAL;
12272
12273 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
12274 peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12275
12276 wdev_lock(wdev);
12277 err = rdev_del_tx_ts(rdev, dev, tsid, peer);
12278 wdev_unlock(wdev);
12279
12280 return err;
12281}
12282
Arik Nemtsov1057d352014-11-19 12:54:26 +020012283static int nl80211_tdls_channel_switch(struct sk_buff *skb,
12284 struct genl_info *info)
12285{
12286 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12287 struct net_device *dev = info->user_ptr[1];
12288 struct wireless_dev *wdev = dev->ieee80211_ptr;
12289 struct cfg80211_chan_def chandef = {};
12290 const u8 *addr;
12291 u8 oper_class;
12292 int err;
12293
12294 if (!rdev->ops->tdls_channel_switch ||
12295 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
12296 return -EOPNOTSUPP;
12297
12298 switch (dev->ieee80211_ptr->iftype) {
12299 case NL80211_IFTYPE_STATION:
12300 case NL80211_IFTYPE_P2P_CLIENT:
12301 break;
12302 default:
12303 return -EOPNOTSUPP;
12304 }
12305
12306 if (!info->attrs[NL80211_ATTR_MAC] ||
12307 !info->attrs[NL80211_ATTR_OPER_CLASS])
12308 return -EINVAL;
12309
12310 err = nl80211_parse_chandef(rdev, info, &chandef);
12311 if (err)
12312 return err;
12313
12314 /*
12315 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
12316 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
12317 * specification is not defined for them.
12318 */
Johannes Berg57fbcce2016-04-12 15:56:15 +020012319 if (chandef.chan->band == NL80211_BAND_2GHZ &&
Arik Nemtsov1057d352014-11-19 12:54:26 +020012320 chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
12321 chandef.width != NL80211_CHAN_WIDTH_20)
12322 return -EINVAL;
12323
12324 /* we will be active on the TDLS link */
Arik Nemtsov923b3522015-07-08 15:41:44 +030012325 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
12326 wdev->iftype))
Arik Nemtsov1057d352014-11-19 12:54:26 +020012327 return -EINVAL;
12328
12329 /* don't allow switching to DFS channels */
12330 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
12331 return -EINVAL;
12332
12333 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
12334 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
12335
12336 wdev_lock(wdev);
12337 err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
12338 wdev_unlock(wdev);
12339
12340 return err;
12341}
12342
12343static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
12344 struct genl_info *info)
12345{
12346 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12347 struct net_device *dev = info->user_ptr[1];
12348 struct wireless_dev *wdev = dev->ieee80211_ptr;
12349 const u8 *addr;
12350
12351 if (!rdev->ops->tdls_channel_switch ||
12352 !rdev->ops->tdls_cancel_channel_switch ||
12353 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
12354 return -EOPNOTSUPP;
12355
12356 switch (dev->ieee80211_ptr->iftype) {
12357 case NL80211_IFTYPE_STATION:
12358 case NL80211_IFTYPE_P2P_CLIENT:
12359 break;
12360 default:
12361 return -EOPNOTSUPP;
12362 }
12363
12364 if (!info->attrs[NL80211_ATTR_MAC])
12365 return -EINVAL;
12366
12367 addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
12368
12369 wdev_lock(wdev);
12370 rdev_tdls_cancel_channel_switch(rdev, dev, addr);
12371 wdev_unlock(wdev);
12372
12373 return 0;
12374}
12375
Michael Braunce0ce132016-10-10 19:12:22 +020012376static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
12377 struct genl_info *info)
12378{
12379 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12380 struct net_device *dev = info->user_ptr[1];
12381 struct wireless_dev *wdev = dev->ieee80211_ptr;
12382 const struct nlattr *nla;
12383 bool enabled;
12384
Michael Braunce0ce132016-10-10 19:12:22 +020012385 if (!rdev->ops->set_multicast_to_unicast)
12386 return -EOPNOTSUPP;
12387
12388 if (wdev->iftype != NL80211_IFTYPE_AP &&
12389 wdev->iftype != NL80211_IFTYPE_P2P_GO)
12390 return -EOPNOTSUPP;
12391
12392 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
12393 enabled = nla_get_flag(nla);
12394
12395 return rdev_set_multicast_to_unicast(rdev, dev, enabled);
12396}
12397
Avraham Stern3a00df52017-06-09 13:08:43 +010012398static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info)
12399{
12400 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12401 struct net_device *dev = info->user_ptr[1];
12402 struct wireless_dev *wdev = dev->ieee80211_ptr;
12403 struct cfg80211_pmk_conf pmk_conf = {};
12404 int ret;
12405
12406 if (wdev->iftype != NL80211_IFTYPE_STATION &&
12407 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
12408 return -EOPNOTSUPP;
12409
12410 if (!wiphy_ext_feature_isset(&rdev->wiphy,
12411 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
12412 return -EOPNOTSUPP;
12413
12414 if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK])
12415 return -EINVAL;
12416
12417 wdev_lock(wdev);
12418 if (!wdev->current_bss) {
12419 ret = -ENOTCONN;
12420 goto out;
12421 }
12422
12423 pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
12424 if (memcmp(pmk_conf.aa, wdev->current_bss->pub.bssid, ETH_ALEN)) {
12425 ret = -EINVAL;
12426 goto out;
12427 }
12428
12429 pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
12430 pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
12431 if (pmk_conf.pmk_len != WLAN_PMK_LEN &&
12432 pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) {
12433 ret = -EINVAL;
12434 goto out;
12435 }
12436
12437 if (info->attrs[NL80211_ATTR_PMKR0_NAME]) {
12438 int r0_name_len = nla_len(info->attrs[NL80211_ATTR_PMKR0_NAME]);
12439
12440 if (r0_name_len != WLAN_PMK_NAME_LEN) {
12441 ret = -EINVAL;
12442 goto out;
12443 }
12444
12445 pmk_conf.pmk_r0_name =
12446 nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]);
12447 }
12448
12449 ret = rdev_set_pmk(rdev, dev, &pmk_conf);
12450out:
12451 wdev_unlock(wdev);
12452 return ret;
12453}
12454
12455static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info)
12456{
12457 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12458 struct net_device *dev = info->user_ptr[1];
12459 struct wireless_dev *wdev = dev->ieee80211_ptr;
12460 const u8 *aa;
12461 int ret;
12462
12463 if (wdev->iftype != NL80211_IFTYPE_STATION &&
12464 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
12465 return -EOPNOTSUPP;
12466
12467 if (!wiphy_ext_feature_isset(&rdev->wiphy,
12468 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
12469 return -EOPNOTSUPP;
12470
12471 if (!info->attrs[NL80211_ATTR_MAC])
12472 return -EINVAL;
12473
12474 wdev_lock(wdev);
12475 aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
12476 ret = rdev_del_pmk(rdev, dev, aa);
12477 wdev_unlock(wdev);
12478
12479 return ret;
12480}
12481
Srinivas Dasari40cbfa92018-01-25 17:13:38 +020012482static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info)
12483{
12484 struct cfg80211_registered_device *rdev = info->user_ptr[0];
12485 struct net_device *dev = info->user_ptr[1];
12486 struct cfg80211_external_auth_params params;
12487
12488 if (rdev->ops->external_auth)
12489 return -EOPNOTSUPP;
12490
12491 if (!info->attrs[NL80211_ATTR_SSID])
12492 return -EINVAL;
12493
12494 if (!info->attrs[NL80211_ATTR_BSSID])
12495 return -EINVAL;
12496
12497 if (!info->attrs[NL80211_ATTR_STATUS_CODE])
12498 return -EINVAL;
12499
12500 memset(&params, 0, sizeof(params));
12501
12502 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
12503 if (params.ssid.ssid_len == 0 ||
12504 params.ssid.ssid_len > IEEE80211_MAX_SSID_LEN)
12505 return -EINVAL;
12506 memcpy(params.ssid.ssid, nla_data(info->attrs[NL80211_ATTR_SSID]),
12507 params.ssid.ssid_len);
12508
12509 memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]),
12510 ETH_ALEN);
12511
12512 params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
12513
12514 return rdev_external_auth(rdev, dev, &params);
12515}
12516
Johannes Berg4c476992010-10-04 21:36:35 +020012517#define NL80211_FLAG_NEED_WIPHY 0x01
12518#define NL80211_FLAG_NEED_NETDEV 0x02
12519#define NL80211_FLAG_NEED_RTNL 0x04
Johannes Berg41265712010-10-04 21:14:05 +020012520#define NL80211_FLAG_CHECK_NETDEV_UP 0x08
12521#define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
12522 NL80211_FLAG_CHECK_NETDEV_UP)
Johannes Berg1bf614e2012-06-15 15:23:36 +020012523#define NL80211_FLAG_NEED_WDEV 0x10
Johannes Berg98104fde2012-06-16 00:19:54 +020012524/* If a netdev is associated, it must be UP, P2P must be started */
Johannes Berg1bf614e2012-06-15 15:23:36 +020012525#define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
12526 NL80211_FLAG_CHECK_NETDEV_UP)
Johannes Berg5393b912014-09-10 15:00:16 +030012527#define NL80211_FLAG_CLEAR_SKB 0x20
Johannes Berg4c476992010-10-04 21:36:35 +020012528
Johannes Bergf84f7712013-11-14 17:14:45 +010012529static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
Johannes Berg4c476992010-10-04 21:36:35 +020012530 struct genl_info *info)
12531{
12532 struct cfg80211_registered_device *rdev;
Johannes Berg89a54e42012-06-15 14:33:17 +020012533 struct wireless_dev *wdev;
Johannes Berg4c476992010-10-04 21:36:35 +020012534 struct net_device *dev;
Johannes Berg4c476992010-10-04 21:36:35 +020012535 bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
12536
12537 if (rtnl)
12538 rtnl_lock();
12539
12540 if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
Johannes Berg4f7eff12012-06-15 14:14:22 +020012541 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
Johannes Berg4c476992010-10-04 21:36:35 +020012542 if (IS_ERR(rdev)) {
12543 if (rtnl)
12544 rtnl_unlock();
12545 return PTR_ERR(rdev);
12546 }
12547 info->user_ptr[0] = rdev;
Johannes Berg1bf614e2012-06-15 15:23:36 +020012548 } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
12549 ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
Johannes Berg5fe231e2013-05-08 21:45:15 +020012550 ASSERT_RTNL();
12551
Johannes Berg89a54e42012-06-15 14:33:17 +020012552 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
12553 info->attrs);
12554 if (IS_ERR(wdev)) {
Johannes Berg4c476992010-10-04 21:36:35 +020012555 if (rtnl)
12556 rtnl_unlock();
Johannes Berg89a54e42012-06-15 14:33:17 +020012557 return PTR_ERR(wdev);
Johannes Berg4c476992010-10-04 21:36:35 +020012558 }
Johannes Berg89a54e42012-06-15 14:33:17 +020012559
Johannes Berg89a54e42012-06-15 14:33:17 +020012560 dev = wdev->netdev;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080012561 rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Berg89a54e42012-06-15 14:33:17 +020012562
Johannes Berg1bf614e2012-06-15 15:23:36 +020012563 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
12564 if (!dev) {
Johannes Berg1bf614e2012-06-15 15:23:36 +020012565 if (rtnl)
12566 rtnl_unlock();
12567 return -EINVAL;
12568 }
12569
12570 info->user_ptr[1] = dev;
12571 } else {
12572 info->user_ptr[1] = wdev;
Johannes Berg41265712010-10-04 21:14:05 +020012573 }
Johannes Berg89a54e42012-06-15 14:33:17 +020012574
Arend Van Spriel73c7da32016-10-20 20:08:22 +010012575 if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
12576 !wdev_running(wdev)) {
12577 if (rtnl)
12578 rtnl_unlock();
12579 return -ENETDOWN;
Johannes Berg1bf614e2012-06-15 15:23:36 +020012580 }
12581
Arend Van Spriel73c7da32016-10-20 20:08:22 +010012582 if (dev)
12583 dev_hold(dev);
12584
Johannes Berg4c476992010-10-04 21:36:35 +020012585 info->user_ptr[0] = rdev;
Johannes Berg4c476992010-10-04 21:36:35 +020012586 }
12587
12588 return 0;
12589}
12590
Johannes Bergf84f7712013-11-14 17:14:45 +010012591static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
Johannes Berg4c476992010-10-04 21:36:35 +020012592 struct genl_info *info)
12593{
Johannes Berg1bf614e2012-06-15 15:23:36 +020012594 if (info->user_ptr[1]) {
12595 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
12596 struct wireless_dev *wdev = info->user_ptr[1];
12597
12598 if (wdev->netdev)
12599 dev_put(wdev->netdev);
12600 } else {
12601 dev_put(info->user_ptr[1]);
12602 }
12603 }
Johannes Berg5393b912014-09-10 15:00:16 +030012604
Johannes Berg4c476992010-10-04 21:36:35 +020012605 if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
12606 rtnl_unlock();
Johannes Berg5393b912014-09-10 15:00:16 +030012607
12608 /* If needed, clear the netlink message payload from the SKB
12609 * as it might contain key data that shouldn't stick around on
12610 * the heap after the SKB is freed. The netlink message header
12611 * is still needed for further processing, so leave it intact.
12612 */
12613 if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
12614 struct nlmsghdr *nlh = nlmsg_hdr(skb);
12615
12616 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
12617 }
Johannes Berg4c476992010-10-04 21:36:35 +020012618}
12619
Johannes Berg4534de82013-11-14 17:14:46 +010012620static const struct genl_ops nl80211_ops[] = {
Johannes Berg55682962007-09-20 13:09:35 -040012621 {
12622 .cmd = NL80211_CMD_GET_WIPHY,
12623 .doit = nl80211_get_wiphy,
12624 .dumpit = nl80211_dump_wiphy,
Johannes Berg86e8cf92013-06-19 10:57:22 +020012625 .done = nl80211_dump_wiphy_done,
Johannes Berg55682962007-09-20 13:09:35 -040012626 .policy = nl80211_policy,
12627 /* can be retrieved by unprivileged users */
Johannes Berg5fe231e2013-05-08 21:45:15 +020012628 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12629 NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012630 },
12631 {
12632 .cmd = NL80211_CMD_SET_WIPHY,
12633 .doit = nl80211_set_wiphy,
12634 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012635 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012636 .internal_flags = NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012637 },
12638 {
12639 .cmd = NL80211_CMD_GET_INTERFACE,
12640 .doit = nl80211_get_interface,
12641 .dumpit = nl80211_dump_interface,
12642 .policy = nl80211_policy,
12643 /* can be retrieved by unprivileged users */
Johannes Berg5fe231e2013-05-08 21:45:15 +020012644 .internal_flags = NL80211_FLAG_NEED_WDEV |
12645 NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012646 },
12647 {
12648 .cmd = NL80211_CMD_SET_INTERFACE,
12649 .doit = nl80211_set_interface,
12650 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012651 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012652 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12653 NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012654 },
12655 {
12656 .cmd = NL80211_CMD_NEW_INTERFACE,
12657 .doit = nl80211_new_interface,
12658 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012659 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012660 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12661 NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012662 },
12663 {
12664 .cmd = NL80211_CMD_DEL_INTERFACE,
12665 .doit = nl80211_del_interface,
12666 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012667 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg84efbb82012-06-16 00:00:26 +020012668 .internal_flags = NL80211_FLAG_NEED_WDEV |
Johannes Berg4c476992010-10-04 21:36:35 +020012669 NL80211_FLAG_NEED_RTNL,
Johannes Berg55682962007-09-20 13:09:35 -040012670 },
Johannes Berg41ade002007-12-19 02:03:29 +010012671 {
12672 .cmd = NL80211_CMD_GET_KEY,
12673 .doit = nl80211_get_key,
12674 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012675 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012676 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012677 NL80211_FLAG_NEED_RTNL,
Johannes Berg41ade002007-12-19 02:03:29 +010012678 },
12679 {
12680 .cmd = NL80211_CMD_SET_KEY,
12681 .doit = nl80211_set_key,
12682 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012683 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012684 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg5393b912014-09-10 15:00:16 +030012685 NL80211_FLAG_NEED_RTNL |
12686 NL80211_FLAG_CLEAR_SKB,
Johannes Berg41ade002007-12-19 02:03:29 +010012687 },
12688 {
12689 .cmd = NL80211_CMD_NEW_KEY,
12690 .doit = nl80211_new_key,
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 Berg5393b912014-09-10 15:00:16 +030012694 NL80211_FLAG_NEED_RTNL |
12695 NL80211_FLAG_CLEAR_SKB,
Johannes Berg41ade002007-12-19 02:03:29 +010012696 },
12697 {
12698 .cmd = NL80211_CMD_DEL_KEY,
12699 .doit = nl80211_del_key,
12700 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012701 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012702 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012703 NL80211_FLAG_NEED_RTNL,
Johannes Berg41ade002007-12-19 02:03:29 +010012704 },
Johannes Berged1b6cc2007-12-19 02:03:32 +010012705 {
12706 .cmd = NL80211_CMD_SET_BEACON,
12707 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012708 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg88600202012-02-13 15:17:18 +010012709 .doit = nl80211_set_beacon,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012710 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012711 NL80211_FLAG_NEED_RTNL,
Johannes Berged1b6cc2007-12-19 02:03:32 +010012712 },
12713 {
Johannes Berg88600202012-02-13 15:17:18 +010012714 .cmd = NL80211_CMD_START_AP,
Johannes Berged1b6cc2007-12-19 02:03:32 +010012715 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012716 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg88600202012-02-13 15:17:18 +010012717 .doit = nl80211_start_ap,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012718 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012719 NL80211_FLAG_NEED_RTNL,
Johannes Berged1b6cc2007-12-19 02:03:32 +010012720 },
12721 {
Johannes Berg88600202012-02-13 15:17:18 +010012722 .cmd = NL80211_CMD_STOP_AP,
Johannes Berged1b6cc2007-12-19 02:03:32 +010012723 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012724 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg88600202012-02-13 15:17:18 +010012725 .doit = nl80211_stop_ap,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012726 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012727 NL80211_FLAG_NEED_RTNL,
Johannes Berged1b6cc2007-12-19 02:03:32 +010012728 },
Johannes Berg5727ef12007-12-19 02:03:34 +010012729 {
12730 .cmd = NL80211_CMD_GET_STATION,
12731 .doit = nl80211_get_station,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012732 .dumpit = nl80211_dump_station,
Johannes Berg5727ef12007-12-19 02:03:34 +010012733 .policy = nl80211_policy,
Johannes Berg4c476992010-10-04 21:36:35 +020012734 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12735 NL80211_FLAG_NEED_RTNL,
Johannes Berg5727ef12007-12-19 02:03:34 +010012736 },
12737 {
12738 .cmd = NL80211_CMD_SET_STATION,
12739 .doit = nl80211_set_station,
12740 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012741 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012742 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012743 NL80211_FLAG_NEED_RTNL,
Johannes Berg5727ef12007-12-19 02:03:34 +010012744 },
12745 {
12746 .cmd = NL80211_CMD_NEW_STATION,
12747 .doit = nl80211_new_station,
12748 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012749 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012750 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012751 NL80211_FLAG_NEED_RTNL,
Johannes Berg5727ef12007-12-19 02:03:34 +010012752 },
12753 {
12754 .cmd = NL80211_CMD_DEL_STATION,
12755 .doit = nl80211_del_station,
12756 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012757 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012758 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012759 NL80211_FLAG_NEED_RTNL,
Johannes Berg5727ef12007-12-19 02:03:34 +010012760 },
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012761 {
12762 .cmd = NL80211_CMD_GET_MPATH,
12763 .doit = nl80211_get_mpath,
12764 .dumpit = nl80211_dump_mpath,
12765 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012766 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012767 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012768 NL80211_FLAG_NEED_RTNL,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012769 },
12770 {
Henning Rogge66be7d22014-09-12 08:58:49 +020012771 .cmd = NL80211_CMD_GET_MPP,
12772 .doit = nl80211_get_mpp,
12773 .dumpit = nl80211_dump_mpp,
12774 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012775 .flags = GENL_UNS_ADMIN_PERM,
Henning Rogge66be7d22014-09-12 08:58:49 +020012776 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12777 NL80211_FLAG_NEED_RTNL,
12778 },
12779 {
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012780 .cmd = NL80211_CMD_SET_MPATH,
12781 .doit = nl80211_set_mpath,
12782 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012783 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012784 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012785 NL80211_FLAG_NEED_RTNL,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012786 },
12787 {
12788 .cmd = NL80211_CMD_NEW_MPATH,
12789 .doit = nl80211_new_mpath,
12790 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012791 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012792 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012793 NL80211_FLAG_NEED_RTNL,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012794 },
12795 {
12796 .cmd = NL80211_CMD_DEL_MPATH,
12797 .doit = nl80211_del_mpath,
12798 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012799 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012800 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012801 NL80211_FLAG_NEED_RTNL,
Luis Carlos Cobo2ec600d2008-02-23 15:17:06 +010012802 },
Jouni Malinen9f1ba902008-08-07 20:07:01 +030012803 {
12804 .cmd = NL80211_CMD_SET_BSS,
12805 .doit = nl80211_set_bss,
12806 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012807 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012808 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012809 NL80211_FLAG_NEED_RTNL,
Jouni Malinen9f1ba902008-08-07 20:07:01 +030012810 },
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -070012811 {
Luis R. Rodriguezf1303472009-01-30 09:26:42 -080012812 .cmd = NL80211_CMD_GET_REG,
Arik Nemtsovad30ca22014-12-15 19:25:59 +020012813 .doit = nl80211_get_reg_do,
12814 .dumpit = nl80211_get_reg_dump,
Luis R. Rodriguezf1303472009-01-30 09:26:42 -080012815 .policy = nl80211_policy,
Johannes Berg5fe231e2013-05-08 21:45:15 +020012816 .internal_flags = NL80211_FLAG_NEED_RTNL,
Luis R. Rodriguezf1303472009-01-30 09:26:42 -080012817 /* can be retrieved by unprivileged users */
12818 },
Johannes Bergb6863032015-10-15 09:25:18 +020012819#ifdef CONFIG_CFG80211_CRDA_SUPPORT
Luis R. Rodriguezf1303472009-01-30 09:26:42 -080012820 {
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -070012821 .cmd = NL80211_CMD_SET_REG,
12822 .doit = nl80211_set_reg,
12823 .policy = nl80211_policy,
12824 .flags = GENL_ADMIN_PERM,
Johannes Berg5fe231e2013-05-08 21:45:15 +020012825 .internal_flags = NL80211_FLAG_NEED_RTNL,
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -070012826 },
Johannes Bergb6863032015-10-15 09:25:18 +020012827#endif
Luis R. Rodriguezb2e1b302008-09-09 23:19:48 -070012828 {
12829 .cmd = NL80211_CMD_REQ_SET_REG,
12830 .doit = nl80211_req_set_reg,
12831 .policy = nl80211_policy,
12832 .flags = GENL_ADMIN_PERM,
12833 },
colin@cozybit.com93da9cc2008-10-21 12:03:48 -070012834 {
Johannes Berg1ea4ff32017-09-13 16:07:22 +020012835 .cmd = NL80211_CMD_RELOAD_REGDB,
12836 .doit = nl80211_reload_regdb,
12837 .policy = nl80211_policy,
12838 .flags = GENL_ADMIN_PERM,
12839 },
12840 {
Javier Cardona24bdd9f2010-12-16 17:37:48 -080012841 .cmd = NL80211_CMD_GET_MESH_CONFIG,
12842 .doit = nl80211_get_mesh_config,
colin@cozybit.com93da9cc2008-10-21 12:03:48 -070012843 .policy = nl80211_policy,
12844 /* can be retrieved by unprivileged users */
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012845 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012846 NL80211_FLAG_NEED_RTNL,
colin@cozybit.com93da9cc2008-10-21 12:03:48 -070012847 },
12848 {
Javier Cardona24bdd9f2010-12-16 17:37:48 -080012849 .cmd = NL80211_CMD_SET_MESH_CONFIG,
12850 .doit = nl80211_update_mesh_config,
colin@cozybit.com93da9cc2008-10-21 12:03:48 -070012851 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012852 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg29cbe682010-12-03 09:20:44 +010012853 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012854 NL80211_FLAG_NEED_RTNL,
colin@cozybit.com93da9cc2008-10-21 12:03:48 -070012855 },
Jouni Malinen9aed3cc2009-01-13 16:03:29 +020012856 {
Johannes Berg2a519312009-02-10 21:25:55 +010012857 .cmd = NL80211_CMD_TRIGGER_SCAN,
12858 .doit = nl80211_trigger_scan,
12859 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012860 .flags = GENL_UNS_ADMIN_PERM,
Johannes Bergfd014282012-06-18 19:17:03 +020012861 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012862 NL80211_FLAG_NEED_RTNL,
Johannes Berg2a519312009-02-10 21:25:55 +010012863 },
12864 {
Vidyullatha Kanchanapally91d3ab42015-10-30 19:14:49 +053012865 .cmd = NL80211_CMD_ABORT_SCAN,
12866 .doit = nl80211_abort_scan,
12867 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012868 .flags = GENL_UNS_ADMIN_PERM,
Vidyullatha Kanchanapally91d3ab42015-10-30 19:14:49 +053012869 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12870 NL80211_FLAG_NEED_RTNL,
12871 },
12872 {
Johannes Berg2a519312009-02-10 21:25:55 +010012873 .cmd = NL80211_CMD_GET_SCAN,
12874 .policy = nl80211_policy,
12875 .dumpit = nl80211_dump_scan,
12876 },
Jouni Malinen636a5d32009-03-19 13:39:22 +020012877 {
Luciano Coelho807f8a82011-05-11 17:09:35 +030012878 .cmd = NL80211_CMD_START_SCHED_SCAN,
12879 .doit = nl80211_start_sched_scan,
12880 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012881 .flags = GENL_UNS_ADMIN_PERM,
Luciano Coelho807f8a82011-05-11 17:09:35 +030012882 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12883 NL80211_FLAG_NEED_RTNL,
12884 },
12885 {
12886 .cmd = NL80211_CMD_STOP_SCHED_SCAN,
12887 .doit = nl80211_stop_sched_scan,
12888 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012889 .flags = GENL_UNS_ADMIN_PERM,
Luciano Coelho807f8a82011-05-11 17:09:35 +030012890 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12891 NL80211_FLAG_NEED_RTNL,
12892 },
12893 {
Jouni Malinen636a5d32009-03-19 13:39:22 +020012894 .cmd = NL80211_CMD_AUTHENTICATE,
12895 .doit = nl80211_authenticate,
12896 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012897 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012898 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg5393b912014-09-10 15:00:16 +030012899 NL80211_FLAG_NEED_RTNL |
12900 NL80211_FLAG_CLEAR_SKB,
Jouni Malinen636a5d32009-03-19 13:39:22 +020012901 },
12902 {
12903 .cmd = NL80211_CMD_ASSOCIATE,
12904 .doit = nl80211_associate,
12905 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012906 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012907 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012908 NL80211_FLAG_NEED_RTNL,
Jouni Malinen636a5d32009-03-19 13:39:22 +020012909 },
12910 {
12911 .cmd = NL80211_CMD_DEAUTHENTICATE,
12912 .doit = nl80211_deauthenticate,
12913 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012914 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012915 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012916 NL80211_FLAG_NEED_RTNL,
Jouni Malinen636a5d32009-03-19 13:39:22 +020012917 },
12918 {
12919 .cmd = NL80211_CMD_DISASSOCIATE,
12920 .doit = nl80211_disassociate,
12921 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012922 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012923 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012924 NL80211_FLAG_NEED_RTNL,
Jouni Malinen636a5d32009-03-19 13:39:22 +020012925 },
Johannes Berg04a773a2009-04-19 21:24:32 +020012926 {
12927 .cmd = NL80211_CMD_JOIN_IBSS,
12928 .doit = nl80211_join_ibss,
12929 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012930 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012931 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012932 NL80211_FLAG_NEED_RTNL,
Johannes Berg04a773a2009-04-19 21:24:32 +020012933 },
12934 {
12935 .cmd = NL80211_CMD_LEAVE_IBSS,
12936 .doit = nl80211_leave_ibss,
12937 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012938 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012939 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012940 NL80211_FLAG_NEED_RTNL,
Johannes Berg04a773a2009-04-19 21:24:32 +020012941 },
Johannes Bergaff89a92009-07-01 21:26:51 +020012942#ifdef CONFIG_NL80211_TESTMODE
12943 {
12944 .cmd = NL80211_CMD_TESTMODE,
12945 .doit = nl80211_testmode_do,
Wey-Yi Guy71063f02011-05-20 09:05:54 -070012946 .dumpit = nl80211_testmode_dump,
Johannes Bergaff89a92009-07-01 21:26:51 +020012947 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012948 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012949 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12950 NL80211_FLAG_NEED_RTNL,
Johannes Bergaff89a92009-07-01 21:26:51 +020012951 },
12952#endif
Samuel Ortizb23aa672009-07-01 21:26:54 +020012953 {
12954 .cmd = NL80211_CMD_CONNECT,
12955 .doit = nl80211_connect,
12956 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012957 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012958 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012959 NL80211_FLAG_NEED_RTNL,
Samuel Ortizb23aa672009-07-01 21:26:54 +020012960 },
12961 {
vamsi krishna088e8df2016-10-27 16:51:11 +030012962 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
12963 .doit = nl80211_update_connect_params,
12964 .policy = nl80211_policy,
12965 .flags = GENL_ADMIN_PERM,
12966 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12967 NL80211_FLAG_NEED_RTNL,
12968 },
12969 {
Samuel Ortizb23aa672009-07-01 21:26:54 +020012970 .cmd = NL80211_CMD_DISCONNECT,
12971 .doit = nl80211_disconnect,
12972 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012973 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg41265712010-10-04 21:14:05 +020012974 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012975 NL80211_FLAG_NEED_RTNL,
Samuel Ortizb23aa672009-07-01 21:26:54 +020012976 },
Johannes Berg463d0182009-07-14 00:33:35 +020012977 {
12978 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
12979 .doit = nl80211_wiphy_netns,
12980 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012981 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020012982 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12983 NL80211_FLAG_NEED_RTNL,
Johannes Berg463d0182009-07-14 00:33:35 +020012984 },
Holger Schurig61fa7132009-11-11 12:25:40 +010012985 {
12986 .cmd = NL80211_CMD_GET_SURVEY,
12987 .policy = nl80211_policy,
12988 .dumpit = nl80211_dump_survey,
12989 },
Samuel Ortiz67fbb162009-11-24 23:59:15 +010012990 {
12991 .cmd = NL80211_CMD_SET_PMKSA,
12992 .doit = nl80211_setdel_pmksa,
12993 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020012994 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020012995 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020012996 NL80211_FLAG_NEED_RTNL,
Samuel Ortiz67fbb162009-11-24 23:59:15 +010012997 },
12998 {
12999 .cmd = NL80211_CMD_DEL_PMKSA,
13000 .doit = nl80211_setdel_pmksa,
13001 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013002 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020013003 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020013004 NL80211_FLAG_NEED_RTNL,
Samuel Ortiz67fbb162009-11-24 23:59:15 +010013005 },
13006 {
13007 .cmd = NL80211_CMD_FLUSH_PMKSA,
13008 .doit = nl80211_flush_pmksa,
13009 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013010 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020013011 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020013012 NL80211_FLAG_NEED_RTNL,
Samuel Ortiz67fbb162009-11-24 23:59:15 +010013013 },
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013014 {
13015 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
13016 .doit = nl80211_remain_on_channel,
13017 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013018 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg71bbc992012-06-15 15:30:18 +020013019 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020013020 NL80211_FLAG_NEED_RTNL,
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013021 },
13022 {
13023 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
13024 .doit = nl80211_cancel_remain_on_channel,
13025 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013026 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg71bbc992012-06-15 15:30:18 +020013027 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020013028 NL80211_FLAG_NEED_RTNL,
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013029 },
Jouni Malinen13ae75b2009-12-29 12:59:45 +020013030 {
13031 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
13032 .doit = nl80211_set_tx_bitrate_mask,
13033 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013034 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020013035 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13036 NL80211_FLAG_NEED_RTNL,
Jouni Malinen13ae75b2009-12-29 12:59:45 +020013037 },
Jouni Malinen026331c2010-02-15 12:53:10 +020013038 {
Johannes Berg2e161f72010-08-12 15:38:38 +020013039 .cmd = NL80211_CMD_REGISTER_FRAME,
13040 .doit = nl80211_register_mgmt,
Jouni Malinen026331c2010-02-15 12:53:10 +020013041 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013042 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg71bbc992012-06-15 15:30:18 +020013043 .internal_flags = NL80211_FLAG_NEED_WDEV |
Johannes Berg4c476992010-10-04 21:36:35 +020013044 NL80211_FLAG_NEED_RTNL,
Jouni Malinen026331c2010-02-15 12:53:10 +020013045 },
13046 {
Johannes Berg2e161f72010-08-12 15:38:38 +020013047 .cmd = NL80211_CMD_FRAME,
13048 .doit = nl80211_tx_mgmt,
Jouni Malinen026331c2010-02-15 12:53:10 +020013049 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013050 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg71bbc992012-06-15 15:30:18 +020013051 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
Johannes Berg4c476992010-10-04 21:36:35 +020013052 NL80211_FLAG_NEED_RTNL,
Jouni Malinen026331c2010-02-15 12:53:10 +020013053 },
Kalle Valoffb9eb32010-02-17 17:58:10 +020013054 {
Johannes Bergf7ca38d2010-11-25 10:02:29 +010013055 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
13056 .doit = nl80211_tx_mgmt_cancel_wait,
13057 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013058 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg71bbc992012-06-15 15:30:18 +020013059 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
Johannes Bergf7ca38d2010-11-25 10:02:29 +010013060 NL80211_FLAG_NEED_RTNL,
13061 },
13062 {
Kalle Valoffb9eb32010-02-17 17:58:10 +020013063 .cmd = NL80211_CMD_SET_POWER_SAVE,
13064 .doit = nl80211_set_power_save,
13065 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013066 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020013067 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13068 NL80211_FLAG_NEED_RTNL,
Kalle Valoffb9eb32010-02-17 17:58:10 +020013069 },
13070 {
13071 .cmd = NL80211_CMD_GET_POWER_SAVE,
13072 .doit = nl80211_get_power_save,
13073 .policy = nl80211_policy,
13074 /* can be retrieved by unprivileged users */
Johannes Berg4c476992010-10-04 21:36:35 +020013075 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13076 NL80211_FLAG_NEED_RTNL,
Kalle Valoffb9eb32010-02-17 17:58:10 +020013077 },
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020013078 {
13079 .cmd = NL80211_CMD_SET_CQM,
13080 .doit = nl80211_set_cqm,
13081 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013082 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020013083 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13084 NL80211_FLAG_NEED_RTNL,
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020013085 },
Johannes Bergf444de02010-05-05 15:25:02 +020013086 {
13087 .cmd = NL80211_CMD_SET_CHANNEL,
13088 .doit = nl80211_set_channel,
13089 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013090 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg4c476992010-10-04 21:36:35 +020013091 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13092 NL80211_FLAG_NEED_RTNL,
Johannes Bergf444de02010-05-05 15:25:02 +020013093 },
Bill Jordane8347eb2010-10-01 13:54:28 -040013094 {
13095 .cmd = NL80211_CMD_SET_WDS_PEER,
13096 .doit = nl80211_set_wds_peer,
13097 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013098 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg43b19952010-10-07 13:10:30 +020013099 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13100 NL80211_FLAG_NEED_RTNL,
Bill Jordane8347eb2010-10-01 13:54:28 -040013101 },
Johannes Berg29cbe682010-12-03 09:20:44 +010013102 {
13103 .cmd = NL80211_CMD_JOIN_MESH,
13104 .doit = nl80211_join_mesh,
13105 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013106 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg29cbe682010-12-03 09:20:44 +010013107 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13108 NL80211_FLAG_NEED_RTNL,
13109 },
13110 {
13111 .cmd = NL80211_CMD_LEAVE_MESH,
13112 .doit = nl80211_leave_mesh,
13113 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013114 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg29cbe682010-12-03 09:20:44 +010013115 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13116 NL80211_FLAG_NEED_RTNL,
13117 },
Rostislav Lisovy6e0bd6c2014-11-03 10:33:18 +010013118 {
13119 .cmd = NL80211_CMD_JOIN_OCB,
13120 .doit = nl80211_join_ocb,
13121 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013122 .flags = GENL_UNS_ADMIN_PERM,
Rostislav Lisovy6e0bd6c2014-11-03 10:33:18 +010013123 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13124 NL80211_FLAG_NEED_RTNL,
13125 },
13126 {
13127 .cmd = NL80211_CMD_LEAVE_OCB,
13128 .doit = nl80211_leave_ocb,
13129 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013130 .flags = GENL_UNS_ADMIN_PERM,
Rostislav Lisovy6e0bd6c2014-11-03 10:33:18 +010013131 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13132 NL80211_FLAG_NEED_RTNL,
13133 },
Johannes Bergdfb89c52012-06-27 09:23:48 +020013134#ifdef CONFIG_PM
Johannes Bergff1b6e62011-05-04 15:37:28 +020013135 {
13136 .cmd = NL80211_CMD_GET_WOWLAN,
13137 .doit = nl80211_get_wowlan,
13138 .policy = nl80211_policy,
13139 /* can be retrieved by unprivileged users */
13140 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13141 NL80211_FLAG_NEED_RTNL,
13142 },
13143 {
13144 .cmd = NL80211_CMD_SET_WOWLAN,
13145 .doit = nl80211_set_wowlan,
13146 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013147 .flags = GENL_UNS_ADMIN_PERM,
Johannes Bergff1b6e62011-05-04 15:37:28 +020013148 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13149 NL80211_FLAG_NEED_RTNL,
13150 },
Johannes Bergdfb89c52012-06-27 09:23:48 +020013151#endif
Johannes Berge5497d72011-07-05 16:35:40 +020013152 {
13153 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
13154 .doit = nl80211_set_rekey_data,
13155 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013156 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berge5497d72011-07-05 16:35:40 +020013157 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg5393b912014-09-10 15:00:16 +030013158 NL80211_FLAG_NEED_RTNL |
13159 NL80211_FLAG_CLEAR_SKB,
Johannes Berge5497d72011-07-05 16:35:40 +020013160 },
Arik Nemtsov109086c2011-09-28 14:12:50 +030013161 {
13162 .cmd = NL80211_CMD_TDLS_MGMT,
13163 .doit = nl80211_tdls_mgmt,
13164 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013165 .flags = GENL_UNS_ADMIN_PERM,
Arik Nemtsov109086c2011-09-28 14:12:50 +030013166 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13167 NL80211_FLAG_NEED_RTNL,
13168 },
13169 {
13170 .cmd = NL80211_CMD_TDLS_OPER,
13171 .doit = nl80211_tdls_oper,
13172 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013173 .flags = GENL_UNS_ADMIN_PERM,
Arik Nemtsov109086c2011-09-28 14:12:50 +030013174 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13175 NL80211_FLAG_NEED_RTNL,
13176 },
Johannes Berg28946da2011-11-04 11:18:12 +010013177 {
13178 .cmd = NL80211_CMD_UNEXPECTED_FRAME,
13179 .doit = nl80211_register_unexpected_frame,
13180 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013181 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg28946da2011-11-04 11:18:12 +010013182 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13183 NL80211_FLAG_NEED_RTNL,
13184 },
Johannes Berg7f6cf312011-11-04 11:18:15 +010013185 {
13186 .cmd = NL80211_CMD_PROBE_CLIENT,
13187 .doit = nl80211_probe_client,
13188 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013189 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg2b5f8b02012-04-02 10:51:55 +020013190 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
Johannes Berg7f6cf312011-11-04 11:18:15 +010013191 NL80211_FLAG_NEED_RTNL,
13192 },
Johannes Berg5e760232011-11-04 11:18:17 +010013193 {
13194 .cmd = NL80211_CMD_REGISTER_BEACONS,
13195 .doit = nl80211_register_beacons,
13196 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013197 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg5e760232011-11-04 11:18:17 +010013198 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13199 NL80211_FLAG_NEED_RTNL,
13200 },
Simon Wunderlich1d9d9212011-11-18 14:20:43 +010013201 {
13202 .cmd = NL80211_CMD_SET_NOACK_MAP,
13203 .doit = nl80211_set_noack_map,
13204 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013205 .flags = GENL_UNS_ADMIN_PERM,
Simon Wunderlich1d9d9212011-11-18 14:20:43 +010013206 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13207 NL80211_FLAG_NEED_RTNL,
13208 },
Johannes Berg98104fde2012-06-16 00:19:54 +020013209 {
13210 .cmd = NL80211_CMD_START_P2P_DEVICE,
13211 .doit = nl80211_start_p2p_device,
13212 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013213 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg98104fde2012-06-16 00:19:54 +020013214 .internal_flags = NL80211_FLAG_NEED_WDEV |
13215 NL80211_FLAG_NEED_RTNL,
13216 },
13217 {
13218 .cmd = NL80211_CMD_STOP_P2P_DEVICE,
13219 .doit = nl80211_stop_p2p_device,
13220 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013221 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg98104fde2012-06-16 00:19:54 +020013222 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13223 NL80211_FLAG_NEED_RTNL,
13224 },
Antonio Quartullif4e583c2012-11-02 13:27:48 +010013225 {
Ayala Bekercb3b7d82016-09-20 17:31:13 +030013226 .cmd = NL80211_CMD_START_NAN,
13227 .doit = nl80211_start_nan,
13228 .policy = nl80211_policy,
13229 .flags = GENL_ADMIN_PERM,
13230 .internal_flags = NL80211_FLAG_NEED_WDEV |
13231 NL80211_FLAG_NEED_RTNL,
13232 },
13233 {
13234 .cmd = NL80211_CMD_STOP_NAN,
13235 .doit = nl80211_stop_nan,
13236 .policy = nl80211_policy,
13237 .flags = GENL_ADMIN_PERM,
13238 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13239 NL80211_FLAG_NEED_RTNL,
13240 },
13241 {
Ayala Bekera442b762016-09-20 17:31:15 +030013242 .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
13243 .doit = nl80211_nan_add_func,
13244 .policy = nl80211_policy,
13245 .flags = GENL_ADMIN_PERM,
13246 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13247 NL80211_FLAG_NEED_RTNL,
13248 },
13249 {
13250 .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
13251 .doit = nl80211_nan_del_func,
13252 .policy = nl80211_policy,
13253 .flags = GENL_ADMIN_PERM,
13254 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13255 NL80211_FLAG_NEED_RTNL,
13256 },
13257 {
Ayala Bekera5a9dcf2016-09-20 17:31:16 +030013258 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
13259 .doit = nl80211_nan_change_config,
13260 .policy = nl80211_policy,
13261 .flags = GENL_ADMIN_PERM,
13262 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13263 NL80211_FLAG_NEED_RTNL,
13264 },
13265 {
Antonio Quartullif4e583c2012-11-02 13:27:48 +010013266 .cmd = NL80211_CMD_SET_MCAST_RATE,
13267 .doit = nl80211_set_mcast_rate,
13268 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013269 .flags = GENL_UNS_ADMIN_PERM,
Antonio Quartullif4e583c2012-11-02 13:27:48 +010013270 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13271 NL80211_FLAG_NEED_RTNL,
13272 },
Vasanthakumar Thiagarajan77765ea2013-01-18 11:18:45 +053013273 {
13274 .cmd = NL80211_CMD_SET_MAC_ACL,
13275 .doit = nl80211_set_mac_acl,
13276 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013277 .flags = GENL_UNS_ADMIN_PERM,
Vasanthakumar Thiagarajan77765ea2013-01-18 11:18:45 +053013278 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13279 NL80211_FLAG_NEED_RTNL,
13280 },
Simon Wunderlich04f39042013-02-08 18:16:19 +010013281 {
13282 .cmd = NL80211_CMD_RADAR_DETECT,
13283 .doit = nl80211_start_radar_detection,
13284 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013285 .flags = GENL_UNS_ADMIN_PERM,
Simon Wunderlich04f39042013-02-08 18:16:19 +010013286 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13287 NL80211_FLAG_NEED_RTNL,
13288 },
Johannes Berg3713b4e2013-02-14 16:19:38 +010013289 {
13290 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
13291 .doit = nl80211_get_protocol_features,
13292 .policy = nl80211_policy,
13293 },
Jouni Malinen355199e2013-02-27 17:14:27 +020013294 {
13295 .cmd = NL80211_CMD_UPDATE_FT_IES,
13296 .doit = nl80211_update_ft_ies,
13297 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013298 .flags = GENL_UNS_ADMIN_PERM,
Jouni Malinen355199e2013-02-27 17:14:27 +020013299 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13300 NL80211_FLAG_NEED_RTNL,
13301 },
Arend van Spriel5de17982013-04-18 15:49:00 +020013302 {
13303 .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
13304 .doit = nl80211_crit_protocol_start,
13305 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013306 .flags = GENL_UNS_ADMIN_PERM,
Arend van Spriel5de17982013-04-18 15:49:00 +020013307 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13308 NL80211_FLAG_NEED_RTNL,
13309 },
13310 {
13311 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
13312 .doit = nl80211_crit_protocol_stop,
13313 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013314 .flags = GENL_UNS_ADMIN_PERM,
Arend van Spriel5de17982013-04-18 15:49:00 +020013315 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13316 NL80211_FLAG_NEED_RTNL,
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -070013317 },
13318 {
13319 .cmd = NL80211_CMD_GET_COALESCE,
13320 .doit = nl80211_get_coalesce,
13321 .policy = nl80211_policy,
13322 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13323 NL80211_FLAG_NEED_RTNL,
13324 },
13325 {
13326 .cmd = NL80211_CMD_SET_COALESCE,
13327 .doit = nl80211_set_coalesce,
13328 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013329 .flags = GENL_UNS_ADMIN_PERM,
Amitkumar Karwarbe29b99a2013-06-28 11:51:26 -070013330 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13331 NL80211_FLAG_NEED_RTNL,
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +020013332 },
13333 {
13334 .cmd = NL80211_CMD_CHANNEL_SWITCH,
13335 .doit = nl80211_channel_switch,
13336 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013337 .flags = GENL_UNS_ADMIN_PERM,
Simon Wunderlich16ef1fe2013-07-11 16:09:05 +020013338 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13339 NL80211_FLAG_NEED_RTNL,
13340 },
Johannes Bergad7e7182013-11-13 13:37:47 +010013341 {
13342 .cmd = NL80211_CMD_VENDOR,
13343 .doit = nl80211_vendor_cmd,
Johannes Berg7bdbe402015-08-15 22:39:49 +030013344 .dumpit = nl80211_vendor_cmd_dump,
Johannes Bergad7e7182013-11-13 13:37:47 +010013345 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013346 .flags = GENL_UNS_ADMIN_PERM,
Johannes Bergad7e7182013-11-13 13:37:47 +010013347 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13348 NL80211_FLAG_NEED_RTNL,
13349 },
Kyeyoon Parkfa9ffc72013-12-16 23:01:30 -080013350 {
13351 .cmd = NL80211_CMD_SET_QOS_MAP,
13352 .doit = nl80211_set_qos_map,
13353 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013354 .flags = GENL_UNS_ADMIN_PERM,
Kyeyoon Parkfa9ffc72013-12-16 23:01:30 -080013355 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13356 NL80211_FLAG_NEED_RTNL,
13357 },
Johannes Berg960d01a2014-09-09 22:55:35 +030013358 {
13359 .cmd = NL80211_CMD_ADD_TX_TS,
13360 .doit = nl80211_add_tx_ts,
13361 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013362 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg960d01a2014-09-09 22:55:35 +030013363 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13364 NL80211_FLAG_NEED_RTNL,
13365 },
13366 {
13367 .cmd = NL80211_CMD_DEL_TX_TS,
13368 .doit = nl80211_del_tx_ts,
13369 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013370 .flags = GENL_UNS_ADMIN_PERM,
Johannes Berg960d01a2014-09-09 22:55:35 +030013371 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13372 NL80211_FLAG_NEED_RTNL,
13373 },
Arik Nemtsov1057d352014-11-19 12:54:26 +020013374 {
13375 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
13376 .doit = nl80211_tdls_channel_switch,
13377 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013378 .flags = GENL_UNS_ADMIN_PERM,
Arik Nemtsov1057d352014-11-19 12:54:26 +020013379 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13380 NL80211_FLAG_NEED_RTNL,
13381 },
13382 {
13383 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
13384 .doit = nl80211_tdls_cancel_channel_switch,
13385 .policy = nl80211_policy,
Martin Willi5617c6c2016-05-09 18:33:58 +020013386 .flags = GENL_UNS_ADMIN_PERM,
Arik Nemtsov1057d352014-11-19 12:54:26 +020013387 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13388 NL80211_FLAG_NEED_RTNL,
13389 },
Michael Braunce0ce132016-10-10 19:12:22 +020013390 {
13391 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
13392 .doit = nl80211_set_multicast_to_unicast,
13393 .policy = nl80211_policy,
13394 .flags = GENL_UNS_ADMIN_PERM,
13395 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13396 NL80211_FLAG_NEED_RTNL,
13397 },
Avraham Stern3a00df52017-06-09 13:08:43 +010013398 {
13399 .cmd = NL80211_CMD_SET_PMK,
13400 .doit = nl80211_set_pmk,
13401 .policy = nl80211_policy,
13402 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13403 NL80211_FLAG_NEED_RTNL,
13404 },
13405 {
13406 .cmd = NL80211_CMD_DEL_PMK,
13407 .doit = nl80211_del_pmk,
13408 .policy = nl80211_policy,
13409 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13410 NL80211_FLAG_NEED_RTNL,
13411 },
Srinivas Dasari40cbfa92018-01-25 17:13:38 +020013412 {
13413 .cmd = NL80211_CMD_EXTERNAL_AUTH,
13414 .doit = nl80211_external_auth,
13415 .policy = nl80211_policy,
13416 .flags = GENL_ADMIN_PERM,
13417 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13418 NL80211_FLAG_NEED_RTNL,
13419 },
Avraham Stern3a00df52017-06-09 13:08:43 +010013420
Johannes Berg55682962007-09-20 13:09:35 -040013421};
Jouni Malinen9588bbd2009-12-23 13:15:41 +010013422
Johannes Berg56989f62016-10-24 14:40:05 +020013423static struct genl_family nl80211_fam __ro_after_init = {
Johannes Berg489111e2016-10-24 14:40:03 +020013424 .name = NL80211_GENL_NAME, /* have users key off the name instead */
13425 .hdrsize = 0, /* no private header */
13426 .version = 1, /* no particular meaning now */
13427 .maxattr = NL80211_ATTR_MAX,
13428 .netnsok = true,
13429 .pre_doit = nl80211_pre_doit,
13430 .post_doit = nl80211_post_doit,
13431 .module = THIS_MODULE,
13432 .ops = nl80211_ops,
13433 .n_ops = ARRAY_SIZE(nl80211_ops),
13434 .mcgrps = nl80211_mcgrps,
13435 .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
13436};
13437
Johannes Berg55682962007-09-20 13:09:35 -040013438/* notification functions */
13439
Johannes Berg3bb20552014-05-26 13:52:25 +020013440void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
13441 enum nl80211_commands cmd)
Johannes Berg55682962007-09-20 13:09:35 -040013442{
13443 struct sk_buff *msg;
Johannes Berg86e8cf92013-06-19 10:57:22 +020013444 struct nl80211_dump_wiphy_state state = {};
Johannes Berg55682962007-09-20 13:09:35 -040013445
Johannes Berg3bb20552014-05-26 13:52:25 +020013446 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
13447 cmd != NL80211_CMD_DEL_WIPHY);
13448
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -070013449 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg55682962007-09-20 13:09:35 -040013450 if (!msg)
13451 return;
13452
Johannes Berg3bb20552014-05-26 13:52:25 +020013453 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
Johannes Berg55682962007-09-20 13:09:35 -040013454 nlmsg_free(msg);
13455 return;
13456 }
13457
Johannes Berg68eb5502013-11-19 15:19:38 +010013458 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013459 NL80211_MCGRP_CONFIG, GFP_KERNEL);
Johannes Berg55682962007-09-20 13:09:35 -040013460}
13461
Denis Kenzior896ff062016-08-03 16:58:33 -050013462void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
13463 struct wireless_dev *wdev,
13464 enum nl80211_commands cmd)
13465{
13466 struct sk_buff *msg;
13467
13468 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
13469 cmd != NL80211_CMD_DEL_INTERFACE);
13470
13471 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13472 if (!msg)
13473 return;
13474
13475 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev,
13476 cmd == NL80211_CMD_DEL_INTERFACE) < 0) {
13477 nlmsg_free(msg);
13478 return;
13479 }
13480
13481 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13482 NL80211_MCGRP_CONFIG, GFP_KERNEL);
13483}
13484
Johannes Berg362a4152009-05-24 16:43:15 +020013485static int nl80211_add_scan_req(struct sk_buff *msg,
13486 struct cfg80211_registered_device *rdev)
13487{
13488 struct cfg80211_scan_request *req = rdev->scan_req;
13489 struct nlattr *nest;
13490 int i;
13491
13492 if (WARN_ON(!req))
13493 return 0;
13494
13495 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
13496 if (!nest)
13497 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -040013498 for (i = 0; i < req->n_ssids; i++) {
13499 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
13500 goto nla_put_failure;
13501 }
Johannes Berg362a4152009-05-24 16:43:15 +020013502 nla_nest_end(msg, nest);
13503
13504 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
13505 if (!nest)
13506 goto nla_put_failure;
David S. Miller9360ffd2012-03-29 04:41:26 -040013507 for (i = 0; i < req->n_channels; i++) {
13508 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
13509 goto nla_put_failure;
13510 }
Johannes Berg362a4152009-05-24 16:43:15 +020013511 nla_nest_end(msg, nest);
13512
David S. Miller9360ffd2012-03-29 04:41:26 -040013513 if (req->ie &&
13514 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
13515 goto nla_put_failure;
Johannes Berg362a4152009-05-24 16:43:15 +020013516
Johannes Bergae917c92013-10-25 11:05:22 +020013517 if (req->flags &&
13518 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
13519 goto nla_put_failure;
Sam Lefflered4737712012-10-11 21:03:31 -070013520
Avraham Stern1d762502016-07-05 17:10:13 +030013521 if (req->info.scan_start_tsf &&
13522 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
13523 req->info.scan_start_tsf, NL80211_BSS_PAD) ||
13524 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
13525 req->info.tsf_bssid)))
13526 goto nla_put_failure;
13527
Johannes Berg362a4152009-05-24 16:43:15 +020013528 return 0;
13529 nla_put_failure:
13530 return -ENOBUFS;
13531}
13532
Arend Van Spriel505a2e82016-12-16 11:21:54 +000013533static int nl80211_prep_scan_msg(struct sk_buff *msg,
Johannes Berga538e2d2009-06-16 19:56:42 +020013534 struct cfg80211_registered_device *rdev,
Johannes Bergfd014282012-06-18 19:17:03 +020013535 struct wireless_dev *wdev,
Eric W. Biederman15e47302012-09-07 20:12:54 +000013536 u32 portid, u32 seq, int flags,
Johannes Berga538e2d2009-06-16 19:56:42 +020013537 u32 cmd)
Johannes Berg2a519312009-02-10 21:25:55 +010013538{
13539 void *hdr;
13540
Eric W. Biederman15e47302012-09-07 20:12:54 +000013541 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
Johannes Berg2a519312009-02-10 21:25:55 +010013542 if (!hdr)
13543 return -1;
13544
David S. Miller9360ffd2012-03-29 04:41:26 -040013545 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Bergfd014282012-06-18 19:17:03 +020013546 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13547 wdev->netdev->ifindex)) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020013548 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13549 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -040013550 goto nla_put_failure;
Johannes Berg2a519312009-02-10 21:25:55 +010013551
Johannes Berg362a4152009-05-24 16:43:15 +020013552 /* ignore errors and send incomplete event anyway */
13553 nl80211_add_scan_req(msg, rdev);
Johannes Berg2a519312009-02-10 21:25:55 +010013554
Johannes Berg053c0952015-01-16 22:09:00 +010013555 genlmsg_end(msg, hdr);
13556 return 0;
Johannes Berg2a519312009-02-10 21:25:55 +010013557
13558 nla_put_failure:
13559 genlmsg_cancel(msg, hdr);
13560 return -EMSGSIZE;
13561}
13562
Luciano Coelho807f8a82011-05-11 17:09:35 +030013563static int
Arend Van Spriel505a2e82016-12-16 11:21:54 +000013564nl80211_prep_sched_scan_msg(struct sk_buff *msg,
Arend Van Spriel96b08fd2017-04-13 13:06:27 +010013565 struct cfg80211_sched_scan_request *req, u32 cmd)
Luciano Coelho807f8a82011-05-11 17:09:35 +030013566{
13567 void *hdr;
13568
Arend Van Spriel96b08fd2017-04-13 13:06:27 +010013569 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
Luciano Coelho807f8a82011-05-11 17:09:35 +030013570 if (!hdr)
13571 return -1;
13572
Arend Van Spriel96b08fd2017-04-13 13:06:27 +010013573 if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
13574 wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
13575 nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
13576 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
13577 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -040013578 goto nla_put_failure;
Luciano Coelho807f8a82011-05-11 17:09:35 +030013579
Johannes Berg053c0952015-01-16 22:09:00 +010013580 genlmsg_end(msg, hdr);
13581 return 0;
Luciano Coelho807f8a82011-05-11 17:09:35 +030013582
13583 nla_put_failure:
13584 genlmsg_cancel(msg, hdr);
13585 return -EMSGSIZE;
13586}
13587
Johannes Berga538e2d2009-06-16 19:56:42 +020013588void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
Johannes Bergfd014282012-06-18 19:17:03 +020013589 struct wireless_dev *wdev)
Johannes Berga538e2d2009-06-16 19:56:42 +020013590{
13591 struct sk_buff *msg;
13592
Thomas Graf58050fc2012-06-28 03:57:45 +000013593 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berga538e2d2009-06-16 19:56:42 +020013594 if (!msg)
13595 return;
13596
Arend Van Spriel505a2e82016-12-16 11:21:54 +000013597 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
Johannes Berga538e2d2009-06-16 19:56:42 +020013598 NL80211_CMD_TRIGGER_SCAN) < 0) {
13599 nlmsg_free(msg);
13600 return;
13601 }
13602
Johannes Berg68eb5502013-11-19 15:19:38 +010013603 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013604 NL80211_MCGRP_SCAN, GFP_KERNEL);
Johannes Berga538e2d2009-06-16 19:56:42 +020013605}
13606
Johannes Bergf9d15d12014-01-22 11:14:19 +020013607struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
13608 struct wireless_dev *wdev, bool aborted)
Johannes Berg2a519312009-02-10 21:25:55 +010013609{
13610 struct sk_buff *msg;
13611
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -070013612 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Johannes Berg2a519312009-02-10 21:25:55 +010013613 if (!msg)
Johannes Bergf9d15d12014-01-22 11:14:19 +020013614 return NULL;
Johannes Berg2a519312009-02-10 21:25:55 +010013615
Arend Van Spriel505a2e82016-12-16 11:21:54 +000013616 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
Johannes Bergf9d15d12014-01-22 11:14:19 +020013617 aborted ? NL80211_CMD_SCAN_ABORTED :
13618 NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
Johannes Berg2a519312009-02-10 21:25:55 +010013619 nlmsg_free(msg);
Johannes Bergf9d15d12014-01-22 11:14:19 +020013620 return NULL;
Johannes Berg2a519312009-02-10 21:25:55 +010013621 }
13622
Johannes Bergf9d15d12014-01-22 11:14:19 +020013623 return msg;
Johannes Berg2a519312009-02-10 21:25:55 +010013624}
13625
Arend Van Spriel505a2e82016-12-16 11:21:54 +000013626/* send message created by nl80211_build_scan_msg() */
13627void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
13628 struct sk_buff *msg)
Johannes Berg2a519312009-02-10 21:25:55 +010013629{
Johannes Berg2a519312009-02-10 21:25:55 +010013630 if (!msg)
13631 return;
13632
Johannes Berg68eb5502013-11-19 15:19:38 +010013633 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013634 NL80211_MCGRP_SCAN, GFP_KERNEL);
Johannes Berg2a519312009-02-10 21:25:55 +010013635}
13636
Arend Van Spriel96b08fd2017-04-13 13:06:27 +010013637void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
Luciano Coelho807f8a82011-05-11 17:09:35 +030013638{
13639 struct sk_buff *msg;
13640
Thomas Graf58050fc2012-06-28 03:57:45 +000013641 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
Luciano Coelho807f8a82011-05-11 17:09:35 +030013642 if (!msg)
13643 return;
13644
Arend Van Spriel96b08fd2017-04-13 13:06:27 +010013645 if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
Luciano Coelho807f8a82011-05-11 17:09:35 +030013646 nlmsg_free(msg);
13647 return;
13648 }
13649
Arend Van Spriel96b08fd2017-04-13 13:06:27 +010013650 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013651 NL80211_MCGRP_SCAN, GFP_KERNEL);
Luciano Coelho807f8a82011-05-11 17:09:35 +030013652}
13653
Jonathan Doronb0d7aa52014-12-15 19:26:00 +020013654static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
13655 struct regulatory_request *request)
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013656{
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013657 /* Userspace can always count this one always being set */
David S. Miller9360ffd2012-03-29 04:41:26 -040013658 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
13659 goto nla_put_failure;
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013660
David S. Miller9360ffd2012-03-29 04:41:26 -040013661 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
13662 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13663 NL80211_REGDOM_TYPE_WORLD))
13664 goto nla_put_failure;
13665 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
13666 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13667 NL80211_REGDOM_TYPE_CUSTOM_WORLD))
13668 goto nla_put_failure;
13669 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
13670 request->intersect) {
13671 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13672 NL80211_REGDOM_TYPE_INTERSECTION))
13673 goto nla_put_failure;
13674 } else {
13675 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
13676 NL80211_REGDOM_TYPE_COUNTRY) ||
13677 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
13678 request->alpha2))
13679 goto nla_put_failure;
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013680 }
13681
Arik Nemtsovad30ca22014-12-15 19:25:59 +020013682 if (request->wiphy_idx != WIPHY_IDX_INVALID) {
13683 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
13684
13685 if (wiphy &&
13686 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
13687 goto nla_put_failure;
Arik Nemtsov1bdd7162014-12-15 19:26:01 +020013688
13689 if (wiphy &&
13690 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
13691 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
13692 goto nla_put_failure;
Arik Nemtsovad30ca22014-12-15 19:25:59 +020013693 }
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013694
Jonathan Doronb0d7aa52014-12-15 19:26:00 +020013695 return true;
13696
13697nla_put_failure:
13698 return false;
13699}
13700
13701/*
13702 * This can happen on global regulatory changes or device specific settings
13703 * based on custom regulatory domains.
13704 */
13705void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
13706 struct regulatory_request *request)
13707{
13708 struct sk_buff *msg;
13709 void *hdr;
13710
13711 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13712 if (!msg)
13713 return;
13714
13715 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
13716 if (!hdr) {
13717 nlmsg_free(msg);
13718 return;
13719 }
13720
13721 if (nl80211_reg_change_event_fill(msg, request) == false)
13722 goto nla_put_failure;
13723
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013724 genlmsg_end(msg, hdr);
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013725
Johannes Bergbc43b282009-07-25 10:54:13 +020013726 rcu_read_lock();
Johannes Berg68eb5502013-11-19 15:19:38 +010013727 genlmsg_multicast_allns(&nl80211_fam, msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013728 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
Johannes Bergbc43b282009-07-25 10:54:13 +020013729 rcu_read_unlock();
Luis R. Rodriguez73d54c92009-03-09 22:07:42 -040013730
13731 return;
13732
13733nla_put_failure:
13734 genlmsg_cancel(msg, hdr);
13735 nlmsg_free(msg);
13736}
13737
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013738static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
13739 struct net_device *netdev,
13740 const u8 *buf, size_t len,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013741 enum nl80211_commands cmd, gfp_t gfp,
13742 int uapsd_queues)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013743{
13744 struct sk_buff *msg;
13745 void *hdr;
13746
Johannes Berg4ef8c1c2017-01-09 11:10:42 +010013747 msg = nlmsg_new(100 + len, gfp);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013748 if (!msg)
13749 return;
13750
13751 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13752 if (!hdr) {
13753 nlmsg_free(msg);
13754 return;
13755 }
13756
David S. Miller9360ffd2012-03-29 04:41:26 -040013757 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13758 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13759 nla_put(msg, NL80211_ATTR_FRAME, len, buf))
13760 goto nla_put_failure;
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013761
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013762 if (uapsd_queues >= 0) {
13763 struct nlattr *nla_wmm =
13764 nla_nest_start(msg, NL80211_ATTR_STA_WME);
13765 if (!nla_wmm)
13766 goto nla_put_failure;
13767
13768 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
13769 uapsd_queues))
13770 goto nla_put_failure;
13771
13772 nla_nest_end(msg, nla_wmm);
13773 }
13774
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013775 genlmsg_end(msg, hdr);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013776
Johannes Berg68eb5502013-11-19 15:19:38 +010013777 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013778 NL80211_MCGRP_MLME, gfp);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013779 return;
13780
13781 nla_put_failure:
13782 genlmsg_cancel(msg, hdr);
13783 nlmsg_free(msg);
13784}
13785
13786void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
Johannes Berge6d6e342009-07-01 21:26:47 +020013787 struct net_device *netdev, const u8 *buf,
13788 size_t len, gfp_t gfp)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013789{
13790 nl80211_send_mlme_event(rdev, netdev, buf, len,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013791 NL80211_CMD_AUTHENTICATE, gfp, -1);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013792}
13793
13794void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
13795 struct net_device *netdev, const u8 *buf,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013796 size_t len, gfp_t gfp, int uapsd_queues)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013797{
Johannes Berge6d6e342009-07-01 21:26:47 +020013798 nl80211_send_mlme_event(rdev, netdev, buf, len,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013799 NL80211_CMD_ASSOCIATE, gfp, uapsd_queues);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013800}
13801
Jouni Malinen53b46b82009-03-27 20:53:56 +020013802void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
Johannes Berge6d6e342009-07-01 21:26:47 +020013803 struct net_device *netdev, const u8 *buf,
13804 size_t len, gfp_t gfp)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013805{
13806 nl80211_send_mlme_event(rdev, netdev, buf, len,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013807 NL80211_CMD_DEAUTHENTICATE, gfp, -1);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013808}
13809
Jouni Malinen53b46b82009-03-27 20:53:56 +020013810void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
13811 struct net_device *netdev, const u8 *buf,
Johannes Berge6d6e342009-07-01 21:26:47 +020013812 size_t len, gfp_t gfp)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013813{
13814 nl80211_send_mlme_event(rdev, netdev, buf, len,
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013815 NL80211_CMD_DISASSOCIATE, gfp, -1);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020013816}
13817
Johannes Berg6ff57cf2013-05-16 00:55:00 +020013818void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
13819 size_t len)
Jouni Malinencf4e5942010-12-16 00:52:40 +020013820{
Johannes Berg947add32013-02-22 22:05:20 +010013821 struct wireless_dev *wdev = dev->ieee80211_ptr;
13822 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080013823 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg6ff57cf2013-05-16 00:55:00 +020013824 const struct ieee80211_mgmt *mgmt = (void *)buf;
13825 u32 cmd;
Jouni Malinencf4e5942010-12-16 00:52:40 +020013826
Johannes Berg6ff57cf2013-05-16 00:55:00 +020013827 if (WARN_ON(len < 2))
13828 return;
13829
13830 if (ieee80211_is_deauth(mgmt->frame_control))
13831 cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
13832 else
13833 cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
13834
13835 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
Eliad Pellerb0b6aa22014-09-09 17:09:45 +030013836 nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1);
Jouni Malinencf4e5942010-12-16 00:52:40 +020013837}
Johannes Berg6ff57cf2013-05-16 00:55:00 +020013838EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
Jouni Malinencf4e5942010-12-16 00:52:40 +020013839
Luis R. Rodriguez1b06bb42009-05-02 00:34:48 -040013840static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
13841 struct net_device *netdev, int cmd,
Johannes Berge6d6e342009-07-01 21:26:47 +020013842 const u8 *addr, gfp_t gfp)
Jouni Malinen1965c852009-04-22 21:38:25 +030013843{
13844 struct sk_buff *msg;
13845 void *hdr;
13846
Johannes Berge6d6e342009-07-01 21:26:47 +020013847 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Jouni Malinen1965c852009-04-22 21:38:25 +030013848 if (!msg)
13849 return;
13850
13851 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13852 if (!hdr) {
13853 nlmsg_free(msg);
13854 return;
13855 }
13856
David S. Miller9360ffd2012-03-29 04:41:26 -040013857 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13858 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13859 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
13860 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
13861 goto nla_put_failure;
Jouni Malinen1965c852009-04-22 21:38:25 +030013862
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013863 genlmsg_end(msg, hdr);
Jouni Malinen1965c852009-04-22 21:38:25 +030013864
Johannes Berg68eb5502013-11-19 15:19:38 +010013865 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013866 NL80211_MCGRP_MLME, gfp);
Jouni Malinen1965c852009-04-22 21:38:25 +030013867 return;
13868
13869 nla_put_failure:
13870 genlmsg_cancel(msg, hdr);
13871 nlmsg_free(msg);
13872}
13873
13874void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
Johannes Berge6d6e342009-07-01 21:26:47 +020013875 struct net_device *netdev, const u8 *addr,
13876 gfp_t gfp)
Jouni Malinen1965c852009-04-22 21:38:25 +030013877{
13878 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
Johannes Berge6d6e342009-07-01 21:26:47 +020013879 addr, gfp);
Jouni Malinen1965c852009-04-22 21:38:25 +030013880}
13881
13882void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
Johannes Berge6d6e342009-07-01 21:26:47 +020013883 struct net_device *netdev, const u8 *addr,
13884 gfp_t gfp)
Jouni Malinen1965c852009-04-22 21:38:25 +030013885{
Johannes Berge6d6e342009-07-01 21:26:47 +020013886 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
13887 addr, gfp);
Jouni Malinen1965c852009-04-22 21:38:25 +030013888}
13889
Samuel Ortizb23aa672009-07-01 21:26:54 +020013890void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
Vidyullatha Kanchanapally5349a0f2017-03-31 00:22:33 +030013891 struct net_device *netdev,
13892 struct cfg80211_connect_resp_params *cr,
Purushottam Kushwaha3093ebbeab2017-01-13 01:12:21 +020013893 gfp_t gfp)
Samuel Ortizb23aa672009-07-01 21:26:54 +020013894{
13895 struct sk_buff *msg;
13896 void *hdr;
13897
Vidyullatha Kanchanapallya3caf742017-03-31 00:22:34 +030013898 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
13899 cr->fils_kek_len + cr->pmk_len +
13900 (cr->pmkid ? WLAN_PMKID_LEN : 0), gfp);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013901 if (!msg)
13902 return;
13903
13904 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
13905 if (!hdr) {
13906 nlmsg_free(msg);
13907 return;
13908 }
13909
David S. Miller9360ffd2012-03-29 04:41:26 -040013910 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13911 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
Vidyullatha Kanchanapally5349a0f2017-03-31 00:22:33 +030013912 (cr->bssid &&
13913 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cr->bssid)) ||
Jouni Malinenbf1ecd22016-05-31 00:16:50 +030013914 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
Vidyullatha Kanchanapally5349a0f2017-03-31 00:22:33 +030013915 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
13916 cr->status) ||
13917 (cr->status < 0 &&
Purushottam Kushwaha3093ebbeab2017-01-13 01:12:21 +020013918 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
Vidyullatha Kanchanapally5349a0f2017-03-31 00:22:33 +030013919 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
13920 cr->timeout_reason))) ||
13921 (cr->req_ie &&
13922 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
13923 (cr->resp_ie &&
13924 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
Vidyullatha Kanchanapallya3caf742017-03-31 00:22:34 +030013925 cr->resp_ie)) ||
13926 (cr->update_erp_next_seq_num &&
13927 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
13928 cr->fils_erp_next_seq_num)) ||
13929 (cr->status == WLAN_STATUS_SUCCESS &&
13930 ((cr->fils_kek &&
13931 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils_kek_len,
13932 cr->fils_kek)) ||
13933 (cr->pmk &&
13934 nla_put(msg, NL80211_ATTR_PMK, cr->pmk_len, cr->pmk)) ||
13935 (cr->pmkid &&
13936 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->pmkid)))))
David S. Miller9360ffd2012-03-29 04:41:26 -040013937 goto nla_put_failure;
Samuel Ortizb23aa672009-07-01 21:26:54 +020013938
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013939 genlmsg_end(msg, hdr);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013940
Johannes Berg68eb5502013-11-19 15:19:38 +010013941 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013942 NL80211_MCGRP_MLME, gfp);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013943 return;
13944
13945 nla_put_failure:
13946 genlmsg_cancel(msg, hdr);
13947 nlmsg_free(msg);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013948}
13949
13950void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
Avraham Stern29ce6ec2017-04-26 10:58:49 +030013951 struct net_device *netdev,
13952 struct cfg80211_roam_info *info, gfp_t gfp)
Samuel Ortizb23aa672009-07-01 21:26:54 +020013953{
13954 struct sk_buff *msg;
13955 void *hdr;
Avraham Stern29ce6ec2017-04-26 10:58:49 +030013956 const u8 *bssid = info->bss ? info->bss->bssid : info->bssid;
Samuel Ortizb23aa672009-07-01 21:26:54 +020013957
Avraham Stern29ce6ec2017-04-26 10:58:49 +030013958 msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len, gfp);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013959 if (!msg)
13960 return;
13961
13962 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
13963 if (!hdr) {
13964 nlmsg_free(msg);
13965 return;
13966 }
13967
David S. Miller9360ffd2012-03-29 04:41:26 -040013968 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13969 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13970 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
Avraham Stern29ce6ec2017-04-26 10:58:49 +030013971 (info->req_ie &&
13972 nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
13973 info->req_ie)) ||
13974 (info->resp_ie &&
13975 nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
Avraham Stern503c1fb2017-09-29 14:21:49 +020013976 info->resp_ie)))
David S. Miller9360ffd2012-03-29 04:41:26 -040013977 goto nla_put_failure;
Samuel Ortizb23aa672009-07-01 21:26:54 +020013978
Johannes Berg3b7b72e2011-10-22 19:05:51 +020013979 genlmsg_end(msg, hdr);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013980
Johannes Berg68eb5502013-11-19 15:19:38 +010013981 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010013982 NL80211_MCGRP_MLME, gfp);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013983 return;
13984
13985 nla_put_failure:
13986 genlmsg_cancel(msg, hdr);
13987 nlmsg_free(msg);
Samuel Ortizb23aa672009-07-01 21:26:54 +020013988}
13989
Avraham Stern503c1fb2017-09-29 14:21:49 +020013990void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev,
13991 struct net_device *netdev, const u8 *bssid)
13992{
13993 struct sk_buff *msg;
13994 void *hdr;
13995
13996 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13997 if (!msg)
13998 return;
13999
14000 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED);
14001 if (!hdr) {
14002 nlmsg_free(msg);
14003 return;
14004 }
14005
14006 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
14007 goto nla_put_failure;
14008
14009 genlmsg_end(msg, hdr);
14010
14011 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14012 NL80211_MCGRP_MLME, GFP_KERNEL);
14013 return;
14014
14015 nla_put_failure:
14016 genlmsg_cancel(msg, hdr);
14017 nlmsg_free(msg);
14018}
14019
Samuel Ortizb23aa672009-07-01 21:26:54 +020014020void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
14021 struct net_device *netdev, u16 reason,
Johannes Berg667503d2009-07-07 03:56:11 +020014022 const u8 *ie, size_t ie_len, bool from_ap)
Samuel Ortizb23aa672009-07-01 21:26:54 +020014023{
14024 struct sk_buff *msg;
14025 void *hdr;
14026
Johannes Berg4ef8c1c2017-01-09 11:10:42 +010014027 msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
Samuel Ortizb23aa672009-07-01 21:26:54 +020014028 if (!msg)
14029 return;
14030
14031 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
14032 if (!hdr) {
14033 nlmsg_free(msg);
14034 return;
14035 }
14036
David S. Miller9360ffd2012-03-29 04:41:26 -040014037 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14038 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
David Spinadel86b6c462017-12-18 12:14:05 +020014039 (reason &&
David S. Miller9360ffd2012-03-29 04:41:26 -040014040 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
14041 (from_ap &&
14042 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
14043 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
14044 goto nla_put_failure;
Samuel Ortizb23aa672009-07-01 21:26:54 +020014045
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014046 genlmsg_end(msg, hdr);
Samuel Ortizb23aa672009-07-01 21:26:54 +020014047
Johannes Berg68eb5502013-11-19 15:19:38 +010014048 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014049 NL80211_MCGRP_MLME, GFP_KERNEL);
Samuel Ortizb23aa672009-07-01 21:26:54 +020014050 return;
14051
14052 nla_put_failure:
14053 genlmsg_cancel(msg, hdr);
14054 nlmsg_free(msg);
Samuel Ortizb23aa672009-07-01 21:26:54 +020014055}
14056
Johannes Berg04a773a2009-04-19 21:24:32 +020014057void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
14058 struct net_device *netdev, const u8 *bssid,
14059 gfp_t gfp)
14060{
14061 struct sk_buff *msg;
14062 void *hdr;
14063
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -070014064 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Johannes Berg04a773a2009-04-19 21:24:32 +020014065 if (!msg)
14066 return;
14067
14068 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
14069 if (!hdr) {
14070 nlmsg_free(msg);
14071 return;
14072 }
14073
David S. Miller9360ffd2012-03-29 04:41:26 -040014074 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14075 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14076 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
14077 goto nla_put_failure;
Johannes Berg04a773a2009-04-19 21:24:32 +020014078
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014079 genlmsg_end(msg, hdr);
Johannes Berg04a773a2009-04-19 21:24:32 +020014080
Johannes Berg68eb5502013-11-19 15:19:38 +010014081 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014082 NL80211_MCGRP_MLME, gfp);
Johannes Berg04a773a2009-04-19 21:24:32 +020014083 return;
14084
14085 nla_put_failure:
14086 genlmsg_cancel(msg, hdr);
14087 nlmsg_free(msg);
14088}
14089
Johannes Berg947add32013-02-22 22:05:20 +010014090void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
14091 const u8* ie, u8 ie_len, gfp_t gfp)
Javier Cardonac93b5e72011-04-07 15:08:34 -070014092{
Johannes Berg947add32013-02-22 22:05:20 +010014093 struct wireless_dev *wdev = dev->ieee80211_ptr;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014094 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Javier Cardonac93b5e72011-04-07 15:08:34 -070014095 struct sk_buff *msg;
14096 void *hdr;
14097
Johannes Berg947add32013-02-22 22:05:20 +010014098 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
14099 return;
14100
14101 trace_cfg80211_notify_new_peer_candidate(dev, addr);
14102
Johannes Berg4ef8c1c2017-01-09 11:10:42 +010014103 msg = nlmsg_new(100 + ie_len, gfp);
Javier Cardonac93b5e72011-04-07 15:08:34 -070014104 if (!msg)
14105 return;
14106
14107 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
14108 if (!hdr) {
14109 nlmsg_free(msg);
14110 return;
14111 }
14112
David S. Miller9360ffd2012-03-29 04:41:26 -040014113 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg947add32013-02-22 22:05:20 +010014114 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14115 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040014116 (ie_len && ie &&
14117 nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
14118 goto nla_put_failure;
Javier Cardonac93b5e72011-04-07 15:08:34 -070014119
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014120 genlmsg_end(msg, hdr);
Javier Cardonac93b5e72011-04-07 15:08:34 -070014121
Johannes Berg68eb5502013-11-19 15:19:38 +010014122 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014123 NL80211_MCGRP_MLME, gfp);
Javier Cardonac93b5e72011-04-07 15:08:34 -070014124 return;
14125
14126 nla_put_failure:
14127 genlmsg_cancel(msg, hdr);
14128 nlmsg_free(msg);
14129}
Johannes Berg947add32013-02-22 22:05:20 +010014130EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
Javier Cardonac93b5e72011-04-07 15:08:34 -070014131
Jouni Malinena3b8b052009-03-27 21:59:49 +020014132void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
14133 struct net_device *netdev, const u8 *addr,
14134 enum nl80211_key_type key_type, int key_id,
Johannes Berge6d6e342009-07-01 21:26:47 +020014135 const u8 *tsc, gfp_t gfp)
Jouni Malinena3b8b052009-03-27 21:59:49 +020014136{
14137 struct sk_buff *msg;
14138 void *hdr;
14139
Johannes Berge6d6e342009-07-01 21:26:47 +020014140 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Jouni Malinena3b8b052009-03-27 21:59:49 +020014141 if (!msg)
14142 return;
14143
14144 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
14145 if (!hdr) {
14146 nlmsg_free(msg);
14147 return;
14148 }
14149
David S. Miller9360ffd2012-03-29 04:41:26 -040014150 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14151 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14152 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
14153 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
14154 (key_id != -1 &&
14155 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
14156 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
14157 goto nla_put_failure;
Jouni Malinena3b8b052009-03-27 21:59:49 +020014158
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014159 genlmsg_end(msg, hdr);
Jouni Malinena3b8b052009-03-27 21:59:49 +020014160
Johannes Berg68eb5502013-11-19 15:19:38 +010014161 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014162 NL80211_MCGRP_MLME, gfp);
Jouni Malinena3b8b052009-03-27 21:59:49 +020014163 return;
14164
14165 nla_put_failure:
14166 genlmsg_cancel(msg, hdr);
14167 nlmsg_free(msg);
14168}
14169
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040014170void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
14171 struct ieee80211_channel *channel_before,
14172 struct ieee80211_channel *channel_after)
14173{
14174 struct sk_buff *msg;
14175 void *hdr;
14176 struct nlattr *nl_freq;
14177
Pablo Neira Ayusofd2120c2009-05-19 15:27:55 -070014178 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040014179 if (!msg)
14180 return;
14181
14182 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
14183 if (!hdr) {
14184 nlmsg_free(msg);
14185 return;
14186 }
14187
14188 /*
14189 * Since we are applying the beacon hint to a wiphy we know its
14190 * wiphy_idx is valid
14191 */
David S. Miller9360ffd2012-03-29 04:41:26 -040014192 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
14193 goto nla_put_failure;
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040014194
14195 /* Before */
14196 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
14197 if (!nl_freq)
14198 goto nla_put_failure;
Johannes Bergcdc89b92013-02-18 23:54:36 +010014199 if (nl80211_msg_put_channel(msg, channel_before, false))
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040014200 goto nla_put_failure;
14201 nla_nest_end(msg, nl_freq);
14202
14203 /* After */
14204 nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
14205 if (!nl_freq)
14206 goto nla_put_failure;
Johannes Bergcdc89b92013-02-18 23:54:36 +010014207 if (nl80211_msg_put_channel(msg, channel_after, false))
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040014208 goto nla_put_failure;
14209 nla_nest_end(msg, nl_freq);
14210
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014211 genlmsg_end(msg, hdr);
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040014212
Johannes Berg463d0182009-07-14 00:33:35 +020014213 rcu_read_lock();
Johannes Berg68eb5502013-11-19 15:19:38 +010014214 genlmsg_multicast_allns(&nl80211_fam, msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014215 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
Johannes Berg463d0182009-07-14 00:33:35 +020014216 rcu_read_unlock();
Luis R. Rodriguez6bad8762009-04-02 14:08:09 -040014217
14218 return;
14219
14220nla_put_failure:
14221 genlmsg_cancel(msg, hdr);
14222 nlmsg_free(msg);
14223}
14224
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014225static void nl80211_send_remain_on_chan_event(
14226 int cmd, struct cfg80211_registered_device *rdev,
Johannes Berg71bbc992012-06-15 15:30:18 +020014227 struct wireless_dev *wdev, u64 cookie,
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014228 struct ieee80211_channel *chan,
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014229 unsigned int duration, gfp_t gfp)
14230{
14231 struct sk_buff *msg;
14232 void *hdr;
14233
14234 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14235 if (!msg)
14236 return;
14237
14238 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
14239 if (!hdr) {
14240 nlmsg_free(msg);
14241 return;
14242 }
14243
David S. Miller9360ffd2012-03-29 04:41:26 -040014244 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg71bbc992012-06-15 15:30:18 +020014245 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14246 wdev->netdev->ifindex)) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014247 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14248 NL80211_ATTR_PAD) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040014249 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
Johannes Berg42d97a52012-11-08 18:31:02 +010014250 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
14251 NL80211_CHAN_NO_HT) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014252 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14253 NL80211_ATTR_PAD))
David S. Miller9360ffd2012-03-29 04:41:26 -040014254 goto nla_put_failure;
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014255
David S. Miller9360ffd2012-03-29 04:41:26 -040014256 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
14257 nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
14258 goto nla_put_failure;
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014259
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014260 genlmsg_end(msg, hdr);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014261
Johannes Berg68eb5502013-11-19 15:19:38 +010014262 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014263 NL80211_MCGRP_MLME, gfp);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014264 return;
14265
14266 nla_put_failure:
14267 genlmsg_cancel(msg, hdr);
14268 nlmsg_free(msg);
14269}
14270
Johannes Berg947add32013-02-22 22:05:20 +010014271void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
14272 struct ieee80211_channel *chan,
14273 unsigned int duration, gfp_t gfp)
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014274{
Johannes Berg947add32013-02-22 22:05:20 +010014275 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014276 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg947add32013-02-22 22:05:20 +010014277
14278 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014279 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
Johannes Berg71bbc992012-06-15 15:30:18 +020014280 rdev, wdev, cookie, chan,
Johannes Berg42d97a52012-11-08 18:31:02 +010014281 duration, gfp);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014282}
Johannes Berg947add32013-02-22 22:05:20 +010014283EXPORT_SYMBOL(cfg80211_ready_on_channel);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014284
Johannes Berg947add32013-02-22 22:05:20 +010014285void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
14286 struct ieee80211_channel *chan,
14287 gfp_t gfp)
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014288{
Johannes Berg947add32013-02-22 22:05:20 +010014289 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014290 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg947add32013-02-22 22:05:20 +010014291
14292 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014293 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
Johannes Berg42d97a52012-11-08 18:31:02 +010014294 rdev, wdev, cookie, chan, 0, gfp);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014295}
Johannes Berg947add32013-02-22 22:05:20 +010014296EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
Jouni Malinen9588bbd2009-12-23 13:15:41 +010014297
Johannes Berg947add32013-02-22 22:05:20 +010014298void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
14299 struct station_info *sinfo, gfp_t gfp)
Johannes Berg98b62182009-12-23 13:15:44 +010014300{
Johannes Berg947add32013-02-22 22:05:20 +010014301 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014302 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg98b62182009-12-23 13:15:44 +010014303 struct sk_buff *msg;
14304
Johannes Berg947add32013-02-22 22:05:20 +010014305 trace_cfg80211_new_sta(dev, mac_addr, sinfo);
14306
Thomas Graf58050fc2012-06-28 03:57:45 +000014307 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Johannes Berg98b62182009-12-23 13:15:44 +010014308 if (!msg)
14309 return;
14310
Johannes Bergcf5ead82014-11-14 17:14:00 +010014311 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
John W. Linville66266b32012-03-15 13:25:41 -040014312 rdev, dev, mac_addr, sinfo) < 0) {
Johannes Berg98b62182009-12-23 13:15:44 +010014313 nlmsg_free(msg);
14314 return;
14315 }
14316
Johannes Berg68eb5502013-11-19 15:19:38 +010014317 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014318 NL80211_MCGRP_MLME, gfp);
Johannes Berg98b62182009-12-23 13:15:44 +010014319}
Johannes Berg947add32013-02-22 22:05:20 +010014320EXPORT_SYMBOL(cfg80211_new_sta);
Johannes Berg98b62182009-12-23 13:15:44 +010014321
Johannes Bergcf5ead82014-11-14 17:14:00 +010014322void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
14323 struct station_info *sinfo, gfp_t gfp)
Jouni Malinenec15e682011-03-23 15:29:52 +020014324{
Johannes Berg947add32013-02-22 22:05:20 +010014325 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014326 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Jouni Malinenec15e682011-03-23 15:29:52 +020014327 struct sk_buff *msg;
Johannes Bergcf5ead82014-11-14 17:14:00 +010014328 struct station_info empty_sinfo = {};
14329
14330 if (!sinfo)
14331 sinfo = &empty_sinfo;
Jouni Malinenec15e682011-03-23 15:29:52 +020014332
Johannes Berg947add32013-02-22 22:05:20 +010014333 trace_cfg80211_del_sta(dev, mac_addr);
14334
Thomas Graf58050fc2012-06-28 03:57:45 +000014335 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Jouni Malinenec15e682011-03-23 15:29:52 +020014336 if (!msg)
14337 return;
14338
Johannes Bergcf5ead82014-11-14 17:14:00 +010014339 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
Johannes Berg57007122015-01-16 21:05:02 +010014340 rdev, dev, mac_addr, sinfo) < 0) {
Jouni Malinenec15e682011-03-23 15:29:52 +020014341 nlmsg_free(msg);
14342 return;
14343 }
14344
Johannes Berg68eb5502013-11-19 15:19:38 +010014345 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014346 NL80211_MCGRP_MLME, gfp);
Jouni Malinenec15e682011-03-23 15:29:52 +020014347}
Johannes Bergcf5ead82014-11-14 17:14:00 +010014348EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
Jouni Malinenec15e682011-03-23 15:29:52 +020014349
Johannes Berg947add32013-02-22 22:05:20 +010014350void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
14351 enum nl80211_connect_failed_reason reason,
14352 gfp_t gfp)
Pandiyarajan Pitchaimuthued44a952012-09-18 16:50:49 +053014353{
Johannes Berg947add32013-02-22 22:05:20 +010014354 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014355 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Pandiyarajan Pitchaimuthued44a952012-09-18 16:50:49 +053014356 struct sk_buff *msg;
14357 void *hdr;
14358
14359 msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
14360 if (!msg)
14361 return;
14362
14363 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
14364 if (!hdr) {
14365 nlmsg_free(msg);
14366 return;
14367 }
14368
14369 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14370 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
14371 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
14372 goto nla_put_failure;
14373
14374 genlmsg_end(msg, hdr);
14375
Johannes Berg68eb5502013-11-19 15:19:38 +010014376 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014377 NL80211_MCGRP_MLME, gfp);
Pandiyarajan Pitchaimuthued44a952012-09-18 16:50:49 +053014378 return;
14379
14380 nla_put_failure:
14381 genlmsg_cancel(msg, hdr);
14382 nlmsg_free(msg);
14383}
Johannes Berg947add32013-02-22 22:05:20 +010014384EXPORT_SYMBOL(cfg80211_conn_failed);
Pandiyarajan Pitchaimuthued44a952012-09-18 16:50:49 +053014385
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014386static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
14387 const u8 *addr, gfp_t gfp)
Johannes Berg28946da2011-11-04 11:18:12 +010014388{
14389 struct wireless_dev *wdev = dev->ieee80211_ptr;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014390 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Berg28946da2011-11-04 11:18:12 +010014391 struct sk_buff *msg;
14392 void *hdr;
Mark Rutland6aa7de02017-10-23 14:07:29 -070014393 u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid);
Johannes Berg28946da2011-11-04 11:18:12 +010014394
Eric W. Biederman15e47302012-09-07 20:12:54 +000014395 if (!nlportid)
Johannes Berg28946da2011-11-04 11:18:12 +010014396 return false;
14397
14398 msg = nlmsg_new(100, gfp);
14399 if (!msg)
14400 return true;
14401
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014402 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
Johannes Berg28946da2011-11-04 11:18:12 +010014403 if (!hdr) {
14404 nlmsg_free(msg);
14405 return true;
14406 }
14407
David S. Miller9360ffd2012-03-29 04:41:26 -040014408 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14409 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14410 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
14411 goto nla_put_failure;
Johannes Berg28946da2011-11-04 11:18:12 +010014412
Johannes Berg9c90a9f2013-06-04 12:46:03 +020014413 genlmsg_end(msg, hdr);
Eric W. Biederman15e47302012-09-07 20:12:54 +000014414 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
Johannes Berg28946da2011-11-04 11:18:12 +010014415 return true;
14416
14417 nla_put_failure:
14418 genlmsg_cancel(msg, hdr);
14419 nlmsg_free(msg);
14420 return true;
14421}
14422
Johannes Berg947add32013-02-22 22:05:20 +010014423bool cfg80211_rx_spurious_frame(struct net_device *dev,
14424 const u8 *addr, gfp_t gfp)
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014425{
Johannes Berg947add32013-02-22 22:05:20 +010014426 struct wireless_dev *wdev = dev->ieee80211_ptr;
14427 bool ret;
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014428
Johannes Berg947add32013-02-22 22:05:20 +010014429 trace_cfg80211_rx_spurious_frame(dev, addr);
14430
14431 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
14432 wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
14433 trace_cfg80211_return_bool(false);
14434 return false;
14435 }
14436 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
14437 addr, gfp);
14438 trace_cfg80211_return_bool(ret);
14439 return ret;
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014440}
Johannes Berg947add32013-02-22 22:05:20 +010014441EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
14442
14443bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
14444 const u8 *addr, gfp_t gfp)
14445{
14446 struct wireless_dev *wdev = dev->ieee80211_ptr;
14447 bool ret;
14448
14449 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
14450
14451 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
14452 wdev->iftype != NL80211_IFTYPE_P2P_GO &&
14453 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
14454 trace_cfg80211_return_bool(false);
14455 return false;
14456 }
14457 ret = __nl80211_unexpected_frame(dev,
14458 NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
14459 addr, gfp);
14460 trace_cfg80211_return_bool(ret);
14461 return ret;
14462}
14463EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
Johannes Bergb92ab5d2011-11-04 11:18:19 +010014464
Johannes Berg2e161f72010-08-12 15:38:38 +020014465int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
Eric W. Biederman15e47302012-09-07 20:12:54 +000014466 struct wireless_dev *wdev, u32 nlportid,
Johannes Berg804483e2012-03-05 22:18:41 +010014467 int freq, int sig_dbm,
Vladimir Kondratiev19504cf2013-08-15 14:51:28 +030014468 const u8 *buf, size_t len, u32 flags, gfp_t gfp)
Jouni Malinen026331c2010-02-15 12:53:10 +020014469{
Johannes Berg71bbc992012-06-15 15:30:18 +020014470 struct net_device *netdev = wdev->netdev;
Jouni Malinen026331c2010-02-15 12:53:10 +020014471 struct sk_buff *msg;
14472 void *hdr;
Jouni Malinen026331c2010-02-15 12:53:10 +020014473
Johannes Berg4ef8c1c2017-01-09 11:10:42 +010014474 msg = nlmsg_new(100 + len, gfp);
Jouni Malinen026331c2010-02-15 12:53:10 +020014475 if (!msg)
14476 return -ENOMEM;
14477
Johannes Berg2e161f72010-08-12 15:38:38 +020014478 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
Jouni Malinen026331c2010-02-15 12:53:10 +020014479 if (!hdr) {
14480 nlmsg_free(msg);
14481 return -ENOMEM;
14482 }
14483
David S. Miller9360ffd2012-03-29 04:41:26 -040014484 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg71bbc992012-06-15 15:30:18 +020014485 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14486 netdev->ifindex)) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014487 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14488 NL80211_ATTR_PAD) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040014489 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
14490 (sig_dbm &&
14491 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
Vladimir Kondratiev19504cf2013-08-15 14:51:28 +030014492 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
14493 (flags &&
14494 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
David S. Miller9360ffd2012-03-29 04:41:26 -040014495 goto nla_put_failure;
Jouni Malinen026331c2010-02-15 12:53:10 +020014496
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014497 genlmsg_end(msg, hdr);
Jouni Malinen026331c2010-02-15 12:53:10 +020014498
Eric W. Biederman15e47302012-09-07 20:12:54 +000014499 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
Jouni Malinen026331c2010-02-15 12:53:10 +020014500
14501 nla_put_failure:
14502 genlmsg_cancel(msg, hdr);
14503 nlmsg_free(msg);
14504 return -ENOBUFS;
14505}
14506
Johannes Berg947add32013-02-22 22:05:20 +010014507void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
14508 const u8 *buf, size_t len, bool ack, gfp_t gfp)
Jouni Malinen026331c2010-02-15 12:53:10 +020014509{
Johannes Berg947add32013-02-22 22:05:20 +010014510 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014511 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg71bbc992012-06-15 15:30:18 +020014512 struct net_device *netdev = wdev->netdev;
Jouni Malinen026331c2010-02-15 12:53:10 +020014513 struct sk_buff *msg;
14514 void *hdr;
14515
Johannes Berg947add32013-02-22 22:05:20 +010014516 trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
14517
Johannes Berg4ef8c1c2017-01-09 11:10:42 +010014518 msg = nlmsg_new(100 + len, gfp);
Jouni Malinen026331c2010-02-15 12:53:10 +020014519 if (!msg)
14520 return;
14521
Johannes Berg2e161f72010-08-12 15:38:38 +020014522 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
Jouni Malinen026331c2010-02-15 12:53:10 +020014523 if (!hdr) {
14524 nlmsg_free(msg);
14525 return;
14526 }
14527
David S. Miller9360ffd2012-03-29 04:41:26 -040014528 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg71bbc992012-06-15 15:30:18 +020014529 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14530 netdev->ifindex)) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014531 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14532 NL80211_ATTR_PAD) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040014533 nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014534 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14535 NL80211_ATTR_PAD) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040014536 (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
14537 goto nla_put_failure;
Jouni Malinen026331c2010-02-15 12:53:10 +020014538
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014539 genlmsg_end(msg, hdr);
Jouni Malinen026331c2010-02-15 12:53:10 +020014540
Johannes Berg68eb5502013-11-19 15:19:38 +010014541 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014542 NL80211_MCGRP_MLME, gfp);
Jouni Malinen026331c2010-02-15 12:53:10 +020014543 return;
14544
14545 nla_put_failure:
14546 genlmsg_cancel(msg, hdr);
14547 nlmsg_free(msg);
14548}
Johannes Berg947add32013-02-22 22:05:20 +010014549EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
Jouni Malinen026331c2010-02-15 12:53:10 +020014550
Johannes Berg5b97f492014-11-26 12:37:43 +010014551static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
14552 const char *mac, gfp_t gfp)
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014553{
Johannes Berg947add32013-02-22 22:05:20 +010014554 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Berg5b97f492014-11-26 12:37:43 +010014555 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14556 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14557 void **cb;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014558
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014559 if (!msg)
Johannes Berg5b97f492014-11-26 12:37:43 +010014560 return NULL;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014561
Johannes Berg5b97f492014-11-26 12:37:43 +010014562 cb = (void **)msg->cb;
14563
14564 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
14565 if (!cb[0]) {
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014566 nlmsg_free(msg);
Johannes Berg5b97f492014-11-26 12:37:43 +010014567 return NULL;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014568 }
14569
David S. Miller9360ffd2012-03-29 04:41:26 -040014570 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Johannes Berg947add32013-02-22 22:05:20 +010014571 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
David S. Miller9360ffd2012-03-29 04:41:26 -040014572 goto nla_put_failure;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014573
Johannes Berg5b97f492014-11-26 12:37:43 +010014574 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014575 goto nla_put_failure;
14576
Johannes Berg5b97f492014-11-26 12:37:43 +010014577 cb[1] = nla_nest_start(msg, NL80211_ATTR_CQM);
14578 if (!cb[1])
14579 goto nla_put_failure;
14580
14581 cb[2] = rdev;
14582
14583 return msg;
14584 nla_put_failure:
14585 nlmsg_free(msg);
14586 return NULL;
14587}
14588
14589static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
14590{
14591 void **cb = (void **)msg->cb;
14592 struct cfg80211_registered_device *rdev = cb[2];
14593
14594 nla_nest_end(msg, cb[1]);
14595 genlmsg_end(msg, cb[0]);
14596
14597 memset(msg->cb, 0, sizeof(msg->cb));
14598
14599 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14600 NL80211_MCGRP_MLME, gfp);
14601}
14602
14603void cfg80211_cqm_rssi_notify(struct net_device *dev,
14604 enum nl80211_cqm_rssi_threshold_event rssi_event,
Andrzej Zaborowskibee427b2017-01-25 12:43:41 +010014605 s32 rssi_level, gfp_t gfp)
Johannes Berg5b97f492014-11-26 12:37:43 +010014606{
14607 struct sk_buff *msg;
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +010014608 struct wireless_dev *wdev = dev->ieee80211_ptr;
14609 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Berg5b97f492014-11-26 12:37:43 +010014610
Andrzej Zaborowskibee427b2017-01-25 12:43:41 +010014611 trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
Johannes Berg5b97f492014-11-26 12:37:43 +010014612
Johannes Berg98f03342014-11-26 12:42:02 +010014613 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
14614 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
14615 return;
14616
Andrew Zaborowski4a4b8162017-02-10 10:02:31 +010014617 if (wdev->cqm_config) {
14618 wdev->cqm_config->last_rssi_event_value = rssi_level;
14619
14620 cfg80211_cqm_rssi_update(rdev, dev);
14621
14622 if (rssi_level == 0)
14623 rssi_level = wdev->cqm_config->last_rssi_event_value;
14624 }
14625
Johannes Berg5b97f492014-11-26 12:37:43 +010014626 msg = cfg80211_prepare_cqm(dev, NULL, gfp);
14627 if (!msg)
14628 return;
14629
David S. Miller9360ffd2012-03-29 04:41:26 -040014630 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
14631 rssi_event))
14632 goto nla_put_failure;
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014633
Andrzej Zaborowskibee427b2017-01-25 12:43:41 +010014634 if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
14635 rssi_level))
14636 goto nla_put_failure;
14637
Johannes Berg5b97f492014-11-26 12:37:43 +010014638 cfg80211_send_cqm(msg, gfp);
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014639
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014640 return;
14641
14642 nla_put_failure:
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014643 nlmsg_free(msg);
14644}
Johannes Berg947add32013-02-22 22:05:20 +010014645EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
Juuso Oikarinend6dc1a32010-03-23 09:02:33 +020014646
Johannes Berg5b97f492014-11-26 12:37:43 +010014647void cfg80211_cqm_txe_notify(struct net_device *dev,
14648 const u8 *peer, u32 num_packets,
14649 u32 rate, u32 intvl, gfp_t gfp)
14650{
14651 struct sk_buff *msg;
14652
14653 msg = cfg80211_prepare_cqm(dev, peer, gfp);
14654 if (!msg)
14655 return;
14656
14657 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
14658 goto nla_put_failure;
14659
14660 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
14661 goto nla_put_failure;
14662
14663 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
14664 goto nla_put_failure;
14665
14666 cfg80211_send_cqm(msg, gfp);
14667 return;
14668
14669 nla_put_failure:
14670 nlmsg_free(msg);
14671}
14672EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
14673
14674void cfg80211_cqm_pktloss_notify(struct net_device *dev,
14675 const u8 *peer, u32 num_packets, gfp_t gfp)
14676{
14677 struct sk_buff *msg;
14678
14679 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
14680
14681 msg = cfg80211_prepare_cqm(dev, peer, gfp);
14682 if (!msg)
14683 return;
14684
14685 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
14686 goto nla_put_failure;
14687
14688 cfg80211_send_cqm(msg, gfp);
14689 return;
14690
14691 nla_put_failure:
14692 nlmsg_free(msg);
14693}
14694EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
14695
Johannes Berg98f03342014-11-26 12:42:02 +010014696void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
14697{
14698 struct sk_buff *msg;
14699
14700 msg = cfg80211_prepare_cqm(dev, NULL, gfp);
14701 if (!msg)
14702 return;
14703
14704 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
14705 goto nla_put_failure;
14706
14707 cfg80211_send_cqm(msg, gfp);
14708 return;
14709
14710 nla_put_failure:
14711 nlmsg_free(msg);
14712}
14713EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
14714
Johannes Berg947add32013-02-22 22:05:20 +010014715static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
14716 struct net_device *netdev, const u8 *bssid,
14717 const u8 *replay_ctr, gfp_t gfp)
Johannes Berge5497d72011-07-05 16:35:40 +020014718{
14719 struct sk_buff *msg;
14720 struct nlattr *rekey_attr;
14721 void *hdr;
14722
Thomas Graf58050fc2012-06-28 03:57:45 +000014723 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Johannes Berge5497d72011-07-05 16:35:40 +020014724 if (!msg)
14725 return;
14726
14727 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
14728 if (!hdr) {
14729 nlmsg_free(msg);
14730 return;
14731 }
14732
David S. Miller9360ffd2012-03-29 04:41:26 -040014733 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14734 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14735 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
14736 goto nla_put_failure;
Johannes Berge5497d72011-07-05 16:35:40 +020014737
14738 rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
14739 if (!rekey_attr)
14740 goto nla_put_failure;
14741
David S. Miller9360ffd2012-03-29 04:41:26 -040014742 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
14743 NL80211_REPLAY_CTR_LEN, replay_ctr))
14744 goto nla_put_failure;
Johannes Berge5497d72011-07-05 16:35:40 +020014745
14746 nla_nest_end(msg, rekey_attr);
14747
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014748 genlmsg_end(msg, hdr);
Johannes Berge5497d72011-07-05 16:35:40 +020014749
Johannes Berg68eb5502013-11-19 15:19:38 +010014750 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014751 NL80211_MCGRP_MLME, gfp);
Johannes Berge5497d72011-07-05 16:35:40 +020014752 return;
14753
14754 nla_put_failure:
14755 genlmsg_cancel(msg, hdr);
14756 nlmsg_free(msg);
14757}
14758
Johannes Berg947add32013-02-22 22:05:20 +010014759void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
14760 const u8 *replay_ctr, gfp_t gfp)
14761{
14762 struct wireless_dev *wdev = dev->ieee80211_ptr;
14763 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014764 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg947add32013-02-22 22:05:20 +010014765
14766 trace_cfg80211_gtk_rekey_notify(dev, bssid);
14767 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
14768}
14769EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
14770
14771static void
14772nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
14773 struct net_device *netdev, int index,
14774 const u8 *bssid, bool preauth, gfp_t gfp)
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014775{
14776 struct sk_buff *msg;
14777 struct nlattr *attr;
14778 void *hdr;
14779
Thomas Graf58050fc2012-06-28 03:57:45 +000014780 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014781 if (!msg)
14782 return;
14783
14784 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
14785 if (!hdr) {
14786 nlmsg_free(msg);
14787 return;
14788 }
14789
David S. Miller9360ffd2012-03-29 04:41:26 -040014790 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14791 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
14792 goto nla_put_failure;
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014793
14794 attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
14795 if (!attr)
14796 goto nla_put_failure;
14797
David S. Miller9360ffd2012-03-29 04:41:26 -040014798 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
14799 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
14800 (preauth &&
14801 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
14802 goto nla_put_failure;
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014803
14804 nla_nest_end(msg, attr);
14805
Johannes Berg3b7b72e2011-10-22 19:05:51 +020014806 genlmsg_end(msg, hdr);
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014807
Johannes Berg68eb5502013-11-19 15:19:38 +010014808 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014809 NL80211_MCGRP_MLME, gfp);
Jouni Malinenc9df56b2011-09-16 18:56:23 +030014810 return;
14811
14812 nla_put_failure:
14813 genlmsg_cancel(msg, hdr);
14814 nlmsg_free(msg);
14815}
14816
Johannes Berg947add32013-02-22 22:05:20 +010014817void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
14818 const u8 *bssid, bool preauth, gfp_t gfp)
14819{
14820 struct wireless_dev *wdev = dev->ieee80211_ptr;
14821 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014822 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg947add32013-02-22 22:05:20 +010014823
14824 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
14825 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
14826}
14827EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
14828
14829static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
14830 struct net_device *netdev,
14831 struct cfg80211_chan_def *chandef,
Luciano Coelhof8d75522014-11-07 14:31:35 +020014832 gfp_t gfp,
14833 enum nl80211_commands notif,
14834 u8 count)
Thomas Pedersen53145262012-04-06 13:35:47 -070014835{
14836 struct sk_buff *msg;
14837 void *hdr;
14838
Thomas Graf58050fc2012-06-28 03:57:45 +000014839 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Thomas Pedersen53145262012-04-06 13:35:47 -070014840 if (!msg)
14841 return;
14842
Luciano Coelhof8d75522014-11-07 14:31:35 +020014843 hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
Thomas Pedersen53145262012-04-06 13:35:47 -070014844 if (!hdr) {
14845 nlmsg_free(msg);
14846 return;
14847 }
14848
Johannes Berg683b6d32012-11-08 21:25:48 +010014849 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
14850 goto nla_put_failure;
14851
14852 if (nl80211_send_chandef(msg, chandef))
John W. Linville7eab0f62012-04-12 14:25:14 -040014853 goto nla_put_failure;
Thomas Pedersen53145262012-04-06 13:35:47 -070014854
Luciano Coelhof8d75522014-11-07 14:31:35 +020014855 if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
14856 (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
14857 goto nla_put_failure;
14858
Thomas Pedersen53145262012-04-06 13:35:47 -070014859 genlmsg_end(msg, hdr);
14860
Johannes Berg68eb5502013-11-19 15:19:38 +010014861 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014862 NL80211_MCGRP_MLME, gfp);
Thomas Pedersen53145262012-04-06 13:35:47 -070014863 return;
14864
14865 nla_put_failure:
14866 genlmsg_cancel(msg, hdr);
14867 nlmsg_free(msg);
14868}
14869
Johannes Berg947add32013-02-22 22:05:20 +010014870void cfg80211_ch_switch_notify(struct net_device *dev,
14871 struct cfg80211_chan_def *chandef)
Thomas Pedersen84f10702012-07-12 16:17:33 -070014872{
Johannes Berg947add32013-02-22 22:05:20 +010014873 struct wireless_dev *wdev = dev->ieee80211_ptr;
14874 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014875 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg947add32013-02-22 22:05:20 +010014876
Simon Wunderliche487eae2013-11-21 18:19:51 +010014877 ASSERT_WDEV_LOCK(wdev);
Johannes Berg947add32013-02-22 22:05:20 +010014878
Simon Wunderliche487eae2013-11-21 18:19:51 +010014879 trace_cfg80211_ch_switch_notify(dev, chandef);
Johannes Berg947add32013-02-22 22:05:20 +010014880
Michal Kazior9e0e2962014-01-29 14:22:27 +010014881 wdev->chandef = *chandef;
Janusz Dziedzic96f55f12014-01-24 14:29:21 +010014882 wdev->preset_chandef = *chandef;
Luciano Coelhof8d75522014-11-07 14:31:35 +020014883 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
14884 NL80211_CMD_CH_SWITCH_NOTIFY, 0);
Johannes Berg947add32013-02-22 22:05:20 +010014885}
14886EXPORT_SYMBOL(cfg80211_ch_switch_notify);
14887
Luciano Coelhof8d75522014-11-07 14:31:35 +020014888void cfg80211_ch_switch_started_notify(struct net_device *dev,
14889 struct cfg80211_chan_def *chandef,
14890 u8 count)
14891{
14892 struct wireless_dev *wdev = dev->ieee80211_ptr;
14893 struct wiphy *wiphy = wdev->wiphy;
14894 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14895
14896 trace_cfg80211_ch_switch_started_notify(dev, chandef);
14897
14898 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
14899 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
14900}
14901EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
14902
Thomas Pedersen84f10702012-07-12 16:17:33 -070014903void
Simon Wunderlich04f39042013-02-08 18:16:19 +010014904nl80211_radar_notify(struct cfg80211_registered_device *rdev,
Janusz Dziedzicd2859df2013-11-06 13:55:51 +010014905 const struct cfg80211_chan_def *chandef,
Simon Wunderlich04f39042013-02-08 18:16:19 +010014906 enum nl80211_radar_event event,
14907 struct net_device *netdev, gfp_t gfp)
14908{
14909 struct sk_buff *msg;
14910 void *hdr;
14911
14912 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14913 if (!msg)
14914 return;
14915
14916 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
14917 if (!hdr) {
14918 nlmsg_free(msg);
14919 return;
14920 }
14921
14922 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
14923 goto nla_put_failure;
14924
14925 /* NOP and radar events don't need a netdev parameter */
14926 if (netdev) {
14927 struct wireless_dev *wdev = netdev->ieee80211_ptr;
14928
14929 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014930 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14931 NL80211_ATTR_PAD))
Simon Wunderlich04f39042013-02-08 18:16:19 +010014932 goto nla_put_failure;
14933 }
14934
14935 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
14936 goto nla_put_failure;
14937
14938 if (nl80211_send_chandef(msg, chandef))
14939 goto nla_put_failure;
14940
Johannes Berg9c90a9f2013-06-04 12:46:03 +020014941 genlmsg_end(msg, hdr);
Simon Wunderlich04f39042013-02-08 18:16:19 +010014942
Johannes Berg68eb5502013-11-19 15:19:38 +010014943 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014944 NL80211_MCGRP_MLME, gfp);
Simon Wunderlich04f39042013-02-08 18:16:19 +010014945 return;
14946
14947 nla_put_failure:
14948 genlmsg_cancel(msg, hdr);
14949 nlmsg_free(msg);
14950}
14951
Johannes Berg7f6cf312011-11-04 11:18:15 +010014952void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
14953 u64 cookie, bool acked, gfp_t gfp)
14954{
14955 struct wireless_dev *wdev = dev->ieee80211_ptr;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014956 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Berg7f6cf312011-11-04 11:18:15 +010014957 struct sk_buff *msg;
14958 void *hdr;
Johannes Berg7f6cf312011-11-04 11:18:15 +010014959
Beni Lev4ee3e062012-08-27 12:49:39 +030014960 trace_cfg80211_probe_status(dev, addr, cookie, acked);
14961
Thomas Graf58050fc2012-06-28 03:57:45 +000014962 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
Beni Lev4ee3e062012-08-27 12:49:39 +030014963
Johannes Berg7f6cf312011-11-04 11:18:15 +010014964 if (!msg)
14965 return;
14966
14967 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
14968 if (!hdr) {
14969 nlmsg_free(msg);
14970 return;
14971 }
14972
David S. Miller9360ffd2012-03-29 04:41:26 -040014973 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14974 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14975 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020014976 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14977 NL80211_ATTR_PAD) ||
David S. Miller9360ffd2012-03-29 04:41:26 -040014978 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)))
14979 goto nla_put_failure;
Johannes Berg7f6cf312011-11-04 11:18:15 +010014980
Johannes Berg9c90a9f2013-06-04 12:46:03 +020014981 genlmsg_end(msg, hdr);
Johannes Berg7f6cf312011-11-04 11:18:15 +010014982
Johannes Berg68eb5502013-11-19 15:19:38 +010014983 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010014984 NL80211_MCGRP_MLME, gfp);
Johannes Berg7f6cf312011-11-04 11:18:15 +010014985 return;
14986
14987 nla_put_failure:
14988 genlmsg_cancel(msg, hdr);
14989 nlmsg_free(msg);
14990}
14991EXPORT_SYMBOL(cfg80211_probe_status);
14992
Johannes Berg5e760232011-11-04 11:18:17 +010014993void cfg80211_report_obss_beacon(struct wiphy *wiphy,
14994 const u8 *frame, size_t len,
Ben Greear37c73b52012-10-26 14:49:25 -070014995 int freq, int sig_dbm)
Johannes Berg5e760232011-11-04 11:18:17 +010014996{
Zhao, Gangf26cbf42014-04-21 12:53:03 +080014997 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg5e760232011-11-04 11:18:17 +010014998 struct sk_buff *msg;
14999 void *hdr;
Ben Greear37c73b52012-10-26 14:49:25 -070015000 struct cfg80211_beacon_registration *reg;
Johannes Berg5e760232011-11-04 11:18:17 +010015001
Beni Lev4ee3e062012-08-27 12:49:39 +030015002 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
15003
Ben Greear37c73b52012-10-26 14:49:25 -070015004 spin_lock_bh(&rdev->beacon_registrations_lock);
15005 list_for_each_entry(reg, &rdev->beacon_registrations, list) {
15006 msg = nlmsg_new(len + 100, GFP_ATOMIC);
15007 if (!msg) {
15008 spin_unlock_bh(&rdev->beacon_registrations_lock);
15009 return;
15010 }
Johannes Berg5e760232011-11-04 11:18:17 +010015011
Ben Greear37c73b52012-10-26 14:49:25 -070015012 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
15013 if (!hdr)
15014 goto nla_put_failure;
Johannes Berg5e760232011-11-04 11:18:17 +010015015
Ben Greear37c73b52012-10-26 14:49:25 -070015016 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15017 (freq &&
15018 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
15019 (sig_dbm &&
15020 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
15021 nla_put(msg, NL80211_ATTR_FRAME, len, frame))
15022 goto nla_put_failure;
15023
15024 genlmsg_end(msg, hdr);
15025
15026 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
Johannes Berg5e760232011-11-04 11:18:17 +010015027 }
Ben Greear37c73b52012-10-26 14:49:25 -070015028 spin_unlock_bh(&rdev->beacon_registrations_lock);
Johannes Berg5e760232011-11-04 11:18:17 +010015029 return;
15030
15031 nla_put_failure:
Ben Greear37c73b52012-10-26 14:49:25 -070015032 spin_unlock_bh(&rdev->beacon_registrations_lock);
15033 if (hdr)
15034 genlmsg_cancel(msg, hdr);
Johannes Berg5e760232011-11-04 11:18:17 +010015035 nlmsg_free(msg);
15036}
15037EXPORT_SYMBOL(cfg80211_report_obss_beacon);
15038
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010015039#ifdef CONFIG_PM
Luciano Coelho8cd4d452014-09-17 11:55:28 +030015040static int cfg80211_net_detect_results(struct sk_buff *msg,
15041 struct cfg80211_wowlan_wakeup *wakeup)
15042{
15043 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
15044 struct nlattr *nl_results, *nl_match, *nl_freqs;
15045 int i, j;
15046
15047 nl_results = nla_nest_start(
15048 msg, NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
15049 if (!nl_results)
15050 return -EMSGSIZE;
15051
15052 for (i = 0; i < nd->n_matches; i++) {
15053 struct cfg80211_wowlan_nd_match *match = nd->matches[i];
15054
15055 nl_match = nla_nest_start(msg, i);
15056 if (!nl_match)
15057 break;
15058
15059 /* The SSID attribute is optional in nl80211, but for
15060 * simplicity reasons it's always present in the
15061 * cfg80211 structure. If a driver can't pass the
15062 * SSID, that needs to be changed. A zero length SSID
15063 * is still a valid SSID (wildcard), so it cannot be
15064 * used for this purpose.
15065 */
15066 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
15067 match->ssid.ssid)) {
15068 nla_nest_cancel(msg, nl_match);
15069 goto out;
15070 }
15071
15072 if (match->n_channels) {
15073 nl_freqs = nla_nest_start(
15074 msg, NL80211_ATTR_SCAN_FREQUENCIES);
15075 if (!nl_freqs) {
15076 nla_nest_cancel(msg, nl_match);
15077 goto out;
15078 }
15079
15080 for (j = 0; j < match->n_channels; j++) {
Samuel Tan5528fae82015-02-09 21:29:15 +020015081 if (nla_put_u32(msg, j, match->channels[j])) {
Luciano Coelho8cd4d452014-09-17 11:55:28 +030015082 nla_nest_cancel(msg, nl_freqs);
15083 nla_nest_cancel(msg, nl_match);
15084 goto out;
15085 }
15086 }
15087
15088 nla_nest_end(msg, nl_freqs);
15089 }
15090
15091 nla_nest_end(msg, nl_match);
15092 }
15093
15094out:
15095 nla_nest_end(msg, nl_results);
15096 return 0;
15097}
15098
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010015099void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
15100 struct cfg80211_wowlan_wakeup *wakeup,
15101 gfp_t gfp)
15102{
Zhao, Gangf26cbf42014-04-21 12:53:03 +080015103 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010015104 struct sk_buff *msg;
15105 void *hdr;
Johannes Berg9c90a9f2013-06-04 12:46:03 +020015106 int size = 200;
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010015107
15108 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
15109
15110 if (wakeup)
15111 size += wakeup->packet_present_len;
15112
15113 msg = nlmsg_new(size, gfp);
15114 if (!msg)
15115 return;
15116
15117 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
15118 if (!hdr)
15119 goto free_msg;
15120
15121 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020015122 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15123 NL80211_ATTR_PAD))
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010015124 goto free_msg;
15125
15126 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15127 wdev->netdev->ifindex))
15128 goto free_msg;
15129
15130 if (wakeup) {
15131 struct nlattr *reasons;
15132
15133 reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
Johannes Berg7fa322c2013-10-25 11:16:58 +020015134 if (!reasons)
15135 goto free_msg;
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010015136
15137 if (wakeup->disconnect &&
15138 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
15139 goto free_msg;
15140 if (wakeup->magic_pkt &&
15141 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
15142 goto free_msg;
15143 if (wakeup->gtk_rekey_failure &&
15144 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
15145 goto free_msg;
15146 if (wakeup->eap_identity_req &&
15147 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
15148 goto free_msg;
15149 if (wakeup->four_way_handshake &&
15150 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
15151 goto free_msg;
15152 if (wakeup->rfkill_release &&
15153 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
15154 goto free_msg;
15155
15156 if (wakeup->pattern_idx >= 0 &&
15157 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
15158 wakeup->pattern_idx))
15159 goto free_msg;
15160
Johannes Bergae917c92013-10-25 11:05:22 +020015161 if (wakeup->tcp_match &&
15162 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
15163 goto free_msg;
Johannes Berg2a0e0472013-01-23 22:57:40 +010015164
Johannes Bergae917c92013-10-25 11:05:22 +020015165 if (wakeup->tcp_connlost &&
15166 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
15167 goto free_msg;
Johannes Berg2a0e0472013-01-23 22:57:40 +010015168
Johannes Bergae917c92013-10-25 11:05:22 +020015169 if (wakeup->tcp_nomoretokens &&
15170 nla_put_flag(msg,
15171 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
15172 goto free_msg;
Johannes Berg2a0e0472013-01-23 22:57:40 +010015173
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010015174 if (wakeup->packet) {
15175 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
15176 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
15177
15178 if (!wakeup->packet_80211) {
15179 pkt_attr =
15180 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
15181 len_attr =
15182 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
15183 }
15184
15185 if (wakeup->packet_len &&
15186 nla_put_u32(msg, len_attr, wakeup->packet_len))
15187 goto free_msg;
15188
15189 if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
15190 wakeup->packet))
15191 goto free_msg;
15192 }
15193
Luciano Coelho8cd4d452014-09-17 11:55:28 +030015194 if (wakeup->net_detect &&
15195 cfg80211_net_detect_results(msg, wakeup))
15196 goto free_msg;
15197
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010015198 nla_nest_end(msg, reasons);
15199 }
15200
Johannes Berg9c90a9f2013-06-04 12:46:03 +020015201 genlmsg_end(msg, hdr);
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010015202
Johannes Berg68eb5502013-11-19 15:19:38 +010015203 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010015204 NL80211_MCGRP_MLME, gfp);
Johannes Bergcd8f7cb2013-01-22 12:34:29 +010015205 return;
15206
15207 free_msg:
15208 nlmsg_free(msg);
15209}
15210EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
15211#endif
15212
Jouni Malinen3475b092012-11-16 22:49:57 +020015213void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
15214 enum nl80211_tdls_operation oper,
15215 u16 reason_code, gfp_t gfp)
15216{
15217 struct wireless_dev *wdev = dev->ieee80211_ptr;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080015218 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Jouni Malinen3475b092012-11-16 22:49:57 +020015219 struct sk_buff *msg;
15220 void *hdr;
Jouni Malinen3475b092012-11-16 22:49:57 +020015221
15222 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
15223 reason_code);
15224
15225 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15226 if (!msg)
15227 return;
15228
15229 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
15230 if (!hdr) {
15231 nlmsg_free(msg);
15232 return;
15233 }
15234
15235 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15236 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15237 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
15238 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
15239 (reason_code > 0 &&
15240 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
15241 goto nla_put_failure;
15242
Johannes Berg9c90a9f2013-06-04 12:46:03 +020015243 genlmsg_end(msg, hdr);
Jouni Malinen3475b092012-11-16 22:49:57 +020015244
Johannes Berg68eb5502013-11-19 15:19:38 +010015245 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010015246 NL80211_MCGRP_MLME, gfp);
Jouni Malinen3475b092012-11-16 22:49:57 +020015247 return;
15248
15249 nla_put_failure:
15250 genlmsg_cancel(msg, hdr);
15251 nlmsg_free(msg);
15252}
15253EXPORT_SYMBOL(cfg80211_tdls_oper_request);
15254
Jouni Malinen026331c2010-02-15 12:53:10 +020015255static int nl80211_netlink_notify(struct notifier_block * nb,
15256 unsigned long state,
15257 void *_notify)
15258{
15259 struct netlink_notify *notify = _notify;
15260 struct cfg80211_registered_device *rdev;
15261 struct wireless_dev *wdev;
Ben Greear37c73b52012-10-26 14:49:25 -070015262 struct cfg80211_beacon_registration *reg, *tmp;
Jouni Malinen026331c2010-02-15 12:53:10 +020015263
Dmitry Ivanov8f815cd2016-04-06 17:23:18 +030015264 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
Jouni Malinen026331c2010-02-15 12:53:10 +020015265 return NOTIFY_DONE;
15266
15267 rcu_read_lock();
15268
Johannes Berg5e760232011-11-04 11:18:17 +010015269 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
Arend Van Sprielca986ad2017-04-21 13:05:00 +010015270 struct cfg80211_sched_scan_request *sched_scan_req;
Jukka Rissanen93a1e862014-12-15 13:25:39 +020015271
Arend Van Sprielca986ad2017-04-21 13:05:00 +010015272 list_for_each_entry_rcu(sched_scan_req,
15273 &rdev->sched_scan_req_list,
15274 list) {
15275 if (sched_scan_req->owner_nlportid == notify->portid) {
15276 sched_scan_req->nl_owner_dead = true;
Johannes Berg753aacf2017-01-05 10:57:14 +010015277 schedule_work(&rdev->sched_scan_stop_wk);
Arend Van Sprielca986ad2017-04-21 13:05:00 +010015278 }
Johannes Berg753aacf2017-01-05 10:57:14 +010015279 }
Johannes Berg78f22b62014-03-24 17:57:27 +010015280
Johannes Berg53873f12016-05-03 16:52:04 +030015281 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
Eric W. Biederman15e47302012-09-07 20:12:54 +000015282 cfg80211_mlme_unregister_socket(wdev, notify->portid);
Ben Greear37c73b52012-10-26 14:49:25 -070015283
Johannes Bergab810072017-04-26 07:43:41 +020015284 if (wdev->owner_nlportid == notify->portid) {
15285 wdev->nl_owner_dead = true;
15286 schedule_work(&rdev->destroy_work);
15287 } else if (wdev->conn_owner_nlportid == notify->portid) {
Andrzej Zaborowskibd2522b2017-01-06 16:33:43 -050015288 schedule_work(&wdev->disconnect_wk);
Johannes Bergab810072017-04-26 07:43:41 +020015289 }
Johannes Berg78f22b62014-03-24 17:57:27 +010015290 }
15291
Ben Greear37c73b52012-10-26 14:49:25 -070015292 spin_lock_bh(&rdev->beacon_registrations_lock);
15293 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
15294 list) {
15295 if (reg->nlportid == notify->portid) {
15296 list_del(&reg->list);
15297 kfree(reg);
15298 break;
15299 }
15300 }
15301 spin_unlock_bh(&rdev->beacon_registrations_lock);
Johannes Berg5e760232011-11-04 11:18:17 +010015302 }
Jouni Malinen026331c2010-02-15 12:53:10 +020015303
15304 rcu_read_unlock();
15305
Ilan peer05050752015-03-04 00:32:06 -050015306 /*
15307 * It is possible that the user space process that is controlling the
15308 * indoor setting disappeared, so notify the regulatory core.
15309 */
15310 regulatory_netlink_notify(notify->portid);
Zhao, Gang6784c7d2014-04-21 12:53:04 +080015311 return NOTIFY_OK;
Jouni Malinen026331c2010-02-15 12:53:10 +020015312}
15313
15314static struct notifier_block nl80211_netlink_notifier = {
15315 .notifier_call = nl80211_netlink_notify,
15316};
15317
Jouni Malinen355199e2013-02-27 17:14:27 +020015318void cfg80211_ft_event(struct net_device *netdev,
15319 struct cfg80211_ft_event_params *ft_event)
15320{
15321 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080015322 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Jouni Malinen355199e2013-02-27 17:14:27 +020015323 struct sk_buff *msg;
15324 void *hdr;
Jouni Malinen355199e2013-02-27 17:14:27 +020015325
15326 trace_cfg80211_ft_event(wiphy, netdev, ft_event);
15327
15328 if (!ft_event->target_ap)
15329 return;
15330
Johannes Berg4ef8c1c2017-01-09 11:10:42 +010015331 msg = nlmsg_new(100 + ft_event->ric_ies_len, GFP_KERNEL);
Jouni Malinen355199e2013-02-27 17:14:27 +020015332 if (!msg)
15333 return;
15334
15335 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
Johannes Bergae917c92013-10-25 11:05:22 +020015336 if (!hdr)
15337 goto out;
Jouni Malinen355199e2013-02-27 17:14:27 +020015338
Johannes Bergae917c92013-10-25 11:05:22 +020015339 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15340 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15341 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
15342 goto out;
15343
15344 if (ft_event->ies &&
15345 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
15346 goto out;
15347 if (ft_event->ric_ies &&
15348 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
15349 ft_event->ric_ies))
15350 goto out;
Jouni Malinen355199e2013-02-27 17:14:27 +020015351
Johannes Berg9c90a9f2013-06-04 12:46:03 +020015352 genlmsg_end(msg, hdr);
Jouni Malinen355199e2013-02-27 17:14:27 +020015353
Johannes Berg68eb5502013-11-19 15:19:38 +010015354 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
Johannes Berg2a94fe42013-11-19 15:19:39 +010015355 NL80211_MCGRP_MLME, GFP_KERNEL);
Johannes Bergae917c92013-10-25 11:05:22 +020015356 return;
15357 out:
15358 nlmsg_free(msg);
Jouni Malinen355199e2013-02-27 17:14:27 +020015359}
15360EXPORT_SYMBOL(cfg80211_ft_event);
15361
Arend van Spriel5de17982013-04-18 15:49:00 +020015362void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
15363{
15364 struct cfg80211_registered_device *rdev;
15365 struct sk_buff *msg;
15366 void *hdr;
15367 u32 nlportid;
15368
Zhao, Gangf26cbf42014-04-21 12:53:03 +080015369 rdev = wiphy_to_rdev(wdev->wiphy);
Arend van Spriel5de17982013-04-18 15:49:00 +020015370 if (!rdev->crit_proto_nlportid)
15371 return;
15372
15373 nlportid = rdev->crit_proto_nlportid;
15374 rdev->crit_proto_nlportid = 0;
15375
15376 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15377 if (!msg)
15378 return;
15379
15380 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
15381 if (!hdr)
15382 goto nla_put_failure;
15383
15384 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020015385 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15386 NL80211_ATTR_PAD))
Arend van Spriel5de17982013-04-18 15:49:00 +020015387 goto nla_put_failure;
15388
15389 genlmsg_end(msg, hdr);
15390
15391 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15392 return;
15393
15394 nla_put_failure:
15395 if (hdr)
15396 genlmsg_cancel(msg, hdr);
15397 nlmsg_free(msg);
Arend van Spriel5de17982013-04-18 15:49:00 +020015398}
15399EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
15400
Johannes Berg348baf02014-01-24 14:06:29 +010015401void nl80211_send_ap_stopped(struct wireless_dev *wdev)
15402{
15403 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080015404 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg348baf02014-01-24 14:06:29 +010015405 struct sk_buff *msg;
15406 void *hdr;
15407
15408 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15409 if (!msg)
15410 return;
15411
15412 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
15413 if (!hdr)
15414 goto out;
15415
15416 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15417 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
Nicolas Dichtel2dad6242016-04-25 10:25:22 +020015418 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15419 NL80211_ATTR_PAD))
Johannes Berg348baf02014-01-24 14:06:29 +010015420 goto out;
15421
15422 genlmsg_end(msg, hdr);
15423
15424 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
15425 NL80211_MCGRP_MLME, GFP_KERNEL);
15426 return;
15427 out:
15428 nlmsg_free(msg);
15429}
15430
Srinivas Dasari40cbfa92018-01-25 17:13:38 +020015431int cfg80211_external_auth_request(struct net_device *dev,
15432 struct cfg80211_external_auth_params *params,
15433 gfp_t gfp)
15434{
15435 struct wireless_dev *wdev = dev->ieee80211_ptr;
15436 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15437 struct sk_buff *msg;
15438 void *hdr;
15439
15440 if (!wdev->conn_owner_nlportid)
15441 return -EINVAL;
15442
15443 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15444 if (!msg)
15445 return -ENOMEM;
15446
15447 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH);
15448 if (!hdr)
15449 goto nla_put_failure;
15450
15451 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15452 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15453 nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) ||
15454 nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION,
15455 params->action) ||
15456 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) ||
15457 nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len,
15458 params->ssid.ssid))
15459 goto nla_put_failure;
15460
15461 genlmsg_end(msg, hdr);
15462 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
15463 wdev->conn_owner_nlportid);
15464 return 0;
15465
15466 nla_put_failure:
15467 nlmsg_free(msg);
15468 return -ENOBUFS;
15469}
15470EXPORT_SYMBOL(cfg80211_external_auth_request);
15471
Johannes Berg55682962007-09-20 13:09:35 -040015472/* initialisation/exit functions */
15473
Johannes Berg56989f62016-10-24 14:40:05 +020015474int __init nl80211_init(void)
Johannes Berg55682962007-09-20 13:09:35 -040015475{
Michał Mirosław0d63cbb2009-05-21 10:34:06 +000015476 int err;
Johannes Berg55682962007-09-20 13:09:35 -040015477
Johannes Berg489111e2016-10-24 14:40:03 +020015478 err = genl_register_family(&nl80211_fam);
Johannes Berg55682962007-09-20 13:09:35 -040015479 if (err)
15480 return err;
15481
Jouni Malinen026331c2010-02-15 12:53:10 +020015482 err = netlink_register_notifier(&nl80211_netlink_notifier);
15483 if (err)
15484 goto err_out;
15485
Johannes Berg55682962007-09-20 13:09:35 -040015486 return 0;
15487 err_out:
15488 genl_unregister_family(&nl80211_fam);
15489 return err;
15490}
15491
15492void nl80211_exit(void)
15493{
Jouni Malinen026331c2010-02-15 12:53:10 +020015494 netlink_unregister_notifier(&nl80211_netlink_notifier);
Johannes Berg55682962007-09-20 13:09:35 -040015495 genl_unregister_family(&nl80211_fam);
15496}