1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * This is the new netlink-based wireless configuration interface. 4 * 5 * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net> 6 * Copyright 2013-2014 Intel Mobile Communications GmbH 7 * Copyright 2015-2017 Intel Deutschland GmbH 8 * Copyright (C) 2018-2019 Intel Corporation 9 */ 10 11 #include <linux/if.h> 12 #include <linux/module.h> 13 #include <linux/err.h> 14 #include <linux/slab.h> 15 #include <linux/list.h> 16 #include <linux/if_ether.h> 17 #include <linux/ieee80211.h> 18 #include <linux/nl80211.h> 19 #include <linux/rtnetlink.h> 20 #include <linux/netlink.h> 21 #include <linux/nospec.h> 22 #include <linux/etherdevice.h> 23 #include <net/net_namespace.h> 24 #include <net/genetlink.h> 25 #include <net/cfg80211.h> 26 #include <net/sock.h> 27 #include <net/inet_connection_sock.h> 28 #include "core.h" 29 #include "nl80211.h" 30 #include "reg.h" 31 #include "rdev-ops.h" 32 33 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev, 34 struct genl_info *info, 35 struct cfg80211_crypto_settings *settings, 36 int cipher_limit); 37 38 /* the netlink family */ 39 static struct genl_family nl80211_fam; 40 41 /* multicast groups */ 42 enum nl80211_multicast_groups { 43 NL80211_MCGRP_CONFIG, 44 NL80211_MCGRP_SCAN, 45 NL80211_MCGRP_REGULATORY, 46 NL80211_MCGRP_MLME, 47 NL80211_MCGRP_VENDOR, 48 NL80211_MCGRP_NAN, 49 NL80211_MCGRP_TESTMODE /* keep last - ifdef! */ 50 }; 51 52 static const struct genl_multicast_group nl80211_mcgrps[] = { 53 [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG }, 54 [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN }, 55 [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG }, 56 [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME }, 57 [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR }, 58 [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN }, 59 #ifdef CONFIG_NL80211_TESTMODE 60 [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE } 61 #endif 62 }; 63 64 /* returns ERR_PTR values */ 65 static struct wireless_dev * 66 __cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs) 67 { 68 struct cfg80211_registered_device *rdev; 69 struct wireless_dev *result = NULL; 70 bool have_ifidx = attrs[NL80211_ATTR_IFINDEX]; 71 bool have_wdev_id = attrs[NL80211_ATTR_WDEV]; 72 u64 wdev_id; 73 int wiphy_idx = -1; 74 int ifidx = -1; 75 76 ASSERT_RTNL(); 77 78 if (!have_ifidx && !have_wdev_id) 79 return ERR_PTR(-EINVAL); 80 81 if (have_ifidx) 82 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]); 83 if (have_wdev_id) { 84 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]); 85 wiphy_idx = wdev_id >> 32; 86 } 87 88 list_for_each_entry(rdev, &cfg80211_rdev_list, list) { 89 struct wireless_dev *wdev; 90 91 if (wiphy_net(&rdev->wiphy) != netns) 92 continue; 93 94 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx) 95 continue; 96 97 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 98 if (have_ifidx && wdev->netdev && 99 wdev->netdev->ifindex == ifidx) { 100 result = wdev; 101 break; 102 } 103 if (have_wdev_id && wdev->identifier == (u32)wdev_id) { 104 result = wdev; 105 break; 106 } 107 } 108 109 if (result) 110 break; 111 } 112 113 if (result) 114 return result; 115 return ERR_PTR(-ENODEV); 116 } 117 118 static struct cfg80211_registered_device * 119 __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs) 120 { 121 struct cfg80211_registered_device *rdev = NULL, *tmp; 122 struct net_device *netdev; 123 124 ASSERT_RTNL(); 125 126 if (!attrs[NL80211_ATTR_WIPHY] && 127 !attrs[NL80211_ATTR_IFINDEX] && 128 !attrs[NL80211_ATTR_WDEV]) 129 return ERR_PTR(-EINVAL); 130 131 if (attrs[NL80211_ATTR_WIPHY]) 132 rdev = cfg80211_rdev_by_wiphy_idx( 133 nla_get_u32(attrs[NL80211_ATTR_WIPHY])); 134 135 if (attrs[NL80211_ATTR_WDEV]) { 136 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]); 137 struct wireless_dev *wdev; 138 bool found = false; 139 140 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32); 141 if (tmp) { 142 /* make sure wdev exists */ 143 list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) { 144 if (wdev->identifier != (u32)wdev_id) 145 continue; 146 found = true; 147 break; 148 } 149 150 if (!found) 151 tmp = NULL; 152 153 if (rdev && tmp != rdev) 154 return ERR_PTR(-EINVAL); 155 rdev = tmp; 156 } 157 } 158 159 if (attrs[NL80211_ATTR_IFINDEX]) { 160 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]); 161 162 netdev = __dev_get_by_index(netns, ifindex); 163 if (netdev) { 164 if (netdev->ieee80211_ptr) 165 tmp = wiphy_to_rdev( 166 netdev->ieee80211_ptr->wiphy); 167 else 168 tmp = NULL; 169 170 /* not wireless device -- return error */ 171 if (!tmp) 172 return ERR_PTR(-EINVAL); 173 174 /* mismatch -- return error */ 175 if (rdev && tmp != rdev) 176 return ERR_PTR(-EINVAL); 177 178 rdev = tmp; 179 } 180 } 181 182 if (!rdev) 183 return ERR_PTR(-ENODEV); 184 185 if (netns != wiphy_net(&rdev->wiphy)) 186 return ERR_PTR(-ENODEV); 187 188 return rdev; 189 } 190 191 /* 192 * This function returns a pointer to the driver 193 * that the genl_info item that is passed refers to. 194 * 195 * The result of this can be a PTR_ERR and hence must 196 * be checked with IS_ERR() for errors. 197 */ 198 static struct cfg80211_registered_device * 199 cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info) 200 { 201 return __cfg80211_rdev_from_attrs(netns, info->attrs); 202 } 203 204 static int validate_beacon_head(const struct nlattr *attr, 205 struct netlink_ext_ack *extack) 206 { 207 const u8 *data = nla_data(attr); 208 unsigned int len = nla_len(attr); 209 const struct element *elem; 210 const struct ieee80211_mgmt *mgmt = (void *)data; 211 unsigned int fixedlen = offsetof(struct ieee80211_mgmt, 212 u.beacon.variable); 213 214 if (len < fixedlen) 215 goto err; 216 217 if (ieee80211_hdrlen(mgmt->frame_control) != 218 offsetof(struct ieee80211_mgmt, u.beacon)) 219 goto err; 220 221 data += fixedlen; 222 len -= fixedlen; 223 224 for_each_element(elem, data, len) { 225 /* nothing */ 226 } 227 228 if (for_each_element_completed(elem, data, len)) 229 return 0; 230 231 err: 232 NL_SET_ERR_MSG_ATTR(extack, attr, "malformed beacon head"); 233 return -EINVAL; 234 } 235 236 static int validate_ie_attr(const struct nlattr *attr, 237 struct netlink_ext_ack *extack) 238 { 239 const u8 *data = nla_data(attr); 240 unsigned int len = nla_len(attr); 241 const struct element *elem; 242 243 for_each_element(elem, data, len) { 244 /* nothing */ 245 } 246 247 if (for_each_element_completed(elem, data, len)) 248 return 0; 249 250 NL_SET_ERR_MSG_ATTR(extack, attr, "malformed information elements"); 251 return -EINVAL; 252 } 253 254 /* policy for the attributes */ 255 static const struct nla_policy 256 nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = { 257 [NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, }, 258 [NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY, 259 .len = U8_MAX }, 260 [NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY, 261 .len = U8_MAX }, 262 }; 263 264 static const struct nla_policy 265 nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = { 266 [NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG }, 267 [NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 }, 268 [NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] = 269 NLA_POLICY_MAX(NLA_U8, 15), 270 [NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 }, 271 [NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] = 272 NLA_POLICY_MAX(NLA_U8, 15), 273 [NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] = 274 NLA_POLICY_MAX(NLA_U8, 31), 275 [NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 }, 276 [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG }, 277 [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG }, 278 }; 279 280 static const struct nla_policy 281 nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = { 282 [NL80211_PMSR_TYPE_FTM] = 283 NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy), 284 }; 285 286 static const struct nla_policy 287 nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = { 288 [NL80211_PMSR_REQ_ATTR_DATA] = 289 NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy), 290 [NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG }, 291 }; 292 293 static const struct nla_policy 294 nl80211_psmr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = { 295 [NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR, 296 /* 297 * we could specify this again to be the top-level policy, 298 * but that would open us up to recursion problems ... 299 */ 300 [NL80211_PMSR_PEER_ATTR_CHAN] = { .type = NLA_NESTED }, 301 [NL80211_PMSR_PEER_ATTR_REQ] = 302 NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy), 303 [NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT }, 304 }; 305 306 static const struct nla_policy 307 nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = { 308 [NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT }, 309 [NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT }, 310 [NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT }, 311 [NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT }, 312 [NL80211_PMSR_ATTR_PEERS] = 313 NLA_POLICY_NESTED_ARRAY(nl80211_psmr_peer_attr_policy), 314 }; 315 316 static const struct nla_policy 317 he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = { 318 [NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] = 319 NLA_POLICY_RANGE(NLA_U8, 1, 20), 320 [NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] = 321 NLA_POLICY_RANGE(NLA_U8, 1, 20), 322 }; 323 324 static const struct nla_policy 325 he_bss_color_policy[NL80211_HE_BSS_COLOR_ATTR_MAX + 1] = { 326 [NL80211_HE_BSS_COLOR_ATTR_COLOR] = NLA_POLICY_RANGE(NLA_U8, 1, 63), 327 [NL80211_HE_BSS_COLOR_ATTR_DISABLED] = { .type = NLA_FLAG }, 328 [NL80211_HE_BSS_COLOR_ATTR_PARTIAL] = { .type = NLA_FLAG }, 329 }; 330 331 const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = { 332 [0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD }, 333 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 }, 334 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING, 335 .len = 20-1 }, 336 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED }, 337 338 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 }, 339 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 }, 340 [NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8, 341 NL80211_EDMG_CHANNELS_MIN, 342 NL80211_EDMG_CHANNELS_MAX), 343 [NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8, 344 NL80211_EDMG_BW_CONFIG_MIN, 345 NL80211_EDMG_BW_CONFIG_MAX), 346 347 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 }, 348 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 }, 349 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 }, 350 351 [NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 352 [NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 353 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 }, 354 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 }, 355 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 }, 356 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG }, 357 358 [NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX), 359 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 }, 360 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 }, 361 362 [NL80211_ATTR_MAC] = { .type = NLA_EXACT_LEN_WARN, .len = ETH_ALEN }, 363 [NL80211_ATTR_PREV_BSSID] = { 364 .type = NLA_EXACT_LEN_WARN, 365 .len = ETH_ALEN 366 }, 367 368 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, }, 369 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY, 370 .len = WLAN_MAX_KEY_LEN }, 371 [NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 5), 372 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 }, 373 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG }, 374 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 375 [NL80211_ATTR_KEY_TYPE] = 376 NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES), 377 378 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 }, 379 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 }, 380 [NL80211_ATTR_BEACON_HEAD] = 381 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head, 382 IEEE80211_MAX_DATA_LEN), 383 [NL80211_ATTR_BEACON_TAIL] = 384 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 385 IEEE80211_MAX_DATA_LEN), 386 [NL80211_ATTR_STA_AID] = 387 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 388 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED }, 389 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 }, 390 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY, 391 .len = NL80211_MAX_SUPP_RATES }, 392 [NL80211_ATTR_STA_PLINK_ACTION] = 393 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1), 394 [NL80211_ATTR_STA_TX_POWER_SETTING] = 395 NLA_POLICY_RANGE(NLA_U8, 396 NL80211_TX_POWER_AUTOMATIC, 397 NL80211_TX_POWER_FIXED), 398 [NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 }, 399 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 }, 400 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ }, 401 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY, 402 .len = IEEE80211_MAX_MESH_ID_LEN }, 403 [NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT, 404 405 [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 }, 406 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED }, 407 408 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 }, 409 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 }, 410 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 }, 411 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY, 412 .len = NL80211_MAX_SUPP_RATES }, 413 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 }, 414 415 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED }, 416 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG }, 417 418 [NL80211_ATTR_HT_CAPABILITY] = { 419 .type = NLA_EXACT_LEN_WARN, 420 .len = NL80211_HT_CAPABILITY_LEN 421 }, 422 423 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 }, 424 [NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY, 425 validate_ie_attr, 426 IEEE80211_MAX_DATA_LEN), 427 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED }, 428 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED }, 429 430 [NL80211_ATTR_SSID] = { .type = NLA_BINARY, 431 .len = IEEE80211_MAX_SSID_LEN }, 432 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 }, 433 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 }, 434 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG }, 435 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG }, 436 [NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32, 437 NL80211_MFP_NO, 438 NL80211_MFP_OPTIONAL), 439 [NL80211_ATTR_STA_FLAGS2] = { 440 .len = sizeof(struct nl80211_sta_flag_update), 441 }, 442 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG }, 443 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 }, 444 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG }, 445 [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG }, 446 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG }, 447 [NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 }, 448 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 }, 449 [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 }, 450 [NL80211_ATTR_PID] = { .type = NLA_U32 }, 451 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 }, 452 [NL80211_ATTR_PMKID] = { 453 .type = NLA_EXACT_LEN_WARN, 454 .len = WLAN_PMKID_LEN 455 }, 456 [NL80211_ATTR_DURATION] = { .type = NLA_U32 }, 457 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 }, 458 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED }, 459 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY, 460 .len = IEEE80211_MAX_DATA_LEN }, 461 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, }, 462 [NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32, 463 NL80211_PS_DISABLED, 464 NL80211_PS_ENABLED), 465 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, }, 466 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG }, 467 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 }, 468 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 }, 469 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 }, 470 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 }, 471 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 }, 472 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 }, 473 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 }, 474 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG }, 475 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 476 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED }, 477 [NL80211_ATTR_STA_PLINK_STATE] = 478 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1), 479 [NL80211_ATTR_MESH_PEER_AID] = 480 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 481 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 }, 482 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED }, 483 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED }, 484 [NL80211_ATTR_HIDDEN_SSID] = 485 NLA_POLICY_RANGE(NLA_U32, 486 NL80211_HIDDEN_SSID_NOT_IN_USE, 487 NL80211_HIDDEN_SSID_ZERO_CONTENTS), 488 [NL80211_ATTR_IE_PROBE_RESP] = 489 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 490 IEEE80211_MAX_DATA_LEN), 491 [NL80211_ATTR_IE_ASSOC_RESP] = 492 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 493 IEEE80211_MAX_DATA_LEN), 494 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG }, 495 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED }, 496 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG }, 497 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 }, 498 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 }, 499 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 }, 500 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG }, 501 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG }, 502 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG }, 503 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG }, 504 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY, 505 .len = IEEE80211_MAX_DATA_LEN }, 506 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 }, 507 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG }, 508 [NL80211_ATTR_HT_CAPABILITY_MASK] = { 509 .len = NL80211_HT_CAPABILITY_LEN 510 }, 511 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 }, 512 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 }, 513 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 }, 514 [NL80211_ATTR_WDEV] = { .type = NLA_U64 }, 515 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 }, 516 [NL80211_ATTR_AUTH_DATA] = { .type = NLA_BINARY, }, 517 [NL80211_ATTR_VHT_CAPABILITY] = { 518 .type = NLA_EXACT_LEN_WARN, 519 .len = NL80211_VHT_CAPABILITY_LEN 520 }, 521 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 }, 522 [NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127), 523 [NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1), 524 [NL80211_ATTR_LOCAL_MESH_POWER_MODE] = 525 NLA_POLICY_RANGE(NLA_U32, 526 NL80211_MESH_POWER_UNKNOWN + 1, 527 NL80211_MESH_POWER_MAX), 528 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 }, 529 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED }, 530 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 }, 531 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, }, 532 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, }, 533 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG }, 534 [NL80211_ATTR_VHT_CAPABILITY_MASK] = { 535 .len = NL80211_VHT_CAPABILITY_LEN, 536 }, 537 [NL80211_ATTR_MDID] = { .type = NLA_U16 }, 538 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY, 539 .len = IEEE80211_MAX_DATA_LEN }, 540 [NL80211_ATTR_PEER_AID] = 541 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 542 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 }, 543 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG }, 544 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED }, 545 [NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY }, 546 [NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY }, 547 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY }, 548 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY }, 549 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG }, 550 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 }, 551 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 }, 552 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 }, 553 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY }, 554 [NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY, 555 .len = IEEE80211_QOS_MAP_LEN_MAX }, 556 [NL80211_ATTR_MAC_HINT] = { 557 .type = NLA_EXACT_LEN_WARN, 558 .len = ETH_ALEN 559 }, 560 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 }, 561 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 }, 562 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG }, 563 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY }, 564 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG }, 565 [NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1), 566 [NL80211_ATTR_USER_PRIO] = 567 NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1), 568 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 }, 569 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 }, 570 [NL80211_ATTR_MAC_MASK] = { 571 .type = NLA_EXACT_LEN_WARN, 572 .len = ETH_ALEN 573 }, 574 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG }, 575 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 }, 576 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 }, 577 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG }, 578 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG }, 579 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED }, 580 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = 581 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1), 582 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = { 583 .len = VHT_MUMIMO_GROUPS_DATA_LEN 584 }, 585 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = { 586 .type = NLA_EXACT_LEN_WARN, 587 .len = ETH_ALEN 588 }, 589 [NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1), 590 [NL80211_ATTR_BANDS] = { .type = NLA_U32 }, 591 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED }, 592 [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY, 593 .len = FILS_MAX_KEK_LEN }, 594 [NL80211_ATTR_FILS_NONCES] = { 595 .type = NLA_EXACT_LEN_WARN, 596 .len = 2 * FILS_NONCE_LEN 597 }, 598 [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, }, 599 [NL80211_ATTR_BSSID] = { .type = NLA_EXACT_LEN_WARN, .len = ETH_ALEN }, 600 [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 }, 601 [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = { 602 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 603 }, 604 [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 }, 605 [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY, 606 .len = FILS_ERP_MAX_USERNAME_LEN }, 607 [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY, 608 .len = FILS_ERP_MAX_REALM_LEN }, 609 [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 }, 610 [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY, 611 .len = FILS_ERP_MAX_RRK_LEN }, 612 [NL80211_ATTR_FILS_CACHE_ID] = { .type = NLA_EXACT_LEN_WARN, .len = 2 }, 613 [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN }, 614 [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG }, 615 [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG }, 616 617 [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 }, 618 [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 }, 619 [NL80211_ATTR_TXQ_QUANTUM] = { .type = NLA_U32 }, 620 [NL80211_ATTR_HE_CAPABILITY] = { .type = NLA_BINARY, 621 .len = NL80211_HE_MAX_CAPABILITY_LEN }, 622 623 [NL80211_ATTR_FTM_RESPONDER] = { 624 .type = NLA_NESTED, 625 .validation_data = nl80211_ftm_responder_policy, 626 }, 627 [NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1), 628 [NL80211_ATTR_PEER_MEASUREMENTS] = 629 NLA_POLICY_NESTED(nl80211_pmsr_attr_policy), 630 [NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1), 631 [NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY, 632 .len = SAE_PASSWORD_MAX_LEN }, 633 [NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG }, 634 [NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy), 635 [NL80211_ATTR_VLAN_ID] = NLA_POLICY_RANGE(NLA_U16, 1, VLAN_N_VID - 2), 636 [NL80211_ATTR_HE_BSS_COLOR] = NLA_POLICY_NESTED(he_bss_color_policy), 637 [NL80211_ATTR_SRC_MAC] = NLA_POLICY_ETH_ADDR, 638 [NL80211_ATTR_DST_MAC] = NLA_POLICY_ETH_ADDR, 639 }; 640 641 /* policy for the key attributes */ 642 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = { 643 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN }, 644 [NL80211_KEY_IDX] = { .type = NLA_U8 }, 645 [NL80211_KEY_CIPHER] = { .type = NLA_U32 }, 646 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 647 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG }, 648 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG }, 649 [NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1), 650 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 651 [NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX), 652 }; 653 654 /* policy for the key default flags */ 655 static const struct nla_policy 656 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = { 657 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG }, 658 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG }, 659 }; 660 661 #ifdef CONFIG_PM 662 /* policy for WoWLAN attributes */ 663 static const struct nla_policy 664 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = { 665 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG }, 666 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG }, 667 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG }, 668 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED }, 669 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG }, 670 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG }, 671 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG }, 672 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG }, 673 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED }, 674 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED }, 675 }; 676 677 static const struct nla_policy 678 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = { 679 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 }, 680 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 }, 681 [NL80211_WOWLAN_TCP_DST_MAC] = { 682 .type = NLA_EXACT_LEN_WARN, 683 .len = ETH_ALEN 684 }, 685 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 }, 686 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 }, 687 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .type = NLA_MIN_LEN, .len = 1 }, 688 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = { 689 .len = sizeof(struct nl80211_wowlan_tcp_data_seq) 690 }, 691 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = { 692 .len = sizeof(struct nl80211_wowlan_tcp_data_token) 693 }, 694 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 }, 695 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .type = NLA_MIN_LEN, .len = 1 }, 696 [NL80211_WOWLAN_TCP_WAKE_MASK] = { .type = NLA_MIN_LEN, .len = 1 }, 697 }; 698 #endif /* CONFIG_PM */ 699 700 /* policy for coalesce rule attributes */ 701 static const struct nla_policy 702 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = { 703 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 }, 704 [NL80211_ATTR_COALESCE_RULE_CONDITION] = 705 NLA_POLICY_RANGE(NLA_U32, 706 NL80211_COALESCE_CONDITION_MATCH, 707 NL80211_COALESCE_CONDITION_NO_MATCH), 708 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED }, 709 }; 710 711 /* policy for GTK rekey offload attributes */ 712 static const struct nla_policy 713 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = { 714 [NL80211_REKEY_DATA_KEK] = { 715 .type = NLA_EXACT_LEN_WARN, 716 .len = NL80211_KEK_LEN, 717 }, 718 [NL80211_REKEY_DATA_KCK] = { 719 .type = NLA_EXACT_LEN_WARN, 720 .len = NL80211_KCK_LEN, 721 }, 722 [NL80211_REKEY_DATA_REPLAY_CTR] = { 723 .type = NLA_EXACT_LEN_WARN, 724 .len = NL80211_REPLAY_CTR_LEN 725 }, 726 }; 727 728 static const struct nla_policy 729 nl80211_match_band_rssi_policy[NUM_NL80211_BANDS] = { 730 [NL80211_BAND_2GHZ] = { .type = NLA_S32 }, 731 [NL80211_BAND_5GHZ] = { .type = NLA_S32 }, 732 [NL80211_BAND_6GHZ] = { .type = NLA_S32 }, 733 [NL80211_BAND_60GHZ] = { .type = NLA_S32 }, 734 }; 735 736 static const struct nla_policy 737 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = { 738 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY, 739 .len = IEEE80211_MAX_SSID_LEN }, 740 [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = { 741 .type = NLA_EXACT_LEN_WARN, 742 .len = ETH_ALEN 743 }, 744 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 }, 745 [NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI] = 746 NLA_POLICY_NESTED(nl80211_match_band_rssi_policy), 747 }; 748 749 static const struct nla_policy 750 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = { 751 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 }, 752 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 }, 753 }; 754 755 static const struct nla_policy 756 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = { 757 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG }, 758 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 }, 759 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = { 760 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 761 }, 762 }; 763 764 /* policy for NAN function attributes */ 765 static const struct nla_policy 766 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = { 767 [NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 }, 768 [NL80211_NAN_FUNC_SERVICE_ID] = { 769 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN }, 770 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 }, 771 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG }, 772 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG }, 773 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 }, 774 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 }, 775 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = { 776 .type = NLA_EXACT_LEN_WARN, 777 .len = ETH_ALEN 778 }, 779 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG }, 780 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 }, 781 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY, 782 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN }, 783 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED }, 784 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED }, 785 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED }, 786 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 }, 787 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 }, 788 }; 789 790 /* policy for Service Response Filter attributes */ 791 static const struct nla_policy 792 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = { 793 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG }, 794 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY, 795 .len = NL80211_NAN_FUNC_SRF_MAX_LEN }, 796 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 }, 797 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED }, 798 }; 799 800 /* policy for packet pattern attributes */ 801 static const struct nla_policy 802 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = { 803 [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, }, 804 [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, }, 805 [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 }, 806 }; 807 808 int nl80211_prepare_wdev_dump(struct netlink_callback *cb, 809 struct cfg80211_registered_device **rdev, 810 struct wireless_dev **wdev) 811 { 812 int err; 813 814 if (!cb->args[0]) { 815 struct nlattr **attrbuf; 816 817 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 818 GFP_KERNEL); 819 if (!attrbuf) 820 return -ENOMEM; 821 822 err = nlmsg_parse_deprecated(cb->nlh, 823 GENL_HDRLEN + nl80211_fam.hdrsize, 824 attrbuf, nl80211_fam.maxattr, 825 nl80211_policy, NULL); 826 if (err) { 827 kfree(attrbuf); 828 return err; 829 } 830 831 *wdev = __cfg80211_wdev_from_attrs(sock_net(cb->skb->sk), 832 attrbuf); 833 kfree(attrbuf); 834 if (IS_ERR(*wdev)) 835 return PTR_ERR(*wdev); 836 *rdev = wiphy_to_rdev((*wdev)->wiphy); 837 /* 0 is the first index - add 1 to parse only once */ 838 cb->args[0] = (*rdev)->wiphy_idx + 1; 839 cb->args[1] = (*wdev)->identifier; 840 } else { 841 /* subtract the 1 again here */ 842 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 843 struct wireless_dev *tmp; 844 845 if (!wiphy) 846 return -ENODEV; 847 *rdev = wiphy_to_rdev(wiphy); 848 *wdev = NULL; 849 850 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) { 851 if (tmp->identifier == cb->args[1]) { 852 *wdev = tmp; 853 break; 854 } 855 } 856 857 if (!*wdev) 858 return -ENODEV; 859 } 860 861 return 0; 862 } 863 864 /* message building helper */ 865 void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq, 866 int flags, u8 cmd) 867 { 868 /* since there is no private header just add the generic one */ 869 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd); 870 } 871 872 static int nl80211_msg_put_wmm_rules(struct sk_buff *msg, 873 const struct ieee80211_reg_rule *rule) 874 { 875 int j; 876 struct nlattr *nl_wmm_rules = 877 nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM); 878 879 if (!nl_wmm_rules) 880 goto nla_put_failure; 881 882 for (j = 0; j < IEEE80211_NUM_ACS; j++) { 883 struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j); 884 885 if (!nl_wmm_rule) 886 goto nla_put_failure; 887 888 if (nla_put_u16(msg, NL80211_WMMR_CW_MIN, 889 rule->wmm_rule.client[j].cw_min) || 890 nla_put_u16(msg, NL80211_WMMR_CW_MAX, 891 rule->wmm_rule.client[j].cw_max) || 892 nla_put_u8(msg, NL80211_WMMR_AIFSN, 893 rule->wmm_rule.client[j].aifsn) || 894 nla_put_u16(msg, NL80211_WMMR_TXOP, 895 rule->wmm_rule.client[j].cot)) 896 goto nla_put_failure; 897 898 nla_nest_end(msg, nl_wmm_rule); 899 } 900 nla_nest_end(msg, nl_wmm_rules); 901 902 return 0; 903 904 nla_put_failure: 905 return -ENOBUFS; 906 } 907 908 static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy, 909 struct ieee80211_channel *chan, 910 bool large) 911 { 912 /* Some channels must be completely excluded from the 913 * list to protect old user-space tools from breaking 914 */ 915 if (!large && chan->flags & 916 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ)) 917 return 0; 918 919 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ, 920 chan->center_freq)) 921 goto nla_put_failure; 922 923 if ((chan->flags & IEEE80211_CHAN_DISABLED) && 924 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED)) 925 goto nla_put_failure; 926 if (chan->flags & IEEE80211_CHAN_NO_IR) { 927 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR)) 928 goto nla_put_failure; 929 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS)) 930 goto nla_put_failure; 931 } 932 if (chan->flags & IEEE80211_CHAN_RADAR) { 933 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR)) 934 goto nla_put_failure; 935 if (large) { 936 u32 time; 937 938 time = elapsed_jiffies_msecs(chan->dfs_state_entered); 939 940 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE, 941 chan->dfs_state)) 942 goto nla_put_failure; 943 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME, 944 time)) 945 goto nla_put_failure; 946 if (nla_put_u32(msg, 947 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME, 948 chan->dfs_cac_ms)) 949 goto nla_put_failure; 950 } 951 } 952 953 if (large) { 954 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) && 955 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS)) 956 goto nla_put_failure; 957 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) && 958 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS)) 959 goto nla_put_failure; 960 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) && 961 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ)) 962 goto nla_put_failure; 963 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) && 964 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ)) 965 goto nla_put_failure; 966 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) && 967 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY)) 968 goto nla_put_failure; 969 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) && 970 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT)) 971 goto nla_put_failure; 972 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) && 973 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ)) 974 goto nla_put_failure; 975 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) && 976 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ)) 977 goto nla_put_failure; 978 if ((chan->flags & IEEE80211_CHAN_NO_HE) && 979 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HE)) 980 goto nla_put_failure; 981 } 982 983 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER, 984 DBM_TO_MBM(chan->max_power))) 985 goto nla_put_failure; 986 987 if (large) { 988 const struct ieee80211_reg_rule *rule = 989 freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq)); 990 991 if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) { 992 if (nl80211_msg_put_wmm_rules(msg, rule)) 993 goto nla_put_failure; 994 } 995 } 996 997 return 0; 998 999 nla_put_failure: 1000 return -ENOBUFS; 1001 } 1002 1003 static bool nl80211_put_txq_stats(struct sk_buff *msg, 1004 struct cfg80211_txq_stats *txqstats, 1005 int attrtype) 1006 { 1007 struct nlattr *txqattr; 1008 1009 #define PUT_TXQVAL_U32(attr, memb) do { \ 1010 if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) && \ 1011 nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \ 1012 return false; \ 1013 } while (0) 1014 1015 txqattr = nla_nest_start_noflag(msg, attrtype); 1016 if (!txqattr) 1017 return false; 1018 1019 PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes); 1020 PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets); 1021 PUT_TXQVAL_U32(FLOWS, flows); 1022 PUT_TXQVAL_U32(DROPS, drops); 1023 PUT_TXQVAL_U32(ECN_MARKS, ecn_marks); 1024 PUT_TXQVAL_U32(OVERLIMIT, overlimit); 1025 PUT_TXQVAL_U32(OVERMEMORY, overmemory); 1026 PUT_TXQVAL_U32(COLLISIONS, collisions); 1027 PUT_TXQVAL_U32(TX_BYTES, tx_bytes); 1028 PUT_TXQVAL_U32(TX_PACKETS, tx_packets); 1029 PUT_TXQVAL_U32(MAX_FLOWS, max_flows); 1030 nla_nest_end(msg, txqattr); 1031 1032 #undef PUT_TXQVAL_U32 1033 return true; 1034 } 1035 1036 /* netlink command implementations */ 1037 1038 struct key_parse { 1039 struct key_params p; 1040 int idx; 1041 int type; 1042 bool def, defmgmt; 1043 bool def_uni, def_multi; 1044 }; 1045 1046 static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key, 1047 struct key_parse *k) 1048 { 1049 struct nlattr *tb[NL80211_KEY_MAX + 1]; 1050 int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key, 1051 nl80211_key_policy, 1052 info->extack); 1053 if (err) 1054 return err; 1055 1056 k->def = !!tb[NL80211_KEY_DEFAULT]; 1057 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT]; 1058 1059 if (k->def) { 1060 k->def_uni = true; 1061 k->def_multi = true; 1062 } 1063 if (k->defmgmt) 1064 k->def_multi = true; 1065 1066 if (tb[NL80211_KEY_IDX]) 1067 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]); 1068 1069 if (tb[NL80211_KEY_DATA]) { 1070 k->p.key = nla_data(tb[NL80211_KEY_DATA]); 1071 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]); 1072 } 1073 1074 if (tb[NL80211_KEY_SEQ]) { 1075 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]); 1076 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]); 1077 } 1078 1079 if (tb[NL80211_KEY_CIPHER]) 1080 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]); 1081 1082 if (tb[NL80211_KEY_TYPE]) 1083 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]); 1084 1085 if (tb[NL80211_KEY_DEFAULT_TYPES]) { 1086 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1087 1088 err = nla_parse_nested_deprecated(kdt, 1089 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1090 tb[NL80211_KEY_DEFAULT_TYPES], 1091 nl80211_key_default_policy, 1092 info->extack); 1093 if (err) 1094 return err; 1095 1096 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1097 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1098 } 1099 1100 if (tb[NL80211_KEY_MODE]) 1101 k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]); 1102 1103 return 0; 1104 } 1105 1106 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k) 1107 { 1108 if (info->attrs[NL80211_ATTR_KEY_DATA]) { 1109 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]); 1110 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]); 1111 } 1112 1113 if (info->attrs[NL80211_ATTR_KEY_SEQ]) { 1114 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]); 1115 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]); 1116 } 1117 1118 if (info->attrs[NL80211_ATTR_KEY_IDX]) 1119 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 1120 1121 if (info->attrs[NL80211_ATTR_KEY_CIPHER]) 1122 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]); 1123 1124 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT]; 1125 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT]; 1126 1127 if (k->def) { 1128 k->def_uni = true; 1129 k->def_multi = true; 1130 } 1131 if (k->defmgmt) 1132 k->def_multi = true; 1133 1134 if (info->attrs[NL80211_ATTR_KEY_TYPE]) 1135 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 1136 1137 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) { 1138 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1139 int err = nla_parse_nested_deprecated(kdt, 1140 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1141 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES], 1142 nl80211_key_default_policy, 1143 info->extack); 1144 if (err) 1145 return err; 1146 1147 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1148 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1149 } 1150 1151 return 0; 1152 } 1153 1154 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k) 1155 { 1156 int err; 1157 1158 memset(k, 0, sizeof(*k)); 1159 k->idx = -1; 1160 k->type = -1; 1161 1162 if (info->attrs[NL80211_ATTR_KEY]) 1163 err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k); 1164 else 1165 err = nl80211_parse_key_old(info, k); 1166 1167 if (err) 1168 return err; 1169 1170 if (k->def && k->defmgmt) { 1171 GENL_SET_ERR_MSG(info, "key with def && defmgmt is invalid"); 1172 return -EINVAL; 1173 } 1174 1175 if (k->defmgmt) { 1176 if (k->def_uni || !k->def_multi) { 1177 GENL_SET_ERR_MSG(info, "defmgmt key must be mcast"); 1178 return -EINVAL; 1179 } 1180 } 1181 1182 if (k->idx != -1) { 1183 if (k->defmgmt) { 1184 if (k->idx < 4 || k->idx > 5) { 1185 GENL_SET_ERR_MSG(info, 1186 "defmgmt key idx not 4 or 5"); 1187 return -EINVAL; 1188 } 1189 } else if (k->def) { 1190 if (k->idx < 0 || k->idx > 3) { 1191 GENL_SET_ERR_MSG(info, "def key idx not 0-3"); 1192 return -EINVAL; 1193 } 1194 } else { 1195 if (k->idx < 0 || k->idx > 5) { 1196 GENL_SET_ERR_MSG(info, "key idx not 0-5"); 1197 return -EINVAL; 1198 } 1199 } 1200 } 1201 1202 return 0; 1203 } 1204 1205 static struct cfg80211_cached_keys * 1206 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev, 1207 struct genl_info *info, bool *no_ht) 1208 { 1209 struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS]; 1210 struct key_parse parse; 1211 struct nlattr *key; 1212 struct cfg80211_cached_keys *result; 1213 int rem, err, def = 0; 1214 bool have_key = false; 1215 1216 nla_for_each_nested(key, keys, rem) { 1217 have_key = true; 1218 break; 1219 } 1220 1221 if (!have_key) 1222 return NULL; 1223 1224 result = kzalloc(sizeof(*result), GFP_KERNEL); 1225 if (!result) 1226 return ERR_PTR(-ENOMEM); 1227 1228 result->def = -1; 1229 1230 nla_for_each_nested(key, keys, rem) { 1231 memset(&parse, 0, sizeof(parse)); 1232 parse.idx = -1; 1233 1234 err = nl80211_parse_key_new(info, key, &parse); 1235 if (err) 1236 goto error; 1237 err = -EINVAL; 1238 if (!parse.p.key) 1239 goto error; 1240 if (parse.idx < 0 || parse.idx > 3) { 1241 GENL_SET_ERR_MSG(info, "key index out of range [0-3]"); 1242 goto error; 1243 } 1244 if (parse.def) { 1245 if (def) { 1246 GENL_SET_ERR_MSG(info, 1247 "only one key can be default"); 1248 goto error; 1249 } 1250 def = 1; 1251 result->def = parse.idx; 1252 if (!parse.def_uni || !parse.def_multi) 1253 goto error; 1254 } else if (parse.defmgmt) 1255 goto error; 1256 err = cfg80211_validate_key_settings(rdev, &parse.p, 1257 parse.idx, false, NULL); 1258 if (err) 1259 goto error; 1260 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 && 1261 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) { 1262 GENL_SET_ERR_MSG(info, "connect key must be WEP"); 1263 err = -EINVAL; 1264 goto error; 1265 } 1266 result->params[parse.idx].cipher = parse.p.cipher; 1267 result->params[parse.idx].key_len = parse.p.key_len; 1268 result->params[parse.idx].key = result->data[parse.idx]; 1269 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len); 1270 1271 /* must be WEP key if we got here */ 1272 if (no_ht) 1273 *no_ht = true; 1274 } 1275 1276 if (result->def < 0) { 1277 err = -EINVAL; 1278 GENL_SET_ERR_MSG(info, "need a default/TX key"); 1279 goto error; 1280 } 1281 1282 return result; 1283 error: 1284 kfree(result); 1285 return ERR_PTR(err); 1286 } 1287 1288 static int nl80211_key_allowed(struct wireless_dev *wdev) 1289 { 1290 ASSERT_WDEV_LOCK(wdev); 1291 1292 switch (wdev->iftype) { 1293 case NL80211_IFTYPE_AP: 1294 case NL80211_IFTYPE_AP_VLAN: 1295 case NL80211_IFTYPE_P2P_GO: 1296 case NL80211_IFTYPE_MESH_POINT: 1297 break; 1298 case NL80211_IFTYPE_ADHOC: 1299 case NL80211_IFTYPE_STATION: 1300 case NL80211_IFTYPE_P2P_CLIENT: 1301 if (!wdev->current_bss) 1302 return -ENOLINK; 1303 break; 1304 case NL80211_IFTYPE_UNSPECIFIED: 1305 case NL80211_IFTYPE_OCB: 1306 case NL80211_IFTYPE_MONITOR: 1307 case NL80211_IFTYPE_NAN: 1308 case NL80211_IFTYPE_P2P_DEVICE: 1309 case NL80211_IFTYPE_WDS: 1310 case NUM_NL80211_IFTYPES: 1311 return -EINVAL; 1312 } 1313 1314 return 0; 1315 } 1316 1317 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy, 1318 struct nlattr *tb) 1319 { 1320 struct ieee80211_channel *chan; 1321 1322 if (tb == NULL) 1323 return NULL; 1324 chan = ieee80211_get_channel(wiphy, nla_get_u32(tb)); 1325 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED) 1326 return NULL; 1327 return chan; 1328 } 1329 1330 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes) 1331 { 1332 struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr); 1333 int i; 1334 1335 if (!nl_modes) 1336 goto nla_put_failure; 1337 1338 i = 0; 1339 while (ifmodes) { 1340 if ((ifmodes & 1) && nla_put_flag(msg, i)) 1341 goto nla_put_failure; 1342 ifmodes >>= 1; 1343 i++; 1344 } 1345 1346 nla_nest_end(msg, nl_modes); 1347 return 0; 1348 1349 nla_put_failure: 1350 return -ENOBUFS; 1351 } 1352 1353 static int nl80211_put_iface_combinations(struct wiphy *wiphy, 1354 struct sk_buff *msg, 1355 bool large) 1356 { 1357 struct nlattr *nl_combis; 1358 int i, j; 1359 1360 nl_combis = nla_nest_start_noflag(msg, 1361 NL80211_ATTR_INTERFACE_COMBINATIONS); 1362 if (!nl_combis) 1363 goto nla_put_failure; 1364 1365 for (i = 0; i < wiphy->n_iface_combinations; i++) { 1366 const struct ieee80211_iface_combination *c; 1367 struct nlattr *nl_combi, *nl_limits; 1368 1369 c = &wiphy->iface_combinations[i]; 1370 1371 nl_combi = nla_nest_start_noflag(msg, i + 1); 1372 if (!nl_combi) 1373 goto nla_put_failure; 1374 1375 nl_limits = nla_nest_start_noflag(msg, 1376 NL80211_IFACE_COMB_LIMITS); 1377 if (!nl_limits) 1378 goto nla_put_failure; 1379 1380 for (j = 0; j < c->n_limits; j++) { 1381 struct nlattr *nl_limit; 1382 1383 nl_limit = nla_nest_start_noflag(msg, j + 1); 1384 if (!nl_limit) 1385 goto nla_put_failure; 1386 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX, 1387 c->limits[j].max)) 1388 goto nla_put_failure; 1389 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES, 1390 c->limits[j].types)) 1391 goto nla_put_failure; 1392 nla_nest_end(msg, nl_limit); 1393 } 1394 1395 nla_nest_end(msg, nl_limits); 1396 1397 if (c->beacon_int_infra_match && 1398 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH)) 1399 goto nla_put_failure; 1400 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS, 1401 c->num_different_channels) || 1402 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM, 1403 c->max_interfaces)) 1404 goto nla_put_failure; 1405 if (large && 1406 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS, 1407 c->radar_detect_widths) || 1408 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS, 1409 c->radar_detect_regions))) 1410 goto nla_put_failure; 1411 if (c->beacon_int_min_gcd && 1412 nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD, 1413 c->beacon_int_min_gcd)) 1414 goto nla_put_failure; 1415 1416 nla_nest_end(msg, nl_combi); 1417 } 1418 1419 nla_nest_end(msg, nl_combis); 1420 1421 return 0; 1422 nla_put_failure: 1423 return -ENOBUFS; 1424 } 1425 1426 #ifdef CONFIG_PM 1427 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev, 1428 struct sk_buff *msg) 1429 { 1430 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp; 1431 struct nlattr *nl_tcp; 1432 1433 if (!tcp) 1434 return 0; 1435 1436 nl_tcp = nla_nest_start_noflag(msg, 1437 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 1438 if (!nl_tcp) 1439 return -ENOBUFS; 1440 1441 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1442 tcp->data_payload_max)) 1443 return -ENOBUFS; 1444 1445 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1446 tcp->data_payload_max)) 1447 return -ENOBUFS; 1448 1449 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ)) 1450 return -ENOBUFS; 1451 1452 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 1453 sizeof(*tcp->tok), tcp->tok)) 1454 return -ENOBUFS; 1455 1456 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 1457 tcp->data_interval_max)) 1458 return -ENOBUFS; 1459 1460 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 1461 tcp->wake_payload_max)) 1462 return -ENOBUFS; 1463 1464 nla_nest_end(msg, nl_tcp); 1465 return 0; 1466 } 1467 1468 static int nl80211_send_wowlan(struct sk_buff *msg, 1469 struct cfg80211_registered_device *rdev, 1470 bool large) 1471 { 1472 struct nlattr *nl_wowlan; 1473 1474 if (!rdev->wiphy.wowlan) 1475 return 0; 1476 1477 nl_wowlan = nla_nest_start_noflag(msg, 1478 NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED); 1479 if (!nl_wowlan) 1480 return -ENOBUFS; 1481 1482 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) && 1483 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 1484 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) && 1485 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 1486 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) && 1487 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 1488 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) && 1489 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) || 1490 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) && 1491 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 1492 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) && 1493 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 1494 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) && 1495 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 1496 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) && 1497 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 1498 return -ENOBUFS; 1499 1500 if (rdev->wiphy.wowlan->n_patterns) { 1501 struct nl80211_pattern_support pat = { 1502 .max_patterns = rdev->wiphy.wowlan->n_patterns, 1503 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len, 1504 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len, 1505 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset, 1506 }; 1507 1508 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 1509 sizeof(pat), &pat)) 1510 return -ENOBUFS; 1511 } 1512 1513 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) && 1514 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT, 1515 rdev->wiphy.wowlan->max_nd_match_sets)) 1516 return -ENOBUFS; 1517 1518 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg)) 1519 return -ENOBUFS; 1520 1521 nla_nest_end(msg, nl_wowlan); 1522 1523 return 0; 1524 } 1525 #endif 1526 1527 static int nl80211_send_coalesce(struct sk_buff *msg, 1528 struct cfg80211_registered_device *rdev) 1529 { 1530 struct nl80211_coalesce_rule_support rule; 1531 1532 if (!rdev->wiphy.coalesce) 1533 return 0; 1534 1535 rule.max_rules = rdev->wiphy.coalesce->n_rules; 1536 rule.max_delay = rdev->wiphy.coalesce->max_delay; 1537 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns; 1538 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len; 1539 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len; 1540 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset; 1541 1542 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule)) 1543 return -ENOBUFS; 1544 1545 return 0; 1546 } 1547 1548 static int 1549 nl80211_send_iftype_data(struct sk_buff *msg, 1550 const struct ieee80211_sband_iftype_data *iftdata) 1551 { 1552 const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap; 1553 1554 if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES, 1555 iftdata->types_mask)) 1556 return -ENOBUFS; 1557 1558 if (he_cap->has_he) { 1559 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC, 1560 sizeof(he_cap->he_cap_elem.mac_cap_info), 1561 he_cap->he_cap_elem.mac_cap_info) || 1562 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY, 1563 sizeof(he_cap->he_cap_elem.phy_cap_info), 1564 he_cap->he_cap_elem.phy_cap_info) || 1565 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET, 1566 sizeof(he_cap->he_mcs_nss_supp), 1567 &he_cap->he_mcs_nss_supp) || 1568 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE, 1569 sizeof(he_cap->ppe_thres), he_cap->ppe_thres)) 1570 return -ENOBUFS; 1571 } 1572 1573 return 0; 1574 } 1575 1576 static int nl80211_send_band_rateinfo(struct sk_buff *msg, 1577 struct ieee80211_supported_band *sband) 1578 { 1579 struct nlattr *nl_rates, *nl_rate; 1580 struct ieee80211_rate *rate; 1581 int i; 1582 1583 /* add HT info */ 1584 if (sband->ht_cap.ht_supported && 1585 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET, 1586 sizeof(sband->ht_cap.mcs), 1587 &sband->ht_cap.mcs) || 1588 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA, 1589 sband->ht_cap.cap) || 1590 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR, 1591 sband->ht_cap.ampdu_factor) || 1592 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY, 1593 sband->ht_cap.ampdu_density))) 1594 return -ENOBUFS; 1595 1596 /* add VHT info */ 1597 if (sband->vht_cap.vht_supported && 1598 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET, 1599 sizeof(sband->vht_cap.vht_mcs), 1600 &sband->vht_cap.vht_mcs) || 1601 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA, 1602 sband->vht_cap.cap))) 1603 return -ENOBUFS; 1604 1605 if (sband->n_iftype_data) { 1606 struct nlattr *nl_iftype_data = 1607 nla_nest_start_noflag(msg, 1608 NL80211_BAND_ATTR_IFTYPE_DATA); 1609 int err; 1610 1611 if (!nl_iftype_data) 1612 return -ENOBUFS; 1613 1614 for (i = 0; i < sband->n_iftype_data; i++) { 1615 struct nlattr *iftdata; 1616 1617 iftdata = nla_nest_start_noflag(msg, i + 1); 1618 if (!iftdata) 1619 return -ENOBUFS; 1620 1621 err = nl80211_send_iftype_data(msg, 1622 &sband->iftype_data[i]); 1623 if (err) 1624 return err; 1625 1626 nla_nest_end(msg, iftdata); 1627 } 1628 1629 nla_nest_end(msg, nl_iftype_data); 1630 } 1631 1632 /* add EDMG info */ 1633 if (sband->edmg_cap.channels && 1634 (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS, 1635 sband->edmg_cap.channels) || 1636 nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG, 1637 sband->edmg_cap.bw_config))) 1638 1639 return -ENOBUFS; 1640 1641 /* add bitrates */ 1642 nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES); 1643 if (!nl_rates) 1644 return -ENOBUFS; 1645 1646 for (i = 0; i < sband->n_bitrates; i++) { 1647 nl_rate = nla_nest_start_noflag(msg, i); 1648 if (!nl_rate) 1649 return -ENOBUFS; 1650 1651 rate = &sband->bitrates[i]; 1652 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE, 1653 rate->bitrate)) 1654 return -ENOBUFS; 1655 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) && 1656 nla_put_flag(msg, 1657 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE)) 1658 return -ENOBUFS; 1659 1660 nla_nest_end(msg, nl_rate); 1661 } 1662 1663 nla_nest_end(msg, nl_rates); 1664 1665 return 0; 1666 } 1667 1668 static int 1669 nl80211_send_mgmt_stypes(struct sk_buff *msg, 1670 const struct ieee80211_txrx_stypes *mgmt_stypes) 1671 { 1672 u16 stypes; 1673 struct nlattr *nl_ftypes, *nl_ifs; 1674 enum nl80211_iftype ift; 1675 int i; 1676 1677 if (!mgmt_stypes) 1678 return 0; 1679 1680 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES); 1681 if (!nl_ifs) 1682 return -ENOBUFS; 1683 1684 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 1685 nl_ftypes = nla_nest_start_noflag(msg, ift); 1686 if (!nl_ftypes) 1687 return -ENOBUFS; 1688 i = 0; 1689 stypes = mgmt_stypes[ift].tx; 1690 while (stypes) { 1691 if ((stypes & 1) && 1692 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 1693 (i << 4) | IEEE80211_FTYPE_MGMT)) 1694 return -ENOBUFS; 1695 stypes >>= 1; 1696 i++; 1697 } 1698 nla_nest_end(msg, nl_ftypes); 1699 } 1700 1701 nla_nest_end(msg, nl_ifs); 1702 1703 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES); 1704 if (!nl_ifs) 1705 return -ENOBUFS; 1706 1707 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 1708 nl_ftypes = nla_nest_start_noflag(msg, ift); 1709 if (!nl_ftypes) 1710 return -ENOBUFS; 1711 i = 0; 1712 stypes = mgmt_stypes[ift].rx; 1713 while (stypes) { 1714 if ((stypes & 1) && 1715 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 1716 (i << 4) | IEEE80211_FTYPE_MGMT)) 1717 return -ENOBUFS; 1718 stypes >>= 1; 1719 i++; 1720 } 1721 nla_nest_end(msg, nl_ftypes); 1722 } 1723 nla_nest_end(msg, nl_ifs); 1724 1725 return 0; 1726 } 1727 1728 #define CMD(op, n) \ 1729 do { \ 1730 if (rdev->ops->op) { \ 1731 i++; \ 1732 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \ 1733 goto nla_put_failure; \ 1734 } \ 1735 } while (0) 1736 1737 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev, 1738 struct sk_buff *msg) 1739 { 1740 int i = 0; 1741 1742 /* 1743 * do *NOT* add anything into this function, new things need to be 1744 * advertised only to new versions of userspace that can deal with 1745 * the split (and they can't possibly care about new features... 1746 */ 1747 CMD(add_virtual_intf, NEW_INTERFACE); 1748 CMD(change_virtual_intf, SET_INTERFACE); 1749 CMD(add_key, NEW_KEY); 1750 CMD(start_ap, START_AP); 1751 CMD(add_station, NEW_STATION); 1752 CMD(add_mpath, NEW_MPATH); 1753 CMD(update_mesh_config, SET_MESH_CONFIG); 1754 CMD(change_bss, SET_BSS); 1755 CMD(auth, AUTHENTICATE); 1756 CMD(assoc, ASSOCIATE); 1757 CMD(deauth, DEAUTHENTICATE); 1758 CMD(disassoc, DISASSOCIATE); 1759 CMD(join_ibss, JOIN_IBSS); 1760 CMD(join_mesh, JOIN_MESH); 1761 CMD(set_pmksa, SET_PMKSA); 1762 CMD(del_pmksa, DEL_PMKSA); 1763 CMD(flush_pmksa, FLUSH_PMKSA); 1764 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) 1765 CMD(remain_on_channel, REMAIN_ON_CHANNEL); 1766 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK); 1767 CMD(mgmt_tx, FRAME); 1768 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL); 1769 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) { 1770 i++; 1771 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS)) 1772 goto nla_put_failure; 1773 } 1774 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap || 1775 rdev->ops->join_mesh) { 1776 i++; 1777 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL)) 1778 goto nla_put_failure; 1779 } 1780 CMD(set_wds_peer, SET_WDS_PEER); 1781 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) { 1782 CMD(tdls_mgmt, TDLS_MGMT); 1783 CMD(tdls_oper, TDLS_OPER); 1784 } 1785 if (rdev->wiphy.max_sched_scan_reqs) 1786 CMD(sched_scan_start, START_SCHED_SCAN); 1787 CMD(probe_client, PROBE_CLIENT); 1788 CMD(set_noack_map, SET_NOACK_MAP); 1789 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) { 1790 i++; 1791 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS)) 1792 goto nla_put_failure; 1793 } 1794 CMD(start_p2p_device, START_P2P_DEVICE); 1795 CMD(set_mcast_rate, SET_MCAST_RATE); 1796 #ifdef CONFIG_NL80211_TESTMODE 1797 CMD(testmode_cmd, TESTMODE); 1798 #endif 1799 1800 if (rdev->ops->connect || rdev->ops->auth) { 1801 i++; 1802 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT)) 1803 goto nla_put_failure; 1804 } 1805 1806 if (rdev->ops->disconnect || rdev->ops->deauth) { 1807 i++; 1808 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT)) 1809 goto nla_put_failure; 1810 } 1811 1812 return i; 1813 nla_put_failure: 1814 return -ENOBUFS; 1815 } 1816 1817 static int 1818 nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap, 1819 struct sk_buff *msg) 1820 { 1821 struct nlattr *ftm; 1822 1823 if (!cap->ftm.supported) 1824 return 0; 1825 1826 ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM); 1827 if (!ftm) 1828 return -ENOBUFS; 1829 1830 if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP)) 1831 return -ENOBUFS; 1832 if (cap->ftm.non_asap && 1833 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP)) 1834 return -ENOBUFS; 1835 if (cap->ftm.request_lci && 1836 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI)) 1837 return -ENOBUFS; 1838 if (cap->ftm.request_civicloc && 1839 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC)) 1840 return -ENOBUFS; 1841 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES, 1842 cap->ftm.preambles)) 1843 return -ENOBUFS; 1844 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS, 1845 cap->ftm.bandwidths)) 1846 return -ENOBUFS; 1847 if (cap->ftm.max_bursts_exponent >= 0 && 1848 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT, 1849 cap->ftm.max_bursts_exponent)) 1850 return -ENOBUFS; 1851 if (cap->ftm.max_ftms_per_burst && 1852 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST, 1853 cap->ftm.max_ftms_per_burst)) 1854 return -ENOBUFS; 1855 1856 nla_nest_end(msg, ftm); 1857 return 0; 1858 } 1859 1860 static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev, 1861 struct sk_buff *msg) 1862 { 1863 const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa; 1864 struct nlattr *pmsr, *caps; 1865 1866 if (!cap) 1867 return 0; 1868 1869 /* 1870 * we don't need to clean up anything here since the caller 1871 * will genlmsg_cancel() if we fail 1872 */ 1873 1874 pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS); 1875 if (!pmsr) 1876 return -ENOBUFS; 1877 1878 if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers)) 1879 return -ENOBUFS; 1880 1881 if (cap->report_ap_tsf && 1882 nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF)) 1883 return -ENOBUFS; 1884 1885 if (cap->randomize_mac_addr && 1886 nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR)) 1887 return -ENOBUFS; 1888 1889 caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA); 1890 if (!caps) 1891 return -ENOBUFS; 1892 1893 if (nl80211_send_pmsr_ftm_capa(cap, msg)) 1894 return -ENOBUFS; 1895 1896 nla_nest_end(msg, caps); 1897 nla_nest_end(msg, pmsr); 1898 1899 return 0; 1900 } 1901 1902 static int 1903 nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev, 1904 struct sk_buff *msg) 1905 { 1906 int i; 1907 struct nlattr *nested, *nested_akms; 1908 const struct wiphy_iftype_akm_suites *iftype_akms; 1909 1910 if (!rdev->wiphy.num_iftype_akm_suites || 1911 !rdev->wiphy.iftype_akm_suites) 1912 return 0; 1913 1914 nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES); 1915 if (!nested) 1916 return -ENOBUFS; 1917 1918 for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) { 1919 nested_akms = nla_nest_start(msg, i + 1); 1920 if (!nested_akms) 1921 return -ENOBUFS; 1922 1923 iftype_akms = &rdev->wiphy.iftype_akm_suites[i]; 1924 1925 if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES, 1926 iftype_akms->iftypes_mask)) 1927 return -ENOBUFS; 1928 1929 if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES, 1930 sizeof(u32) * iftype_akms->n_akm_suites, 1931 iftype_akms->akm_suites)) { 1932 return -ENOBUFS; 1933 } 1934 nla_nest_end(msg, nested_akms); 1935 } 1936 1937 nla_nest_end(msg, nested); 1938 1939 return 0; 1940 } 1941 1942 struct nl80211_dump_wiphy_state { 1943 s64 filter_wiphy; 1944 long start; 1945 long split_start, band_start, chan_start, capa_start; 1946 bool split; 1947 }; 1948 1949 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev, 1950 enum nl80211_commands cmd, 1951 struct sk_buff *msg, u32 portid, u32 seq, 1952 int flags, struct nl80211_dump_wiphy_state *state) 1953 { 1954 void *hdr; 1955 struct nlattr *nl_bands, *nl_band; 1956 struct nlattr *nl_freqs, *nl_freq; 1957 struct nlattr *nl_cmds; 1958 enum nl80211_band band; 1959 struct ieee80211_channel *chan; 1960 int i; 1961 const struct ieee80211_txrx_stypes *mgmt_stypes = 1962 rdev->wiphy.mgmt_stypes; 1963 u32 features; 1964 1965 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 1966 if (!hdr) 1967 return -ENOBUFS; 1968 1969 if (WARN_ON(!state)) 1970 return -EINVAL; 1971 1972 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 1973 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME, 1974 wiphy_name(&rdev->wiphy)) || 1975 nla_put_u32(msg, NL80211_ATTR_GENERATION, 1976 cfg80211_rdev_list_generation)) 1977 goto nla_put_failure; 1978 1979 if (cmd != NL80211_CMD_NEW_WIPHY) 1980 goto finish; 1981 1982 switch (state->split_start) { 1983 case 0: 1984 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT, 1985 rdev->wiphy.retry_short) || 1986 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG, 1987 rdev->wiphy.retry_long) || 1988 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD, 1989 rdev->wiphy.frag_threshold) || 1990 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD, 1991 rdev->wiphy.rts_threshold) || 1992 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS, 1993 rdev->wiphy.coverage_class) || 1994 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS, 1995 rdev->wiphy.max_scan_ssids) || 1996 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS, 1997 rdev->wiphy.max_sched_scan_ssids) || 1998 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN, 1999 rdev->wiphy.max_scan_ie_len) || 2000 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN, 2001 rdev->wiphy.max_sched_scan_ie_len) || 2002 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS, 2003 rdev->wiphy.max_match_sets) || 2004 nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS, 2005 rdev->wiphy.max_sched_scan_plans) || 2006 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL, 2007 rdev->wiphy.max_sched_scan_plan_interval) || 2008 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS, 2009 rdev->wiphy.max_sched_scan_plan_iterations)) 2010 goto nla_put_failure; 2011 2012 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) && 2013 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN)) 2014 goto nla_put_failure; 2015 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) && 2016 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH)) 2017 goto nla_put_failure; 2018 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) && 2019 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD)) 2020 goto nla_put_failure; 2021 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) && 2022 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT)) 2023 goto nla_put_failure; 2024 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) && 2025 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT)) 2026 goto nla_put_failure; 2027 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) && 2028 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP)) 2029 goto nla_put_failure; 2030 state->split_start++; 2031 if (state->split) 2032 break; 2033 /* fall through */ 2034 case 1: 2035 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES, 2036 sizeof(u32) * rdev->wiphy.n_cipher_suites, 2037 rdev->wiphy.cipher_suites)) 2038 goto nla_put_failure; 2039 2040 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS, 2041 rdev->wiphy.max_num_pmkids)) 2042 goto nla_put_failure; 2043 2044 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 2045 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE)) 2046 goto nla_put_failure; 2047 2048 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX, 2049 rdev->wiphy.available_antennas_tx) || 2050 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX, 2051 rdev->wiphy.available_antennas_rx)) 2052 goto nla_put_failure; 2053 2054 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) && 2055 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD, 2056 rdev->wiphy.probe_resp_offload)) 2057 goto nla_put_failure; 2058 2059 if ((rdev->wiphy.available_antennas_tx || 2060 rdev->wiphy.available_antennas_rx) && 2061 rdev->ops->get_antenna) { 2062 u32 tx_ant = 0, rx_ant = 0; 2063 int res; 2064 2065 res = rdev_get_antenna(rdev, &tx_ant, &rx_ant); 2066 if (!res) { 2067 if (nla_put_u32(msg, 2068 NL80211_ATTR_WIPHY_ANTENNA_TX, 2069 tx_ant) || 2070 nla_put_u32(msg, 2071 NL80211_ATTR_WIPHY_ANTENNA_RX, 2072 rx_ant)) 2073 goto nla_put_failure; 2074 } 2075 } 2076 2077 state->split_start++; 2078 if (state->split) 2079 break; 2080 /* fall through */ 2081 case 2: 2082 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES, 2083 rdev->wiphy.interface_modes)) 2084 goto nla_put_failure; 2085 state->split_start++; 2086 if (state->split) 2087 break; 2088 /* fall through */ 2089 case 3: 2090 nl_bands = nla_nest_start_noflag(msg, 2091 NL80211_ATTR_WIPHY_BANDS); 2092 if (!nl_bands) 2093 goto nla_put_failure; 2094 2095 for (band = state->band_start; 2096 band < NUM_NL80211_BANDS; band++) { 2097 struct ieee80211_supported_band *sband; 2098 2099 sband = rdev->wiphy.bands[band]; 2100 2101 if (!sband) 2102 continue; 2103 2104 nl_band = nla_nest_start_noflag(msg, band); 2105 if (!nl_band) 2106 goto nla_put_failure; 2107 2108 switch (state->chan_start) { 2109 case 0: 2110 if (nl80211_send_band_rateinfo(msg, sband)) 2111 goto nla_put_failure; 2112 state->chan_start++; 2113 if (state->split) 2114 break; 2115 /* fall through */ 2116 default: 2117 /* add frequencies */ 2118 nl_freqs = nla_nest_start_noflag(msg, 2119 NL80211_BAND_ATTR_FREQS); 2120 if (!nl_freqs) 2121 goto nla_put_failure; 2122 2123 for (i = state->chan_start - 1; 2124 i < sband->n_channels; 2125 i++) { 2126 nl_freq = nla_nest_start_noflag(msg, 2127 i); 2128 if (!nl_freq) 2129 goto nla_put_failure; 2130 2131 chan = &sband->channels[i]; 2132 2133 if (nl80211_msg_put_channel( 2134 msg, &rdev->wiphy, chan, 2135 state->split)) 2136 goto nla_put_failure; 2137 2138 nla_nest_end(msg, nl_freq); 2139 if (state->split) 2140 break; 2141 } 2142 if (i < sband->n_channels) 2143 state->chan_start = i + 2; 2144 else 2145 state->chan_start = 0; 2146 nla_nest_end(msg, nl_freqs); 2147 } 2148 2149 nla_nest_end(msg, nl_band); 2150 2151 if (state->split) { 2152 /* start again here */ 2153 if (state->chan_start) 2154 band--; 2155 break; 2156 } 2157 } 2158 nla_nest_end(msg, nl_bands); 2159 2160 if (band < NUM_NL80211_BANDS) 2161 state->band_start = band + 1; 2162 else 2163 state->band_start = 0; 2164 2165 /* if bands & channels are done, continue outside */ 2166 if (state->band_start == 0 && state->chan_start == 0) 2167 state->split_start++; 2168 if (state->split) 2169 break; 2170 /* fall through */ 2171 case 4: 2172 nl_cmds = nla_nest_start_noflag(msg, 2173 NL80211_ATTR_SUPPORTED_COMMANDS); 2174 if (!nl_cmds) 2175 goto nla_put_failure; 2176 2177 i = nl80211_add_commands_unsplit(rdev, msg); 2178 if (i < 0) 2179 goto nla_put_failure; 2180 if (state->split) { 2181 CMD(crit_proto_start, CRIT_PROTOCOL_START); 2182 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP); 2183 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH) 2184 CMD(channel_switch, CHANNEL_SWITCH); 2185 CMD(set_qos_map, SET_QOS_MAP); 2186 if (rdev->wiphy.features & 2187 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION) 2188 CMD(add_tx_ts, ADD_TX_TS); 2189 CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST); 2190 CMD(update_connect_params, UPDATE_CONNECT_PARAMS); 2191 CMD(update_ft_ies, UPDATE_FT_IES); 2192 } 2193 #undef CMD 2194 2195 nla_nest_end(msg, nl_cmds); 2196 state->split_start++; 2197 if (state->split) 2198 break; 2199 /* fall through */ 2200 case 5: 2201 if (rdev->ops->remain_on_channel && 2202 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) && 2203 nla_put_u32(msg, 2204 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION, 2205 rdev->wiphy.max_remain_on_channel_duration)) 2206 goto nla_put_failure; 2207 2208 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) && 2209 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK)) 2210 goto nla_put_failure; 2211 2212 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes)) 2213 goto nla_put_failure; 2214 state->split_start++; 2215 if (state->split) 2216 break; 2217 /* fall through */ 2218 case 6: 2219 #ifdef CONFIG_PM 2220 if (nl80211_send_wowlan(msg, rdev, state->split)) 2221 goto nla_put_failure; 2222 state->split_start++; 2223 if (state->split) 2224 break; 2225 #else 2226 state->split_start++; 2227 #endif 2228 /* fall through */ 2229 case 7: 2230 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES, 2231 rdev->wiphy.software_iftypes)) 2232 goto nla_put_failure; 2233 2234 if (nl80211_put_iface_combinations(&rdev->wiphy, msg, 2235 state->split)) 2236 goto nla_put_failure; 2237 2238 state->split_start++; 2239 if (state->split) 2240 break; 2241 /* fall through */ 2242 case 8: 2243 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) && 2244 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME, 2245 rdev->wiphy.ap_sme_capa)) 2246 goto nla_put_failure; 2247 2248 features = rdev->wiphy.features; 2249 /* 2250 * We can only add the per-channel limit information if the 2251 * dump is split, otherwise it makes it too big. Therefore 2252 * only advertise it in that case. 2253 */ 2254 if (state->split) 2255 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS; 2256 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features)) 2257 goto nla_put_failure; 2258 2259 if (rdev->wiphy.ht_capa_mod_mask && 2260 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK, 2261 sizeof(*rdev->wiphy.ht_capa_mod_mask), 2262 rdev->wiphy.ht_capa_mod_mask)) 2263 goto nla_put_failure; 2264 2265 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME && 2266 rdev->wiphy.max_acl_mac_addrs && 2267 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX, 2268 rdev->wiphy.max_acl_mac_addrs)) 2269 goto nla_put_failure; 2270 2271 /* 2272 * Any information below this point is only available to 2273 * applications that can deal with it being split. This 2274 * helps ensure that newly added capabilities don't break 2275 * older tools by overrunning their buffers. 2276 * 2277 * We still increment split_start so that in the split 2278 * case we'll continue with more data in the next round, 2279 * but break unconditionally so unsplit data stops here. 2280 */ 2281 state->split_start++; 2282 break; 2283 case 9: 2284 if (rdev->wiphy.extended_capabilities && 2285 (nla_put(msg, NL80211_ATTR_EXT_CAPA, 2286 rdev->wiphy.extended_capabilities_len, 2287 rdev->wiphy.extended_capabilities) || 2288 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 2289 rdev->wiphy.extended_capabilities_len, 2290 rdev->wiphy.extended_capabilities_mask))) 2291 goto nla_put_failure; 2292 2293 if (rdev->wiphy.vht_capa_mod_mask && 2294 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK, 2295 sizeof(*rdev->wiphy.vht_capa_mod_mask), 2296 rdev->wiphy.vht_capa_mod_mask)) 2297 goto nla_put_failure; 2298 2299 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 2300 rdev->wiphy.perm_addr)) 2301 goto nla_put_failure; 2302 2303 if (!is_zero_ether_addr(rdev->wiphy.addr_mask) && 2304 nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN, 2305 rdev->wiphy.addr_mask)) 2306 goto nla_put_failure; 2307 2308 if (rdev->wiphy.n_addresses > 1) { 2309 void *attr; 2310 2311 attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS); 2312 if (!attr) 2313 goto nla_put_failure; 2314 2315 for (i = 0; i < rdev->wiphy.n_addresses; i++) 2316 if (nla_put(msg, i + 1, ETH_ALEN, 2317 rdev->wiphy.addresses[i].addr)) 2318 goto nla_put_failure; 2319 2320 nla_nest_end(msg, attr); 2321 } 2322 2323 state->split_start++; 2324 break; 2325 case 10: 2326 if (nl80211_send_coalesce(msg, rdev)) 2327 goto nla_put_failure; 2328 2329 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) && 2330 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) || 2331 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ))) 2332 goto nla_put_failure; 2333 2334 if (rdev->wiphy.max_ap_assoc_sta && 2335 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA, 2336 rdev->wiphy.max_ap_assoc_sta)) 2337 goto nla_put_failure; 2338 2339 state->split_start++; 2340 break; 2341 case 11: 2342 if (rdev->wiphy.n_vendor_commands) { 2343 const struct nl80211_vendor_cmd_info *info; 2344 struct nlattr *nested; 2345 2346 nested = nla_nest_start_noflag(msg, 2347 NL80211_ATTR_VENDOR_DATA); 2348 if (!nested) 2349 goto nla_put_failure; 2350 2351 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 2352 info = &rdev->wiphy.vendor_commands[i].info; 2353 if (nla_put(msg, i + 1, sizeof(*info), info)) 2354 goto nla_put_failure; 2355 } 2356 nla_nest_end(msg, nested); 2357 } 2358 2359 if (rdev->wiphy.n_vendor_events) { 2360 const struct nl80211_vendor_cmd_info *info; 2361 struct nlattr *nested; 2362 2363 nested = nla_nest_start_noflag(msg, 2364 NL80211_ATTR_VENDOR_EVENTS); 2365 if (!nested) 2366 goto nla_put_failure; 2367 2368 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) { 2369 info = &rdev->wiphy.vendor_events[i]; 2370 if (nla_put(msg, i + 1, sizeof(*info), info)) 2371 goto nla_put_failure; 2372 } 2373 nla_nest_end(msg, nested); 2374 } 2375 state->split_start++; 2376 break; 2377 case 12: 2378 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH && 2379 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS, 2380 rdev->wiphy.max_num_csa_counters)) 2381 goto nla_put_failure; 2382 2383 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 2384 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 2385 goto nla_put_failure; 2386 2387 if (rdev->wiphy.max_sched_scan_reqs && 2388 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS, 2389 rdev->wiphy.max_sched_scan_reqs)) 2390 goto nla_put_failure; 2391 2392 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES, 2393 sizeof(rdev->wiphy.ext_features), 2394 rdev->wiphy.ext_features)) 2395 goto nla_put_failure; 2396 2397 if (rdev->wiphy.bss_select_support) { 2398 struct nlattr *nested; 2399 u32 bss_select_support = rdev->wiphy.bss_select_support; 2400 2401 nested = nla_nest_start_noflag(msg, 2402 NL80211_ATTR_BSS_SELECT); 2403 if (!nested) 2404 goto nla_put_failure; 2405 2406 i = 0; 2407 while (bss_select_support) { 2408 if ((bss_select_support & 1) && 2409 nla_put_flag(msg, i)) 2410 goto nla_put_failure; 2411 i++; 2412 bss_select_support >>= 1; 2413 } 2414 nla_nest_end(msg, nested); 2415 } 2416 2417 state->split_start++; 2418 break; 2419 case 13: 2420 if (rdev->wiphy.num_iftype_ext_capab && 2421 rdev->wiphy.iftype_ext_capab) { 2422 struct nlattr *nested_ext_capab, *nested; 2423 2424 nested = nla_nest_start_noflag(msg, 2425 NL80211_ATTR_IFTYPE_EXT_CAPA); 2426 if (!nested) 2427 goto nla_put_failure; 2428 2429 for (i = state->capa_start; 2430 i < rdev->wiphy.num_iftype_ext_capab; i++) { 2431 const struct wiphy_iftype_ext_capab *capab; 2432 2433 capab = &rdev->wiphy.iftype_ext_capab[i]; 2434 2435 nested_ext_capab = nla_nest_start_noflag(msg, 2436 i); 2437 if (!nested_ext_capab || 2438 nla_put_u32(msg, NL80211_ATTR_IFTYPE, 2439 capab->iftype) || 2440 nla_put(msg, NL80211_ATTR_EXT_CAPA, 2441 capab->extended_capabilities_len, 2442 capab->extended_capabilities) || 2443 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 2444 capab->extended_capabilities_len, 2445 capab->extended_capabilities_mask)) 2446 goto nla_put_failure; 2447 2448 nla_nest_end(msg, nested_ext_capab); 2449 if (state->split) 2450 break; 2451 } 2452 nla_nest_end(msg, nested); 2453 if (i < rdev->wiphy.num_iftype_ext_capab) { 2454 state->capa_start = i + 1; 2455 break; 2456 } 2457 } 2458 2459 if (nla_put_u32(msg, NL80211_ATTR_BANDS, 2460 rdev->wiphy.nan_supported_bands)) 2461 goto nla_put_failure; 2462 2463 if (wiphy_ext_feature_isset(&rdev->wiphy, 2464 NL80211_EXT_FEATURE_TXQS)) { 2465 struct cfg80211_txq_stats txqstats = {}; 2466 int res; 2467 2468 res = rdev_get_txq_stats(rdev, NULL, &txqstats); 2469 if (!res && 2470 !nl80211_put_txq_stats(msg, &txqstats, 2471 NL80211_ATTR_TXQ_STATS)) 2472 goto nla_put_failure; 2473 2474 if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT, 2475 rdev->wiphy.txq_limit)) 2476 goto nla_put_failure; 2477 if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT, 2478 rdev->wiphy.txq_memory_limit)) 2479 goto nla_put_failure; 2480 if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM, 2481 rdev->wiphy.txq_quantum)) 2482 goto nla_put_failure; 2483 } 2484 2485 state->split_start++; 2486 break; 2487 case 14: 2488 if (nl80211_send_pmsr_capa(rdev, msg)) 2489 goto nla_put_failure; 2490 2491 state->split_start++; 2492 break; 2493 case 15: 2494 if (rdev->wiphy.akm_suites && 2495 nla_put(msg, NL80211_ATTR_AKM_SUITES, 2496 sizeof(u32) * rdev->wiphy.n_akm_suites, 2497 rdev->wiphy.akm_suites)) 2498 goto nla_put_failure; 2499 2500 if (nl80211_put_iftype_akm_suites(rdev, msg)) 2501 goto nla_put_failure; 2502 2503 /* done */ 2504 state->split_start = 0; 2505 break; 2506 } 2507 finish: 2508 genlmsg_end(msg, hdr); 2509 return 0; 2510 2511 nla_put_failure: 2512 genlmsg_cancel(msg, hdr); 2513 return -EMSGSIZE; 2514 } 2515 2516 static int nl80211_dump_wiphy_parse(struct sk_buff *skb, 2517 struct netlink_callback *cb, 2518 struct nl80211_dump_wiphy_state *state) 2519 { 2520 struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 2521 int ret; 2522 2523 if (!tb) 2524 return -ENOMEM; 2525 2526 ret = nlmsg_parse_deprecated(cb->nlh, 2527 GENL_HDRLEN + nl80211_fam.hdrsize, 2528 tb, nl80211_fam.maxattr, 2529 nl80211_policy, NULL); 2530 /* ignore parse errors for backward compatibility */ 2531 if (ret) { 2532 ret = 0; 2533 goto out; 2534 } 2535 2536 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP]; 2537 if (tb[NL80211_ATTR_WIPHY]) 2538 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]); 2539 if (tb[NL80211_ATTR_WDEV]) 2540 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32; 2541 if (tb[NL80211_ATTR_IFINDEX]) { 2542 struct net_device *netdev; 2543 struct cfg80211_registered_device *rdev; 2544 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]); 2545 2546 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx); 2547 if (!netdev) { 2548 ret = -ENODEV; 2549 goto out; 2550 } 2551 if (netdev->ieee80211_ptr) { 2552 rdev = wiphy_to_rdev( 2553 netdev->ieee80211_ptr->wiphy); 2554 state->filter_wiphy = rdev->wiphy_idx; 2555 } 2556 } 2557 2558 ret = 0; 2559 out: 2560 kfree(tb); 2561 return ret; 2562 } 2563 2564 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb) 2565 { 2566 int idx = 0, ret; 2567 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0]; 2568 struct cfg80211_registered_device *rdev; 2569 2570 rtnl_lock(); 2571 if (!state) { 2572 state = kzalloc(sizeof(*state), GFP_KERNEL); 2573 if (!state) { 2574 rtnl_unlock(); 2575 return -ENOMEM; 2576 } 2577 state->filter_wiphy = -1; 2578 ret = nl80211_dump_wiphy_parse(skb, cb, state); 2579 if (ret) { 2580 kfree(state); 2581 rtnl_unlock(); 2582 return ret; 2583 } 2584 cb->args[0] = (long)state; 2585 } 2586 2587 list_for_each_entry(rdev, &cfg80211_rdev_list, list) { 2588 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 2589 continue; 2590 if (++idx <= state->start) 2591 continue; 2592 if (state->filter_wiphy != -1 && 2593 state->filter_wiphy != rdev->wiphy_idx) 2594 continue; 2595 /* attempt to fit multiple wiphy data chunks into the skb */ 2596 do { 2597 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, 2598 skb, 2599 NETLINK_CB(cb->skb).portid, 2600 cb->nlh->nlmsg_seq, 2601 NLM_F_MULTI, state); 2602 if (ret < 0) { 2603 /* 2604 * If sending the wiphy data didn't fit (ENOBUFS 2605 * or EMSGSIZE returned), this SKB is still 2606 * empty (so it's not too big because another 2607 * wiphy dataset is already in the skb) and 2608 * we've not tried to adjust the dump allocation 2609 * yet ... then adjust the alloc size to be 2610 * bigger, and return 1 but with the empty skb. 2611 * This results in an empty message being RX'ed 2612 * in userspace, but that is ignored. 2613 * 2614 * We can then retry with the larger buffer. 2615 */ 2616 if ((ret == -ENOBUFS || ret == -EMSGSIZE) && 2617 !skb->len && !state->split && 2618 cb->min_dump_alloc < 4096) { 2619 cb->min_dump_alloc = 4096; 2620 state->split_start = 0; 2621 rtnl_unlock(); 2622 return 1; 2623 } 2624 idx--; 2625 break; 2626 } 2627 } while (state->split_start > 0); 2628 break; 2629 } 2630 rtnl_unlock(); 2631 2632 state->start = idx; 2633 2634 return skb->len; 2635 } 2636 2637 static int nl80211_dump_wiphy_done(struct netlink_callback *cb) 2638 { 2639 kfree((void *)cb->args[0]); 2640 return 0; 2641 } 2642 2643 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info) 2644 { 2645 struct sk_buff *msg; 2646 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 2647 struct nl80211_dump_wiphy_state state = {}; 2648 2649 msg = nlmsg_new(4096, GFP_KERNEL); 2650 if (!msg) 2651 return -ENOMEM; 2652 2653 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg, 2654 info->snd_portid, info->snd_seq, 0, 2655 &state) < 0) { 2656 nlmsg_free(msg); 2657 return -ENOBUFS; 2658 } 2659 2660 return genlmsg_reply(msg, info); 2661 } 2662 2663 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = { 2664 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 }, 2665 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 }, 2666 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 }, 2667 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 }, 2668 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 }, 2669 }; 2670 2671 static int parse_txq_params(struct nlattr *tb[], 2672 struct ieee80211_txq_params *txq_params) 2673 { 2674 u8 ac; 2675 2676 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] || 2677 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] || 2678 !tb[NL80211_TXQ_ATTR_AIFS]) 2679 return -EINVAL; 2680 2681 ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]); 2682 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]); 2683 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]); 2684 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]); 2685 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]); 2686 2687 if (ac >= NL80211_NUM_ACS) 2688 return -EINVAL; 2689 txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS); 2690 return 0; 2691 } 2692 2693 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev) 2694 { 2695 /* 2696 * You can only set the channel explicitly for WDS interfaces, 2697 * all others have their channel managed via their respective 2698 * "establish a connection" command (connect, join, ...) 2699 * 2700 * For AP/GO and mesh mode, the channel can be set with the 2701 * channel userspace API, but is only stored and passed to the 2702 * low-level driver when the AP starts or the mesh is joined. 2703 * This is for backward compatibility, userspace can also give 2704 * the channel in the start-ap or join-mesh commands instead. 2705 * 2706 * Monitors are special as they are normally slaved to 2707 * whatever else is going on, so they have their own special 2708 * operation to set the monitor channel if possible. 2709 */ 2710 return !wdev || 2711 wdev->iftype == NL80211_IFTYPE_AP || 2712 wdev->iftype == NL80211_IFTYPE_MESH_POINT || 2713 wdev->iftype == NL80211_IFTYPE_MONITOR || 2714 wdev->iftype == NL80211_IFTYPE_P2P_GO; 2715 } 2716 2717 int nl80211_parse_chandef(struct cfg80211_registered_device *rdev, 2718 struct genl_info *info, 2719 struct cfg80211_chan_def *chandef) 2720 { 2721 struct netlink_ext_ack *extack = info->extack; 2722 struct nlattr **attrs = info->attrs; 2723 u32 control_freq; 2724 2725 if (!attrs[NL80211_ATTR_WIPHY_FREQ]) 2726 return -EINVAL; 2727 2728 control_freq = nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ]); 2729 2730 memset(chandef, 0, sizeof(*chandef)); 2731 2732 chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq); 2733 chandef->width = NL80211_CHAN_WIDTH_20_NOHT; 2734 chandef->center_freq1 = control_freq; 2735 chandef->center_freq2 = 0; 2736 2737 /* Primary channel not allowed */ 2738 if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED) { 2739 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 2740 "Channel is disabled"); 2741 return -EINVAL; 2742 } 2743 2744 if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) { 2745 enum nl80211_channel_type chantype; 2746 2747 chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]); 2748 2749 switch (chantype) { 2750 case NL80211_CHAN_NO_HT: 2751 case NL80211_CHAN_HT20: 2752 case NL80211_CHAN_HT40PLUS: 2753 case NL80211_CHAN_HT40MINUS: 2754 cfg80211_chandef_create(chandef, chandef->chan, 2755 chantype); 2756 /* user input for center_freq is incorrect */ 2757 if (attrs[NL80211_ATTR_CENTER_FREQ1] && 2758 chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) { 2759 NL_SET_ERR_MSG_ATTR(extack, 2760 attrs[NL80211_ATTR_CENTER_FREQ1], 2761 "bad center frequency 1"); 2762 return -EINVAL; 2763 } 2764 /* center_freq2 must be zero */ 2765 if (attrs[NL80211_ATTR_CENTER_FREQ2] && 2766 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) { 2767 NL_SET_ERR_MSG_ATTR(extack, 2768 attrs[NL80211_ATTR_CENTER_FREQ2], 2769 "center frequency 2 can't be used"); 2770 return -EINVAL; 2771 } 2772 break; 2773 default: 2774 NL_SET_ERR_MSG_ATTR(extack, 2775 attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE], 2776 "invalid channel type"); 2777 return -EINVAL; 2778 } 2779 } else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) { 2780 chandef->width = 2781 nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]); 2782 if (attrs[NL80211_ATTR_CENTER_FREQ1]) 2783 chandef->center_freq1 = 2784 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]); 2785 if (attrs[NL80211_ATTR_CENTER_FREQ2]) 2786 chandef->center_freq2 = 2787 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]); 2788 } 2789 2790 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 2791 chandef->edmg.channels = 2792 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 2793 2794 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 2795 chandef->edmg.bw_config = 2796 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 2797 } else { 2798 chandef->edmg.bw_config = 0; 2799 chandef->edmg.channels = 0; 2800 } 2801 2802 if (!cfg80211_chandef_valid(chandef)) { 2803 NL_SET_ERR_MSG(extack, "invalid channel definition"); 2804 return -EINVAL; 2805 } 2806 2807 if (!cfg80211_chandef_usable(&rdev->wiphy, chandef, 2808 IEEE80211_CHAN_DISABLED)) { 2809 NL_SET_ERR_MSG(extack, "(extension) channel is disabled"); 2810 return -EINVAL; 2811 } 2812 2813 if ((chandef->width == NL80211_CHAN_WIDTH_5 || 2814 chandef->width == NL80211_CHAN_WIDTH_10) && 2815 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) { 2816 NL_SET_ERR_MSG(extack, "5/10 MHz not supported"); 2817 return -EINVAL; 2818 } 2819 2820 return 0; 2821 } 2822 2823 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev, 2824 struct net_device *dev, 2825 struct genl_info *info) 2826 { 2827 struct cfg80211_chan_def chandef; 2828 int result; 2829 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR; 2830 struct wireless_dev *wdev = NULL; 2831 2832 if (dev) 2833 wdev = dev->ieee80211_ptr; 2834 if (!nl80211_can_set_dev_channel(wdev)) 2835 return -EOPNOTSUPP; 2836 if (wdev) 2837 iftype = wdev->iftype; 2838 2839 result = nl80211_parse_chandef(rdev, info, &chandef); 2840 if (result) 2841 return result; 2842 2843 switch (iftype) { 2844 case NL80211_IFTYPE_AP: 2845 case NL80211_IFTYPE_P2P_GO: 2846 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 2847 iftype)) { 2848 result = -EINVAL; 2849 break; 2850 } 2851 if (wdev->beacon_interval) { 2852 if (!dev || !rdev->ops->set_ap_chanwidth || 2853 !(rdev->wiphy.features & 2854 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) { 2855 result = -EBUSY; 2856 break; 2857 } 2858 2859 /* Only allow dynamic channel width changes */ 2860 if (chandef.chan != wdev->preset_chandef.chan) { 2861 result = -EBUSY; 2862 break; 2863 } 2864 result = rdev_set_ap_chanwidth(rdev, dev, &chandef); 2865 if (result) 2866 break; 2867 } 2868 wdev->preset_chandef = chandef; 2869 result = 0; 2870 break; 2871 case NL80211_IFTYPE_MESH_POINT: 2872 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef); 2873 break; 2874 case NL80211_IFTYPE_MONITOR: 2875 result = cfg80211_set_monitor_channel(rdev, &chandef); 2876 break; 2877 default: 2878 result = -EINVAL; 2879 } 2880 2881 return result; 2882 } 2883 2884 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info) 2885 { 2886 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 2887 struct net_device *netdev = info->user_ptr[1]; 2888 2889 return __nl80211_set_channel(rdev, netdev, info); 2890 } 2891 2892 static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info) 2893 { 2894 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 2895 struct net_device *dev = info->user_ptr[1]; 2896 struct wireless_dev *wdev = dev->ieee80211_ptr; 2897 const u8 *bssid; 2898 2899 if (!info->attrs[NL80211_ATTR_MAC]) 2900 return -EINVAL; 2901 2902 if (netif_running(dev)) 2903 return -EBUSY; 2904 2905 if (!rdev->ops->set_wds_peer) 2906 return -EOPNOTSUPP; 2907 2908 if (wdev->iftype != NL80211_IFTYPE_WDS) 2909 return -EOPNOTSUPP; 2910 2911 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 2912 return rdev_set_wds_peer(rdev, dev, bssid); 2913 } 2914 2915 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info) 2916 { 2917 struct cfg80211_registered_device *rdev; 2918 struct net_device *netdev = NULL; 2919 struct wireless_dev *wdev; 2920 int result = 0, rem_txq_params = 0; 2921 struct nlattr *nl_txq_params; 2922 u32 changed; 2923 u8 retry_short = 0, retry_long = 0; 2924 u32 frag_threshold = 0, rts_threshold = 0; 2925 u8 coverage_class = 0; 2926 u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0; 2927 2928 ASSERT_RTNL(); 2929 2930 /* 2931 * Try to find the wiphy and netdev. Normally this 2932 * function shouldn't need the netdev, but this is 2933 * done for backward compatibility -- previously 2934 * setting the channel was done per wiphy, but now 2935 * it is per netdev. Previous userland like hostapd 2936 * also passed a netdev to set_wiphy, so that it is 2937 * possible to let that go to the right netdev! 2938 */ 2939 2940 if (info->attrs[NL80211_ATTR_IFINDEX]) { 2941 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]); 2942 2943 netdev = __dev_get_by_index(genl_info_net(info), ifindex); 2944 if (netdev && netdev->ieee80211_ptr) 2945 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy); 2946 else 2947 netdev = NULL; 2948 } 2949 2950 if (!netdev) { 2951 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info), 2952 info->attrs); 2953 if (IS_ERR(rdev)) 2954 return PTR_ERR(rdev); 2955 wdev = NULL; 2956 netdev = NULL; 2957 result = 0; 2958 } else 2959 wdev = netdev->ieee80211_ptr; 2960 2961 /* 2962 * end workaround code, by now the rdev is available 2963 * and locked, and wdev may or may not be NULL. 2964 */ 2965 2966 if (info->attrs[NL80211_ATTR_WIPHY_NAME]) 2967 result = cfg80211_dev_rename( 2968 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME])); 2969 2970 if (result) 2971 return result; 2972 2973 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) { 2974 struct ieee80211_txq_params txq_params; 2975 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1]; 2976 2977 if (!rdev->ops->set_txq_params) 2978 return -EOPNOTSUPP; 2979 2980 if (!netdev) 2981 return -EINVAL; 2982 2983 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 2984 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 2985 return -EINVAL; 2986 2987 if (!netif_running(netdev)) 2988 return -ENETDOWN; 2989 2990 nla_for_each_nested(nl_txq_params, 2991 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS], 2992 rem_txq_params) { 2993 result = nla_parse_nested_deprecated(tb, 2994 NL80211_TXQ_ATTR_MAX, 2995 nl_txq_params, 2996 txq_params_policy, 2997 info->extack); 2998 if (result) 2999 return result; 3000 result = parse_txq_params(tb, &txq_params); 3001 if (result) 3002 return result; 3003 3004 result = rdev_set_txq_params(rdev, netdev, 3005 &txq_params); 3006 if (result) 3007 return result; 3008 } 3009 } 3010 3011 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 3012 result = __nl80211_set_channel( 3013 rdev, 3014 nl80211_can_set_dev_channel(wdev) ? netdev : NULL, 3015 info); 3016 if (result) 3017 return result; 3018 } 3019 3020 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) { 3021 struct wireless_dev *txp_wdev = wdev; 3022 enum nl80211_tx_power_setting type; 3023 int idx, mbm = 0; 3024 3025 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER)) 3026 txp_wdev = NULL; 3027 3028 if (!rdev->ops->set_tx_power) 3029 return -EOPNOTSUPP; 3030 3031 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING; 3032 type = nla_get_u32(info->attrs[idx]); 3033 3034 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] && 3035 (type != NL80211_TX_POWER_AUTOMATIC)) 3036 return -EINVAL; 3037 3038 if (type != NL80211_TX_POWER_AUTOMATIC) { 3039 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL; 3040 mbm = nla_get_u32(info->attrs[idx]); 3041 } 3042 3043 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm); 3044 if (result) 3045 return result; 3046 } 3047 3048 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] && 3049 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) { 3050 u32 tx_ant, rx_ant; 3051 3052 if ((!rdev->wiphy.available_antennas_tx && 3053 !rdev->wiphy.available_antennas_rx) || 3054 !rdev->ops->set_antenna) 3055 return -EOPNOTSUPP; 3056 3057 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]); 3058 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]); 3059 3060 /* reject antenna configurations which don't match the 3061 * available antenna masks, except for the "all" mask */ 3062 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) || 3063 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) 3064 return -EINVAL; 3065 3066 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx; 3067 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx; 3068 3069 result = rdev_set_antenna(rdev, tx_ant, rx_ant); 3070 if (result) 3071 return result; 3072 } 3073 3074 changed = 0; 3075 3076 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) { 3077 retry_short = nla_get_u8( 3078 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]); 3079 3080 changed |= WIPHY_PARAM_RETRY_SHORT; 3081 } 3082 3083 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) { 3084 retry_long = nla_get_u8( 3085 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]); 3086 3087 changed |= WIPHY_PARAM_RETRY_LONG; 3088 } 3089 3090 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) { 3091 frag_threshold = nla_get_u32( 3092 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]); 3093 if (frag_threshold < 256) 3094 return -EINVAL; 3095 3096 if (frag_threshold != (u32) -1) { 3097 /* 3098 * Fragments (apart from the last one) are required to 3099 * have even length. Make the fragmentation code 3100 * simpler by stripping LSB should someone try to use 3101 * odd threshold value. 3102 */ 3103 frag_threshold &= ~0x1; 3104 } 3105 changed |= WIPHY_PARAM_FRAG_THRESHOLD; 3106 } 3107 3108 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) { 3109 rts_threshold = nla_get_u32( 3110 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]); 3111 changed |= WIPHY_PARAM_RTS_THRESHOLD; 3112 } 3113 3114 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) { 3115 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) 3116 return -EINVAL; 3117 3118 coverage_class = nla_get_u8( 3119 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]); 3120 changed |= WIPHY_PARAM_COVERAGE_CLASS; 3121 } 3122 3123 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) { 3124 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION)) 3125 return -EOPNOTSUPP; 3126 3127 changed |= WIPHY_PARAM_DYN_ACK; 3128 } 3129 3130 if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) { 3131 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3132 NL80211_EXT_FEATURE_TXQS)) 3133 return -EOPNOTSUPP; 3134 txq_limit = nla_get_u32( 3135 info->attrs[NL80211_ATTR_TXQ_LIMIT]); 3136 changed |= WIPHY_PARAM_TXQ_LIMIT; 3137 } 3138 3139 if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) { 3140 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3141 NL80211_EXT_FEATURE_TXQS)) 3142 return -EOPNOTSUPP; 3143 txq_memory_limit = nla_get_u32( 3144 info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]); 3145 changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT; 3146 } 3147 3148 if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) { 3149 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3150 NL80211_EXT_FEATURE_TXQS)) 3151 return -EOPNOTSUPP; 3152 txq_quantum = nla_get_u32( 3153 info->attrs[NL80211_ATTR_TXQ_QUANTUM]); 3154 changed |= WIPHY_PARAM_TXQ_QUANTUM; 3155 } 3156 3157 if (changed) { 3158 u8 old_retry_short, old_retry_long; 3159 u32 old_frag_threshold, old_rts_threshold; 3160 u8 old_coverage_class; 3161 u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum; 3162 3163 if (!rdev->ops->set_wiphy_params) 3164 return -EOPNOTSUPP; 3165 3166 old_retry_short = rdev->wiphy.retry_short; 3167 old_retry_long = rdev->wiphy.retry_long; 3168 old_frag_threshold = rdev->wiphy.frag_threshold; 3169 old_rts_threshold = rdev->wiphy.rts_threshold; 3170 old_coverage_class = rdev->wiphy.coverage_class; 3171 old_txq_limit = rdev->wiphy.txq_limit; 3172 old_txq_memory_limit = rdev->wiphy.txq_memory_limit; 3173 old_txq_quantum = rdev->wiphy.txq_quantum; 3174 3175 if (changed & WIPHY_PARAM_RETRY_SHORT) 3176 rdev->wiphy.retry_short = retry_short; 3177 if (changed & WIPHY_PARAM_RETRY_LONG) 3178 rdev->wiphy.retry_long = retry_long; 3179 if (changed & WIPHY_PARAM_FRAG_THRESHOLD) 3180 rdev->wiphy.frag_threshold = frag_threshold; 3181 if (changed & WIPHY_PARAM_RTS_THRESHOLD) 3182 rdev->wiphy.rts_threshold = rts_threshold; 3183 if (changed & WIPHY_PARAM_COVERAGE_CLASS) 3184 rdev->wiphy.coverage_class = coverage_class; 3185 if (changed & WIPHY_PARAM_TXQ_LIMIT) 3186 rdev->wiphy.txq_limit = txq_limit; 3187 if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT) 3188 rdev->wiphy.txq_memory_limit = txq_memory_limit; 3189 if (changed & WIPHY_PARAM_TXQ_QUANTUM) 3190 rdev->wiphy.txq_quantum = txq_quantum; 3191 3192 result = rdev_set_wiphy_params(rdev, changed); 3193 if (result) { 3194 rdev->wiphy.retry_short = old_retry_short; 3195 rdev->wiphy.retry_long = old_retry_long; 3196 rdev->wiphy.frag_threshold = old_frag_threshold; 3197 rdev->wiphy.rts_threshold = old_rts_threshold; 3198 rdev->wiphy.coverage_class = old_coverage_class; 3199 rdev->wiphy.txq_limit = old_txq_limit; 3200 rdev->wiphy.txq_memory_limit = old_txq_memory_limit; 3201 rdev->wiphy.txq_quantum = old_txq_quantum; 3202 return result; 3203 } 3204 } 3205 return 0; 3206 } 3207 3208 static int nl80211_send_chandef(struct sk_buff *msg, 3209 const struct cfg80211_chan_def *chandef) 3210 { 3211 if (WARN_ON(!cfg80211_chandef_valid(chandef))) 3212 return -EINVAL; 3213 3214 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 3215 chandef->chan->center_freq)) 3216 return -ENOBUFS; 3217 switch (chandef->width) { 3218 case NL80211_CHAN_WIDTH_20_NOHT: 3219 case NL80211_CHAN_WIDTH_20: 3220 case NL80211_CHAN_WIDTH_40: 3221 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 3222 cfg80211_get_chandef_type(chandef))) 3223 return -ENOBUFS; 3224 break; 3225 default: 3226 break; 3227 } 3228 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width)) 3229 return -ENOBUFS; 3230 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1)) 3231 return -ENOBUFS; 3232 if (chandef->center_freq2 && 3233 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2)) 3234 return -ENOBUFS; 3235 return 0; 3236 } 3237 3238 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags, 3239 struct cfg80211_registered_device *rdev, 3240 struct wireless_dev *wdev, 3241 enum nl80211_commands cmd) 3242 { 3243 struct net_device *dev = wdev->netdev; 3244 void *hdr; 3245 3246 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE && 3247 cmd != NL80211_CMD_DEL_INTERFACE && 3248 cmd != NL80211_CMD_SET_INTERFACE); 3249 3250 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 3251 if (!hdr) 3252 return -1; 3253 3254 if (dev && 3255 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 3256 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name))) 3257 goto nla_put_failure; 3258 3259 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 3260 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) || 3261 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 3262 NL80211_ATTR_PAD) || 3263 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) || 3264 nla_put_u32(msg, NL80211_ATTR_GENERATION, 3265 rdev->devlist_generation ^ 3266 (cfg80211_rdev_list_generation << 2)) || 3267 nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr)) 3268 goto nla_put_failure; 3269 3270 if (rdev->ops->get_channel) { 3271 int ret; 3272 struct cfg80211_chan_def chandef = {}; 3273 3274 ret = rdev_get_channel(rdev, wdev, &chandef); 3275 if (ret == 0) { 3276 if (nl80211_send_chandef(msg, &chandef)) 3277 goto nla_put_failure; 3278 } 3279 } 3280 3281 if (rdev->ops->get_tx_power) { 3282 int dbm, ret; 3283 3284 ret = rdev_get_tx_power(rdev, wdev, &dbm); 3285 if (ret == 0 && 3286 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL, 3287 DBM_TO_MBM(dbm))) 3288 goto nla_put_failure; 3289 } 3290 3291 wdev_lock(wdev); 3292 switch (wdev->iftype) { 3293 case NL80211_IFTYPE_AP: 3294 if (wdev->ssid_len && 3295 nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid)) 3296 goto nla_put_failure_locked; 3297 break; 3298 case NL80211_IFTYPE_STATION: 3299 case NL80211_IFTYPE_P2P_CLIENT: 3300 case NL80211_IFTYPE_ADHOC: { 3301 const u8 *ssid_ie; 3302 if (!wdev->current_bss) 3303 break; 3304 rcu_read_lock(); 3305 ssid_ie = ieee80211_bss_get_ie(&wdev->current_bss->pub, 3306 WLAN_EID_SSID); 3307 if (ssid_ie && 3308 nla_put(msg, NL80211_ATTR_SSID, ssid_ie[1], ssid_ie + 2)) 3309 goto nla_put_failure_rcu_locked; 3310 rcu_read_unlock(); 3311 break; 3312 } 3313 default: 3314 /* nothing */ 3315 break; 3316 } 3317 wdev_unlock(wdev); 3318 3319 if (rdev->ops->get_txq_stats) { 3320 struct cfg80211_txq_stats txqstats = {}; 3321 int ret = rdev_get_txq_stats(rdev, wdev, &txqstats); 3322 3323 if (ret == 0 && 3324 !nl80211_put_txq_stats(msg, &txqstats, 3325 NL80211_ATTR_TXQ_STATS)) 3326 goto nla_put_failure; 3327 } 3328 3329 genlmsg_end(msg, hdr); 3330 return 0; 3331 3332 nla_put_failure_rcu_locked: 3333 rcu_read_unlock(); 3334 nla_put_failure_locked: 3335 wdev_unlock(wdev); 3336 nla_put_failure: 3337 genlmsg_cancel(msg, hdr); 3338 return -EMSGSIZE; 3339 } 3340 3341 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb) 3342 { 3343 int wp_idx = 0; 3344 int if_idx = 0; 3345 int wp_start = cb->args[0]; 3346 int if_start = cb->args[1]; 3347 int filter_wiphy = -1; 3348 struct cfg80211_registered_device *rdev; 3349 struct wireless_dev *wdev; 3350 int ret; 3351 3352 rtnl_lock(); 3353 if (!cb->args[2]) { 3354 struct nl80211_dump_wiphy_state state = { 3355 .filter_wiphy = -1, 3356 }; 3357 3358 ret = nl80211_dump_wiphy_parse(skb, cb, &state); 3359 if (ret) 3360 goto out_unlock; 3361 3362 filter_wiphy = state.filter_wiphy; 3363 3364 /* 3365 * if filtering, set cb->args[2] to +1 since 0 is the default 3366 * value needed to determine that parsing is necessary. 3367 */ 3368 if (filter_wiphy >= 0) 3369 cb->args[2] = filter_wiphy + 1; 3370 else 3371 cb->args[2] = -1; 3372 } else if (cb->args[2] > 0) { 3373 filter_wiphy = cb->args[2] - 1; 3374 } 3375 3376 list_for_each_entry(rdev, &cfg80211_rdev_list, list) { 3377 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 3378 continue; 3379 if (wp_idx < wp_start) { 3380 wp_idx++; 3381 continue; 3382 } 3383 3384 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx) 3385 continue; 3386 3387 if_idx = 0; 3388 3389 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 3390 if (if_idx < if_start) { 3391 if_idx++; 3392 continue; 3393 } 3394 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid, 3395 cb->nlh->nlmsg_seq, NLM_F_MULTI, 3396 rdev, wdev, 3397 NL80211_CMD_NEW_INTERFACE) < 0) { 3398 goto out; 3399 } 3400 if_idx++; 3401 } 3402 3403 wp_idx++; 3404 } 3405 out: 3406 cb->args[0] = wp_idx; 3407 cb->args[1] = if_idx; 3408 3409 ret = skb->len; 3410 out_unlock: 3411 rtnl_unlock(); 3412 3413 return ret; 3414 } 3415 3416 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info) 3417 { 3418 struct sk_buff *msg; 3419 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3420 struct wireless_dev *wdev = info->user_ptr[1]; 3421 3422 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 3423 if (!msg) 3424 return -ENOMEM; 3425 3426 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 3427 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 3428 nlmsg_free(msg); 3429 return -ENOBUFS; 3430 } 3431 3432 return genlmsg_reply(msg, info); 3433 } 3434 3435 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = { 3436 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG }, 3437 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG }, 3438 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG }, 3439 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG }, 3440 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG }, 3441 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG }, 3442 }; 3443 3444 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags) 3445 { 3446 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1]; 3447 int flag; 3448 3449 *mntrflags = 0; 3450 3451 if (!nla) 3452 return -EINVAL; 3453 3454 if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL)) 3455 return -EINVAL; 3456 3457 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++) 3458 if (flags[flag]) 3459 *mntrflags |= (1<<flag); 3460 3461 *mntrflags |= MONITOR_FLAG_CHANGED; 3462 3463 return 0; 3464 } 3465 3466 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev, 3467 enum nl80211_iftype type, 3468 struct genl_info *info, 3469 struct vif_params *params) 3470 { 3471 bool change = false; 3472 int err; 3473 3474 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) { 3475 if (type != NL80211_IFTYPE_MONITOR) 3476 return -EINVAL; 3477 3478 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS], 3479 ¶ms->flags); 3480 if (err) 3481 return err; 3482 3483 change = true; 3484 } 3485 3486 if (params->flags & MONITOR_FLAG_ACTIVE && 3487 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR)) 3488 return -EOPNOTSUPP; 3489 3490 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) { 3491 const u8 *mumimo_groups; 3492 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 3493 3494 if (type != NL80211_IFTYPE_MONITOR) 3495 return -EINVAL; 3496 3497 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 3498 return -EOPNOTSUPP; 3499 3500 mumimo_groups = 3501 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]); 3502 3503 /* bits 0 and 63 are reserved and must be zero */ 3504 if ((mumimo_groups[0] & BIT(0)) || 3505 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7))) 3506 return -EINVAL; 3507 3508 params->vht_mumimo_groups = mumimo_groups; 3509 change = true; 3510 } 3511 3512 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) { 3513 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 3514 3515 if (type != NL80211_IFTYPE_MONITOR) 3516 return -EINVAL; 3517 3518 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 3519 return -EOPNOTSUPP; 3520 3521 params->vht_mumimo_follow_addr = 3522 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]); 3523 change = true; 3524 } 3525 3526 return change ? 1 : 0; 3527 } 3528 3529 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev, 3530 struct net_device *netdev, u8 use_4addr, 3531 enum nl80211_iftype iftype) 3532 { 3533 if (!use_4addr) { 3534 if (netdev && netif_is_bridge_port(netdev)) 3535 return -EBUSY; 3536 return 0; 3537 } 3538 3539 switch (iftype) { 3540 case NL80211_IFTYPE_AP_VLAN: 3541 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP) 3542 return 0; 3543 break; 3544 case NL80211_IFTYPE_STATION: 3545 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION) 3546 return 0; 3547 break; 3548 default: 3549 break; 3550 } 3551 3552 return -EOPNOTSUPP; 3553 } 3554 3555 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info) 3556 { 3557 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3558 struct vif_params params; 3559 int err; 3560 enum nl80211_iftype otype, ntype; 3561 struct net_device *dev = info->user_ptr[1]; 3562 bool change = false; 3563 3564 memset(¶ms, 0, sizeof(params)); 3565 3566 otype = ntype = dev->ieee80211_ptr->iftype; 3567 3568 if (info->attrs[NL80211_ATTR_IFTYPE]) { 3569 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 3570 if (otype != ntype) 3571 change = true; 3572 } 3573 3574 if (info->attrs[NL80211_ATTR_MESH_ID]) { 3575 struct wireless_dev *wdev = dev->ieee80211_ptr; 3576 3577 if (ntype != NL80211_IFTYPE_MESH_POINT) 3578 return -EINVAL; 3579 if (netif_running(dev)) 3580 return -EBUSY; 3581 3582 wdev_lock(wdev); 3583 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN != 3584 IEEE80211_MAX_MESH_ID_LEN); 3585 wdev->mesh_id_up_len = 3586 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 3587 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 3588 wdev->mesh_id_up_len); 3589 wdev_unlock(wdev); 3590 } 3591 3592 if (info->attrs[NL80211_ATTR_4ADDR]) { 3593 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 3594 change = true; 3595 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype); 3596 if (err) 3597 return err; 3598 } else { 3599 params.use_4addr = -1; 3600 } 3601 3602 err = nl80211_parse_mon_options(rdev, ntype, info, ¶ms); 3603 if (err < 0) 3604 return err; 3605 if (err > 0) 3606 change = true; 3607 3608 if (change) 3609 err = cfg80211_change_iface(rdev, dev, ntype, ¶ms); 3610 else 3611 err = 0; 3612 3613 if (!err && params.use_4addr != -1) 3614 dev->ieee80211_ptr->use_4addr = params.use_4addr; 3615 3616 if (change && !err) { 3617 struct wireless_dev *wdev = dev->ieee80211_ptr; 3618 3619 nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE); 3620 } 3621 3622 return err; 3623 } 3624 3625 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 3626 { 3627 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3628 struct vif_params params; 3629 struct wireless_dev *wdev; 3630 struct sk_buff *msg; 3631 int err; 3632 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED; 3633 3634 /* to avoid failing a new interface creation due to pending removal */ 3635 cfg80211_destroy_ifaces(rdev); 3636 3637 memset(¶ms, 0, sizeof(params)); 3638 3639 if (!info->attrs[NL80211_ATTR_IFNAME]) 3640 return -EINVAL; 3641 3642 if (info->attrs[NL80211_ATTR_IFTYPE]) 3643 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 3644 3645 if (!rdev->ops->add_virtual_intf) 3646 return -EOPNOTSUPP; 3647 3648 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN || 3649 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) && 3650 info->attrs[NL80211_ATTR_MAC]) { 3651 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC], 3652 ETH_ALEN); 3653 if (!is_valid_ether_addr(params.macaddr)) 3654 return -EADDRNOTAVAIL; 3655 } 3656 3657 if (info->attrs[NL80211_ATTR_4ADDR]) { 3658 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 3659 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type); 3660 if (err) 3661 return err; 3662 } 3663 3664 if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0)) 3665 return -EOPNOTSUPP; 3666 3667 err = nl80211_parse_mon_options(rdev, type, info, ¶ms); 3668 if (err < 0) 3669 return err; 3670 3671 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 3672 if (!msg) 3673 return -ENOMEM; 3674 3675 wdev = rdev_add_virtual_intf(rdev, 3676 nla_data(info->attrs[NL80211_ATTR_IFNAME]), 3677 NET_NAME_USER, type, ¶ms); 3678 if (WARN_ON(!wdev)) { 3679 nlmsg_free(msg); 3680 return -EPROTO; 3681 } else if (IS_ERR(wdev)) { 3682 nlmsg_free(msg); 3683 return PTR_ERR(wdev); 3684 } 3685 3686 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 3687 wdev->owner_nlportid = info->snd_portid; 3688 3689 switch (type) { 3690 case NL80211_IFTYPE_MESH_POINT: 3691 if (!info->attrs[NL80211_ATTR_MESH_ID]) 3692 break; 3693 wdev_lock(wdev); 3694 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN != 3695 IEEE80211_MAX_MESH_ID_LEN); 3696 wdev->mesh_id_up_len = 3697 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 3698 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 3699 wdev->mesh_id_up_len); 3700 wdev_unlock(wdev); 3701 break; 3702 case NL80211_IFTYPE_NAN: 3703 case NL80211_IFTYPE_P2P_DEVICE: 3704 /* 3705 * P2P Device and NAN do not have a netdev, so don't go 3706 * through the netdev notifier and must be added here 3707 */ 3708 cfg80211_init_wdev(rdev, wdev); 3709 break; 3710 default: 3711 break; 3712 } 3713 3714 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 3715 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 3716 nlmsg_free(msg); 3717 return -ENOBUFS; 3718 } 3719 3720 return genlmsg_reply(msg, info); 3721 } 3722 3723 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info) 3724 { 3725 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3726 struct wireless_dev *wdev = info->user_ptr[1]; 3727 3728 if (!rdev->ops->del_virtual_intf) 3729 return -EOPNOTSUPP; 3730 3731 /* 3732 * If we remove a wireless device without a netdev then clear 3733 * user_ptr[1] so that nl80211_post_doit won't dereference it 3734 * to check if it needs to do dev_put(). Otherwise it crashes 3735 * since the wdev has been freed, unlike with a netdev where 3736 * we need the dev_put() for the netdev to really be freed. 3737 */ 3738 if (!wdev->netdev) 3739 info->user_ptr[1] = NULL; 3740 3741 return rdev_del_virtual_intf(rdev, wdev); 3742 } 3743 3744 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info) 3745 { 3746 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3747 struct net_device *dev = info->user_ptr[1]; 3748 u16 noack_map; 3749 3750 if (!info->attrs[NL80211_ATTR_NOACK_MAP]) 3751 return -EINVAL; 3752 3753 if (!rdev->ops->set_noack_map) 3754 return -EOPNOTSUPP; 3755 3756 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]); 3757 3758 return rdev_set_noack_map(rdev, dev, noack_map); 3759 } 3760 3761 struct get_key_cookie { 3762 struct sk_buff *msg; 3763 int error; 3764 int idx; 3765 }; 3766 3767 static void get_key_callback(void *c, struct key_params *params) 3768 { 3769 struct nlattr *key; 3770 struct get_key_cookie *cookie = c; 3771 3772 if ((params->key && 3773 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA, 3774 params->key_len, params->key)) || 3775 (params->seq && 3776 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ, 3777 params->seq_len, params->seq)) || 3778 (params->cipher && 3779 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER, 3780 params->cipher))) 3781 goto nla_put_failure; 3782 3783 key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY); 3784 if (!key) 3785 goto nla_put_failure; 3786 3787 if ((params->key && 3788 nla_put(cookie->msg, NL80211_KEY_DATA, 3789 params->key_len, params->key)) || 3790 (params->seq && 3791 nla_put(cookie->msg, NL80211_KEY_SEQ, 3792 params->seq_len, params->seq)) || 3793 (params->cipher && 3794 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER, 3795 params->cipher))) 3796 goto nla_put_failure; 3797 3798 if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx)) 3799 goto nla_put_failure; 3800 3801 nla_nest_end(cookie->msg, key); 3802 3803 return; 3804 nla_put_failure: 3805 cookie->error = 1; 3806 } 3807 3808 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info) 3809 { 3810 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3811 int err; 3812 struct net_device *dev = info->user_ptr[1]; 3813 u8 key_idx = 0; 3814 const u8 *mac_addr = NULL; 3815 bool pairwise; 3816 struct get_key_cookie cookie = { 3817 .error = 0, 3818 }; 3819 void *hdr; 3820 struct sk_buff *msg; 3821 3822 if (info->attrs[NL80211_ATTR_KEY_IDX]) 3823 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 3824 3825 if (info->attrs[NL80211_ATTR_MAC]) 3826 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 3827 3828 pairwise = !!mac_addr; 3829 if (info->attrs[NL80211_ATTR_KEY_TYPE]) { 3830 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 3831 3832 if (kt != NL80211_KEYTYPE_GROUP && 3833 kt != NL80211_KEYTYPE_PAIRWISE) 3834 return -EINVAL; 3835 pairwise = kt == NL80211_KEYTYPE_PAIRWISE; 3836 } 3837 3838 if (!rdev->ops->get_key) 3839 return -EOPNOTSUPP; 3840 3841 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 3842 return -ENOENT; 3843 3844 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 3845 if (!msg) 3846 return -ENOMEM; 3847 3848 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 3849 NL80211_CMD_NEW_KEY); 3850 if (!hdr) 3851 goto nla_put_failure; 3852 3853 cookie.msg = msg; 3854 cookie.idx = key_idx; 3855 3856 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 3857 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx)) 3858 goto nla_put_failure; 3859 if (mac_addr && 3860 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr)) 3861 goto nla_put_failure; 3862 3863 err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie, 3864 get_key_callback); 3865 3866 if (err) 3867 goto free_msg; 3868 3869 if (cookie.error) 3870 goto nla_put_failure; 3871 3872 genlmsg_end(msg, hdr); 3873 return genlmsg_reply(msg, info); 3874 3875 nla_put_failure: 3876 err = -ENOBUFS; 3877 free_msg: 3878 nlmsg_free(msg); 3879 return err; 3880 } 3881 3882 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info) 3883 { 3884 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3885 struct key_parse key; 3886 int err; 3887 struct net_device *dev = info->user_ptr[1]; 3888 3889 err = nl80211_parse_key(info, &key); 3890 if (err) 3891 return err; 3892 3893 if (key.idx < 0) 3894 return -EINVAL; 3895 3896 /* Only support setting default key and 3897 * Extended Key ID action NL80211_KEY_SET_TX. 3898 */ 3899 if (!key.def && !key.defmgmt && 3900 !(key.p.mode == NL80211_KEY_SET_TX)) 3901 return -EINVAL; 3902 3903 wdev_lock(dev->ieee80211_ptr); 3904 3905 if (key.def) { 3906 if (!rdev->ops->set_default_key) { 3907 err = -EOPNOTSUPP; 3908 goto out; 3909 } 3910 3911 err = nl80211_key_allowed(dev->ieee80211_ptr); 3912 if (err) 3913 goto out; 3914 3915 err = rdev_set_default_key(rdev, dev, key.idx, 3916 key.def_uni, key.def_multi); 3917 3918 if (err) 3919 goto out; 3920 3921 #ifdef CONFIG_CFG80211_WEXT 3922 dev->ieee80211_ptr->wext.default_key = key.idx; 3923 #endif 3924 } else if (key.defmgmt) { 3925 if (key.def_uni || !key.def_multi) { 3926 err = -EINVAL; 3927 goto out; 3928 } 3929 3930 if (!rdev->ops->set_default_mgmt_key) { 3931 err = -EOPNOTSUPP; 3932 goto out; 3933 } 3934 3935 err = nl80211_key_allowed(dev->ieee80211_ptr); 3936 if (err) 3937 goto out; 3938 3939 err = rdev_set_default_mgmt_key(rdev, dev, key.idx); 3940 if (err) 3941 goto out; 3942 3943 #ifdef CONFIG_CFG80211_WEXT 3944 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx; 3945 #endif 3946 } else if (key.p.mode == NL80211_KEY_SET_TX && 3947 wiphy_ext_feature_isset(&rdev->wiphy, 3948 NL80211_EXT_FEATURE_EXT_KEY_ID)) { 3949 u8 *mac_addr = NULL; 3950 3951 if (info->attrs[NL80211_ATTR_MAC]) 3952 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 3953 3954 if (!mac_addr || key.idx < 0 || key.idx > 1) { 3955 err = -EINVAL; 3956 goto out; 3957 } 3958 3959 err = rdev_add_key(rdev, dev, key.idx, 3960 NL80211_KEYTYPE_PAIRWISE, 3961 mac_addr, &key.p); 3962 } else { 3963 err = -EINVAL; 3964 } 3965 out: 3966 wdev_unlock(dev->ieee80211_ptr); 3967 3968 return err; 3969 } 3970 3971 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info) 3972 { 3973 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3974 int err; 3975 struct net_device *dev = info->user_ptr[1]; 3976 struct key_parse key; 3977 const u8 *mac_addr = NULL; 3978 3979 err = nl80211_parse_key(info, &key); 3980 if (err) 3981 return err; 3982 3983 if (!key.p.key) 3984 return -EINVAL; 3985 3986 if (info->attrs[NL80211_ATTR_MAC]) 3987 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 3988 3989 if (key.type == -1) { 3990 if (mac_addr) 3991 key.type = NL80211_KEYTYPE_PAIRWISE; 3992 else 3993 key.type = NL80211_KEYTYPE_GROUP; 3994 } 3995 3996 /* for now */ 3997 if (key.type != NL80211_KEYTYPE_PAIRWISE && 3998 key.type != NL80211_KEYTYPE_GROUP) 3999 return -EINVAL; 4000 4001 if (key.type == NL80211_KEYTYPE_GROUP && 4002 info->attrs[NL80211_ATTR_VLAN_ID]) 4003 key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 4004 4005 if (!rdev->ops->add_key) 4006 return -EOPNOTSUPP; 4007 4008 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx, 4009 key.type == NL80211_KEYTYPE_PAIRWISE, 4010 mac_addr)) 4011 return -EINVAL; 4012 4013 wdev_lock(dev->ieee80211_ptr); 4014 err = nl80211_key_allowed(dev->ieee80211_ptr); 4015 if (!err) 4016 err = rdev_add_key(rdev, dev, key.idx, 4017 key.type == NL80211_KEYTYPE_PAIRWISE, 4018 mac_addr, &key.p); 4019 wdev_unlock(dev->ieee80211_ptr); 4020 4021 return err; 4022 } 4023 4024 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info) 4025 { 4026 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4027 int err; 4028 struct net_device *dev = info->user_ptr[1]; 4029 u8 *mac_addr = NULL; 4030 struct key_parse key; 4031 4032 err = nl80211_parse_key(info, &key); 4033 if (err) 4034 return err; 4035 4036 if (info->attrs[NL80211_ATTR_MAC]) 4037 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4038 4039 if (key.type == -1) { 4040 if (mac_addr) 4041 key.type = NL80211_KEYTYPE_PAIRWISE; 4042 else 4043 key.type = NL80211_KEYTYPE_GROUP; 4044 } 4045 4046 /* for now */ 4047 if (key.type != NL80211_KEYTYPE_PAIRWISE && 4048 key.type != NL80211_KEYTYPE_GROUP) 4049 return -EINVAL; 4050 4051 if (!rdev->ops->del_key) 4052 return -EOPNOTSUPP; 4053 4054 wdev_lock(dev->ieee80211_ptr); 4055 err = nl80211_key_allowed(dev->ieee80211_ptr); 4056 4057 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr && 4058 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4059 err = -ENOENT; 4060 4061 if (!err) 4062 err = rdev_del_key(rdev, dev, key.idx, 4063 key.type == NL80211_KEYTYPE_PAIRWISE, 4064 mac_addr); 4065 4066 #ifdef CONFIG_CFG80211_WEXT 4067 if (!err) { 4068 if (key.idx == dev->ieee80211_ptr->wext.default_key) 4069 dev->ieee80211_ptr->wext.default_key = -1; 4070 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key) 4071 dev->ieee80211_ptr->wext.default_mgmt_key = -1; 4072 } 4073 #endif 4074 wdev_unlock(dev->ieee80211_ptr); 4075 4076 return err; 4077 } 4078 4079 /* This function returns an error or the number of nested attributes */ 4080 static int validate_acl_mac_addrs(struct nlattr *nl_attr) 4081 { 4082 struct nlattr *attr; 4083 int n_entries = 0, tmp; 4084 4085 nla_for_each_nested(attr, nl_attr, tmp) { 4086 if (nla_len(attr) != ETH_ALEN) 4087 return -EINVAL; 4088 4089 n_entries++; 4090 } 4091 4092 return n_entries; 4093 } 4094 4095 /* 4096 * This function parses ACL information and allocates memory for ACL data. 4097 * On successful return, the calling function is responsible to free the 4098 * ACL buffer returned by this function. 4099 */ 4100 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy, 4101 struct genl_info *info) 4102 { 4103 enum nl80211_acl_policy acl_policy; 4104 struct nlattr *attr; 4105 struct cfg80211_acl_data *acl; 4106 int i = 0, n_entries, tmp; 4107 4108 if (!wiphy->max_acl_mac_addrs) 4109 return ERR_PTR(-EOPNOTSUPP); 4110 4111 if (!info->attrs[NL80211_ATTR_ACL_POLICY]) 4112 return ERR_PTR(-EINVAL); 4113 4114 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]); 4115 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED && 4116 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED) 4117 return ERR_PTR(-EINVAL); 4118 4119 if (!info->attrs[NL80211_ATTR_MAC_ADDRS]) 4120 return ERR_PTR(-EINVAL); 4121 4122 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]); 4123 if (n_entries < 0) 4124 return ERR_PTR(n_entries); 4125 4126 if (n_entries > wiphy->max_acl_mac_addrs) 4127 return ERR_PTR(-ENOTSUPP); 4128 4129 acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL); 4130 if (!acl) 4131 return ERR_PTR(-ENOMEM); 4132 4133 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) { 4134 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN); 4135 i++; 4136 } 4137 4138 acl->n_acl_entries = n_entries; 4139 acl->acl_policy = acl_policy; 4140 4141 return acl; 4142 } 4143 4144 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info) 4145 { 4146 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4147 struct net_device *dev = info->user_ptr[1]; 4148 struct cfg80211_acl_data *acl; 4149 int err; 4150 4151 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 4152 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 4153 return -EOPNOTSUPP; 4154 4155 if (!dev->ieee80211_ptr->beacon_interval) 4156 return -EINVAL; 4157 4158 acl = parse_acl_data(&rdev->wiphy, info); 4159 if (IS_ERR(acl)) 4160 return PTR_ERR(acl); 4161 4162 err = rdev_set_mac_acl(rdev, dev, acl); 4163 4164 kfree(acl); 4165 4166 return err; 4167 } 4168 4169 static u32 rateset_to_mask(struct ieee80211_supported_band *sband, 4170 u8 *rates, u8 rates_len) 4171 { 4172 u8 i; 4173 u32 mask = 0; 4174 4175 for (i = 0; i < rates_len; i++) { 4176 int rate = (rates[i] & 0x7f) * 5; 4177 int ridx; 4178 4179 for (ridx = 0; ridx < sband->n_bitrates; ridx++) { 4180 struct ieee80211_rate *srate = 4181 &sband->bitrates[ridx]; 4182 if (rate == srate->bitrate) { 4183 mask |= 1 << ridx; 4184 break; 4185 } 4186 } 4187 if (ridx == sband->n_bitrates) 4188 return 0; /* rate not found */ 4189 } 4190 4191 return mask; 4192 } 4193 4194 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband, 4195 u8 *rates, u8 rates_len, 4196 u8 mcs[IEEE80211_HT_MCS_MASK_LEN]) 4197 { 4198 u8 i; 4199 4200 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN); 4201 4202 for (i = 0; i < rates_len; i++) { 4203 int ridx, rbit; 4204 4205 ridx = rates[i] / 8; 4206 rbit = BIT(rates[i] % 8); 4207 4208 /* check validity */ 4209 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN)) 4210 return false; 4211 4212 /* check availability */ 4213 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN); 4214 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit) 4215 mcs[ridx] |= rbit; 4216 else 4217 return false; 4218 } 4219 4220 return true; 4221 } 4222 4223 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map) 4224 { 4225 u16 mcs_mask = 0; 4226 4227 switch (vht_mcs_map) { 4228 case IEEE80211_VHT_MCS_NOT_SUPPORTED: 4229 break; 4230 case IEEE80211_VHT_MCS_SUPPORT_0_7: 4231 mcs_mask = 0x00FF; 4232 break; 4233 case IEEE80211_VHT_MCS_SUPPORT_0_8: 4234 mcs_mask = 0x01FF; 4235 break; 4236 case IEEE80211_VHT_MCS_SUPPORT_0_9: 4237 mcs_mask = 0x03FF; 4238 break; 4239 default: 4240 break; 4241 } 4242 4243 return mcs_mask; 4244 } 4245 4246 static void vht_build_mcs_mask(u16 vht_mcs_map, 4247 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX]) 4248 { 4249 u8 nss; 4250 4251 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) { 4252 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03); 4253 vht_mcs_map >>= 2; 4254 } 4255 } 4256 4257 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband, 4258 struct nl80211_txrate_vht *txrate, 4259 u16 mcs[NL80211_VHT_NSS_MAX]) 4260 { 4261 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 4262 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {}; 4263 u8 i; 4264 4265 if (!sband->vht_cap.vht_supported) 4266 return false; 4267 4268 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX); 4269 4270 /* Build vht_mcs_mask from VHT capabilities */ 4271 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 4272 4273 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 4274 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 4275 mcs[i] = txrate->mcs[i]; 4276 else 4277 return false; 4278 } 4279 4280 return true; 4281 } 4282 4283 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = { 4284 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY, 4285 .len = NL80211_MAX_SUPP_RATES }, 4286 [NL80211_TXRATE_HT] = { .type = NLA_BINARY, 4287 .len = NL80211_MAX_SUPP_HT_RATES }, 4288 [NL80211_TXRATE_VHT] = { 4289 .type = NLA_EXACT_LEN_WARN, 4290 .len = sizeof(struct nl80211_txrate_vht), 4291 }, 4292 [NL80211_TXRATE_GI] = { .type = NLA_U8 }, 4293 }; 4294 4295 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info, 4296 struct cfg80211_bitrate_mask *mask) 4297 { 4298 struct nlattr *tb[NL80211_TXRATE_MAX + 1]; 4299 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4300 int rem, i; 4301 struct nlattr *tx_rates; 4302 struct ieee80211_supported_band *sband; 4303 u16 vht_tx_mcs_map; 4304 4305 memset(mask, 0, sizeof(*mask)); 4306 /* Default to all rates enabled */ 4307 for (i = 0; i < NUM_NL80211_BANDS; i++) { 4308 sband = rdev->wiphy.bands[i]; 4309 4310 if (!sband) 4311 continue; 4312 4313 mask->control[i].legacy = (1 << sband->n_bitrates) - 1; 4314 memcpy(mask->control[i].ht_mcs, 4315 sband->ht_cap.mcs.rx_mask, 4316 sizeof(mask->control[i].ht_mcs)); 4317 4318 if (!sband->vht_cap.vht_supported) 4319 continue; 4320 4321 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 4322 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs); 4323 } 4324 4325 /* if no rates are given set it back to the defaults */ 4326 if (!info->attrs[NL80211_ATTR_TX_RATES]) 4327 goto out; 4328 4329 /* The nested attribute uses enum nl80211_band as the index. This maps 4330 * directly to the enum nl80211_band values used in cfg80211. 4331 */ 4332 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8); 4333 nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) { 4334 enum nl80211_band band = nla_type(tx_rates); 4335 int err; 4336 4337 if (band < 0 || band >= NUM_NL80211_BANDS) 4338 return -EINVAL; 4339 sband = rdev->wiphy.bands[band]; 4340 if (sband == NULL) 4341 return -EINVAL; 4342 err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX, 4343 tx_rates, 4344 nl80211_txattr_policy, 4345 info->extack); 4346 if (err) 4347 return err; 4348 if (tb[NL80211_TXRATE_LEGACY]) { 4349 mask->control[band].legacy = rateset_to_mask( 4350 sband, 4351 nla_data(tb[NL80211_TXRATE_LEGACY]), 4352 nla_len(tb[NL80211_TXRATE_LEGACY])); 4353 if ((mask->control[band].legacy == 0) && 4354 nla_len(tb[NL80211_TXRATE_LEGACY])) 4355 return -EINVAL; 4356 } 4357 if (tb[NL80211_TXRATE_HT]) { 4358 if (!ht_rateset_to_mask( 4359 sband, 4360 nla_data(tb[NL80211_TXRATE_HT]), 4361 nla_len(tb[NL80211_TXRATE_HT]), 4362 mask->control[band].ht_mcs)) 4363 return -EINVAL; 4364 } 4365 if (tb[NL80211_TXRATE_VHT]) { 4366 if (!vht_set_mcs_mask( 4367 sband, 4368 nla_data(tb[NL80211_TXRATE_VHT]), 4369 mask->control[band].vht_mcs)) 4370 return -EINVAL; 4371 } 4372 if (tb[NL80211_TXRATE_GI]) { 4373 mask->control[band].gi = 4374 nla_get_u8(tb[NL80211_TXRATE_GI]); 4375 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI) 4376 return -EINVAL; 4377 } 4378 4379 if (mask->control[band].legacy == 0) { 4380 /* don't allow empty legacy rates if HT or VHT 4381 * are not even supported. 4382 */ 4383 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported || 4384 rdev->wiphy.bands[band]->vht_cap.vht_supported)) 4385 return -EINVAL; 4386 4387 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) 4388 if (mask->control[band].ht_mcs[i]) 4389 goto out; 4390 4391 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) 4392 if (mask->control[band].vht_mcs[i]) 4393 goto out; 4394 4395 /* legacy and mcs rates may not be both empty */ 4396 return -EINVAL; 4397 } 4398 } 4399 4400 out: 4401 return 0; 4402 } 4403 4404 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev, 4405 enum nl80211_band band, 4406 struct cfg80211_bitrate_mask *beacon_rate) 4407 { 4408 u32 count_ht, count_vht, i; 4409 u32 rate = beacon_rate->control[band].legacy; 4410 4411 /* Allow only one rate */ 4412 if (hweight32(rate) > 1) 4413 return -EINVAL; 4414 4415 count_ht = 0; 4416 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) { 4417 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) { 4418 return -EINVAL; 4419 } else if (beacon_rate->control[band].ht_mcs[i]) { 4420 count_ht++; 4421 if (count_ht > 1) 4422 return -EINVAL; 4423 } 4424 if (count_ht && rate) 4425 return -EINVAL; 4426 } 4427 4428 count_vht = 0; 4429 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 4430 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) { 4431 return -EINVAL; 4432 } else if (beacon_rate->control[band].vht_mcs[i]) { 4433 count_vht++; 4434 if (count_vht > 1) 4435 return -EINVAL; 4436 } 4437 if (count_vht && rate) 4438 return -EINVAL; 4439 } 4440 4441 if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht)) 4442 return -EINVAL; 4443 4444 if (rate && 4445 !wiphy_ext_feature_isset(&rdev->wiphy, 4446 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY)) 4447 return -EINVAL; 4448 if (count_ht && 4449 !wiphy_ext_feature_isset(&rdev->wiphy, 4450 NL80211_EXT_FEATURE_BEACON_RATE_HT)) 4451 return -EINVAL; 4452 if (count_vht && 4453 !wiphy_ext_feature_isset(&rdev->wiphy, 4454 NL80211_EXT_FEATURE_BEACON_RATE_VHT)) 4455 return -EINVAL; 4456 4457 return 0; 4458 } 4459 4460 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev, 4461 struct nlattr *attrs[], 4462 struct cfg80211_beacon_data *bcn) 4463 { 4464 bool haveinfo = false; 4465 int err; 4466 4467 memset(bcn, 0, sizeof(*bcn)); 4468 4469 if (attrs[NL80211_ATTR_BEACON_HEAD]) { 4470 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]); 4471 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]); 4472 if (!bcn->head_len) 4473 return -EINVAL; 4474 haveinfo = true; 4475 } 4476 4477 if (attrs[NL80211_ATTR_BEACON_TAIL]) { 4478 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]); 4479 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]); 4480 haveinfo = true; 4481 } 4482 4483 if (!haveinfo) 4484 return -EINVAL; 4485 4486 if (attrs[NL80211_ATTR_IE]) { 4487 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]); 4488 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]); 4489 } 4490 4491 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) { 4492 bcn->proberesp_ies = 4493 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]); 4494 bcn->proberesp_ies_len = 4495 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]); 4496 } 4497 4498 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) { 4499 bcn->assocresp_ies = 4500 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 4501 bcn->assocresp_ies_len = 4502 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 4503 } 4504 4505 if (attrs[NL80211_ATTR_PROBE_RESP]) { 4506 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]); 4507 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]); 4508 } 4509 4510 if (attrs[NL80211_ATTR_FTM_RESPONDER]) { 4511 struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1]; 4512 4513 err = nla_parse_nested_deprecated(tb, 4514 NL80211_FTM_RESP_ATTR_MAX, 4515 attrs[NL80211_ATTR_FTM_RESPONDER], 4516 NULL, NULL); 4517 if (err) 4518 return err; 4519 4520 if (tb[NL80211_FTM_RESP_ATTR_ENABLED] && 4521 wiphy_ext_feature_isset(&rdev->wiphy, 4522 NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER)) 4523 bcn->ftm_responder = 1; 4524 else 4525 return -EOPNOTSUPP; 4526 4527 if (tb[NL80211_FTM_RESP_ATTR_LCI]) { 4528 bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]); 4529 bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]); 4530 } 4531 4532 if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) { 4533 bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 4534 bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 4535 } 4536 } else { 4537 bcn->ftm_responder = -1; 4538 } 4539 4540 return 0; 4541 } 4542 4543 static int nl80211_parse_he_obss_pd(struct nlattr *attrs, 4544 struct ieee80211_he_obss_pd *he_obss_pd) 4545 { 4546 struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1]; 4547 int err; 4548 4549 err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs, 4550 he_obss_pd_policy, NULL); 4551 if (err) 4552 return err; 4553 4554 if (!tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] || 4555 !tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]) 4556 return -EINVAL; 4557 4558 he_obss_pd->min_offset = 4559 nla_get_u32(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]); 4560 he_obss_pd->max_offset = 4561 nla_get_u32(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]); 4562 4563 if (he_obss_pd->min_offset >= he_obss_pd->max_offset) 4564 return -EINVAL; 4565 4566 he_obss_pd->enable = true; 4567 4568 return 0; 4569 } 4570 4571 static int nl80211_parse_he_bss_color(struct nlattr *attrs, 4572 struct cfg80211_he_bss_color *he_bss_color) 4573 { 4574 struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1]; 4575 int err; 4576 4577 err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs, 4578 he_bss_color_policy, NULL); 4579 if (err) 4580 return err; 4581 4582 if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]) 4583 return -EINVAL; 4584 4585 he_bss_color->color = 4586 nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]); 4587 he_bss_color->disabled = 4588 nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]); 4589 he_bss_color->partial = 4590 nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]); 4591 4592 return 0; 4593 } 4594 4595 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params, 4596 const u8 *rates) 4597 { 4598 int i; 4599 4600 if (!rates) 4601 return; 4602 4603 for (i = 0; i < rates[1]; i++) { 4604 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY) 4605 params->ht_required = true; 4606 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY) 4607 params->vht_required = true; 4608 } 4609 } 4610 4611 /* 4612 * Since the nl80211 API didn't include, from the beginning, attributes about 4613 * HT/VHT requirements/capabilities, we parse them out of the IEs for the 4614 * benefit of drivers that rebuild IEs in the firmware. 4615 */ 4616 static void nl80211_calculate_ap_params(struct cfg80211_ap_settings *params) 4617 { 4618 const struct cfg80211_beacon_data *bcn = ¶ms->beacon; 4619 size_t ies_len = bcn->tail_len; 4620 const u8 *ies = bcn->tail; 4621 const u8 *rates; 4622 const u8 *cap; 4623 4624 rates = cfg80211_find_ie(WLAN_EID_SUPP_RATES, ies, ies_len); 4625 nl80211_check_ap_rate_selectors(params, rates); 4626 4627 rates = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, ies, ies_len); 4628 nl80211_check_ap_rate_selectors(params, rates); 4629 4630 cap = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies, ies_len); 4631 if (cap && cap[1] >= sizeof(*params->ht_cap)) 4632 params->ht_cap = (void *)(cap + 2); 4633 cap = cfg80211_find_ie(WLAN_EID_VHT_CAPABILITY, ies, ies_len); 4634 if (cap && cap[1] >= sizeof(*params->vht_cap)) 4635 params->vht_cap = (void *)(cap + 2); 4636 cap = cfg80211_find_ext_ie(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len); 4637 if (cap && cap[1] >= sizeof(*params->he_cap) + 1) 4638 params->he_cap = (void *)(cap + 3); 4639 } 4640 4641 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev, 4642 struct cfg80211_ap_settings *params) 4643 { 4644 struct wireless_dev *wdev; 4645 bool ret = false; 4646 4647 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 4648 if (wdev->iftype != NL80211_IFTYPE_AP && 4649 wdev->iftype != NL80211_IFTYPE_P2P_GO) 4650 continue; 4651 4652 if (!wdev->preset_chandef.chan) 4653 continue; 4654 4655 params->chandef = wdev->preset_chandef; 4656 ret = true; 4657 break; 4658 } 4659 4660 return ret; 4661 } 4662 4663 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev, 4664 enum nl80211_auth_type auth_type, 4665 enum nl80211_commands cmd) 4666 { 4667 if (auth_type > NL80211_AUTHTYPE_MAX) 4668 return false; 4669 4670 switch (cmd) { 4671 case NL80211_CMD_AUTHENTICATE: 4672 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 4673 auth_type == NL80211_AUTHTYPE_SAE) 4674 return false; 4675 if (!wiphy_ext_feature_isset(&rdev->wiphy, 4676 NL80211_EXT_FEATURE_FILS_STA) && 4677 (auth_type == NL80211_AUTHTYPE_FILS_SK || 4678 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 4679 auth_type == NL80211_AUTHTYPE_FILS_PK)) 4680 return false; 4681 return true; 4682 case NL80211_CMD_CONNECT: 4683 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 4684 !wiphy_ext_feature_isset(&rdev->wiphy, 4685 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 4686 auth_type == NL80211_AUTHTYPE_SAE) 4687 return false; 4688 4689 /* FILS with SK PFS or PK not supported yet */ 4690 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 4691 auth_type == NL80211_AUTHTYPE_FILS_PK) 4692 return false; 4693 if (!wiphy_ext_feature_isset( 4694 &rdev->wiphy, 4695 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 4696 auth_type == NL80211_AUTHTYPE_FILS_SK) 4697 return false; 4698 return true; 4699 case NL80211_CMD_START_AP: 4700 /* SAE not supported yet */ 4701 if (auth_type == NL80211_AUTHTYPE_SAE) 4702 return false; 4703 /* FILS not supported yet */ 4704 if (auth_type == NL80211_AUTHTYPE_FILS_SK || 4705 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 4706 auth_type == NL80211_AUTHTYPE_FILS_PK) 4707 return false; 4708 return true; 4709 default: 4710 return false; 4711 } 4712 } 4713 4714 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info) 4715 { 4716 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4717 struct net_device *dev = info->user_ptr[1]; 4718 struct wireless_dev *wdev = dev->ieee80211_ptr; 4719 struct cfg80211_ap_settings params; 4720 int err; 4721 4722 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 4723 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 4724 return -EOPNOTSUPP; 4725 4726 if (!rdev->ops->start_ap) 4727 return -EOPNOTSUPP; 4728 4729 if (wdev->beacon_interval) 4730 return -EALREADY; 4731 4732 memset(¶ms, 0, sizeof(params)); 4733 4734 /* these are required for START_AP */ 4735 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] || 4736 !info->attrs[NL80211_ATTR_DTIM_PERIOD] || 4737 !info->attrs[NL80211_ATTR_BEACON_HEAD]) 4738 return -EINVAL; 4739 4740 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon); 4741 if (err) 4742 return err; 4743 4744 params.beacon_interval = 4745 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 4746 params.dtim_period = 4747 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 4748 4749 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype, 4750 params.beacon_interval); 4751 if (err) 4752 return err; 4753 4754 /* 4755 * In theory, some of these attributes should be required here 4756 * but since they were not used when the command was originally 4757 * added, keep them optional for old user space programs to let 4758 * them continue to work with drivers that do not need the 4759 * additional information -- drivers must check! 4760 */ 4761 if (info->attrs[NL80211_ATTR_SSID]) { 4762 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 4763 params.ssid_len = 4764 nla_len(info->attrs[NL80211_ATTR_SSID]); 4765 if (params.ssid_len == 0 || 4766 params.ssid_len > IEEE80211_MAX_SSID_LEN) 4767 return -EINVAL; 4768 } 4769 4770 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) 4771 params.hidden_ssid = nla_get_u32( 4772 info->attrs[NL80211_ATTR_HIDDEN_SSID]); 4773 4774 params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 4775 4776 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 4777 params.auth_type = nla_get_u32( 4778 info->attrs[NL80211_ATTR_AUTH_TYPE]); 4779 if (!nl80211_valid_auth_type(rdev, params.auth_type, 4780 NL80211_CMD_START_AP)) 4781 return -EINVAL; 4782 } else 4783 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC; 4784 4785 err = nl80211_crypto_settings(rdev, info, ¶ms.crypto, 4786 NL80211_MAX_NR_CIPHER_SUITES); 4787 if (err) 4788 return err; 4789 4790 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) { 4791 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER)) 4792 return -EOPNOTSUPP; 4793 params.inactivity_timeout = nla_get_u16( 4794 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]); 4795 } 4796 4797 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 4798 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 4799 return -EINVAL; 4800 params.p2p_ctwindow = 4801 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 4802 if (params.p2p_ctwindow != 0 && 4803 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) 4804 return -EINVAL; 4805 } 4806 4807 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 4808 u8 tmp; 4809 4810 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 4811 return -EINVAL; 4812 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 4813 params.p2p_opp_ps = tmp; 4814 if (params.p2p_opp_ps != 0 && 4815 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) 4816 return -EINVAL; 4817 } 4818 4819 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 4820 err = nl80211_parse_chandef(rdev, info, ¶ms.chandef); 4821 if (err) 4822 return err; 4823 } else if (wdev->preset_chandef.chan) { 4824 params.chandef = wdev->preset_chandef; 4825 } else if (!nl80211_get_ap_channel(rdev, ¶ms)) 4826 return -EINVAL; 4827 4828 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms.chandef, 4829 wdev->iftype)) 4830 return -EINVAL; 4831 4832 if (info->attrs[NL80211_ATTR_TX_RATES]) { 4833 err = nl80211_parse_tx_bitrate_mask(info, ¶ms.beacon_rate); 4834 if (err) 4835 return err; 4836 4837 err = validate_beacon_tx_rate(rdev, params.chandef.chan->band, 4838 ¶ms.beacon_rate); 4839 if (err) 4840 return err; 4841 } 4842 4843 if (info->attrs[NL80211_ATTR_SMPS_MODE]) { 4844 params.smps_mode = 4845 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]); 4846 switch (params.smps_mode) { 4847 case NL80211_SMPS_OFF: 4848 break; 4849 case NL80211_SMPS_STATIC: 4850 if (!(rdev->wiphy.features & 4851 NL80211_FEATURE_STATIC_SMPS)) 4852 return -EINVAL; 4853 break; 4854 case NL80211_SMPS_DYNAMIC: 4855 if (!(rdev->wiphy.features & 4856 NL80211_FEATURE_DYNAMIC_SMPS)) 4857 return -EINVAL; 4858 break; 4859 default: 4860 return -EINVAL; 4861 } 4862 } else { 4863 params.smps_mode = NL80211_SMPS_OFF; 4864 } 4865 4866 params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 4867 if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) 4868 return -EOPNOTSUPP; 4869 4870 if (info->attrs[NL80211_ATTR_ACL_POLICY]) { 4871 params.acl = parse_acl_data(&rdev->wiphy, info); 4872 if (IS_ERR(params.acl)) 4873 return PTR_ERR(params.acl); 4874 } 4875 4876 params.twt_responder = 4877 nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]); 4878 4879 if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) { 4880 err = nl80211_parse_he_obss_pd( 4881 info->attrs[NL80211_ATTR_HE_OBSS_PD], 4882 ¶ms.he_obss_pd); 4883 if (err) 4884 return err; 4885 } 4886 4887 if (info->attrs[NL80211_ATTR_HE_BSS_COLOR]) { 4888 err = nl80211_parse_he_bss_color( 4889 info->attrs[NL80211_ATTR_HE_BSS_COLOR], 4890 ¶ms.he_bss_color); 4891 if (err) 4892 return err; 4893 } 4894 4895 nl80211_calculate_ap_params(¶ms); 4896 4897 if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT]) 4898 params.flags |= AP_SETTINGS_EXTERNAL_AUTH_SUPPORT; 4899 4900 wdev_lock(wdev); 4901 err = rdev_start_ap(rdev, dev, ¶ms); 4902 if (!err) { 4903 wdev->preset_chandef = params.chandef; 4904 wdev->beacon_interval = params.beacon_interval; 4905 wdev->chandef = params.chandef; 4906 wdev->ssid_len = params.ssid_len; 4907 memcpy(wdev->ssid, params.ssid, wdev->ssid_len); 4908 4909 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 4910 wdev->conn_owner_nlportid = info->snd_portid; 4911 } 4912 wdev_unlock(wdev); 4913 4914 kfree(params.acl); 4915 4916 return err; 4917 } 4918 4919 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info) 4920 { 4921 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4922 struct net_device *dev = info->user_ptr[1]; 4923 struct wireless_dev *wdev = dev->ieee80211_ptr; 4924 struct cfg80211_beacon_data params; 4925 int err; 4926 4927 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 4928 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 4929 return -EOPNOTSUPP; 4930 4931 if (!rdev->ops->change_beacon) 4932 return -EOPNOTSUPP; 4933 4934 if (!wdev->beacon_interval) 4935 return -EINVAL; 4936 4937 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms); 4938 if (err) 4939 return err; 4940 4941 wdev_lock(wdev); 4942 err = rdev_change_beacon(rdev, dev, ¶ms); 4943 wdev_unlock(wdev); 4944 4945 return err; 4946 } 4947 4948 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info) 4949 { 4950 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4951 struct net_device *dev = info->user_ptr[1]; 4952 4953 return cfg80211_stop_ap(rdev, dev, false); 4954 } 4955 4956 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = { 4957 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG }, 4958 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG }, 4959 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG }, 4960 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG }, 4961 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG }, 4962 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG }, 4963 }; 4964 4965 static int parse_station_flags(struct genl_info *info, 4966 enum nl80211_iftype iftype, 4967 struct station_parameters *params) 4968 { 4969 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1]; 4970 struct nlattr *nla; 4971 int flag; 4972 4973 /* 4974 * Try parsing the new attribute first so userspace 4975 * can specify both for older kernels. 4976 */ 4977 nla = info->attrs[NL80211_ATTR_STA_FLAGS2]; 4978 if (nla) { 4979 struct nl80211_sta_flag_update *sta_flags; 4980 4981 sta_flags = nla_data(nla); 4982 params->sta_flags_mask = sta_flags->mask; 4983 params->sta_flags_set = sta_flags->set; 4984 params->sta_flags_set &= params->sta_flags_mask; 4985 if ((params->sta_flags_mask | 4986 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID)) 4987 return -EINVAL; 4988 return 0; 4989 } 4990 4991 /* if present, parse the old attribute */ 4992 4993 nla = info->attrs[NL80211_ATTR_STA_FLAGS]; 4994 if (!nla) 4995 return 0; 4996 4997 if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack)) 4998 return -EINVAL; 4999 5000 /* 5001 * Only allow certain flags for interface types so that 5002 * other attributes are silently ignored. Remember that 5003 * this is backward compatibility code with old userspace 5004 * and shouldn't be hit in other cases anyway. 5005 */ 5006 switch (iftype) { 5007 case NL80211_IFTYPE_AP: 5008 case NL80211_IFTYPE_AP_VLAN: 5009 case NL80211_IFTYPE_P2P_GO: 5010 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 5011 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 5012 BIT(NL80211_STA_FLAG_WME) | 5013 BIT(NL80211_STA_FLAG_MFP); 5014 break; 5015 case NL80211_IFTYPE_P2P_CLIENT: 5016 case NL80211_IFTYPE_STATION: 5017 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 5018 BIT(NL80211_STA_FLAG_TDLS_PEER); 5019 break; 5020 case NL80211_IFTYPE_MESH_POINT: 5021 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 5022 BIT(NL80211_STA_FLAG_MFP) | 5023 BIT(NL80211_STA_FLAG_AUTHORIZED); 5024 break; 5025 default: 5026 return -EINVAL; 5027 } 5028 5029 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) { 5030 if (flags[flag]) { 5031 params->sta_flags_set |= (1<<flag); 5032 5033 /* no longer support new API additions in old API */ 5034 if (flag > NL80211_STA_FLAG_MAX_OLD_API) 5035 return -EINVAL; 5036 } 5037 } 5038 5039 return 0; 5040 } 5041 5042 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr) 5043 { 5044 struct nlattr *rate; 5045 u32 bitrate; 5046 u16 bitrate_compat; 5047 enum nl80211_rate_info rate_flg; 5048 5049 rate = nla_nest_start_noflag(msg, attr); 5050 if (!rate) 5051 return false; 5052 5053 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */ 5054 bitrate = cfg80211_calculate_bitrate(info); 5055 /* report 16-bit bitrate only if we can */ 5056 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0; 5057 if (bitrate > 0 && 5058 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate)) 5059 return false; 5060 if (bitrate_compat > 0 && 5061 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat)) 5062 return false; 5063 5064 switch (info->bw) { 5065 case RATE_INFO_BW_5: 5066 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH; 5067 break; 5068 case RATE_INFO_BW_10: 5069 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH; 5070 break; 5071 default: 5072 WARN_ON(1); 5073 /* fall through */ 5074 case RATE_INFO_BW_20: 5075 rate_flg = 0; 5076 break; 5077 case RATE_INFO_BW_40: 5078 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH; 5079 break; 5080 case RATE_INFO_BW_80: 5081 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH; 5082 break; 5083 case RATE_INFO_BW_160: 5084 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH; 5085 break; 5086 case RATE_INFO_BW_HE_RU: 5087 rate_flg = 0; 5088 WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS)); 5089 } 5090 5091 if (rate_flg && nla_put_flag(msg, rate_flg)) 5092 return false; 5093 5094 if (info->flags & RATE_INFO_FLAGS_MCS) { 5095 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs)) 5096 return false; 5097 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 5098 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 5099 return false; 5100 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) { 5101 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs)) 5102 return false; 5103 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss)) 5104 return false; 5105 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 5106 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 5107 return false; 5108 } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) { 5109 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs)) 5110 return false; 5111 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss)) 5112 return false; 5113 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi)) 5114 return false; 5115 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm)) 5116 return false; 5117 if (info->bw == RATE_INFO_BW_HE_RU && 5118 nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC, 5119 info->he_ru_alloc)) 5120 return false; 5121 } 5122 5123 nla_nest_end(msg, rate); 5124 return true; 5125 } 5126 5127 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal, 5128 int id) 5129 { 5130 void *attr; 5131 int i = 0; 5132 5133 if (!mask) 5134 return true; 5135 5136 attr = nla_nest_start_noflag(msg, id); 5137 if (!attr) 5138 return false; 5139 5140 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) { 5141 if (!(mask & BIT(i))) 5142 continue; 5143 5144 if (nla_put_u8(msg, i, signal[i])) 5145 return false; 5146 } 5147 5148 nla_nest_end(msg, attr); 5149 5150 return true; 5151 } 5152 5153 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid, 5154 u32 seq, int flags, 5155 struct cfg80211_registered_device *rdev, 5156 struct net_device *dev, 5157 const u8 *mac_addr, struct station_info *sinfo) 5158 { 5159 void *hdr; 5160 struct nlattr *sinfoattr, *bss_param; 5161 5162 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 5163 if (!hdr) { 5164 cfg80211_sinfo_release_content(sinfo); 5165 return -1; 5166 } 5167 5168 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 5169 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 5170 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation)) 5171 goto nla_put_failure; 5172 5173 sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO); 5174 if (!sinfoattr) 5175 goto nla_put_failure; 5176 5177 #define PUT_SINFO(attr, memb, type) do { \ 5178 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \ 5179 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 5180 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \ 5181 sinfo->memb)) \ 5182 goto nla_put_failure; \ 5183 } while (0) 5184 #define PUT_SINFO_U64(attr, memb) do { \ 5185 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 5186 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \ 5187 sinfo->memb, NL80211_STA_INFO_PAD)) \ 5188 goto nla_put_failure; \ 5189 } while (0) 5190 5191 PUT_SINFO(CONNECTED_TIME, connected_time, u32); 5192 PUT_SINFO(INACTIVE_TIME, inactive_time, u32); 5193 PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at); 5194 5195 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 5196 BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) && 5197 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES, 5198 (u32)sinfo->rx_bytes)) 5199 goto nla_put_failure; 5200 5201 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 5202 BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) && 5203 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES, 5204 (u32)sinfo->tx_bytes)) 5205 goto nla_put_failure; 5206 5207 PUT_SINFO_U64(RX_BYTES64, rx_bytes); 5208 PUT_SINFO_U64(TX_BYTES64, tx_bytes); 5209 PUT_SINFO(LLID, llid, u16); 5210 PUT_SINFO(PLID, plid, u16); 5211 PUT_SINFO(PLINK_STATE, plink_state, u8); 5212 PUT_SINFO_U64(RX_DURATION, rx_duration); 5213 PUT_SINFO_U64(TX_DURATION, tx_duration); 5214 5215 if (wiphy_ext_feature_isset(&rdev->wiphy, 5216 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 5217 PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16); 5218 5219 switch (rdev->wiphy.signal_type) { 5220 case CFG80211_SIGNAL_TYPE_MBM: 5221 PUT_SINFO(SIGNAL, signal, u8); 5222 PUT_SINFO(SIGNAL_AVG, signal_avg, u8); 5223 break; 5224 default: 5225 break; 5226 } 5227 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) { 5228 if (!nl80211_put_signal(msg, sinfo->chains, 5229 sinfo->chain_signal, 5230 NL80211_STA_INFO_CHAIN_SIGNAL)) 5231 goto nla_put_failure; 5232 } 5233 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) { 5234 if (!nl80211_put_signal(msg, sinfo->chains, 5235 sinfo->chain_signal_avg, 5236 NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) 5237 goto nla_put_failure; 5238 } 5239 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) { 5240 if (!nl80211_put_sta_rate(msg, &sinfo->txrate, 5241 NL80211_STA_INFO_TX_BITRATE)) 5242 goto nla_put_failure; 5243 } 5244 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) { 5245 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate, 5246 NL80211_STA_INFO_RX_BITRATE)) 5247 goto nla_put_failure; 5248 } 5249 5250 PUT_SINFO(RX_PACKETS, rx_packets, u32); 5251 PUT_SINFO(TX_PACKETS, tx_packets, u32); 5252 PUT_SINFO(TX_RETRIES, tx_retries, u32); 5253 PUT_SINFO(TX_FAILED, tx_failed, u32); 5254 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32); 5255 PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32); 5256 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32); 5257 PUT_SINFO(LOCAL_PM, local_pm, u32); 5258 PUT_SINFO(PEER_PM, peer_pm, u32); 5259 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32); 5260 PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8); 5261 5262 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) { 5263 bss_param = nla_nest_start_noflag(msg, 5264 NL80211_STA_INFO_BSS_PARAM); 5265 if (!bss_param) 5266 goto nla_put_failure; 5267 5268 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) && 5269 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) || 5270 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) && 5271 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) || 5272 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) && 5273 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) || 5274 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD, 5275 sinfo->bss_param.dtim_period) || 5276 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL, 5277 sinfo->bss_param.beacon_interval)) 5278 goto nla_put_failure; 5279 5280 nla_nest_end(msg, bss_param); 5281 } 5282 if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) && 5283 nla_put(msg, NL80211_STA_INFO_STA_FLAGS, 5284 sizeof(struct nl80211_sta_flag_update), 5285 &sinfo->sta_flags)) 5286 goto nla_put_failure; 5287 5288 PUT_SINFO_U64(T_OFFSET, t_offset); 5289 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc); 5290 PUT_SINFO_U64(BEACON_RX, rx_beacon); 5291 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8); 5292 PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32); 5293 PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32); 5294 if (wiphy_ext_feature_isset(&rdev->wiphy, 5295 NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) { 5296 PUT_SINFO(ACK_SIGNAL, ack_signal, u8); 5297 PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8); 5298 } 5299 5300 #undef PUT_SINFO 5301 #undef PUT_SINFO_U64 5302 5303 if (sinfo->pertid) { 5304 struct nlattr *tidsattr; 5305 int tid; 5306 5307 tidsattr = nla_nest_start_noflag(msg, 5308 NL80211_STA_INFO_TID_STATS); 5309 if (!tidsattr) 5310 goto nla_put_failure; 5311 5312 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) { 5313 struct cfg80211_tid_stats *tidstats; 5314 struct nlattr *tidattr; 5315 5316 tidstats = &sinfo->pertid[tid]; 5317 5318 if (!tidstats->filled) 5319 continue; 5320 5321 tidattr = nla_nest_start_noflag(msg, tid + 1); 5322 if (!tidattr) 5323 goto nla_put_failure; 5324 5325 #define PUT_TIDVAL_U64(attr, memb) do { \ 5326 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \ 5327 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \ 5328 tidstats->memb, NL80211_TID_STATS_PAD)) \ 5329 goto nla_put_failure; \ 5330 } while (0) 5331 5332 PUT_TIDVAL_U64(RX_MSDU, rx_msdu); 5333 PUT_TIDVAL_U64(TX_MSDU, tx_msdu); 5334 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries); 5335 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed); 5336 5337 #undef PUT_TIDVAL_U64 5338 if ((tidstats->filled & 5339 BIT(NL80211_TID_STATS_TXQ_STATS)) && 5340 !nl80211_put_txq_stats(msg, &tidstats->txq_stats, 5341 NL80211_TID_STATS_TXQ_STATS)) 5342 goto nla_put_failure; 5343 5344 nla_nest_end(msg, tidattr); 5345 } 5346 5347 nla_nest_end(msg, tidsattr); 5348 } 5349 5350 nla_nest_end(msg, sinfoattr); 5351 5352 if (sinfo->assoc_req_ies_len && 5353 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len, 5354 sinfo->assoc_req_ies)) 5355 goto nla_put_failure; 5356 5357 cfg80211_sinfo_release_content(sinfo); 5358 genlmsg_end(msg, hdr); 5359 return 0; 5360 5361 nla_put_failure: 5362 cfg80211_sinfo_release_content(sinfo); 5363 genlmsg_cancel(msg, hdr); 5364 return -EMSGSIZE; 5365 } 5366 5367 static int nl80211_dump_station(struct sk_buff *skb, 5368 struct netlink_callback *cb) 5369 { 5370 struct station_info sinfo; 5371 struct cfg80211_registered_device *rdev; 5372 struct wireless_dev *wdev; 5373 u8 mac_addr[ETH_ALEN]; 5374 int sta_idx = cb->args[2]; 5375 int err; 5376 5377 rtnl_lock(); 5378 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev); 5379 if (err) 5380 goto out_err; 5381 5382 if (!wdev->netdev) { 5383 err = -EINVAL; 5384 goto out_err; 5385 } 5386 5387 if (!rdev->ops->dump_station) { 5388 err = -EOPNOTSUPP; 5389 goto out_err; 5390 } 5391 5392 while (1) { 5393 memset(&sinfo, 0, sizeof(sinfo)); 5394 err = rdev_dump_station(rdev, wdev->netdev, sta_idx, 5395 mac_addr, &sinfo); 5396 if (err == -ENOENT) 5397 break; 5398 if (err) 5399 goto out_err; 5400 5401 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION, 5402 NETLINK_CB(cb->skb).portid, 5403 cb->nlh->nlmsg_seq, NLM_F_MULTI, 5404 rdev, wdev->netdev, mac_addr, 5405 &sinfo) < 0) 5406 goto out; 5407 5408 sta_idx++; 5409 } 5410 5411 out: 5412 cb->args[2] = sta_idx; 5413 err = skb->len; 5414 out_err: 5415 rtnl_unlock(); 5416 5417 return err; 5418 } 5419 5420 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info) 5421 { 5422 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5423 struct net_device *dev = info->user_ptr[1]; 5424 struct station_info sinfo; 5425 struct sk_buff *msg; 5426 u8 *mac_addr = NULL; 5427 int err; 5428 5429 memset(&sinfo, 0, sizeof(sinfo)); 5430 5431 if (!info->attrs[NL80211_ATTR_MAC]) 5432 return -EINVAL; 5433 5434 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 5435 5436 if (!rdev->ops->get_station) 5437 return -EOPNOTSUPP; 5438 5439 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 5440 if (err) 5441 return err; 5442 5443 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 5444 if (!msg) { 5445 cfg80211_sinfo_release_content(&sinfo); 5446 return -ENOMEM; 5447 } 5448 5449 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 5450 info->snd_portid, info->snd_seq, 0, 5451 rdev, dev, mac_addr, &sinfo) < 0) { 5452 nlmsg_free(msg); 5453 return -ENOBUFS; 5454 } 5455 5456 return genlmsg_reply(msg, info); 5457 } 5458 5459 int cfg80211_check_station_change(struct wiphy *wiphy, 5460 struct station_parameters *params, 5461 enum cfg80211_station_type statype) 5462 { 5463 if (params->listen_interval != -1 && 5464 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 5465 return -EINVAL; 5466 5467 if (params->support_p2p_ps != -1 && 5468 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 5469 return -EINVAL; 5470 5471 if (params->aid && 5472 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) && 5473 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 5474 return -EINVAL; 5475 5476 /* When you run into this, adjust the code below for the new flag */ 5477 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7); 5478 5479 switch (statype) { 5480 case CFG80211_STA_MESH_PEER_KERNEL: 5481 case CFG80211_STA_MESH_PEER_USER: 5482 /* 5483 * No ignoring the TDLS flag here -- the userspace mesh 5484 * code doesn't have the bug of including TDLS in the 5485 * mask everywhere. 5486 */ 5487 if (params->sta_flags_mask & 5488 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) | 5489 BIT(NL80211_STA_FLAG_MFP) | 5490 BIT(NL80211_STA_FLAG_AUTHORIZED))) 5491 return -EINVAL; 5492 break; 5493 case CFG80211_STA_TDLS_PEER_SETUP: 5494 case CFG80211_STA_TDLS_PEER_ACTIVE: 5495 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 5496 return -EINVAL; 5497 /* ignore since it can't change */ 5498 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 5499 break; 5500 default: 5501 /* disallow mesh-specific things */ 5502 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION) 5503 return -EINVAL; 5504 if (params->local_pm) 5505 return -EINVAL; 5506 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 5507 return -EINVAL; 5508 } 5509 5510 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 5511 statype != CFG80211_STA_TDLS_PEER_ACTIVE) { 5512 /* TDLS can't be set, ... */ 5513 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) 5514 return -EINVAL; 5515 /* 5516 * ... but don't bother the driver with it. This works around 5517 * a hostapd/wpa_supplicant issue -- it always includes the 5518 * TLDS_PEER flag in the mask even for AP mode. 5519 */ 5520 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 5521 } 5522 5523 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 5524 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 5525 /* reject other things that can't change */ 5526 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) 5527 return -EINVAL; 5528 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY) 5529 return -EINVAL; 5530 if (params->supported_rates) 5531 return -EINVAL; 5532 if (params->ext_capab || params->ht_capa || params->vht_capa || 5533 params->he_capa) 5534 return -EINVAL; 5535 } 5536 5537 if (statype != CFG80211_STA_AP_CLIENT && 5538 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 5539 if (params->vlan) 5540 return -EINVAL; 5541 } 5542 5543 switch (statype) { 5544 case CFG80211_STA_AP_MLME_CLIENT: 5545 /* Use this only for authorizing/unauthorizing a station */ 5546 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 5547 return -EOPNOTSUPP; 5548 break; 5549 case CFG80211_STA_AP_CLIENT: 5550 case CFG80211_STA_AP_CLIENT_UNASSOC: 5551 /* accept only the listed bits */ 5552 if (params->sta_flags_mask & 5553 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 5554 BIT(NL80211_STA_FLAG_AUTHENTICATED) | 5555 BIT(NL80211_STA_FLAG_ASSOCIATED) | 5556 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 5557 BIT(NL80211_STA_FLAG_WME) | 5558 BIT(NL80211_STA_FLAG_MFP))) 5559 return -EINVAL; 5560 5561 /* but authenticated/associated only if driver handles it */ 5562 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 5563 params->sta_flags_mask & 5564 (BIT(NL80211_STA_FLAG_AUTHENTICATED) | 5565 BIT(NL80211_STA_FLAG_ASSOCIATED))) 5566 return -EINVAL; 5567 break; 5568 case CFG80211_STA_IBSS: 5569 case CFG80211_STA_AP_STA: 5570 /* reject any changes other than AUTHORIZED */ 5571 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED)) 5572 return -EINVAL; 5573 break; 5574 case CFG80211_STA_TDLS_PEER_SETUP: 5575 /* reject any changes other than AUTHORIZED or WME */ 5576 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 5577 BIT(NL80211_STA_FLAG_WME))) 5578 return -EINVAL; 5579 /* force (at least) rates when authorizing */ 5580 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) && 5581 !params->supported_rates) 5582 return -EINVAL; 5583 break; 5584 case CFG80211_STA_TDLS_PEER_ACTIVE: 5585 /* reject any changes */ 5586 return -EINVAL; 5587 case CFG80211_STA_MESH_PEER_KERNEL: 5588 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 5589 return -EINVAL; 5590 break; 5591 case CFG80211_STA_MESH_PEER_USER: 5592 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION && 5593 params->plink_action != NL80211_PLINK_ACTION_BLOCK) 5594 return -EINVAL; 5595 break; 5596 } 5597 5598 /* 5599 * Older kernel versions ignored this attribute entirely, so don't 5600 * reject attempts to update it but mark it as unused instead so the 5601 * driver won't look at the data. 5602 */ 5603 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC && 5604 statype != CFG80211_STA_TDLS_PEER_SETUP) 5605 params->opmode_notif_used = false; 5606 5607 return 0; 5608 } 5609 EXPORT_SYMBOL(cfg80211_check_station_change); 5610 5611 /* 5612 * Get vlan interface making sure it is running and on the right wiphy. 5613 */ 5614 static struct net_device *get_vlan(struct genl_info *info, 5615 struct cfg80211_registered_device *rdev) 5616 { 5617 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN]; 5618 struct net_device *v; 5619 int ret; 5620 5621 if (!vlanattr) 5622 return NULL; 5623 5624 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr)); 5625 if (!v) 5626 return ERR_PTR(-ENODEV); 5627 5628 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) { 5629 ret = -EINVAL; 5630 goto error; 5631 } 5632 5633 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN && 5634 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 5635 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 5636 ret = -EINVAL; 5637 goto error; 5638 } 5639 5640 if (!netif_running(v)) { 5641 ret = -ENETDOWN; 5642 goto error; 5643 } 5644 5645 return v; 5646 error: 5647 dev_put(v); 5648 return ERR_PTR(ret); 5649 } 5650 5651 static const struct nla_policy 5652 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = { 5653 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 }, 5654 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 }, 5655 }; 5656 5657 static int nl80211_parse_sta_wme(struct genl_info *info, 5658 struct station_parameters *params) 5659 { 5660 struct nlattr *tb[NL80211_STA_WME_MAX + 1]; 5661 struct nlattr *nla; 5662 int err; 5663 5664 /* parse WME attributes if present */ 5665 if (!info->attrs[NL80211_ATTR_STA_WME]) 5666 return 0; 5667 5668 nla = info->attrs[NL80211_ATTR_STA_WME]; 5669 err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla, 5670 nl80211_sta_wme_policy, 5671 info->extack); 5672 if (err) 5673 return err; 5674 5675 if (tb[NL80211_STA_WME_UAPSD_QUEUES]) 5676 params->uapsd_queues = nla_get_u8( 5677 tb[NL80211_STA_WME_UAPSD_QUEUES]); 5678 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK) 5679 return -EINVAL; 5680 5681 if (tb[NL80211_STA_WME_MAX_SP]) 5682 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]); 5683 5684 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK) 5685 return -EINVAL; 5686 5687 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD; 5688 5689 return 0; 5690 } 5691 5692 static int nl80211_parse_sta_channel_info(struct genl_info *info, 5693 struct station_parameters *params) 5694 { 5695 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) { 5696 params->supported_channels = 5697 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 5698 params->supported_channels_len = 5699 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 5700 /* 5701 * Need to include at least one (first channel, number of 5702 * channels) tuple for each subband, and must have proper 5703 * tuples for the rest of the data as well. 5704 */ 5705 if (params->supported_channels_len < 2) 5706 return -EINVAL; 5707 if (params->supported_channels_len % 2) 5708 return -EINVAL; 5709 } 5710 5711 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) { 5712 params->supported_oper_classes = 5713 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 5714 params->supported_oper_classes_len = 5715 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 5716 /* 5717 * The value of the Length field of the Supported Operating 5718 * Classes element is between 2 and 253. 5719 */ 5720 if (params->supported_oper_classes_len < 2 || 5721 params->supported_oper_classes_len > 253) 5722 return -EINVAL; 5723 } 5724 return 0; 5725 } 5726 5727 static int nl80211_set_station_tdls(struct genl_info *info, 5728 struct station_parameters *params) 5729 { 5730 int err; 5731 /* Dummy STA entry gets updated once the peer capabilities are known */ 5732 if (info->attrs[NL80211_ATTR_PEER_AID]) 5733 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 5734 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 5735 params->ht_capa = 5736 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 5737 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 5738 params->vht_capa = 5739 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 5740 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 5741 params->he_capa = 5742 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 5743 params->he_capa_len = 5744 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 5745 5746 if (params->he_capa_len < NL80211_HE_MIN_CAPABILITY_LEN) 5747 return -EINVAL; 5748 } 5749 5750 err = nl80211_parse_sta_channel_info(info, params); 5751 if (err) 5752 return err; 5753 5754 return nl80211_parse_sta_wme(info, params); 5755 } 5756 5757 static int nl80211_parse_sta_txpower_setting(struct genl_info *info, 5758 struct station_parameters *params) 5759 { 5760 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5761 int idx; 5762 5763 if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) { 5764 if (!rdev->ops->set_tx_power || 5765 !wiphy_ext_feature_isset(&rdev->wiphy, 5766 NL80211_EXT_FEATURE_STA_TX_PWR)) 5767 return -EOPNOTSUPP; 5768 5769 idx = NL80211_ATTR_STA_TX_POWER_SETTING; 5770 params->txpwr.type = nla_get_u8(info->attrs[idx]); 5771 5772 if (params->txpwr.type == NL80211_TX_POWER_LIMITED) { 5773 idx = NL80211_ATTR_STA_TX_POWER; 5774 5775 if (info->attrs[idx]) 5776 params->txpwr.power = 5777 nla_get_s16(info->attrs[idx]); 5778 else 5779 return -EINVAL; 5780 } 5781 params->sta_modify_mask |= STATION_PARAM_APPLY_STA_TXPOWER; 5782 } 5783 5784 return 0; 5785 } 5786 5787 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info) 5788 { 5789 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5790 struct net_device *dev = info->user_ptr[1]; 5791 struct station_parameters params; 5792 u8 *mac_addr; 5793 int err; 5794 5795 memset(¶ms, 0, sizeof(params)); 5796 5797 if (!rdev->ops->change_station) 5798 return -EOPNOTSUPP; 5799 5800 /* 5801 * AID and listen_interval properties can be set only for unassociated 5802 * station. Include these parameters here and will check them in 5803 * cfg80211_check_station_change(). 5804 */ 5805 if (info->attrs[NL80211_ATTR_STA_AID]) 5806 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 5807 5808 if (info->attrs[NL80211_ATTR_VLAN_ID]) 5809 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 5810 5811 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 5812 params.listen_interval = 5813 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 5814 else 5815 params.listen_interval = -1; 5816 5817 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) 5818 params.support_p2p_ps = 5819 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 5820 else 5821 params.support_p2p_ps = -1; 5822 5823 if (!info->attrs[NL80211_ATTR_MAC]) 5824 return -EINVAL; 5825 5826 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 5827 5828 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 5829 params.supported_rates = 5830 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 5831 params.supported_rates_len = 5832 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 5833 } 5834 5835 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 5836 params.capability = 5837 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 5838 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 5839 } 5840 5841 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 5842 params.ext_capab = 5843 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 5844 params.ext_capab_len = 5845 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 5846 } 5847 5848 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 5849 return -EINVAL; 5850 5851 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 5852 params.plink_action = 5853 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 5854 5855 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) { 5856 params.plink_state = 5857 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]); 5858 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) 5859 params.peer_aid = nla_get_u16( 5860 info->attrs[NL80211_ATTR_MESH_PEER_AID]); 5861 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE; 5862 } 5863 5864 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) 5865 params.local_pm = nla_get_u32( 5866 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]); 5867 5868 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 5869 params.opmode_notif_used = true; 5870 params.opmode_notif = 5871 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 5872 } 5873 5874 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 5875 params.airtime_weight = 5876 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 5877 5878 if (params.airtime_weight && 5879 !wiphy_ext_feature_isset(&rdev->wiphy, 5880 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 5881 return -EOPNOTSUPP; 5882 5883 err = nl80211_parse_sta_txpower_setting(info, ¶ms); 5884 if (err) 5885 return err; 5886 5887 /* Include parameters for TDLS peer (will check later) */ 5888 err = nl80211_set_station_tdls(info, ¶ms); 5889 if (err) 5890 return err; 5891 5892 params.vlan = get_vlan(info, rdev); 5893 if (IS_ERR(params.vlan)) 5894 return PTR_ERR(params.vlan); 5895 5896 switch (dev->ieee80211_ptr->iftype) { 5897 case NL80211_IFTYPE_AP: 5898 case NL80211_IFTYPE_AP_VLAN: 5899 case NL80211_IFTYPE_P2P_GO: 5900 case NL80211_IFTYPE_P2P_CLIENT: 5901 case NL80211_IFTYPE_STATION: 5902 case NL80211_IFTYPE_ADHOC: 5903 case NL80211_IFTYPE_MESH_POINT: 5904 break; 5905 default: 5906 err = -EOPNOTSUPP; 5907 goto out_put_vlan; 5908 } 5909 5910 /* driver will call cfg80211_check_station_change() */ 5911 err = rdev_change_station(rdev, dev, mac_addr, ¶ms); 5912 5913 out_put_vlan: 5914 if (params.vlan) 5915 dev_put(params.vlan); 5916 5917 return err; 5918 } 5919 5920 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info) 5921 { 5922 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5923 int err; 5924 struct net_device *dev = info->user_ptr[1]; 5925 struct station_parameters params; 5926 u8 *mac_addr = NULL; 5927 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 5928 BIT(NL80211_STA_FLAG_ASSOCIATED); 5929 5930 memset(¶ms, 0, sizeof(params)); 5931 5932 if (!rdev->ops->add_station) 5933 return -EOPNOTSUPP; 5934 5935 if (!info->attrs[NL80211_ATTR_MAC]) 5936 return -EINVAL; 5937 5938 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 5939 return -EINVAL; 5940 5941 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 5942 return -EINVAL; 5943 5944 if (!info->attrs[NL80211_ATTR_STA_AID] && 5945 !info->attrs[NL80211_ATTR_PEER_AID]) 5946 return -EINVAL; 5947 5948 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 5949 params.supported_rates = 5950 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 5951 params.supported_rates_len = 5952 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 5953 params.listen_interval = 5954 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 5955 5956 if (info->attrs[NL80211_ATTR_VLAN_ID]) 5957 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 5958 5959 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) { 5960 params.support_p2p_ps = 5961 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 5962 } else { 5963 /* 5964 * if not specified, assume it's supported for P2P GO interface, 5965 * and is NOT supported for AP interface 5966 */ 5967 params.support_p2p_ps = 5968 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO; 5969 } 5970 5971 if (info->attrs[NL80211_ATTR_PEER_AID]) 5972 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 5973 else 5974 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 5975 5976 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 5977 params.capability = 5978 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 5979 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 5980 } 5981 5982 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 5983 params.ext_capab = 5984 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 5985 params.ext_capab_len = 5986 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 5987 } 5988 5989 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 5990 params.ht_capa = 5991 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 5992 5993 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 5994 params.vht_capa = 5995 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 5996 5997 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 5998 params.he_capa = 5999 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 6000 params.he_capa_len = 6001 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 6002 6003 /* max len is validated in nla policy */ 6004 if (params.he_capa_len < NL80211_HE_MIN_CAPABILITY_LEN) 6005 return -EINVAL; 6006 } 6007 6008 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 6009 params.opmode_notif_used = true; 6010 params.opmode_notif = 6011 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 6012 } 6013 6014 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 6015 params.plink_action = 6016 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 6017 6018 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 6019 params.airtime_weight = 6020 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 6021 6022 if (params.airtime_weight && 6023 !wiphy_ext_feature_isset(&rdev->wiphy, 6024 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 6025 return -EOPNOTSUPP; 6026 6027 err = nl80211_parse_sta_txpower_setting(info, ¶ms); 6028 if (err) 6029 return err; 6030 6031 err = nl80211_parse_sta_channel_info(info, ¶ms); 6032 if (err) 6033 return err; 6034 6035 err = nl80211_parse_sta_wme(info, ¶ms); 6036 if (err) 6037 return err; 6038 6039 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 6040 return -EINVAL; 6041 6042 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT 6043 * as userspace might just pass through the capabilities from the IEs 6044 * directly, rather than enforcing this restriction and returning an 6045 * error in this case. 6046 */ 6047 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) { 6048 params.ht_capa = NULL; 6049 params.vht_capa = NULL; 6050 6051 /* HE requires WME */ 6052 if (params.he_capa_len) 6053 return -EINVAL; 6054 } 6055 6056 /* When you run into this, adjust the code below for the new flag */ 6057 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7); 6058 6059 switch (dev->ieee80211_ptr->iftype) { 6060 case NL80211_IFTYPE_AP: 6061 case NL80211_IFTYPE_AP_VLAN: 6062 case NL80211_IFTYPE_P2P_GO: 6063 /* ignore WME attributes if iface/sta is not capable */ 6064 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) || 6065 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) 6066 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 6067 6068 /* TDLS peers cannot be added */ 6069 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 6070 info->attrs[NL80211_ATTR_PEER_AID]) 6071 return -EINVAL; 6072 /* but don't bother the driver with it */ 6073 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 6074 6075 /* allow authenticated/associated only if driver handles it */ 6076 if (!(rdev->wiphy.features & 6077 NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 6078 params.sta_flags_mask & auth_assoc) 6079 return -EINVAL; 6080 6081 /* Older userspace, or userspace wanting to be compatible with 6082 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth 6083 * and assoc flags in the mask, but assumes the station will be 6084 * added as associated anyway since this was the required driver 6085 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was 6086 * introduced. 6087 * In order to not bother drivers with this quirk in the API 6088 * set the flags in both the mask and set for new stations in 6089 * this case. 6090 */ 6091 if (!(params.sta_flags_mask & auth_assoc)) { 6092 params.sta_flags_mask |= auth_assoc; 6093 params.sta_flags_set |= auth_assoc; 6094 } 6095 6096 /* must be last in here for error handling */ 6097 params.vlan = get_vlan(info, rdev); 6098 if (IS_ERR(params.vlan)) 6099 return PTR_ERR(params.vlan); 6100 break; 6101 case NL80211_IFTYPE_MESH_POINT: 6102 /* ignore uAPSD data */ 6103 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 6104 6105 /* associated is disallowed */ 6106 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) 6107 return -EINVAL; 6108 /* TDLS peers cannot be added */ 6109 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 6110 info->attrs[NL80211_ATTR_PEER_AID]) 6111 return -EINVAL; 6112 break; 6113 case NL80211_IFTYPE_STATION: 6114 case NL80211_IFTYPE_P2P_CLIENT: 6115 /* ignore uAPSD data */ 6116 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 6117 6118 /* these are disallowed */ 6119 if (params.sta_flags_mask & 6120 (BIT(NL80211_STA_FLAG_ASSOCIATED) | 6121 BIT(NL80211_STA_FLAG_AUTHENTICATED))) 6122 return -EINVAL; 6123 /* Only TDLS peers can be added */ 6124 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 6125 return -EINVAL; 6126 /* Can only add if TDLS ... */ 6127 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS)) 6128 return -EOPNOTSUPP; 6129 /* ... with external setup is supported */ 6130 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP)) 6131 return -EOPNOTSUPP; 6132 /* 6133 * Older wpa_supplicant versions always mark the TDLS peer 6134 * as authorized, but it shouldn't yet be. 6135 */ 6136 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED); 6137 break; 6138 default: 6139 return -EOPNOTSUPP; 6140 } 6141 6142 /* be aware of params.vlan when changing code here */ 6143 6144 err = rdev_add_station(rdev, dev, mac_addr, ¶ms); 6145 6146 if (params.vlan) 6147 dev_put(params.vlan); 6148 return err; 6149 } 6150 6151 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info) 6152 { 6153 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6154 struct net_device *dev = info->user_ptr[1]; 6155 struct station_del_parameters params; 6156 6157 memset(¶ms, 0, sizeof(params)); 6158 6159 if (info->attrs[NL80211_ATTR_MAC]) 6160 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 6161 6162 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6163 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN && 6164 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT && 6165 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6166 return -EINVAL; 6167 6168 if (!rdev->ops->del_station) 6169 return -EOPNOTSUPP; 6170 6171 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) { 6172 params.subtype = 6173 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]); 6174 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 && 6175 params.subtype != IEEE80211_STYPE_DEAUTH >> 4) 6176 return -EINVAL; 6177 } else { 6178 /* Default to Deauthentication frame */ 6179 params.subtype = IEEE80211_STYPE_DEAUTH >> 4; 6180 } 6181 6182 if (info->attrs[NL80211_ATTR_REASON_CODE]) { 6183 params.reason_code = 6184 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 6185 if (params.reason_code == 0) 6186 return -EINVAL; /* 0 is reserved */ 6187 } else { 6188 /* Default to reason code 2 */ 6189 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID; 6190 } 6191 6192 return rdev_del_station(rdev, dev, ¶ms); 6193 } 6194 6195 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq, 6196 int flags, struct net_device *dev, 6197 u8 *dst, u8 *next_hop, 6198 struct mpath_info *pinfo) 6199 { 6200 void *hdr; 6201 struct nlattr *pinfoattr; 6202 6203 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH); 6204 if (!hdr) 6205 return -1; 6206 6207 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 6208 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) || 6209 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) || 6210 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation)) 6211 goto nla_put_failure; 6212 6213 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO); 6214 if (!pinfoattr) 6215 goto nla_put_failure; 6216 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) && 6217 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN, 6218 pinfo->frame_qlen)) 6219 goto nla_put_failure; 6220 if (((pinfo->filled & MPATH_INFO_SN) && 6221 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) || 6222 ((pinfo->filled & MPATH_INFO_METRIC) && 6223 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC, 6224 pinfo->metric)) || 6225 ((pinfo->filled & MPATH_INFO_EXPTIME) && 6226 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME, 6227 pinfo->exptime)) || 6228 ((pinfo->filled & MPATH_INFO_FLAGS) && 6229 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS, 6230 pinfo->flags)) || 6231 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) && 6232 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT, 6233 pinfo->discovery_timeout)) || 6234 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) && 6235 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES, 6236 pinfo->discovery_retries)) || 6237 ((pinfo->filled & MPATH_INFO_HOP_COUNT) && 6238 nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT, 6239 pinfo->hop_count)) || 6240 ((pinfo->filled & MPATH_INFO_PATH_CHANGE) && 6241 nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE, 6242 pinfo->path_change_count))) 6243 goto nla_put_failure; 6244 6245 nla_nest_end(msg, pinfoattr); 6246 6247 genlmsg_end(msg, hdr); 6248 return 0; 6249 6250 nla_put_failure: 6251 genlmsg_cancel(msg, hdr); 6252 return -EMSGSIZE; 6253 } 6254 6255 static int nl80211_dump_mpath(struct sk_buff *skb, 6256 struct netlink_callback *cb) 6257 { 6258 struct mpath_info pinfo; 6259 struct cfg80211_registered_device *rdev; 6260 struct wireless_dev *wdev; 6261 u8 dst[ETH_ALEN]; 6262 u8 next_hop[ETH_ALEN]; 6263 int path_idx = cb->args[2]; 6264 int err; 6265 6266 rtnl_lock(); 6267 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev); 6268 if (err) 6269 goto out_err; 6270 6271 if (!rdev->ops->dump_mpath) { 6272 err = -EOPNOTSUPP; 6273 goto out_err; 6274 } 6275 6276 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 6277 err = -EOPNOTSUPP; 6278 goto out_err; 6279 } 6280 6281 while (1) { 6282 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst, 6283 next_hop, &pinfo); 6284 if (err == -ENOENT) 6285 break; 6286 if (err) 6287 goto out_err; 6288 6289 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 6290 cb->nlh->nlmsg_seq, NLM_F_MULTI, 6291 wdev->netdev, dst, next_hop, 6292 &pinfo) < 0) 6293 goto out; 6294 6295 path_idx++; 6296 } 6297 6298 out: 6299 cb->args[2] = path_idx; 6300 err = skb->len; 6301 out_err: 6302 rtnl_unlock(); 6303 return err; 6304 } 6305 6306 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info) 6307 { 6308 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6309 int err; 6310 struct net_device *dev = info->user_ptr[1]; 6311 struct mpath_info pinfo; 6312 struct sk_buff *msg; 6313 u8 *dst = NULL; 6314 u8 next_hop[ETH_ALEN]; 6315 6316 memset(&pinfo, 0, sizeof(pinfo)); 6317 6318 if (!info->attrs[NL80211_ATTR_MAC]) 6319 return -EINVAL; 6320 6321 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 6322 6323 if (!rdev->ops->get_mpath) 6324 return -EOPNOTSUPP; 6325 6326 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 6327 return -EOPNOTSUPP; 6328 6329 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo); 6330 if (err) 6331 return err; 6332 6333 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 6334 if (!msg) 6335 return -ENOMEM; 6336 6337 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 6338 dev, dst, next_hop, &pinfo) < 0) { 6339 nlmsg_free(msg); 6340 return -ENOBUFS; 6341 } 6342 6343 return genlmsg_reply(msg, info); 6344 } 6345 6346 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info) 6347 { 6348 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6349 struct net_device *dev = info->user_ptr[1]; 6350 u8 *dst = NULL; 6351 u8 *next_hop = NULL; 6352 6353 if (!info->attrs[NL80211_ATTR_MAC]) 6354 return -EINVAL; 6355 6356 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 6357 return -EINVAL; 6358 6359 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 6360 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 6361 6362 if (!rdev->ops->change_mpath) 6363 return -EOPNOTSUPP; 6364 6365 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 6366 return -EOPNOTSUPP; 6367 6368 return rdev_change_mpath(rdev, dev, dst, next_hop); 6369 } 6370 6371 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info) 6372 { 6373 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6374 struct net_device *dev = info->user_ptr[1]; 6375 u8 *dst = NULL; 6376 u8 *next_hop = NULL; 6377 6378 if (!info->attrs[NL80211_ATTR_MAC]) 6379 return -EINVAL; 6380 6381 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 6382 return -EINVAL; 6383 6384 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 6385 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 6386 6387 if (!rdev->ops->add_mpath) 6388 return -EOPNOTSUPP; 6389 6390 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 6391 return -EOPNOTSUPP; 6392 6393 return rdev_add_mpath(rdev, dev, dst, next_hop); 6394 } 6395 6396 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info) 6397 { 6398 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6399 struct net_device *dev = info->user_ptr[1]; 6400 u8 *dst = NULL; 6401 6402 if (info->attrs[NL80211_ATTR_MAC]) 6403 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 6404 6405 if (!rdev->ops->del_mpath) 6406 return -EOPNOTSUPP; 6407 6408 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 6409 return -EOPNOTSUPP; 6410 6411 return rdev_del_mpath(rdev, dev, dst); 6412 } 6413 6414 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info) 6415 { 6416 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6417 int err; 6418 struct net_device *dev = info->user_ptr[1]; 6419 struct mpath_info pinfo; 6420 struct sk_buff *msg; 6421 u8 *dst = NULL; 6422 u8 mpp[ETH_ALEN]; 6423 6424 memset(&pinfo, 0, sizeof(pinfo)); 6425 6426 if (!info->attrs[NL80211_ATTR_MAC]) 6427 return -EINVAL; 6428 6429 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 6430 6431 if (!rdev->ops->get_mpp) 6432 return -EOPNOTSUPP; 6433 6434 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 6435 return -EOPNOTSUPP; 6436 6437 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo); 6438 if (err) 6439 return err; 6440 6441 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 6442 if (!msg) 6443 return -ENOMEM; 6444 6445 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 6446 dev, dst, mpp, &pinfo) < 0) { 6447 nlmsg_free(msg); 6448 return -ENOBUFS; 6449 } 6450 6451 return genlmsg_reply(msg, info); 6452 } 6453 6454 static int nl80211_dump_mpp(struct sk_buff *skb, 6455 struct netlink_callback *cb) 6456 { 6457 struct mpath_info pinfo; 6458 struct cfg80211_registered_device *rdev; 6459 struct wireless_dev *wdev; 6460 u8 dst[ETH_ALEN]; 6461 u8 mpp[ETH_ALEN]; 6462 int path_idx = cb->args[2]; 6463 int err; 6464 6465 rtnl_lock(); 6466 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev); 6467 if (err) 6468 goto out_err; 6469 6470 if (!rdev->ops->dump_mpp) { 6471 err = -EOPNOTSUPP; 6472 goto out_err; 6473 } 6474 6475 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 6476 err = -EOPNOTSUPP; 6477 goto out_err; 6478 } 6479 6480 while (1) { 6481 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst, 6482 mpp, &pinfo); 6483 if (err == -ENOENT) 6484 break; 6485 if (err) 6486 goto out_err; 6487 6488 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 6489 cb->nlh->nlmsg_seq, NLM_F_MULTI, 6490 wdev->netdev, dst, mpp, 6491 &pinfo) < 0) 6492 goto out; 6493 6494 path_idx++; 6495 } 6496 6497 out: 6498 cb->args[2] = path_idx; 6499 err = skb->len; 6500 out_err: 6501 rtnl_unlock(); 6502 return err; 6503 } 6504 6505 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info) 6506 { 6507 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6508 struct net_device *dev = info->user_ptr[1]; 6509 struct wireless_dev *wdev = dev->ieee80211_ptr; 6510 struct bss_parameters params; 6511 int err; 6512 6513 memset(¶ms, 0, sizeof(params)); 6514 /* default to not changing parameters */ 6515 params.use_cts_prot = -1; 6516 params.use_short_preamble = -1; 6517 params.use_short_slot_time = -1; 6518 params.ap_isolate = -1; 6519 params.ht_opmode = -1; 6520 params.p2p_ctwindow = -1; 6521 params.p2p_opp_ps = -1; 6522 6523 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT]) 6524 params.use_cts_prot = 6525 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]); 6526 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]) 6527 params.use_short_preamble = 6528 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]); 6529 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]) 6530 params.use_short_slot_time = 6531 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]); 6532 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 6533 params.basic_rates = 6534 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 6535 params.basic_rates_len = 6536 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 6537 } 6538 if (info->attrs[NL80211_ATTR_AP_ISOLATE]) 6539 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]); 6540 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE]) 6541 params.ht_opmode = 6542 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]); 6543 6544 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 6545 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6546 return -EINVAL; 6547 params.p2p_ctwindow = 6548 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 6549 if (params.p2p_ctwindow != 0 && 6550 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) 6551 return -EINVAL; 6552 } 6553 6554 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 6555 u8 tmp; 6556 6557 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6558 return -EINVAL; 6559 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 6560 params.p2p_opp_ps = tmp; 6561 if (params.p2p_opp_ps && 6562 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) 6563 return -EINVAL; 6564 } 6565 6566 if (!rdev->ops->change_bss) 6567 return -EOPNOTSUPP; 6568 6569 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6570 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6571 return -EOPNOTSUPP; 6572 6573 wdev_lock(wdev); 6574 err = rdev_change_bss(rdev, dev, ¶ms); 6575 wdev_unlock(wdev); 6576 6577 return err; 6578 } 6579 6580 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info) 6581 { 6582 char *data = NULL; 6583 bool is_indoor; 6584 enum nl80211_user_reg_hint_type user_reg_hint_type; 6585 u32 owner_nlportid; 6586 6587 /* 6588 * You should only get this when cfg80211 hasn't yet initialized 6589 * completely when built-in to the kernel right between the time 6590 * window between nl80211_init() and regulatory_init(), if that is 6591 * even possible. 6592 */ 6593 if (unlikely(!rcu_access_pointer(cfg80211_regdomain))) 6594 return -EINPROGRESS; 6595 6596 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]) 6597 user_reg_hint_type = 6598 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]); 6599 else 6600 user_reg_hint_type = NL80211_USER_REG_HINT_USER; 6601 6602 switch (user_reg_hint_type) { 6603 case NL80211_USER_REG_HINT_USER: 6604 case NL80211_USER_REG_HINT_CELL_BASE: 6605 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 6606 return -EINVAL; 6607 6608 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 6609 return regulatory_hint_user(data, user_reg_hint_type); 6610 case NL80211_USER_REG_HINT_INDOOR: 6611 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 6612 owner_nlportid = info->snd_portid; 6613 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR]; 6614 } else { 6615 owner_nlportid = 0; 6616 is_indoor = true; 6617 } 6618 6619 return regulatory_hint_indoor(is_indoor, owner_nlportid); 6620 default: 6621 return -EINVAL; 6622 } 6623 } 6624 6625 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info) 6626 { 6627 return reg_reload_regdb(); 6628 } 6629 6630 static int nl80211_get_mesh_config(struct sk_buff *skb, 6631 struct genl_info *info) 6632 { 6633 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6634 struct net_device *dev = info->user_ptr[1]; 6635 struct wireless_dev *wdev = dev->ieee80211_ptr; 6636 struct mesh_config cur_params; 6637 int err = 0; 6638 void *hdr; 6639 struct nlattr *pinfoattr; 6640 struct sk_buff *msg; 6641 6642 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 6643 return -EOPNOTSUPP; 6644 6645 if (!rdev->ops->get_mesh_config) 6646 return -EOPNOTSUPP; 6647 6648 wdev_lock(wdev); 6649 /* If not connected, get default parameters */ 6650 if (!wdev->mesh_id_len) 6651 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params)); 6652 else 6653 err = rdev_get_mesh_config(rdev, dev, &cur_params); 6654 wdev_unlock(wdev); 6655 6656 if (err) 6657 return err; 6658 6659 /* Draw up a netlink message to send back */ 6660 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 6661 if (!msg) 6662 return -ENOMEM; 6663 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 6664 NL80211_CMD_GET_MESH_CONFIG); 6665 if (!hdr) 6666 goto out; 6667 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG); 6668 if (!pinfoattr) 6669 goto nla_put_failure; 6670 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 6671 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT, 6672 cur_params.dot11MeshRetryTimeout) || 6673 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT, 6674 cur_params.dot11MeshConfirmTimeout) || 6675 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT, 6676 cur_params.dot11MeshHoldingTimeout) || 6677 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS, 6678 cur_params.dot11MeshMaxPeerLinks) || 6679 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES, 6680 cur_params.dot11MeshMaxRetries) || 6681 nla_put_u8(msg, NL80211_MESHCONF_TTL, 6682 cur_params.dot11MeshTTL) || 6683 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL, 6684 cur_params.element_ttl) || 6685 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS, 6686 cur_params.auto_open_plinks) || 6687 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 6688 cur_params.dot11MeshNbrOffsetMaxNeighbor) || 6689 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 6690 cur_params.dot11MeshHWMPmaxPREQretries) || 6691 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME, 6692 cur_params.path_refresh_time) || 6693 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 6694 cur_params.min_discovery_timeout) || 6695 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 6696 cur_params.dot11MeshHWMPactivePathTimeout) || 6697 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 6698 cur_params.dot11MeshHWMPpreqMinInterval) || 6699 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 6700 cur_params.dot11MeshHWMPperrMinInterval) || 6701 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 6702 cur_params.dot11MeshHWMPnetDiameterTraversalTime) || 6703 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE, 6704 cur_params.dot11MeshHWMPRootMode) || 6705 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL, 6706 cur_params.dot11MeshHWMPRannInterval) || 6707 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 6708 cur_params.dot11MeshGateAnnouncementProtocol) || 6709 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING, 6710 cur_params.dot11MeshForwarding) || 6711 nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD, 6712 cur_params.rssi_threshold) || 6713 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE, 6714 cur_params.ht_opmode) || 6715 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 6716 cur_params.dot11MeshHWMPactivePathToRootTimeout) || 6717 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 6718 cur_params.dot11MeshHWMProotInterval) || 6719 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 6720 cur_params.dot11MeshHWMPconfirmationInterval) || 6721 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE, 6722 cur_params.power_mode) || 6723 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW, 6724 cur_params.dot11MeshAwakeWindowDuration) || 6725 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT, 6726 cur_params.plink_timeout) || 6727 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE, 6728 cur_params.dot11MeshConnectedToMeshGate)) 6729 goto nla_put_failure; 6730 nla_nest_end(msg, pinfoattr); 6731 genlmsg_end(msg, hdr); 6732 return genlmsg_reply(msg, info); 6733 6734 nla_put_failure: 6735 out: 6736 nlmsg_free(msg); 6737 return -ENOBUFS; 6738 } 6739 6740 static const struct nla_policy 6741 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = { 6742 [NL80211_MESHCONF_RETRY_TIMEOUT] = 6743 NLA_POLICY_RANGE(NLA_U16, 1, 255), 6744 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = 6745 NLA_POLICY_RANGE(NLA_U16, 1, 255), 6746 [NL80211_MESHCONF_HOLDING_TIMEOUT] = 6747 NLA_POLICY_RANGE(NLA_U16, 1, 255), 6748 [NL80211_MESHCONF_MAX_PEER_LINKS] = 6749 NLA_POLICY_RANGE(NLA_U16, 0, 255), 6750 [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16), 6751 [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 6752 [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 6753 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1), 6754 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = 6755 NLA_POLICY_RANGE(NLA_U32, 1, 255), 6756 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 }, 6757 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 }, 6758 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1), 6759 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 }, 6760 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = 6761 NLA_POLICY_MIN(NLA_U16, 1), 6762 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = 6763 NLA_POLICY_MIN(NLA_U16, 1), 6764 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = 6765 NLA_POLICY_MIN(NLA_U16, 1), 6766 [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4), 6767 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = 6768 NLA_POLICY_MIN(NLA_U16, 1), 6769 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1), 6770 [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1), 6771 [NL80211_MESHCONF_RSSI_THRESHOLD] = 6772 NLA_POLICY_RANGE(NLA_S32, -255, 0), 6773 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 }, 6774 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 }, 6775 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = 6776 NLA_POLICY_MIN(NLA_U16, 1), 6777 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = 6778 NLA_POLICY_MIN(NLA_U16, 1), 6779 [NL80211_MESHCONF_POWER_MODE] = 6780 NLA_POLICY_RANGE(NLA_U32, 6781 NL80211_MESH_POWER_ACTIVE, 6782 NL80211_MESH_POWER_MAX), 6783 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 }, 6784 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 }, 6785 [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 6786 }; 6787 6788 static const struct nla_policy 6789 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = { 6790 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 }, 6791 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 }, 6792 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 }, 6793 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG }, 6794 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 }, 6795 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG }, 6796 [NL80211_MESH_SETUP_IE] = 6797 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 6798 IEEE80211_MAX_DATA_LEN), 6799 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG }, 6800 }; 6801 6802 static int nl80211_parse_mesh_config(struct genl_info *info, 6803 struct mesh_config *cfg, 6804 u32 *mask_out) 6805 { 6806 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1]; 6807 u32 mask = 0; 6808 u16 ht_opmode; 6809 6810 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn) \ 6811 do { \ 6812 if (tb[attr]) { \ 6813 cfg->param = fn(tb[attr]); \ 6814 mask |= BIT((attr) - 1); \ 6815 } \ 6816 } while (0) 6817 6818 if (!info->attrs[NL80211_ATTR_MESH_CONFIG]) 6819 return -EINVAL; 6820 if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack)) 6821 return -EINVAL; 6822 6823 /* This makes sure that there aren't more than 32 mesh config 6824 * parameters (otherwise our bitfield scheme would not work.) */ 6825 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32); 6826 6827 /* Fill in the params struct */ 6828 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask, 6829 NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16); 6830 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask, 6831 NL80211_MESHCONF_CONFIRM_TIMEOUT, 6832 nla_get_u16); 6833 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask, 6834 NL80211_MESHCONF_HOLDING_TIMEOUT, 6835 nla_get_u16); 6836 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask, 6837 NL80211_MESHCONF_MAX_PEER_LINKS, 6838 nla_get_u16); 6839 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask, 6840 NL80211_MESHCONF_MAX_RETRIES, nla_get_u8); 6841 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask, 6842 NL80211_MESHCONF_TTL, nla_get_u8); 6843 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask, 6844 NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8); 6845 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask, 6846 NL80211_MESHCONF_AUTO_OPEN_PLINKS, 6847 nla_get_u8); 6848 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor, 6849 mask, 6850 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 6851 nla_get_u32); 6852 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask, 6853 NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 6854 nla_get_u8); 6855 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask, 6856 NL80211_MESHCONF_PATH_REFRESH_TIME, 6857 nla_get_u32); 6858 if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) && 6859 (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535)) 6860 return -EINVAL; 6861 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask, 6862 NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 6863 nla_get_u16); 6864 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout, 6865 mask, 6866 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 6867 nla_get_u32); 6868 if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) && 6869 (cfg->dot11MeshHWMPactivePathTimeout < 1 || 6870 cfg->dot11MeshHWMPactivePathTimeout > 65535)) 6871 return -EINVAL; 6872 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask, 6873 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 6874 nla_get_u16); 6875 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask, 6876 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 6877 nla_get_u16); 6878 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 6879 dot11MeshHWMPnetDiameterTraversalTime, mask, 6880 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 6881 nla_get_u16); 6882 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask, 6883 NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8); 6884 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask, 6885 NL80211_MESHCONF_HWMP_RANN_INTERVAL, 6886 nla_get_u16); 6887 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol, 6888 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 6889 nla_get_u8); 6890 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask, 6891 NL80211_MESHCONF_FORWARDING, nla_get_u8); 6892 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask, 6893 NL80211_MESHCONF_RSSI_THRESHOLD, 6894 nla_get_s32); 6895 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask, 6896 NL80211_MESHCONF_CONNECTED_TO_GATE, 6897 nla_get_u8); 6898 /* 6899 * Check HT operation mode based on 6900 * IEEE 802.11-2016 9.4.2.57 HT Operation element. 6901 */ 6902 if (tb[NL80211_MESHCONF_HT_OPMODE]) { 6903 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]); 6904 6905 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION | 6906 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT | 6907 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)) 6908 return -EINVAL; 6909 6910 /* NON_HT_STA bit is reserved, but some programs set it */ 6911 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT; 6912 6913 cfg->ht_opmode = ht_opmode; 6914 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1)); 6915 } 6916 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 6917 dot11MeshHWMPactivePathToRootTimeout, mask, 6918 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 6919 nla_get_u32); 6920 if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) && 6921 (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 || 6922 cfg->dot11MeshHWMPactivePathToRootTimeout > 65535)) 6923 return -EINVAL; 6924 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask, 6925 NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 6926 nla_get_u16); 6927 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval, 6928 mask, 6929 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 6930 nla_get_u16); 6931 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask, 6932 NL80211_MESHCONF_POWER_MODE, nla_get_u32); 6933 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask, 6934 NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16); 6935 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask, 6936 NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32); 6937 if (mask_out) 6938 *mask_out = mask; 6939 6940 return 0; 6941 6942 #undef FILL_IN_MESH_PARAM_IF_SET 6943 } 6944 6945 static int nl80211_parse_mesh_setup(struct genl_info *info, 6946 struct mesh_setup *setup) 6947 { 6948 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6949 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1]; 6950 6951 if (!info->attrs[NL80211_ATTR_MESH_SETUP]) 6952 return -EINVAL; 6953 if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack)) 6954 return -EINVAL; 6955 6956 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC]) 6957 setup->sync_method = 6958 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ? 6959 IEEE80211_SYNC_METHOD_VENDOR : 6960 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET; 6961 6962 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL]) 6963 setup->path_sel_proto = 6964 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ? 6965 IEEE80211_PATH_PROTOCOL_VENDOR : 6966 IEEE80211_PATH_PROTOCOL_HWMP; 6967 6968 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC]) 6969 setup->path_metric = 6970 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ? 6971 IEEE80211_PATH_METRIC_VENDOR : 6972 IEEE80211_PATH_METRIC_AIRTIME; 6973 6974 if (tb[NL80211_MESH_SETUP_IE]) { 6975 struct nlattr *ieattr = 6976 tb[NL80211_MESH_SETUP_IE]; 6977 setup->ie = nla_data(ieattr); 6978 setup->ie_len = nla_len(ieattr); 6979 } 6980 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] && 6981 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM)) 6982 return -EINVAL; 6983 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]); 6984 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]); 6985 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]); 6986 if (setup->is_secure) 6987 setup->user_mpm = true; 6988 6989 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) { 6990 if (!setup->user_mpm) 6991 return -EINVAL; 6992 setup->auth_id = 6993 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]); 6994 } 6995 6996 return 0; 6997 } 6998 6999 static int nl80211_update_mesh_config(struct sk_buff *skb, 7000 struct genl_info *info) 7001 { 7002 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7003 struct net_device *dev = info->user_ptr[1]; 7004 struct wireless_dev *wdev = dev->ieee80211_ptr; 7005 struct mesh_config cfg; 7006 u32 mask; 7007 int err; 7008 7009 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 7010 return -EOPNOTSUPP; 7011 7012 if (!rdev->ops->update_mesh_config) 7013 return -EOPNOTSUPP; 7014 7015 err = nl80211_parse_mesh_config(info, &cfg, &mask); 7016 if (err) 7017 return err; 7018 7019 wdev_lock(wdev); 7020 if (!wdev->mesh_id_len) 7021 err = -ENOLINK; 7022 7023 if (!err) 7024 err = rdev_update_mesh_config(rdev, dev, mask, &cfg); 7025 7026 wdev_unlock(wdev); 7027 7028 return err; 7029 } 7030 7031 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom, 7032 struct sk_buff *msg) 7033 { 7034 struct nlattr *nl_reg_rules; 7035 unsigned int i; 7036 7037 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) || 7038 (regdom->dfs_region && 7039 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region))) 7040 goto nla_put_failure; 7041 7042 nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES); 7043 if (!nl_reg_rules) 7044 goto nla_put_failure; 7045 7046 for (i = 0; i < regdom->n_reg_rules; i++) { 7047 struct nlattr *nl_reg_rule; 7048 const struct ieee80211_reg_rule *reg_rule; 7049 const struct ieee80211_freq_range *freq_range; 7050 const struct ieee80211_power_rule *power_rule; 7051 unsigned int max_bandwidth_khz; 7052 7053 reg_rule = ®dom->reg_rules[i]; 7054 freq_range = ®_rule->freq_range; 7055 power_rule = ®_rule->power_rule; 7056 7057 nl_reg_rule = nla_nest_start_noflag(msg, i); 7058 if (!nl_reg_rule) 7059 goto nla_put_failure; 7060 7061 max_bandwidth_khz = freq_range->max_bandwidth_khz; 7062 if (!max_bandwidth_khz) 7063 max_bandwidth_khz = reg_get_max_bandwidth(regdom, 7064 reg_rule); 7065 7066 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS, 7067 reg_rule->flags) || 7068 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START, 7069 freq_range->start_freq_khz) || 7070 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END, 7071 freq_range->end_freq_khz) || 7072 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW, 7073 max_bandwidth_khz) || 7074 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN, 7075 power_rule->max_antenna_gain) || 7076 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP, 7077 power_rule->max_eirp) || 7078 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME, 7079 reg_rule->dfs_cac_ms)) 7080 goto nla_put_failure; 7081 7082 nla_nest_end(msg, nl_reg_rule); 7083 } 7084 7085 nla_nest_end(msg, nl_reg_rules); 7086 return 0; 7087 7088 nla_put_failure: 7089 return -EMSGSIZE; 7090 } 7091 7092 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info) 7093 { 7094 const struct ieee80211_regdomain *regdom = NULL; 7095 struct cfg80211_registered_device *rdev; 7096 struct wiphy *wiphy = NULL; 7097 struct sk_buff *msg; 7098 void *hdr; 7099 7100 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7101 if (!msg) 7102 return -ENOBUFS; 7103 7104 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 7105 NL80211_CMD_GET_REG); 7106 if (!hdr) 7107 goto put_failure; 7108 7109 if (info->attrs[NL80211_ATTR_WIPHY]) { 7110 bool self_managed; 7111 7112 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 7113 if (IS_ERR(rdev)) { 7114 nlmsg_free(msg); 7115 return PTR_ERR(rdev); 7116 } 7117 7118 wiphy = &rdev->wiphy; 7119 self_managed = wiphy->regulatory_flags & 7120 REGULATORY_WIPHY_SELF_MANAGED; 7121 regdom = get_wiphy_regdom(wiphy); 7122 7123 /* a self-managed-reg device must have a private regdom */ 7124 if (WARN_ON(!regdom && self_managed)) { 7125 nlmsg_free(msg); 7126 return -EINVAL; 7127 } 7128 7129 if (regdom && 7130 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 7131 goto nla_put_failure; 7132 } 7133 7134 if (!wiphy && reg_last_request_cell_base() && 7135 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 7136 NL80211_USER_REG_HINT_CELL_BASE)) 7137 goto nla_put_failure; 7138 7139 rcu_read_lock(); 7140 7141 if (!regdom) 7142 regdom = rcu_dereference(cfg80211_regdomain); 7143 7144 if (nl80211_put_regdom(regdom, msg)) 7145 goto nla_put_failure_rcu; 7146 7147 rcu_read_unlock(); 7148 7149 genlmsg_end(msg, hdr); 7150 return genlmsg_reply(msg, info); 7151 7152 nla_put_failure_rcu: 7153 rcu_read_unlock(); 7154 nla_put_failure: 7155 put_failure: 7156 nlmsg_free(msg); 7157 return -EMSGSIZE; 7158 } 7159 7160 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb, 7161 u32 seq, int flags, struct wiphy *wiphy, 7162 const struct ieee80211_regdomain *regdom) 7163 { 7164 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 7165 NL80211_CMD_GET_REG); 7166 7167 if (!hdr) 7168 return -1; 7169 7170 genl_dump_check_consistent(cb, hdr); 7171 7172 if (nl80211_put_regdom(regdom, msg)) 7173 goto nla_put_failure; 7174 7175 if (!wiphy && reg_last_request_cell_base() && 7176 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 7177 NL80211_USER_REG_HINT_CELL_BASE)) 7178 goto nla_put_failure; 7179 7180 if (wiphy && 7181 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 7182 goto nla_put_failure; 7183 7184 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 7185 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 7186 goto nla_put_failure; 7187 7188 genlmsg_end(msg, hdr); 7189 return 0; 7190 7191 nla_put_failure: 7192 genlmsg_cancel(msg, hdr); 7193 return -EMSGSIZE; 7194 } 7195 7196 static int nl80211_get_reg_dump(struct sk_buff *skb, 7197 struct netlink_callback *cb) 7198 { 7199 const struct ieee80211_regdomain *regdom = NULL; 7200 struct cfg80211_registered_device *rdev; 7201 int err, reg_idx, start = cb->args[2]; 7202 7203 rtnl_lock(); 7204 7205 if (cfg80211_regdomain && start == 0) { 7206 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 7207 NLM_F_MULTI, NULL, 7208 rtnl_dereference(cfg80211_regdomain)); 7209 if (err < 0) 7210 goto out_err; 7211 } 7212 7213 /* the global regdom is idx 0 */ 7214 reg_idx = 1; 7215 list_for_each_entry(rdev, &cfg80211_rdev_list, list) { 7216 regdom = get_wiphy_regdom(&rdev->wiphy); 7217 if (!regdom) 7218 continue; 7219 7220 if (++reg_idx <= start) 7221 continue; 7222 7223 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 7224 NLM_F_MULTI, &rdev->wiphy, regdom); 7225 if (err < 0) { 7226 reg_idx--; 7227 break; 7228 } 7229 } 7230 7231 cb->args[2] = reg_idx; 7232 err = skb->len; 7233 out_err: 7234 rtnl_unlock(); 7235 return err; 7236 } 7237 7238 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 7239 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = { 7240 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 }, 7241 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 }, 7242 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 }, 7243 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 }, 7244 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 }, 7245 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 }, 7246 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 }, 7247 }; 7248 7249 static int parse_reg_rule(struct nlattr *tb[], 7250 struct ieee80211_reg_rule *reg_rule) 7251 { 7252 struct ieee80211_freq_range *freq_range = ®_rule->freq_range; 7253 struct ieee80211_power_rule *power_rule = ®_rule->power_rule; 7254 7255 if (!tb[NL80211_ATTR_REG_RULE_FLAGS]) 7256 return -EINVAL; 7257 if (!tb[NL80211_ATTR_FREQ_RANGE_START]) 7258 return -EINVAL; 7259 if (!tb[NL80211_ATTR_FREQ_RANGE_END]) 7260 return -EINVAL; 7261 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]) 7262 return -EINVAL; 7263 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]) 7264 return -EINVAL; 7265 7266 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]); 7267 7268 freq_range->start_freq_khz = 7269 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]); 7270 freq_range->end_freq_khz = 7271 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]); 7272 freq_range->max_bandwidth_khz = 7273 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]); 7274 7275 power_rule->max_eirp = 7276 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]); 7277 7278 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]) 7279 power_rule->max_antenna_gain = 7280 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]); 7281 7282 if (tb[NL80211_ATTR_DFS_CAC_TIME]) 7283 reg_rule->dfs_cac_ms = 7284 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]); 7285 7286 return 0; 7287 } 7288 7289 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info) 7290 { 7291 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1]; 7292 struct nlattr *nl_reg_rule; 7293 char *alpha2; 7294 int rem_reg_rules, r; 7295 u32 num_rules = 0, rule_idx = 0; 7296 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET; 7297 struct ieee80211_regdomain *rd; 7298 7299 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 7300 return -EINVAL; 7301 7302 if (!info->attrs[NL80211_ATTR_REG_RULES]) 7303 return -EINVAL; 7304 7305 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 7306 7307 if (info->attrs[NL80211_ATTR_DFS_REGION]) 7308 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]); 7309 7310 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 7311 rem_reg_rules) { 7312 num_rules++; 7313 if (num_rules > NL80211_MAX_SUPP_REG_RULES) 7314 return -EINVAL; 7315 } 7316 7317 if (!reg_is_valid_request(alpha2)) 7318 return -EINVAL; 7319 7320 rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL); 7321 if (!rd) 7322 return -ENOMEM; 7323 7324 rd->n_reg_rules = num_rules; 7325 rd->alpha2[0] = alpha2[0]; 7326 rd->alpha2[1] = alpha2[1]; 7327 7328 /* 7329 * Disable DFS master mode if the DFS region was 7330 * not supported or known on this kernel. 7331 */ 7332 if (reg_supported_dfs_region(dfs_region)) 7333 rd->dfs_region = dfs_region; 7334 7335 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 7336 rem_reg_rules) { 7337 r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX, 7338 nl_reg_rule, reg_rule_policy, 7339 info->extack); 7340 if (r) 7341 goto bad_reg; 7342 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]); 7343 if (r) 7344 goto bad_reg; 7345 7346 rule_idx++; 7347 7348 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) { 7349 r = -EINVAL; 7350 goto bad_reg; 7351 } 7352 } 7353 7354 /* set_regdom takes ownership of rd */ 7355 return set_regdom(rd, REGD_SOURCE_CRDA); 7356 bad_reg: 7357 kfree(rd); 7358 return r; 7359 } 7360 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */ 7361 7362 static int validate_scan_freqs(struct nlattr *freqs) 7363 { 7364 struct nlattr *attr1, *attr2; 7365 int n_channels = 0, tmp1, tmp2; 7366 7367 nla_for_each_nested(attr1, freqs, tmp1) 7368 if (nla_len(attr1) != sizeof(u32)) 7369 return 0; 7370 7371 nla_for_each_nested(attr1, freqs, tmp1) { 7372 n_channels++; 7373 /* 7374 * Some hardware has a limited channel list for 7375 * scanning, and it is pretty much nonsensical 7376 * to scan for a channel twice, so disallow that 7377 * and don't require drivers to check that the 7378 * channel list they get isn't longer than what 7379 * they can scan, as long as they can scan all 7380 * the channels they registered at once. 7381 */ 7382 nla_for_each_nested(attr2, freqs, tmp2) 7383 if (attr1 != attr2 && 7384 nla_get_u32(attr1) == nla_get_u32(attr2)) 7385 return 0; 7386 } 7387 7388 return n_channels; 7389 } 7390 7391 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b) 7392 { 7393 return b < NUM_NL80211_BANDS && wiphy->bands[b]; 7394 } 7395 7396 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy, 7397 struct cfg80211_bss_selection *bss_select) 7398 { 7399 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1]; 7400 struct nlattr *nest; 7401 int err; 7402 bool found = false; 7403 int i; 7404 7405 /* only process one nested attribute */ 7406 nest = nla_data(nla); 7407 if (!nla_ok(nest, nla_len(nest))) 7408 return -EINVAL; 7409 7410 err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX, 7411 nest, nl80211_bss_select_policy, 7412 NULL); 7413 if (err) 7414 return err; 7415 7416 /* only one attribute may be given */ 7417 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) { 7418 if (attr[i]) { 7419 if (found) 7420 return -EINVAL; 7421 found = true; 7422 } 7423 } 7424 7425 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID; 7426 7427 if (attr[NL80211_BSS_SELECT_ATTR_RSSI]) 7428 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI; 7429 7430 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) { 7431 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF; 7432 bss_select->param.band_pref = 7433 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]); 7434 if (!is_band_valid(wiphy, bss_select->param.band_pref)) 7435 return -EINVAL; 7436 } 7437 7438 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) { 7439 struct nl80211_bss_select_rssi_adjust *adj_param; 7440 7441 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]); 7442 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST; 7443 bss_select->param.adjust.band = adj_param->band; 7444 bss_select->param.adjust.delta = adj_param->delta; 7445 if (!is_band_valid(wiphy, bss_select->param.adjust.band)) 7446 return -EINVAL; 7447 } 7448 7449 /* user-space did not provide behaviour attribute */ 7450 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID) 7451 return -EINVAL; 7452 7453 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour))) 7454 return -EINVAL; 7455 7456 return 0; 7457 } 7458 7459 int nl80211_parse_random_mac(struct nlattr **attrs, 7460 u8 *mac_addr, u8 *mac_addr_mask) 7461 { 7462 int i; 7463 7464 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) { 7465 eth_zero_addr(mac_addr); 7466 eth_zero_addr(mac_addr_mask); 7467 mac_addr[0] = 0x2; 7468 mac_addr_mask[0] = 0x3; 7469 7470 return 0; 7471 } 7472 7473 /* need both or none */ 7474 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK]) 7475 return -EINVAL; 7476 7477 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN); 7478 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN); 7479 7480 /* don't allow or configure an mcast address */ 7481 if (!is_multicast_ether_addr(mac_addr_mask) || 7482 is_multicast_ether_addr(mac_addr)) 7483 return -EINVAL; 7484 7485 /* 7486 * allow users to pass a MAC address that has bits set outside 7487 * of the mask, but don't bother drivers with having to deal 7488 * with such bits 7489 */ 7490 for (i = 0; i < ETH_ALEN; i++) 7491 mac_addr[i] &= mac_addr_mask[i]; 7492 7493 return 0; 7494 } 7495 7496 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev) 7497 { 7498 ASSERT_WDEV_LOCK(wdev); 7499 7500 if (!cfg80211_beaconing_iface_active(wdev)) 7501 return true; 7502 7503 if (!(wdev->chandef.chan->flags & IEEE80211_CHAN_RADAR)) 7504 return true; 7505 7506 return regulatory_pre_cac_allowed(wdev->wiphy); 7507 } 7508 7509 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag, 7510 enum nl80211_ext_feature_index feat) 7511 { 7512 if (!(flags & flag)) 7513 return true; 7514 if (wiphy_ext_feature_isset(wiphy, feat)) 7515 return true; 7516 return false; 7517 } 7518 7519 static int 7520 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev, 7521 void *request, struct nlattr **attrs, 7522 bool is_sched_scan) 7523 { 7524 u8 *mac_addr, *mac_addr_mask; 7525 u32 *flags; 7526 enum nl80211_feature_flags randomness_flag; 7527 7528 if (!attrs[NL80211_ATTR_SCAN_FLAGS]) 7529 return 0; 7530 7531 if (is_sched_scan) { 7532 struct cfg80211_sched_scan_request *req = request; 7533 7534 randomness_flag = wdev ? 7535 NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR : 7536 NL80211_FEATURE_ND_RANDOM_MAC_ADDR; 7537 flags = &req->flags; 7538 mac_addr = req->mac_addr; 7539 mac_addr_mask = req->mac_addr_mask; 7540 } else { 7541 struct cfg80211_scan_request *req = request; 7542 7543 randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR; 7544 flags = &req->flags; 7545 mac_addr = req->mac_addr; 7546 mac_addr_mask = req->mac_addr_mask; 7547 } 7548 7549 *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]); 7550 7551 if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) && 7552 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) || 7553 !nl80211_check_scan_feat(wiphy, *flags, 7554 NL80211_SCAN_FLAG_LOW_SPAN, 7555 NL80211_EXT_FEATURE_LOW_SPAN_SCAN) || 7556 !nl80211_check_scan_feat(wiphy, *flags, 7557 NL80211_SCAN_FLAG_LOW_POWER, 7558 NL80211_EXT_FEATURE_LOW_POWER_SCAN) || 7559 !nl80211_check_scan_feat(wiphy, *flags, 7560 NL80211_SCAN_FLAG_HIGH_ACCURACY, 7561 NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) || 7562 !nl80211_check_scan_feat(wiphy, *flags, 7563 NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME, 7564 NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) || 7565 !nl80211_check_scan_feat(wiphy, *flags, 7566 NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP, 7567 NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) || 7568 !nl80211_check_scan_feat(wiphy, *flags, 7569 NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION, 7570 NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) || 7571 !nl80211_check_scan_feat(wiphy, *flags, 7572 NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE, 7573 NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) || 7574 !nl80211_check_scan_feat(wiphy, *flags, 7575 NL80211_SCAN_FLAG_RANDOM_SN, 7576 NL80211_EXT_FEATURE_SCAN_RANDOM_SN) || 7577 !nl80211_check_scan_feat(wiphy, *flags, 7578 NL80211_SCAN_FLAG_MIN_PREQ_CONTENT, 7579 NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT)) 7580 return -EOPNOTSUPP; 7581 7582 if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) { 7583 int err; 7584 7585 if (!(wiphy->features & randomness_flag) || 7586 (wdev && wdev->current_bss)) 7587 return -EOPNOTSUPP; 7588 7589 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask); 7590 if (err) 7591 return err; 7592 } 7593 7594 return 0; 7595 } 7596 7597 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info) 7598 { 7599 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7600 struct wireless_dev *wdev = info->user_ptr[1]; 7601 struct cfg80211_scan_request *request; 7602 struct nlattr *attr; 7603 struct wiphy *wiphy; 7604 int err, tmp, n_ssids = 0, n_channels, i; 7605 size_t ie_len; 7606 7607 wiphy = &rdev->wiphy; 7608 7609 if (wdev->iftype == NL80211_IFTYPE_NAN) 7610 return -EOPNOTSUPP; 7611 7612 if (!rdev->ops->scan) 7613 return -EOPNOTSUPP; 7614 7615 if (rdev->scan_req || rdev->scan_msg) { 7616 err = -EBUSY; 7617 goto unlock; 7618 } 7619 7620 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 7621 n_channels = validate_scan_freqs( 7622 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]); 7623 if (!n_channels) { 7624 err = -EINVAL; 7625 goto unlock; 7626 } 7627 } else { 7628 n_channels = ieee80211_get_num_supported_channels(wiphy); 7629 } 7630 7631 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) 7632 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) 7633 n_ssids++; 7634 7635 if (n_ssids > wiphy->max_scan_ssids) { 7636 err = -EINVAL; 7637 goto unlock; 7638 } 7639 7640 if (info->attrs[NL80211_ATTR_IE]) 7641 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 7642 else 7643 ie_len = 0; 7644 7645 if (ie_len > wiphy->max_scan_ie_len) { 7646 err = -EINVAL; 7647 goto unlock; 7648 } 7649 7650 request = kzalloc(sizeof(*request) 7651 + sizeof(*request->ssids) * n_ssids 7652 + sizeof(*request->channels) * n_channels 7653 + ie_len, GFP_KERNEL); 7654 if (!request) { 7655 err = -ENOMEM; 7656 goto unlock; 7657 } 7658 7659 if (n_ssids) 7660 request->ssids = (void *)&request->channels[n_channels]; 7661 request->n_ssids = n_ssids; 7662 if (ie_len) { 7663 if (n_ssids) 7664 request->ie = (void *)(request->ssids + n_ssids); 7665 else 7666 request->ie = (void *)(request->channels + n_channels); 7667 } 7668 7669 i = 0; 7670 if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 7671 /* user specified, bail out if channel not found */ 7672 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) { 7673 struct ieee80211_channel *chan; 7674 7675 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr)); 7676 7677 if (!chan) { 7678 err = -EINVAL; 7679 goto out_free; 7680 } 7681 7682 /* ignore disabled channels */ 7683 if (chan->flags & IEEE80211_CHAN_DISABLED) 7684 continue; 7685 7686 request->channels[i] = chan; 7687 i++; 7688 } 7689 } else { 7690 enum nl80211_band band; 7691 7692 /* all channels */ 7693 for (band = 0; band < NUM_NL80211_BANDS; band++) { 7694 int j; 7695 7696 if (!wiphy->bands[band]) 7697 continue; 7698 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 7699 struct ieee80211_channel *chan; 7700 7701 chan = &wiphy->bands[band]->channels[j]; 7702 7703 if (chan->flags & IEEE80211_CHAN_DISABLED) 7704 continue; 7705 7706 request->channels[i] = chan; 7707 i++; 7708 } 7709 } 7710 } 7711 7712 if (!i) { 7713 err = -EINVAL; 7714 goto out_free; 7715 } 7716 7717 request->n_channels = i; 7718 7719 wdev_lock(wdev); 7720 if (!cfg80211_off_channel_oper_allowed(wdev)) { 7721 struct ieee80211_channel *chan; 7722 7723 if (request->n_channels != 1) { 7724 wdev_unlock(wdev); 7725 err = -EBUSY; 7726 goto out_free; 7727 } 7728 7729 chan = request->channels[0]; 7730 if (chan->center_freq != wdev->chandef.chan->center_freq) { 7731 wdev_unlock(wdev); 7732 err = -EBUSY; 7733 goto out_free; 7734 } 7735 } 7736 wdev_unlock(wdev); 7737 7738 i = 0; 7739 if (n_ssids) { 7740 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) { 7741 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 7742 err = -EINVAL; 7743 goto out_free; 7744 } 7745 request->ssids[i].ssid_len = nla_len(attr); 7746 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr)); 7747 i++; 7748 } 7749 } 7750 7751 if (info->attrs[NL80211_ATTR_IE]) { 7752 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 7753 memcpy((void *)request->ie, 7754 nla_data(info->attrs[NL80211_ATTR_IE]), 7755 request->ie_len); 7756 } 7757 7758 for (i = 0; i < NUM_NL80211_BANDS; i++) 7759 if (wiphy->bands[i]) 7760 request->rates[i] = 7761 (1 << wiphy->bands[i]->n_bitrates) - 1; 7762 7763 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) { 7764 nla_for_each_nested(attr, 7765 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES], 7766 tmp) { 7767 enum nl80211_band band = nla_type(attr); 7768 7769 if (band < 0 || band >= NUM_NL80211_BANDS) { 7770 err = -EINVAL; 7771 goto out_free; 7772 } 7773 7774 if (!wiphy->bands[band]) 7775 continue; 7776 7777 err = ieee80211_get_ratemask(wiphy->bands[band], 7778 nla_data(attr), 7779 nla_len(attr), 7780 &request->rates[band]); 7781 if (err) 7782 goto out_free; 7783 } 7784 } 7785 7786 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) { 7787 if (!wiphy_ext_feature_isset(wiphy, 7788 NL80211_EXT_FEATURE_SET_SCAN_DWELL)) { 7789 err = -EOPNOTSUPP; 7790 goto out_free; 7791 } 7792 7793 request->duration = 7794 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]); 7795 request->duration_mandatory = 7796 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]); 7797 } 7798 7799 err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs, 7800 false); 7801 if (err) 7802 goto out_free; 7803 7804 request->no_cck = 7805 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 7806 7807 /* Initial implementation used NL80211_ATTR_MAC to set the specific 7808 * BSSID to scan for. This was problematic because that same attribute 7809 * was already used for another purpose (local random MAC address). The 7810 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards 7811 * compatibility with older userspace components, also use the 7812 * NL80211_ATTR_MAC value here if it can be determined to be used for 7813 * the specific BSSID use case instead of the random MAC address 7814 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use). 7815 */ 7816 if (info->attrs[NL80211_ATTR_BSSID]) 7817 memcpy(request->bssid, 7818 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN); 7819 else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) && 7820 info->attrs[NL80211_ATTR_MAC]) 7821 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]), 7822 ETH_ALEN); 7823 else 7824 eth_broadcast_addr(request->bssid); 7825 7826 request->wdev = wdev; 7827 request->wiphy = &rdev->wiphy; 7828 request->scan_start = jiffies; 7829 7830 rdev->scan_req = request; 7831 err = rdev_scan(rdev, request); 7832 7833 if (!err) { 7834 nl80211_send_scan_start(rdev, wdev); 7835 if (wdev->netdev) 7836 dev_hold(wdev->netdev); 7837 } else { 7838 out_free: 7839 rdev->scan_req = NULL; 7840 kfree(request); 7841 } 7842 7843 unlock: 7844 return err; 7845 } 7846 7847 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info) 7848 { 7849 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7850 struct wireless_dev *wdev = info->user_ptr[1]; 7851 7852 if (!rdev->ops->abort_scan) 7853 return -EOPNOTSUPP; 7854 7855 if (rdev->scan_msg) 7856 return 0; 7857 7858 if (!rdev->scan_req) 7859 return -ENOENT; 7860 7861 rdev_abort_scan(rdev, wdev); 7862 return 0; 7863 } 7864 7865 static int 7866 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans, 7867 struct cfg80211_sched_scan_request *request, 7868 struct nlattr **attrs) 7869 { 7870 int tmp, err, i = 0; 7871 struct nlattr *attr; 7872 7873 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 7874 u32 interval; 7875 7876 /* 7877 * If scan plans are not specified, 7878 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this 7879 * case one scan plan will be set with the specified scan 7880 * interval and infinite number of iterations. 7881 */ 7882 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]); 7883 if (!interval) 7884 return -EINVAL; 7885 7886 request->scan_plans[0].interval = 7887 DIV_ROUND_UP(interval, MSEC_PER_SEC); 7888 if (!request->scan_plans[0].interval) 7889 return -EINVAL; 7890 7891 if (request->scan_plans[0].interval > 7892 wiphy->max_sched_scan_plan_interval) 7893 request->scan_plans[0].interval = 7894 wiphy->max_sched_scan_plan_interval; 7895 7896 return 0; 7897 } 7898 7899 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) { 7900 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1]; 7901 7902 if (WARN_ON(i >= n_plans)) 7903 return -EINVAL; 7904 7905 err = nla_parse_nested_deprecated(plan, 7906 NL80211_SCHED_SCAN_PLAN_MAX, 7907 attr, nl80211_plan_policy, 7908 NULL); 7909 if (err) 7910 return err; 7911 7912 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]) 7913 return -EINVAL; 7914 7915 request->scan_plans[i].interval = 7916 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]); 7917 if (!request->scan_plans[i].interval || 7918 request->scan_plans[i].interval > 7919 wiphy->max_sched_scan_plan_interval) 7920 return -EINVAL; 7921 7922 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) { 7923 request->scan_plans[i].iterations = 7924 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]); 7925 if (!request->scan_plans[i].iterations || 7926 (request->scan_plans[i].iterations > 7927 wiphy->max_sched_scan_plan_iterations)) 7928 return -EINVAL; 7929 } else if (i < n_plans - 1) { 7930 /* 7931 * All scan plans but the last one must specify 7932 * a finite number of iterations 7933 */ 7934 return -EINVAL; 7935 } 7936 7937 i++; 7938 } 7939 7940 /* 7941 * The last scan plan must not specify the number of 7942 * iterations, it is supposed to run infinitely 7943 */ 7944 if (request->scan_plans[n_plans - 1].iterations) 7945 return -EINVAL; 7946 7947 return 0; 7948 } 7949 7950 static int 7951 nl80211_parse_sched_scan_per_band_rssi(struct wiphy *wiphy, 7952 struct cfg80211_match_set *match_sets, 7953 struct nlattr *tb_band_rssi, 7954 s32 rssi_thold) 7955 { 7956 struct nlattr *attr; 7957 int i, tmp, ret = 0; 7958 7959 if (!wiphy_ext_feature_isset(wiphy, 7960 NL80211_EXT_FEATURE_SCHED_SCAN_BAND_SPECIFIC_RSSI_THOLD)) { 7961 if (tb_band_rssi) 7962 ret = -EOPNOTSUPP; 7963 else 7964 for (i = 0; i < NUM_NL80211_BANDS; i++) 7965 match_sets->per_band_rssi_thold[i] = 7966 NL80211_SCAN_RSSI_THOLD_OFF; 7967 return ret; 7968 } 7969 7970 for (i = 0; i < NUM_NL80211_BANDS; i++) 7971 match_sets->per_band_rssi_thold[i] = rssi_thold; 7972 7973 nla_for_each_nested(attr, tb_band_rssi, tmp) { 7974 enum nl80211_band band = nla_type(attr); 7975 7976 if (band < 0 || band >= NUM_NL80211_BANDS) 7977 return -EINVAL; 7978 7979 match_sets->per_band_rssi_thold[band] = nla_get_s32(attr); 7980 } 7981 7982 return 0; 7983 } 7984 7985 static struct cfg80211_sched_scan_request * 7986 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev, 7987 struct nlattr **attrs, int max_match_sets) 7988 { 7989 struct cfg80211_sched_scan_request *request; 7990 struct nlattr *attr; 7991 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0; 7992 enum nl80211_band band; 7993 size_t ie_len; 7994 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1]; 7995 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF; 7996 7997 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 7998 n_channels = validate_scan_freqs( 7999 attrs[NL80211_ATTR_SCAN_FREQUENCIES]); 8000 if (!n_channels) 8001 return ERR_PTR(-EINVAL); 8002 } else { 8003 n_channels = ieee80211_get_num_supported_channels(wiphy); 8004 } 8005 8006 if (attrs[NL80211_ATTR_SCAN_SSIDS]) 8007 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 8008 tmp) 8009 n_ssids++; 8010 8011 if (n_ssids > wiphy->max_sched_scan_ssids) 8012 return ERR_PTR(-EINVAL); 8013 8014 /* 8015 * First, count the number of 'real' matchsets. Due to an issue with 8016 * the old implementation, matchsets containing only the RSSI attribute 8017 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default' 8018 * RSSI for all matchsets, rather than their own matchset for reporting 8019 * all APs with a strong RSSI. This is needed to be compatible with 8020 * older userspace that treated a matchset with only the RSSI as the 8021 * global RSSI for all other matchsets - if there are other matchsets. 8022 */ 8023 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 8024 nla_for_each_nested(attr, 8025 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 8026 tmp) { 8027 struct nlattr *rssi; 8028 8029 err = nla_parse_nested_deprecated(tb, 8030 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 8031 attr, 8032 nl80211_match_policy, 8033 NULL); 8034 if (err) 8035 return ERR_PTR(err); 8036 8037 /* SSID and BSSID are mutually exclusive */ 8038 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] && 8039 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) 8040 return ERR_PTR(-EINVAL); 8041 8042 /* add other standalone attributes here */ 8043 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] || 8044 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) { 8045 n_match_sets++; 8046 continue; 8047 } 8048 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 8049 if (rssi) 8050 default_match_rssi = nla_get_s32(rssi); 8051 } 8052 } 8053 8054 /* However, if there's no other matchset, add the RSSI one */ 8055 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF) 8056 n_match_sets = 1; 8057 8058 if (n_match_sets > max_match_sets) 8059 return ERR_PTR(-EINVAL); 8060 8061 if (attrs[NL80211_ATTR_IE]) 8062 ie_len = nla_len(attrs[NL80211_ATTR_IE]); 8063 else 8064 ie_len = 0; 8065 8066 if (ie_len > wiphy->max_sched_scan_ie_len) 8067 return ERR_PTR(-EINVAL); 8068 8069 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 8070 /* 8071 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since 8072 * each scan plan already specifies its own interval 8073 */ 8074 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 8075 return ERR_PTR(-EINVAL); 8076 8077 nla_for_each_nested(attr, 8078 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) 8079 n_plans++; 8080 } else { 8081 /* 8082 * The scan interval attribute is kept for backward 8083 * compatibility. If no scan plans are specified and sched scan 8084 * interval is specified, one scan plan will be set with this 8085 * scan interval and infinite number of iterations. 8086 */ 8087 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 8088 return ERR_PTR(-EINVAL); 8089 8090 n_plans = 1; 8091 } 8092 8093 if (!n_plans || n_plans > wiphy->max_sched_scan_plans) 8094 return ERR_PTR(-EINVAL); 8095 8096 if (!wiphy_ext_feature_isset( 8097 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) && 8098 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] || 8099 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST])) 8100 return ERR_PTR(-EINVAL); 8101 8102 request = kzalloc(sizeof(*request) 8103 + sizeof(*request->ssids) * n_ssids 8104 + sizeof(*request->match_sets) * n_match_sets 8105 + sizeof(*request->scan_plans) * n_plans 8106 + sizeof(*request->channels) * n_channels 8107 + ie_len, GFP_KERNEL); 8108 if (!request) 8109 return ERR_PTR(-ENOMEM); 8110 8111 if (n_ssids) 8112 request->ssids = (void *)&request->channels[n_channels]; 8113 request->n_ssids = n_ssids; 8114 if (ie_len) { 8115 if (n_ssids) 8116 request->ie = (void *)(request->ssids + n_ssids); 8117 else 8118 request->ie = (void *)(request->channels + n_channels); 8119 } 8120 8121 if (n_match_sets) { 8122 if (request->ie) 8123 request->match_sets = (void *)(request->ie + ie_len); 8124 else if (n_ssids) 8125 request->match_sets = 8126 (void *)(request->ssids + n_ssids); 8127 else 8128 request->match_sets = 8129 (void *)(request->channels + n_channels); 8130 } 8131 request->n_match_sets = n_match_sets; 8132 8133 if (n_match_sets) 8134 request->scan_plans = (void *)(request->match_sets + 8135 n_match_sets); 8136 else if (request->ie) 8137 request->scan_plans = (void *)(request->ie + ie_len); 8138 else if (n_ssids) 8139 request->scan_plans = (void *)(request->ssids + n_ssids); 8140 else 8141 request->scan_plans = (void *)(request->channels + n_channels); 8142 8143 request->n_scan_plans = n_plans; 8144 8145 i = 0; 8146 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 8147 /* user specified, bail out if channel not found */ 8148 nla_for_each_nested(attr, 8149 attrs[NL80211_ATTR_SCAN_FREQUENCIES], 8150 tmp) { 8151 struct ieee80211_channel *chan; 8152 8153 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr)); 8154 8155 if (!chan) { 8156 err = -EINVAL; 8157 goto out_free; 8158 } 8159 8160 /* ignore disabled channels */ 8161 if (chan->flags & IEEE80211_CHAN_DISABLED) 8162 continue; 8163 8164 request->channels[i] = chan; 8165 i++; 8166 } 8167 } else { 8168 /* all channels */ 8169 for (band = 0; band < NUM_NL80211_BANDS; band++) { 8170 int j; 8171 8172 if (!wiphy->bands[band]) 8173 continue; 8174 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 8175 struct ieee80211_channel *chan; 8176 8177 chan = &wiphy->bands[band]->channels[j]; 8178 8179 if (chan->flags & IEEE80211_CHAN_DISABLED) 8180 continue; 8181 8182 request->channels[i] = chan; 8183 i++; 8184 } 8185 } 8186 } 8187 8188 if (!i) { 8189 err = -EINVAL; 8190 goto out_free; 8191 } 8192 8193 request->n_channels = i; 8194 8195 i = 0; 8196 if (n_ssids) { 8197 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 8198 tmp) { 8199 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 8200 err = -EINVAL; 8201 goto out_free; 8202 } 8203 request->ssids[i].ssid_len = nla_len(attr); 8204 memcpy(request->ssids[i].ssid, nla_data(attr), 8205 nla_len(attr)); 8206 i++; 8207 } 8208 } 8209 8210 i = 0; 8211 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 8212 nla_for_each_nested(attr, 8213 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 8214 tmp) { 8215 struct nlattr *ssid, *bssid, *rssi; 8216 8217 err = nla_parse_nested_deprecated(tb, 8218 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 8219 attr, 8220 nl80211_match_policy, 8221 NULL); 8222 if (err) 8223 goto out_free; 8224 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]; 8225 bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]; 8226 8227 if (!ssid && !bssid) { 8228 i++; 8229 continue; 8230 } 8231 8232 if (WARN_ON(i >= n_match_sets)) { 8233 /* this indicates a programming error, 8234 * the loop above should have verified 8235 * things properly 8236 */ 8237 err = -EINVAL; 8238 goto out_free; 8239 } 8240 8241 if (ssid) { 8242 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) { 8243 err = -EINVAL; 8244 goto out_free; 8245 } 8246 memcpy(request->match_sets[i].ssid.ssid, 8247 nla_data(ssid), nla_len(ssid)); 8248 request->match_sets[i].ssid.ssid_len = 8249 nla_len(ssid); 8250 } 8251 if (bssid) { 8252 if (nla_len(bssid) != ETH_ALEN) { 8253 err = -EINVAL; 8254 goto out_free; 8255 } 8256 memcpy(request->match_sets[i].bssid, 8257 nla_data(bssid), ETH_ALEN); 8258 } 8259 8260 /* special attribute - old implementation w/a */ 8261 request->match_sets[i].rssi_thold = default_match_rssi; 8262 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 8263 if (rssi) 8264 request->match_sets[i].rssi_thold = 8265 nla_get_s32(rssi); 8266 8267 /* Parse per band RSSI attribute */ 8268 err = nl80211_parse_sched_scan_per_band_rssi(wiphy, 8269 &request->match_sets[i], 8270 tb[NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI], 8271 request->match_sets[i].rssi_thold); 8272 if (err) 8273 goto out_free; 8274 8275 i++; 8276 } 8277 8278 /* there was no other matchset, so the RSSI one is alone */ 8279 if (i == 0 && n_match_sets) 8280 request->match_sets[0].rssi_thold = default_match_rssi; 8281 8282 request->min_rssi_thold = INT_MAX; 8283 for (i = 0; i < n_match_sets; i++) 8284 request->min_rssi_thold = 8285 min(request->match_sets[i].rssi_thold, 8286 request->min_rssi_thold); 8287 } else { 8288 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF; 8289 } 8290 8291 if (ie_len) { 8292 request->ie_len = ie_len; 8293 memcpy((void *)request->ie, 8294 nla_data(attrs[NL80211_ATTR_IE]), 8295 request->ie_len); 8296 } 8297 8298 err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true); 8299 if (err) 8300 goto out_free; 8301 8302 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY]) 8303 request->delay = 8304 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]); 8305 8306 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) { 8307 request->relative_rssi = nla_get_s8( 8308 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]); 8309 request->relative_rssi_set = true; 8310 } 8311 8312 if (request->relative_rssi_set && 8313 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) { 8314 struct nl80211_bss_select_rssi_adjust *rssi_adjust; 8315 8316 rssi_adjust = nla_data( 8317 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]); 8318 request->rssi_adjust.band = rssi_adjust->band; 8319 request->rssi_adjust.delta = rssi_adjust->delta; 8320 if (!is_band_valid(wiphy, request->rssi_adjust.band)) { 8321 err = -EINVAL; 8322 goto out_free; 8323 } 8324 } 8325 8326 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs); 8327 if (err) 8328 goto out_free; 8329 8330 request->scan_start = jiffies; 8331 8332 return request; 8333 8334 out_free: 8335 kfree(request); 8336 return ERR_PTR(err); 8337 } 8338 8339 static int nl80211_start_sched_scan(struct sk_buff *skb, 8340 struct genl_info *info) 8341 { 8342 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8343 struct net_device *dev = info->user_ptr[1]; 8344 struct wireless_dev *wdev = dev->ieee80211_ptr; 8345 struct cfg80211_sched_scan_request *sched_scan_req; 8346 bool want_multi; 8347 int err; 8348 8349 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start) 8350 return -EOPNOTSUPP; 8351 8352 want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI]; 8353 err = cfg80211_sched_scan_req_possible(rdev, want_multi); 8354 if (err) 8355 return err; 8356 8357 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev, 8358 info->attrs, 8359 rdev->wiphy.max_match_sets); 8360 8361 err = PTR_ERR_OR_ZERO(sched_scan_req); 8362 if (err) 8363 goto out_err; 8364 8365 /* leave request id zero for legacy request 8366 * or if driver does not support multi-scheduled scan 8367 */ 8368 if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) 8369 sched_scan_req->reqid = cfg80211_assign_cookie(rdev); 8370 8371 err = rdev_sched_scan_start(rdev, dev, sched_scan_req); 8372 if (err) 8373 goto out_free; 8374 8375 sched_scan_req->dev = dev; 8376 sched_scan_req->wiphy = &rdev->wiphy; 8377 8378 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 8379 sched_scan_req->owner_nlportid = info->snd_portid; 8380 8381 cfg80211_add_sched_scan_req(rdev, sched_scan_req); 8382 8383 nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN); 8384 return 0; 8385 8386 out_free: 8387 kfree(sched_scan_req); 8388 out_err: 8389 return err; 8390 } 8391 8392 static int nl80211_stop_sched_scan(struct sk_buff *skb, 8393 struct genl_info *info) 8394 { 8395 struct cfg80211_sched_scan_request *req; 8396 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8397 u64 cookie; 8398 8399 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop) 8400 return -EOPNOTSUPP; 8401 8402 if (info->attrs[NL80211_ATTR_COOKIE]) { 8403 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 8404 return __cfg80211_stop_sched_scan(rdev, cookie, false); 8405 } 8406 8407 req = list_first_or_null_rcu(&rdev->sched_scan_req_list, 8408 struct cfg80211_sched_scan_request, 8409 list); 8410 if (!req || req->reqid || 8411 (req->owner_nlportid && 8412 req->owner_nlportid != info->snd_portid)) 8413 return -ENOENT; 8414 8415 return cfg80211_stop_sched_scan_req(rdev, req, false); 8416 } 8417 8418 static int nl80211_start_radar_detection(struct sk_buff *skb, 8419 struct genl_info *info) 8420 { 8421 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8422 struct net_device *dev = info->user_ptr[1]; 8423 struct wireless_dev *wdev = dev->ieee80211_ptr; 8424 struct wiphy *wiphy = wdev->wiphy; 8425 struct cfg80211_chan_def chandef; 8426 enum nl80211_dfs_regions dfs_region; 8427 unsigned int cac_time_ms; 8428 int err; 8429 8430 dfs_region = reg_get_dfs_region(wiphy); 8431 if (dfs_region == NL80211_DFS_UNSET) 8432 return -EINVAL; 8433 8434 err = nl80211_parse_chandef(rdev, info, &chandef); 8435 if (err) 8436 return err; 8437 8438 if (netif_carrier_ok(dev)) 8439 return -EBUSY; 8440 8441 if (wdev->cac_started) 8442 return -EBUSY; 8443 8444 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 8445 if (err < 0) 8446 return err; 8447 8448 if (err == 0) 8449 return -EINVAL; 8450 8451 if (!cfg80211_chandef_dfs_usable(wiphy, &chandef)) 8452 return -EINVAL; 8453 8454 /* CAC start is offloaded to HW and can't be started manually */ 8455 if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD)) 8456 return -EOPNOTSUPP; 8457 8458 if (!rdev->ops->start_radar_detection) 8459 return -EOPNOTSUPP; 8460 8461 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef); 8462 if (WARN_ON(!cac_time_ms)) 8463 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS; 8464 8465 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms); 8466 if (!err) { 8467 wdev->chandef = chandef; 8468 wdev->cac_started = true; 8469 wdev->cac_start_time = jiffies; 8470 wdev->cac_time_ms = cac_time_ms; 8471 } 8472 return err; 8473 } 8474 8475 static int nl80211_notify_radar_detection(struct sk_buff *skb, 8476 struct genl_info *info) 8477 { 8478 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8479 struct net_device *dev = info->user_ptr[1]; 8480 struct wireless_dev *wdev = dev->ieee80211_ptr; 8481 struct wiphy *wiphy = wdev->wiphy; 8482 struct cfg80211_chan_def chandef; 8483 enum nl80211_dfs_regions dfs_region; 8484 int err; 8485 8486 dfs_region = reg_get_dfs_region(wiphy); 8487 if (dfs_region == NL80211_DFS_UNSET) { 8488 GENL_SET_ERR_MSG(info, 8489 "DFS Region is not set. Unexpected Radar indication"); 8490 return -EINVAL; 8491 } 8492 8493 err = nl80211_parse_chandef(rdev, info, &chandef); 8494 if (err) { 8495 GENL_SET_ERR_MSG(info, "Unable to extract chandef info"); 8496 return err; 8497 } 8498 8499 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 8500 if (err < 0) { 8501 GENL_SET_ERR_MSG(info, "chandef is invalid"); 8502 return err; 8503 } 8504 8505 if (err == 0) { 8506 GENL_SET_ERR_MSG(info, 8507 "Unexpected Radar indication for chandef/iftype"); 8508 return -EINVAL; 8509 } 8510 8511 /* Do not process this notification if radar is already detected 8512 * by kernel on this channel, and return success. 8513 */ 8514 if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE) 8515 return 0; 8516 8517 cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE); 8518 8519 cfg80211_sched_dfs_chan_update(rdev); 8520 8521 rdev->radar_chandef = chandef; 8522 8523 /* Propagate this notification to other radios as well */ 8524 queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk); 8525 8526 return 0; 8527 } 8528 8529 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info) 8530 { 8531 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8532 struct net_device *dev = info->user_ptr[1]; 8533 struct wireless_dev *wdev = dev->ieee80211_ptr; 8534 struct cfg80211_csa_settings params; 8535 /* csa_attrs is defined static to avoid waste of stack size - this 8536 * function is called under RTNL lock, so this should not be a problem. 8537 */ 8538 static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1]; 8539 int err; 8540 bool need_new_beacon = false; 8541 bool need_handle_dfs_flag = true; 8542 int len, i; 8543 u32 cs_count; 8544 8545 if (!rdev->ops->channel_switch || 8546 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)) 8547 return -EOPNOTSUPP; 8548 8549 switch (dev->ieee80211_ptr->iftype) { 8550 case NL80211_IFTYPE_AP: 8551 case NL80211_IFTYPE_P2P_GO: 8552 need_new_beacon = true; 8553 /* For all modes except AP the handle_dfs flag needs to be 8554 * supplied to tell the kernel that userspace will handle radar 8555 * events when they happen. Otherwise a switch to a channel 8556 * requiring DFS will be rejected. 8557 */ 8558 need_handle_dfs_flag = false; 8559 8560 /* useless if AP is not running */ 8561 if (!wdev->beacon_interval) 8562 return -ENOTCONN; 8563 break; 8564 case NL80211_IFTYPE_ADHOC: 8565 if (!wdev->ssid_len) 8566 return -ENOTCONN; 8567 break; 8568 case NL80211_IFTYPE_MESH_POINT: 8569 if (!wdev->mesh_id_len) 8570 return -ENOTCONN; 8571 break; 8572 default: 8573 return -EOPNOTSUPP; 8574 } 8575 8576 memset(¶ms, 0, sizeof(params)); 8577 params.beacon_csa.ftm_responder = -1; 8578 8579 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 8580 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]) 8581 return -EINVAL; 8582 8583 /* only important for AP, IBSS and mesh create IEs internally */ 8584 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES]) 8585 return -EINVAL; 8586 8587 /* Even though the attribute is u32, the specification says 8588 * u8, so let's make sure we don't overflow. 8589 */ 8590 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]); 8591 if (cs_count > 255) 8592 return -EINVAL; 8593 8594 params.count = cs_count; 8595 8596 if (!need_new_beacon) 8597 goto skip_beacons; 8598 8599 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_after); 8600 if (err) 8601 return err; 8602 8603 err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX, 8604 info->attrs[NL80211_ATTR_CSA_IES], 8605 nl80211_policy, info->extack); 8606 if (err) 8607 return err; 8608 8609 err = nl80211_parse_beacon(rdev, csa_attrs, ¶ms.beacon_csa); 8610 if (err) 8611 return err; 8612 8613 if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]) 8614 return -EINVAL; 8615 8616 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]); 8617 if (!len || (len % sizeof(u16))) 8618 return -EINVAL; 8619 8620 params.n_counter_offsets_beacon = len / sizeof(u16); 8621 if (rdev->wiphy.max_num_csa_counters && 8622 (params.n_counter_offsets_beacon > 8623 rdev->wiphy.max_num_csa_counters)) 8624 return -EINVAL; 8625 8626 params.counter_offsets_beacon = 8627 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]); 8628 8629 /* sanity checks - counters should fit and be the same */ 8630 for (i = 0; i < params.n_counter_offsets_beacon; i++) { 8631 u16 offset = params.counter_offsets_beacon[i]; 8632 8633 if (offset >= params.beacon_csa.tail_len) 8634 return -EINVAL; 8635 8636 if (params.beacon_csa.tail[offset] != params.count) 8637 return -EINVAL; 8638 } 8639 8640 if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) { 8641 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]); 8642 if (!len || (len % sizeof(u16))) 8643 return -EINVAL; 8644 8645 params.n_counter_offsets_presp = len / sizeof(u16); 8646 if (rdev->wiphy.max_num_csa_counters && 8647 (params.n_counter_offsets_presp > 8648 rdev->wiphy.max_num_csa_counters)) 8649 return -EINVAL; 8650 8651 params.counter_offsets_presp = 8652 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]); 8653 8654 /* sanity checks - counters should fit and be the same */ 8655 for (i = 0; i < params.n_counter_offsets_presp; i++) { 8656 u16 offset = params.counter_offsets_presp[i]; 8657 8658 if (offset >= params.beacon_csa.probe_resp_len) 8659 return -EINVAL; 8660 8661 if (params.beacon_csa.probe_resp[offset] != 8662 params.count) 8663 return -EINVAL; 8664 } 8665 } 8666 8667 skip_beacons: 8668 err = nl80211_parse_chandef(rdev, info, ¶ms.chandef); 8669 if (err) 8670 return err; 8671 8672 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms.chandef, 8673 wdev->iftype)) 8674 return -EINVAL; 8675 8676 err = cfg80211_chandef_dfs_required(wdev->wiphy, 8677 ¶ms.chandef, 8678 wdev->iftype); 8679 if (err < 0) 8680 return err; 8681 8682 if (err > 0) { 8683 params.radar_required = true; 8684 if (need_handle_dfs_flag && 8685 !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) { 8686 return -EINVAL; 8687 } 8688 } 8689 8690 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX]) 8691 params.block_tx = true; 8692 8693 wdev_lock(wdev); 8694 err = rdev_channel_switch(rdev, dev, ¶ms); 8695 wdev_unlock(wdev); 8696 8697 return err; 8698 } 8699 8700 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb, 8701 u32 seq, int flags, 8702 struct cfg80211_registered_device *rdev, 8703 struct wireless_dev *wdev, 8704 struct cfg80211_internal_bss *intbss) 8705 { 8706 struct cfg80211_bss *res = &intbss->pub; 8707 const struct cfg80211_bss_ies *ies; 8708 void *hdr; 8709 struct nlattr *bss; 8710 8711 ASSERT_WDEV_LOCK(wdev); 8712 8713 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 8714 NL80211_CMD_NEW_SCAN_RESULTS); 8715 if (!hdr) 8716 return -1; 8717 8718 genl_dump_check_consistent(cb, hdr); 8719 8720 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation)) 8721 goto nla_put_failure; 8722 if (wdev->netdev && 8723 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex)) 8724 goto nla_put_failure; 8725 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 8726 NL80211_ATTR_PAD)) 8727 goto nla_put_failure; 8728 8729 bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS); 8730 if (!bss) 8731 goto nla_put_failure; 8732 if ((!is_zero_ether_addr(res->bssid) && 8733 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid))) 8734 goto nla_put_failure; 8735 8736 rcu_read_lock(); 8737 /* indicate whether we have probe response data or not */ 8738 if (rcu_access_pointer(res->proberesp_ies) && 8739 nla_put_flag(msg, NL80211_BSS_PRESP_DATA)) 8740 goto fail_unlock_rcu; 8741 8742 /* this pointer prefers to be pointed to probe response data 8743 * but is always valid 8744 */ 8745 ies = rcu_dereference(res->ies); 8746 if (ies) { 8747 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf, 8748 NL80211_BSS_PAD)) 8749 goto fail_unlock_rcu; 8750 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS, 8751 ies->len, ies->data)) 8752 goto fail_unlock_rcu; 8753 } 8754 8755 /* and this pointer is always (unless driver didn't know) beacon data */ 8756 ies = rcu_dereference(res->beacon_ies); 8757 if (ies && ies->from_beacon) { 8758 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf, 8759 NL80211_BSS_PAD)) 8760 goto fail_unlock_rcu; 8761 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES, 8762 ies->len, ies->data)) 8763 goto fail_unlock_rcu; 8764 } 8765 rcu_read_unlock(); 8766 8767 if (res->beacon_interval && 8768 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval)) 8769 goto nla_put_failure; 8770 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) || 8771 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) || 8772 nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) || 8773 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO, 8774 jiffies_to_msecs(jiffies - intbss->ts))) 8775 goto nla_put_failure; 8776 8777 if (intbss->parent_tsf && 8778 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF, 8779 intbss->parent_tsf, NL80211_BSS_PAD) || 8780 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN, 8781 intbss->parent_bssid))) 8782 goto nla_put_failure; 8783 8784 if (intbss->ts_boottime && 8785 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME, 8786 intbss->ts_boottime, NL80211_BSS_PAD)) 8787 goto nla_put_failure; 8788 8789 if (!nl80211_put_signal(msg, intbss->pub.chains, 8790 intbss->pub.chain_signal, 8791 NL80211_BSS_CHAIN_SIGNAL)) 8792 goto nla_put_failure; 8793 8794 switch (rdev->wiphy.signal_type) { 8795 case CFG80211_SIGNAL_TYPE_MBM: 8796 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal)) 8797 goto nla_put_failure; 8798 break; 8799 case CFG80211_SIGNAL_TYPE_UNSPEC: 8800 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal)) 8801 goto nla_put_failure; 8802 break; 8803 default: 8804 break; 8805 } 8806 8807 switch (wdev->iftype) { 8808 case NL80211_IFTYPE_P2P_CLIENT: 8809 case NL80211_IFTYPE_STATION: 8810 if (intbss == wdev->current_bss && 8811 nla_put_u32(msg, NL80211_BSS_STATUS, 8812 NL80211_BSS_STATUS_ASSOCIATED)) 8813 goto nla_put_failure; 8814 break; 8815 case NL80211_IFTYPE_ADHOC: 8816 if (intbss == wdev->current_bss && 8817 nla_put_u32(msg, NL80211_BSS_STATUS, 8818 NL80211_BSS_STATUS_IBSS_JOINED)) 8819 goto nla_put_failure; 8820 break; 8821 default: 8822 break; 8823 } 8824 8825 nla_nest_end(msg, bss); 8826 8827 genlmsg_end(msg, hdr); 8828 return 0; 8829 8830 fail_unlock_rcu: 8831 rcu_read_unlock(); 8832 nla_put_failure: 8833 genlmsg_cancel(msg, hdr); 8834 return -EMSGSIZE; 8835 } 8836 8837 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb) 8838 { 8839 struct cfg80211_registered_device *rdev; 8840 struct cfg80211_internal_bss *scan; 8841 struct wireless_dev *wdev; 8842 int start = cb->args[2], idx = 0; 8843 int err; 8844 8845 rtnl_lock(); 8846 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev); 8847 if (err) { 8848 rtnl_unlock(); 8849 return err; 8850 } 8851 8852 wdev_lock(wdev); 8853 spin_lock_bh(&rdev->bss_lock); 8854 8855 /* 8856 * dump_scan will be called multiple times to break up the scan results 8857 * into multiple messages. It is unlikely that any more bss-es will be 8858 * expired after the first call, so only call only call this on the 8859 * first dump_scan invocation. 8860 */ 8861 if (start == 0) 8862 cfg80211_bss_expire(rdev); 8863 8864 cb->seq = rdev->bss_generation; 8865 8866 list_for_each_entry(scan, &rdev->bss_list, list) { 8867 if (++idx <= start) 8868 continue; 8869 if (nl80211_send_bss(skb, cb, 8870 cb->nlh->nlmsg_seq, NLM_F_MULTI, 8871 rdev, wdev, scan) < 0) { 8872 idx--; 8873 break; 8874 } 8875 } 8876 8877 spin_unlock_bh(&rdev->bss_lock); 8878 wdev_unlock(wdev); 8879 8880 cb->args[2] = idx; 8881 rtnl_unlock(); 8882 8883 return skb->len; 8884 } 8885 8886 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq, 8887 int flags, struct net_device *dev, 8888 bool allow_radio_stats, 8889 struct survey_info *survey) 8890 { 8891 void *hdr; 8892 struct nlattr *infoattr; 8893 8894 /* skip radio stats if userspace didn't request them */ 8895 if (!survey->channel && !allow_radio_stats) 8896 return 0; 8897 8898 hdr = nl80211hdr_put(msg, portid, seq, flags, 8899 NL80211_CMD_NEW_SURVEY_RESULTS); 8900 if (!hdr) 8901 return -ENOMEM; 8902 8903 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 8904 goto nla_put_failure; 8905 8906 infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO); 8907 if (!infoattr) 8908 goto nla_put_failure; 8909 8910 if (survey->channel && 8911 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY, 8912 survey->channel->center_freq)) 8913 goto nla_put_failure; 8914 8915 if ((survey->filled & SURVEY_INFO_NOISE_DBM) && 8916 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise)) 8917 goto nla_put_failure; 8918 if ((survey->filled & SURVEY_INFO_IN_USE) && 8919 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE)) 8920 goto nla_put_failure; 8921 if ((survey->filled & SURVEY_INFO_TIME) && 8922 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME, 8923 survey->time, NL80211_SURVEY_INFO_PAD)) 8924 goto nla_put_failure; 8925 if ((survey->filled & SURVEY_INFO_TIME_BUSY) && 8926 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY, 8927 survey->time_busy, NL80211_SURVEY_INFO_PAD)) 8928 goto nla_put_failure; 8929 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) && 8930 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY, 8931 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD)) 8932 goto nla_put_failure; 8933 if ((survey->filled & SURVEY_INFO_TIME_RX) && 8934 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX, 8935 survey->time_rx, NL80211_SURVEY_INFO_PAD)) 8936 goto nla_put_failure; 8937 if ((survey->filled & SURVEY_INFO_TIME_TX) && 8938 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX, 8939 survey->time_tx, NL80211_SURVEY_INFO_PAD)) 8940 goto nla_put_failure; 8941 if ((survey->filled & SURVEY_INFO_TIME_SCAN) && 8942 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN, 8943 survey->time_scan, NL80211_SURVEY_INFO_PAD)) 8944 goto nla_put_failure; 8945 if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) && 8946 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX, 8947 survey->time_bss_rx, NL80211_SURVEY_INFO_PAD)) 8948 goto nla_put_failure; 8949 8950 nla_nest_end(msg, infoattr); 8951 8952 genlmsg_end(msg, hdr); 8953 return 0; 8954 8955 nla_put_failure: 8956 genlmsg_cancel(msg, hdr); 8957 return -EMSGSIZE; 8958 } 8959 8960 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb) 8961 { 8962 struct nlattr **attrbuf; 8963 struct survey_info survey; 8964 struct cfg80211_registered_device *rdev; 8965 struct wireless_dev *wdev; 8966 int survey_idx = cb->args[2]; 8967 int res; 8968 bool radio_stats; 8969 8970 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 8971 if (!attrbuf) 8972 return -ENOMEM; 8973 8974 rtnl_lock(); 8975 res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev); 8976 if (res) 8977 goto out_err; 8978 8979 /* prepare_wdev_dump parsed the attributes */ 8980 radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS]; 8981 8982 if (!wdev->netdev) { 8983 res = -EINVAL; 8984 goto out_err; 8985 } 8986 8987 if (!rdev->ops->dump_survey) { 8988 res = -EOPNOTSUPP; 8989 goto out_err; 8990 } 8991 8992 while (1) { 8993 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey); 8994 if (res == -ENOENT) 8995 break; 8996 if (res) 8997 goto out_err; 8998 8999 /* don't send disabled channels, but do send non-channel data */ 9000 if (survey.channel && 9001 survey.channel->flags & IEEE80211_CHAN_DISABLED) { 9002 survey_idx++; 9003 continue; 9004 } 9005 9006 if (nl80211_send_survey(skb, 9007 NETLINK_CB(cb->skb).portid, 9008 cb->nlh->nlmsg_seq, NLM_F_MULTI, 9009 wdev->netdev, radio_stats, &survey) < 0) 9010 goto out; 9011 survey_idx++; 9012 } 9013 9014 out: 9015 cb->args[2] = survey_idx; 9016 res = skb->len; 9017 out_err: 9018 kfree(attrbuf); 9019 rtnl_unlock(); 9020 return res; 9021 } 9022 9023 static bool nl80211_valid_wpa_versions(u32 wpa_versions) 9024 { 9025 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 | 9026 NL80211_WPA_VERSION_2 | 9027 NL80211_WPA_VERSION_3)); 9028 } 9029 9030 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info) 9031 { 9032 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9033 struct net_device *dev = info->user_ptr[1]; 9034 struct ieee80211_channel *chan; 9035 const u8 *bssid, *ssid, *ie = NULL, *auth_data = NULL; 9036 int err, ssid_len, ie_len = 0, auth_data_len = 0; 9037 enum nl80211_auth_type auth_type; 9038 struct key_parse key; 9039 bool local_state_change; 9040 9041 if (!info->attrs[NL80211_ATTR_MAC]) 9042 return -EINVAL; 9043 9044 if (!info->attrs[NL80211_ATTR_AUTH_TYPE]) 9045 return -EINVAL; 9046 9047 if (!info->attrs[NL80211_ATTR_SSID]) 9048 return -EINVAL; 9049 9050 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 9051 return -EINVAL; 9052 9053 err = nl80211_parse_key(info, &key); 9054 if (err) 9055 return err; 9056 9057 if (key.idx >= 0) { 9058 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP) 9059 return -EINVAL; 9060 if (!key.p.key || !key.p.key_len) 9061 return -EINVAL; 9062 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 || 9063 key.p.key_len != WLAN_KEY_LEN_WEP40) && 9064 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 || 9065 key.p.key_len != WLAN_KEY_LEN_WEP104)) 9066 return -EINVAL; 9067 if (key.idx > 3) 9068 return -EINVAL; 9069 } else { 9070 key.p.key_len = 0; 9071 key.p.key = NULL; 9072 } 9073 9074 if (key.idx >= 0) { 9075 int i; 9076 bool ok = false; 9077 9078 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) { 9079 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) { 9080 ok = true; 9081 break; 9082 } 9083 } 9084 if (!ok) 9085 return -EINVAL; 9086 } 9087 9088 if (!rdev->ops->auth) 9089 return -EOPNOTSUPP; 9090 9091 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 9092 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 9093 return -EOPNOTSUPP; 9094 9095 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 9096 chan = nl80211_get_valid_chan(&rdev->wiphy, 9097 info->attrs[NL80211_ATTR_WIPHY_FREQ]); 9098 if (!chan) 9099 return -EINVAL; 9100 9101 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 9102 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 9103 9104 if (info->attrs[NL80211_ATTR_IE]) { 9105 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 9106 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9107 } 9108 9109 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 9110 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE)) 9111 return -EINVAL; 9112 9113 if ((auth_type == NL80211_AUTHTYPE_SAE || 9114 auth_type == NL80211_AUTHTYPE_FILS_SK || 9115 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 9116 auth_type == NL80211_AUTHTYPE_FILS_PK) && 9117 !info->attrs[NL80211_ATTR_AUTH_DATA]) 9118 return -EINVAL; 9119 9120 if (info->attrs[NL80211_ATTR_AUTH_DATA]) { 9121 if (auth_type != NL80211_AUTHTYPE_SAE && 9122 auth_type != NL80211_AUTHTYPE_FILS_SK && 9123 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS && 9124 auth_type != NL80211_AUTHTYPE_FILS_PK) 9125 return -EINVAL; 9126 auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]); 9127 auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]); 9128 /* need to include at least Auth Transaction and Status Code */ 9129 if (auth_data_len < 4) 9130 return -EINVAL; 9131 } 9132 9133 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 9134 9135 /* 9136 * Since we no longer track auth state, ignore 9137 * requests to only change local state. 9138 */ 9139 if (local_state_change) 9140 return 0; 9141 9142 wdev_lock(dev->ieee80211_ptr); 9143 err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid, 9144 ssid, ssid_len, ie, ie_len, 9145 key.p.key, key.p.key_len, key.idx, 9146 auth_data, auth_data_len); 9147 wdev_unlock(dev->ieee80211_ptr); 9148 return err; 9149 } 9150 9151 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev, 9152 struct genl_info *info) 9153 { 9154 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 9155 GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set"); 9156 return -EINVAL; 9157 } 9158 9159 if (!rdev->ops->tx_control_port || 9160 !wiphy_ext_feature_isset(&rdev->wiphy, 9161 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 9162 return -EOPNOTSUPP; 9163 9164 return 0; 9165 } 9166 9167 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev, 9168 struct genl_info *info, 9169 struct cfg80211_crypto_settings *settings, 9170 int cipher_limit) 9171 { 9172 memset(settings, 0, sizeof(*settings)); 9173 9174 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT]; 9175 9176 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 9177 u16 proto; 9178 9179 proto = nla_get_u16( 9180 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 9181 settings->control_port_ethertype = cpu_to_be16(proto); 9182 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 9183 proto != ETH_P_PAE) 9184 return -EINVAL; 9185 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]) 9186 settings->control_port_no_encrypt = true; 9187 } else 9188 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE); 9189 9190 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 9191 int r = validate_pae_over_nl80211(rdev, info); 9192 9193 if (r < 0) 9194 return r; 9195 9196 settings->control_port_over_nl80211 = true; 9197 } 9198 9199 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) { 9200 void *data; 9201 int len, i; 9202 9203 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 9204 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 9205 settings->n_ciphers_pairwise = len / sizeof(u32); 9206 9207 if (len % sizeof(u32)) 9208 return -EINVAL; 9209 9210 if (settings->n_ciphers_pairwise > cipher_limit) 9211 return -EINVAL; 9212 9213 memcpy(settings->ciphers_pairwise, data, len); 9214 9215 for (i = 0; i < settings->n_ciphers_pairwise; i++) 9216 if (!cfg80211_supported_cipher_suite( 9217 &rdev->wiphy, 9218 settings->ciphers_pairwise[i])) 9219 return -EINVAL; 9220 } 9221 9222 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) { 9223 settings->cipher_group = 9224 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]); 9225 if (!cfg80211_supported_cipher_suite(&rdev->wiphy, 9226 settings->cipher_group)) 9227 return -EINVAL; 9228 } 9229 9230 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) { 9231 settings->wpa_versions = 9232 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]); 9233 if (!nl80211_valid_wpa_versions(settings->wpa_versions)) 9234 return -EINVAL; 9235 } 9236 9237 if (info->attrs[NL80211_ATTR_AKM_SUITES]) { 9238 void *data; 9239 int len; 9240 9241 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]); 9242 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]); 9243 settings->n_akm_suites = len / sizeof(u32); 9244 9245 if (len % sizeof(u32)) 9246 return -EINVAL; 9247 9248 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES) 9249 return -EINVAL; 9250 9251 memcpy(settings->akm_suites, data, len); 9252 } 9253 9254 if (info->attrs[NL80211_ATTR_PMK]) { 9255 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN) 9256 return -EINVAL; 9257 if (!wiphy_ext_feature_isset(&rdev->wiphy, 9258 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK)) 9259 return -EINVAL; 9260 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]); 9261 } 9262 9263 if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) { 9264 if (!wiphy_ext_feature_isset(&rdev->wiphy, 9265 NL80211_EXT_FEATURE_SAE_OFFLOAD)) 9266 return -EINVAL; 9267 settings->sae_pwd = 9268 nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 9269 settings->sae_pwd_len = 9270 nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 9271 } 9272 9273 return 0; 9274 } 9275 9276 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info) 9277 { 9278 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9279 struct net_device *dev = info->user_ptr[1]; 9280 struct ieee80211_channel *chan; 9281 struct cfg80211_assoc_request req = {}; 9282 const u8 *bssid, *ssid; 9283 int err, ssid_len = 0; 9284 9285 if (dev->ieee80211_ptr->conn_owner_nlportid && 9286 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 9287 return -EPERM; 9288 9289 if (!info->attrs[NL80211_ATTR_MAC] || 9290 !info->attrs[NL80211_ATTR_SSID] || 9291 !info->attrs[NL80211_ATTR_WIPHY_FREQ]) 9292 return -EINVAL; 9293 9294 if (!rdev->ops->assoc) 9295 return -EOPNOTSUPP; 9296 9297 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 9298 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 9299 return -EOPNOTSUPP; 9300 9301 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 9302 9303 chan = nl80211_get_valid_chan(&rdev->wiphy, 9304 info->attrs[NL80211_ATTR_WIPHY_FREQ]); 9305 if (!chan) 9306 return -EINVAL; 9307 9308 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 9309 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 9310 9311 if (info->attrs[NL80211_ATTR_IE]) { 9312 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 9313 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9314 } 9315 9316 if (info->attrs[NL80211_ATTR_USE_MFP]) { 9317 enum nl80211_mfp mfp = 9318 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 9319 if (mfp == NL80211_MFP_REQUIRED) 9320 req.use_mfp = true; 9321 else if (mfp != NL80211_MFP_NO) 9322 return -EINVAL; 9323 } 9324 9325 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 9326 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 9327 9328 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 9329 req.flags |= ASSOC_REQ_DISABLE_HT; 9330 9331 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 9332 memcpy(&req.ht_capa_mask, 9333 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 9334 sizeof(req.ht_capa_mask)); 9335 9336 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 9337 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 9338 return -EINVAL; 9339 memcpy(&req.ht_capa, 9340 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 9341 sizeof(req.ht_capa)); 9342 } 9343 9344 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 9345 req.flags |= ASSOC_REQ_DISABLE_VHT; 9346 9347 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 9348 memcpy(&req.vht_capa_mask, 9349 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 9350 sizeof(req.vht_capa_mask)); 9351 9352 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 9353 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 9354 return -EINVAL; 9355 memcpy(&req.vht_capa, 9356 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 9357 sizeof(req.vht_capa)); 9358 } 9359 9360 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 9361 if (!((rdev->wiphy.features & 9362 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 9363 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 9364 !wiphy_ext_feature_isset(&rdev->wiphy, 9365 NL80211_EXT_FEATURE_RRM)) 9366 return -EINVAL; 9367 req.flags |= ASSOC_REQ_USE_RRM; 9368 } 9369 9370 if (info->attrs[NL80211_ATTR_FILS_KEK]) { 9371 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 9372 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 9373 if (!info->attrs[NL80211_ATTR_FILS_NONCES]) 9374 return -EINVAL; 9375 req.fils_nonces = 9376 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 9377 } 9378 9379 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1); 9380 if (!err) { 9381 wdev_lock(dev->ieee80211_ptr); 9382 9383 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid, 9384 ssid, ssid_len, &req); 9385 9386 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 9387 dev->ieee80211_ptr->conn_owner_nlportid = 9388 info->snd_portid; 9389 memcpy(dev->ieee80211_ptr->disconnect_bssid, 9390 bssid, ETH_ALEN); 9391 } 9392 9393 wdev_unlock(dev->ieee80211_ptr); 9394 } 9395 9396 return err; 9397 } 9398 9399 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info) 9400 { 9401 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9402 struct net_device *dev = info->user_ptr[1]; 9403 const u8 *ie = NULL, *bssid; 9404 int ie_len = 0, err; 9405 u16 reason_code; 9406 bool local_state_change; 9407 9408 if (dev->ieee80211_ptr->conn_owner_nlportid && 9409 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 9410 return -EPERM; 9411 9412 if (!info->attrs[NL80211_ATTR_MAC]) 9413 return -EINVAL; 9414 9415 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 9416 return -EINVAL; 9417 9418 if (!rdev->ops->deauth) 9419 return -EOPNOTSUPP; 9420 9421 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 9422 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 9423 return -EOPNOTSUPP; 9424 9425 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 9426 9427 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 9428 if (reason_code == 0) { 9429 /* Reason Code 0 is reserved */ 9430 return -EINVAL; 9431 } 9432 9433 if (info->attrs[NL80211_ATTR_IE]) { 9434 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 9435 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9436 } 9437 9438 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 9439 9440 wdev_lock(dev->ieee80211_ptr); 9441 err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code, 9442 local_state_change); 9443 wdev_unlock(dev->ieee80211_ptr); 9444 return err; 9445 } 9446 9447 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info) 9448 { 9449 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9450 struct net_device *dev = info->user_ptr[1]; 9451 const u8 *ie = NULL, *bssid; 9452 int ie_len = 0, err; 9453 u16 reason_code; 9454 bool local_state_change; 9455 9456 if (dev->ieee80211_ptr->conn_owner_nlportid && 9457 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 9458 return -EPERM; 9459 9460 if (!info->attrs[NL80211_ATTR_MAC]) 9461 return -EINVAL; 9462 9463 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 9464 return -EINVAL; 9465 9466 if (!rdev->ops->disassoc) 9467 return -EOPNOTSUPP; 9468 9469 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 9470 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 9471 return -EOPNOTSUPP; 9472 9473 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 9474 9475 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 9476 if (reason_code == 0) { 9477 /* Reason Code 0 is reserved */ 9478 return -EINVAL; 9479 } 9480 9481 if (info->attrs[NL80211_ATTR_IE]) { 9482 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 9483 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9484 } 9485 9486 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 9487 9488 wdev_lock(dev->ieee80211_ptr); 9489 err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code, 9490 local_state_change); 9491 wdev_unlock(dev->ieee80211_ptr); 9492 return err; 9493 } 9494 9495 static bool 9496 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev, 9497 int mcast_rate[NUM_NL80211_BANDS], 9498 int rateval) 9499 { 9500 struct wiphy *wiphy = &rdev->wiphy; 9501 bool found = false; 9502 int band, i; 9503 9504 for (band = 0; band < NUM_NL80211_BANDS; band++) { 9505 struct ieee80211_supported_band *sband; 9506 9507 sband = wiphy->bands[band]; 9508 if (!sband) 9509 continue; 9510 9511 for (i = 0; i < sband->n_bitrates; i++) { 9512 if (sband->bitrates[i].bitrate == rateval) { 9513 mcast_rate[band] = i + 1; 9514 found = true; 9515 break; 9516 } 9517 } 9518 } 9519 9520 return found; 9521 } 9522 9523 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info) 9524 { 9525 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9526 struct net_device *dev = info->user_ptr[1]; 9527 struct cfg80211_ibss_params ibss; 9528 struct wiphy *wiphy; 9529 struct cfg80211_cached_keys *connkeys = NULL; 9530 int err; 9531 9532 memset(&ibss, 0, sizeof(ibss)); 9533 9534 if (!info->attrs[NL80211_ATTR_SSID] || 9535 !nla_len(info->attrs[NL80211_ATTR_SSID])) 9536 return -EINVAL; 9537 9538 ibss.beacon_interval = 100; 9539 9540 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) 9541 ibss.beacon_interval = 9542 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 9543 9544 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC, 9545 ibss.beacon_interval); 9546 if (err) 9547 return err; 9548 9549 if (!rdev->ops->join_ibss) 9550 return -EOPNOTSUPP; 9551 9552 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 9553 return -EOPNOTSUPP; 9554 9555 wiphy = &rdev->wiphy; 9556 9557 if (info->attrs[NL80211_ATTR_MAC]) { 9558 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 9559 9560 if (!is_valid_ether_addr(ibss.bssid)) 9561 return -EINVAL; 9562 } 9563 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 9564 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 9565 9566 if (info->attrs[NL80211_ATTR_IE]) { 9567 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 9568 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9569 } 9570 9571 err = nl80211_parse_chandef(rdev, info, &ibss.chandef); 9572 if (err) 9573 return err; 9574 9575 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef, 9576 NL80211_IFTYPE_ADHOC)) 9577 return -EINVAL; 9578 9579 switch (ibss.chandef.width) { 9580 case NL80211_CHAN_WIDTH_5: 9581 case NL80211_CHAN_WIDTH_10: 9582 case NL80211_CHAN_WIDTH_20_NOHT: 9583 break; 9584 case NL80211_CHAN_WIDTH_20: 9585 case NL80211_CHAN_WIDTH_40: 9586 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 9587 return -EINVAL; 9588 break; 9589 case NL80211_CHAN_WIDTH_80: 9590 case NL80211_CHAN_WIDTH_80P80: 9591 case NL80211_CHAN_WIDTH_160: 9592 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 9593 return -EINVAL; 9594 if (!wiphy_ext_feature_isset(&rdev->wiphy, 9595 NL80211_EXT_FEATURE_VHT_IBSS)) 9596 return -EINVAL; 9597 break; 9598 default: 9599 return -EINVAL; 9600 } 9601 9602 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED]; 9603 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 9604 9605 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 9606 u8 *rates = 9607 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 9608 int n_rates = 9609 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 9610 struct ieee80211_supported_band *sband = 9611 wiphy->bands[ibss.chandef.chan->band]; 9612 9613 err = ieee80211_get_ratemask(sband, rates, n_rates, 9614 &ibss.basic_rates); 9615 if (err) 9616 return err; 9617 } 9618 9619 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 9620 memcpy(&ibss.ht_capa_mask, 9621 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 9622 sizeof(ibss.ht_capa_mask)); 9623 9624 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 9625 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 9626 return -EINVAL; 9627 memcpy(&ibss.ht_capa, 9628 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 9629 sizeof(ibss.ht_capa)); 9630 } 9631 9632 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 9633 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate, 9634 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 9635 return -EINVAL; 9636 9637 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) { 9638 bool no_ht = false; 9639 9640 connkeys = nl80211_parse_connkeys(rdev, info, &no_ht); 9641 if (IS_ERR(connkeys)) 9642 return PTR_ERR(connkeys); 9643 9644 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) && 9645 no_ht) { 9646 kzfree(connkeys); 9647 return -EINVAL; 9648 } 9649 } 9650 9651 ibss.control_port = 9652 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]); 9653 9654 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 9655 int r = validate_pae_over_nl80211(rdev, info); 9656 9657 if (r < 0) { 9658 kzfree(connkeys); 9659 return r; 9660 } 9661 9662 ibss.control_port_over_nl80211 = true; 9663 } 9664 9665 ibss.userspace_handles_dfs = 9666 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 9667 9668 wdev_lock(dev->ieee80211_ptr); 9669 err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys); 9670 if (err) 9671 kzfree(connkeys); 9672 else if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 9673 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 9674 wdev_unlock(dev->ieee80211_ptr); 9675 9676 return err; 9677 } 9678 9679 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info) 9680 { 9681 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9682 struct net_device *dev = info->user_ptr[1]; 9683 9684 if (!rdev->ops->leave_ibss) 9685 return -EOPNOTSUPP; 9686 9687 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 9688 return -EOPNOTSUPP; 9689 9690 return cfg80211_leave_ibss(rdev, dev, false); 9691 } 9692 9693 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info) 9694 { 9695 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9696 struct net_device *dev = info->user_ptr[1]; 9697 int mcast_rate[NUM_NL80211_BANDS]; 9698 u32 nla_rate; 9699 int err; 9700 9701 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC && 9702 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT && 9703 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB) 9704 return -EOPNOTSUPP; 9705 9706 if (!rdev->ops->set_mcast_rate) 9707 return -EOPNOTSUPP; 9708 9709 memset(mcast_rate, 0, sizeof(mcast_rate)); 9710 9711 if (!info->attrs[NL80211_ATTR_MCAST_RATE]) 9712 return -EINVAL; 9713 9714 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]); 9715 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate)) 9716 return -EINVAL; 9717 9718 err = rdev_set_mcast_rate(rdev, dev, mcast_rate); 9719 9720 return err; 9721 } 9722 9723 static struct sk_buff * 9724 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev, 9725 struct wireless_dev *wdev, int approxlen, 9726 u32 portid, u32 seq, enum nl80211_commands cmd, 9727 enum nl80211_attrs attr, 9728 const struct nl80211_vendor_cmd_info *info, 9729 gfp_t gfp) 9730 { 9731 struct sk_buff *skb; 9732 void *hdr; 9733 struct nlattr *data; 9734 9735 skb = nlmsg_new(approxlen + 100, gfp); 9736 if (!skb) 9737 return NULL; 9738 9739 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd); 9740 if (!hdr) { 9741 kfree_skb(skb); 9742 return NULL; 9743 } 9744 9745 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 9746 goto nla_put_failure; 9747 9748 if (info) { 9749 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID, 9750 info->vendor_id)) 9751 goto nla_put_failure; 9752 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD, 9753 info->subcmd)) 9754 goto nla_put_failure; 9755 } 9756 9757 if (wdev) { 9758 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 9759 wdev_id(wdev), NL80211_ATTR_PAD)) 9760 goto nla_put_failure; 9761 if (wdev->netdev && 9762 nla_put_u32(skb, NL80211_ATTR_IFINDEX, 9763 wdev->netdev->ifindex)) 9764 goto nla_put_failure; 9765 } 9766 9767 data = nla_nest_start_noflag(skb, attr); 9768 if (!data) 9769 goto nla_put_failure; 9770 9771 ((void **)skb->cb)[0] = rdev; 9772 ((void **)skb->cb)[1] = hdr; 9773 ((void **)skb->cb)[2] = data; 9774 9775 return skb; 9776 9777 nla_put_failure: 9778 kfree_skb(skb); 9779 return NULL; 9780 } 9781 9782 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy, 9783 struct wireless_dev *wdev, 9784 enum nl80211_commands cmd, 9785 enum nl80211_attrs attr, 9786 unsigned int portid, 9787 int vendor_event_idx, 9788 int approxlen, gfp_t gfp) 9789 { 9790 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 9791 const struct nl80211_vendor_cmd_info *info; 9792 9793 switch (cmd) { 9794 case NL80211_CMD_TESTMODE: 9795 if (WARN_ON(vendor_event_idx != -1)) 9796 return NULL; 9797 info = NULL; 9798 break; 9799 case NL80211_CMD_VENDOR: 9800 if (WARN_ON(vendor_event_idx < 0 || 9801 vendor_event_idx >= wiphy->n_vendor_events)) 9802 return NULL; 9803 info = &wiphy->vendor_events[vendor_event_idx]; 9804 break; 9805 default: 9806 WARN_ON(1); 9807 return NULL; 9808 } 9809 9810 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0, 9811 cmd, attr, info, gfp); 9812 } 9813 EXPORT_SYMBOL(__cfg80211_alloc_event_skb); 9814 9815 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp) 9816 { 9817 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 9818 void *hdr = ((void **)skb->cb)[1]; 9819 struct nlmsghdr *nlhdr = nlmsg_hdr(skb); 9820 struct nlattr *data = ((void **)skb->cb)[2]; 9821 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE; 9822 9823 /* clear CB data for netlink core to own from now on */ 9824 memset(skb->cb, 0, sizeof(skb->cb)); 9825 9826 nla_nest_end(skb, data); 9827 genlmsg_end(skb, hdr); 9828 9829 if (nlhdr->nlmsg_pid) { 9830 genlmsg_unicast(wiphy_net(&rdev->wiphy), skb, 9831 nlhdr->nlmsg_pid); 9832 } else { 9833 if (data->nla_type == NL80211_ATTR_VENDOR_DATA) 9834 mcgrp = NL80211_MCGRP_VENDOR; 9835 9836 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 9837 skb, 0, mcgrp, gfp); 9838 } 9839 } 9840 EXPORT_SYMBOL(__cfg80211_send_event_skb); 9841 9842 #ifdef CONFIG_NL80211_TESTMODE 9843 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info) 9844 { 9845 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9846 struct wireless_dev *wdev = 9847 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs); 9848 int err; 9849 9850 if (!rdev->ops->testmode_cmd) 9851 return -EOPNOTSUPP; 9852 9853 if (IS_ERR(wdev)) { 9854 err = PTR_ERR(wdev); 9855 if (err != -EINVAL) 9856 return err; 9857 wdev = NULL; 9858 } else if (wdev->wiphy != &rdev->wiphy) { 9859 return -EINVAL; 9860 } 9861 9862 if (!info->attrs[NL80211_ATTR_TESTDATA]) 9863 return -EINVAL; 9864 9865 rdev->cur_cmd_info = info; 9866 err = rdev_testmode_cmd(rdev, wdev, 9867 nla_data(info->attrs[NL80211_ATTR_TESTDATA]), 9868 nla_len(info->attrs[NL80211_ATTR_TESTDATA])); 9869 rdev->cur_cmd_info = NULL; 9870 9871 return err; 9872 } 9873 9874 static int nl80211_testmode_dump(struct sk_buff *skb, 9875 struct netlink_callback *cb) 9876 { 9877 struct cfg80211_registered_device *rdev; 9878 struct nlattr **attrbuf = NULL; 9879 int err; 9880 long phy_idx; 9881 void *data = NULL; 9882 int data_len = 0; 9883 9884 rtnl_lock(); 9885 9886 if (cb->args[0]) { 9887 /* 9888 * 0 is a valid index, but not valid for args[0], 9889 * so we need to offset by 1. 9890 */ 9891 phy_idx = cb->args[0] - 1; 9892 9893 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx); 9894 if (!rdev) { 9895 err = -ENOENT; 9896 goto out_err; 9897 } 9898 } else { 9899 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 9900 GFP_KERNEL); 9901 if (!attrbuf) { 9902 err = -ENOMEM; 9903 goto out_err; 9904 } 9905 9906 err = nlmsg_parse_deprecated(cb->nlh, 9907 GENL_HDRLEN + nl80211_fam.hdrsize, 9908 attrbuf, nl80211_fam.maxattr, 9909 nl80211_policy, NULL); 9910 if (err) 9911 goto out_err; 9912 9913 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 9914 if (IS_ERR(rdev)) { 9915 err = PTR_ERR(rdev); 9916 goto out_err; 9917 } 9918 phy_idx = rdev->wiphy_idx; 9919 9920 if (attrbuf[NL80211_ATTR_TESTDATA]) 9921 cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA]; 9922 } 9923 9924 if (cb->args[1]) { 9925 data = nla_data((void *)cb->args[1]); 9926 data_len = nla_len((void *)cb->args[1]); 9927 } 9928 9929 if (!rdev->ops->testmode_dump) { 9930 err = -EOPNOTSUPP; 9931 goto out_err; 9932 } 9933 9934 while (1) { 9935 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 9936 cb->nlh->nlmsg_seq, NLM_F_MULTI, 9937 NL80211_CMD_TESTMODE); 9938 struct nlattr *tmdata; 9939 9940 if (!hdr) 9941 break; 9942 9943 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) { 9944 genlmsg_cancel(skb, hdr); 9945 break; 9946 } 9947 9948 tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA); 9949 if (!tmdata) { 9950 genlmsg_cancel(skb, hdr); 9951 break; 9952 } 9953 err = rdev_testmode_dump(rdev, skb, cb, data, data_len); 9954 nla_nest_end(skb, tmdata); 9955 9956 if (err == -ENOBUFS || err == -ENOENT) { 9957 genlmsg_cancel(skb, hdr); 9958 break; 9959 } else if (err) { 9960 genlmsg_cancel(skb, hdr); 9961 goto out_err; 9962 } 9963 9964 genlmsg_end(skb, hdr); 9965 } 9966 9967 err = skb->len; 9968 /* see above */ 9969 cb->args[0] = phy_idx + 1; 9970 out_err: 9971 kfree(attrbuf); 9972 rtnl_unlock(); 9973 return err; 9974 } 9975 #endif 9976 9977 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info) 9978 { 9979 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9980 struct net_device *dev = info->user_ptr[1]; 9981 struct cfg80211_connect_params connect; 9982 struct wiphy *wiphy; 9983 struct cfg80211_cached_keys *connkeys = NULL; 9984 int err; 9985 9986 memset(&connect, 0, sizeof(connect)); 9987 9988 if (!info->attrs[NL80211_ATTR_SSID] || 9989 !nla_len(info->attrs[NL80211_ATTR_SSID])) 9990 return -EINVAL; 9991 9992 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 9993 connect.auth_type = 9994 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 9995 if (!nl80211_valid_auth_type(rdev, connect.auth_type, 9996 NL80211_CMD_CONNECT)) 9997 return -EINVAL; 9998 } else 9999 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC; 10000 10001 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY]; 10002 10003 if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] && 10004 !wiphy_ext_feature_isset(&rdev->wiphy, 10005 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 10006 return -EINVAL; 10007 connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS]; 10008 10009 err = nl80211_crypto_settings(rdev, info, &connect.crypto, 10010 NL80211_MAX_NR_CIPHER_SUITES); 10011 if (err) 10012 return err; 10013 10014 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10015 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 10016 return -EOPNOTSUPP; 10017 10018 wiphy = &rdev->wiphy; 10019 10020 connect.bg_scan_period = -1; 10021 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] && 10022 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) { 10023 connect.bg_scan_period = 10024 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]); 10025 } 10026 10027 if (info->attrs[NL80211_ATTR_MAC]) 10028 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 10029 else if (info->attrs[NL80211_ATTR_MAC_HINT]) 10030 connect.bssid_hint = 10031 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]); 10032 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 10033 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 10034 10035 if (info->attrs[NL80211_ATTR_IE]) { 10036 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 10037 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10038 } 10039 10040 if (info->attrs[NL80211_ATTR_USE_MFP]) { 10041 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 10042 if (connect.mfp == NL80211_MFP_OPTIONAL && 10043 !wiphy_ext_feature_isset(&rdev->wiphy, 10044 NL80211_EXT_FEATURE_MFP_OPTIONAL)) 10045 return -EOPNOTSUPP; 10046 } else { 10047 connect.mfp = NL80211_MFP_NO; 10048 } 10049 10050 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 10051 connect.prev_bssid = 10052 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 10053 10054 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 10055 connect.channel = nl80211_get_valid_chan( 10056 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]); 10057 if (!connect.channel) 10058 return -EINVAL; 10059 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) { 10060 connect.channel_hint = nl80211_get_valid_chan( 10061 wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]); 10062 if (!connect.channel_hint) 10063 return -EINVAL; 10064 } 10065 10066 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 10067 connect.edmg.channels = 10068 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 10069 10070 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 10071 connect.edmg.bw_config = 10072 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 10073 } 10074 10075 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) { 10076 connkeys = nl80211_parse_connkeys(rdev, info, NULL); 10077 if (IS_ERR(connkeys)) 10078 return PTR_ERR(connkeys); 10079 } 10080 10081 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 10082 connect.flags |= ASSOC_REQ_DISABLE_HT; 10083 10084 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 10085 memcpy(&connect.ht_capa_mask, 10086 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 10087 sizeof(connect.ht_capa_mask)); 10088 10089 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 10090 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) { 10091 kzfree(connkeys); 10092 return -EINVAL; 10093 } 10094 memcpy(&connect.ht_capa, 10095 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 10096 sizeof(connect.ht_capa)); 10097 } 10098 10099 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 10100 connect.flags |= ASSOC_REQ_DISABLE_VHT; 10101 10102 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 10103 memcpy(&connect.vht_capa_mask, 10104 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 10105 sizeof(connect.vht_capa_mask)); 10106 10107 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 10108 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) { 10109 kzfree(connkeys); 10110 return -EINVAL; 10111 } 10112 memcpy(&connect.vht_capa, 10113 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 10114 sizeof(connect.vht_capa)); 10115 } 10116 10117 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 10118 if (!((rdev->wiphy.features & 10119 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 10120 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 10121 !wiphy_ext_feature_isset(&rdev->wiphy, 10122 NL80211_EXT_FEATURE_RRM)) { 10123 kzfree(connkeys); 10124 return -EINVAL; 10125 } 10126 connect.flags |= ASSOC_REQ_USE_RRM; 10127 } 10128 10129 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 10130 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 10131 kzfree(connkeys); 10132 return -EOPNOTSUPP; 10133 } 10134 10135 if (info->attrs[NL80211_ATTR_BSS_SELECT]) { 10136 /* bss selection makes no sense if bssid is set */ 10137 if (connect.bssid) { 10138 kzfree(connkeys); 10139 return -EINVAL; 10140 } 10141 10142 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT], 10143 wiphy, &connect.bss_select); 10144 if (err) { 10145 kzfree(connkeys); 10146 return err; 10147 } 10148 } 10149 10150 if (wiphy_ext_feature_isset(&rdev->wiphy, 10151 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 10152 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 10153 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 10154 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 10155 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 10156 connect.fils_erp_username = 10157 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 10158 connect.fils_erp_username_len = 10159 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 10160 connect.fils_erp_realm = 10161 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 10162 connect.fils_erp_realm_len = 10163 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 10164 connect.fils_erp_next_seq_num = 10165 nla_get_u16( 10166 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 10167 connect.fils_erp_rrk = 10168 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 10169 connect.fils_erp_rrk_len = 10170 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 10171 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 10172 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 10173 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 10174 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 10175 kzfree(connkeys); 10176 return -EINVAL; 10177 } 10178 10179 if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) { 10180 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 10181 kzfree(connkeys); 10182 GENL_SET_ERR_MSG(info, 10183 "external auth requires connection ownership"); 10184 return -EINVAL; 10185 } 10186 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT; 10187 } 10188 10189 wdev_lock(dev->ieee80211_ptr); 10190 10191 err = cfg80211_connect(rdev, dev, &connect, connkeys, 10192 connect.prev_bssid); 10193 if (err) 10194 kzfree(connkeys); 10195 10196 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 10197 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 10198 if (connect.bssid) 10199 memcpy(dev->ieee80211_ptr->disconnect_bssid, 10200 connect.bssid, ETH_ALEN); 10201 else 10202 memset(dev->ieee80211_ptr->disconnect_bssid, 10203 0, ETH_ALEN); 10204 } 10205 10206 wdev_unlock(dev->ieee80211_ptr); 10207 10208 return err; 10209 } 10210 10211 static int nl80211_update_connect_params(struct sk_buff *skb, 10212 struct genl_info *info) 10213 { 10214 struct cfg80211_connect_params connect = {}; 10215 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10216 struct net_device *dev = info->user_ptr[1]; 10217 struct wireless_dev *wdev = dev->ieee80211_ptr; 10218 bool fils_sk_offload; 10219 u32 auth_type; 10220 u32 changed = 0; 10221 int ret; 10222 10223 if (!rdev->ops->update_connect_params) 10224 return -EOPNOTSUPP; 10225 10226 if (info->attrs[NL80211_ATTR_IE]) { 10227 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 10228 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10229 changed |= UPDATE_ASSOC_IES; 10230 } 10231 10232 fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy, 10233 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD); 10234 10235 /* 10236 * when driver supports fils-sk offload all attributes must be 10237 * provided. So the else covers "fils-sk-not-all" and 10238 * "no-fils-sk-any". 10239 */ 10240 if (fils_sk_offload && 10241 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 10242 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 10243 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 10244 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 10245 connect.fils_erp_username = 10246 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 10247 connect.fils_erp_username_len = 10248 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 10249 connect.fils_erp_realm = 10250 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 10251 connect.fils_erp_realm_len = 10252 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 10253 connect.fils_erp_next_seq_num = 10254 nla_get_u16( 10255 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 10256 connect.fils_erp_rrk = 10257 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 10258 connect.fils_erp_rrk_len = 10259 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 10260 changed |= UPDATE_FILS_ERP_INFO; 10261 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 10262 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 10263 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 10264 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 10265 return -EINVAL; 10266 } 10267 10268 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 10269 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 10270 if (!nl80211_valid_auth_type(rdev, auth_type, 10271 NL80211_CMD_CONNECT)) 10272 return -EINVAL; 10273 10274 if (auth_type == NL80211_AUTHTYPE_FILS_SK && 10275 fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO)) 10276 return -EINVAL; 10277 10278 connect.auth_type = auth_type; 10279 changed |= UPDATE_AUTH_TYPE; 10280 } 10281 10282 wdev_lock(dev->ieee80211_ptr); 10283 if (!wdev->current_bss) 10284 ret = -ENOLINK; 10285 else 10286 ret = rdev_update_connect_params(rdev, dev, &connect, changed); 10287 wdev_unlock(dev->ieee80211_ptr); 10288 10289 return ret; 10290 } 10291 10292 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info) 10293 { 10294 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10295 struct net_device *dev = info->user_ptr[1]; 10296 u16 reason; 10297 int ret; 10298 10299 if (dev->ieee80211_ptr->conn_owner_nlportid && 10300 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 10301 return -EPERM; 10302 10303 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 10304 reason = WLAN_REASON_DEAUTH_LEAVING; 10305 else 10306 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 10307 10308 if (reason == 0) 10309 return -EINVAL; 10310 10311 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10312 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 10313 return -EOPNOTSUPP; 10314 10315 wdev_lock(dev->ieee80211_ptr); 10316 ret = cfg80211_disconnect(rdev, dev, reason, true); 10317 wdev_unlock(dev->ieee80211_ptr); 10318 return ret; 10319 } 10320 10321 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info) 10322 { 10323 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10324 struct net *net; 10325 int err; 10326 10327 if (info->attrs[NL80211_ATTR_PID]) { 10328 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]); 10329 10330 net = get_net_ns_by_pid(pid); 10331 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) { 10332 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]); 10333 10334 net = get_net_ns_by_fd(fd); 10335 } else { 10336 return -EINVAL; 10337 } 10338 10339 if (IS_ERR(net)) 10340 return PTR_ERR(net); 10341 10342 err = 0; 10343 10344 /* check if anything to do */ 10345 if (!net_eq(wiphy_net(&rdev->wiphy), net)) 10346 err = cfg80211_switch_netns(rdev, net); 10347 10348 put_net(net); 10349 return err; 10350 } 10351 10352 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info) 10353 { 10354 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10355 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev, 10356 struct cfg80211_pmksa *pmksa) = NULL; 10357 struct net_device *dev = info->user_ptr[1]; 10358 struct cfg80211_pmksa pmksa; 10359 10360 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 10361 10362 if (!info->attrs[NL80211_ATTR_PMKID]) 10363 return -EINVAL; 10364 10365 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 10366 10367 if (info->attrs[NL80211_ATTR_MAC]) { 10368 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 10369 } else if (info->attrs[NL80211_ATTR_SSID] && 10370 info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 10371 (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA || 10372 info->attrs[NL80211_ATTR_PMK])) { 10373 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 10374 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 10375 pmksa.cache_id = 10376 nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 10377 } else { 10378 return -EINVAL; 10379 } 10380 if (info->attrs[NL80211_ATTR_PMK]) { 10381 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 10382 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 10383 } 10384 10385 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10386 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 10387 !(dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP && 10388 wiphy_ext_feature_isset(&rdev->wiphy, 10389 NL80211_EXT_FEATURE_AP_PMKSA_CACHING))) 10390 return -EOPNOTSUPP; 10391 10392 switch (info->genlhdr->cmd) { 10393 case NL80211_CMD_SET_PMKSA: 10394 rdev_ops = rdev->ops->set_pmksa; 10395 break; 10396 case NL80211_CMD_DEL_PMKSA: 10397 rdev_ops = rdev->ops->del_pmksa; 10398 break; 10399 default: 10400 WARN_ON(1); 10401 break; 10402 } 10403 10404 if (!rdev_ops) 10405 return -EOPNOTSUPP; 10406 10407 return rdev_ops(&rdev->wiphy, dev, &pmksa); 10408 } 10409 10410 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info) 10411 { 10412 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10413 struct net_device *dev = info->user_ptr[1]; 10414 10415 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10416 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 10417 return -EOPNOTSUPP; 10418 10419 if (!rdev->ops->flush_pmksa) 10420 return -EOPNOTSUPP; 10421 10422 return rdev_flush_pmksa(rdev, dev); 10423 } 10424 10425 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info) 10426 { 10427 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10428 struct net_device *dev = info->user_ptr[1]; 10429 u8 action_code, dialog_token; 10430 u32 peer_capability = 0; 10431 u16 status_code; 10432 u8 *peer; 10433 bool initiator; 10434 10435 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 10436 !rdev->ops->tdls_mgmt) 10437 return -EOPNOTSUPP; 10438 10439 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] || 10440 !info->attrs[NL80211_ATTR_STATUS_CODE] || 10441 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] || 10442 !info->attrs[NL80211_ATTR_IE] || 10443 !info->attrs[NL80211_ATTR_MAC]) 10444 return -EINVAL; 10445 10446 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 10447 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]); 10448 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 10449 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]); 10450 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]); 10451 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]) 10452 peer_capability = 10453 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]); 10454 10455 return rdev_tdls_mgmt(rdev, dev, peer, action_code, 10456 dialog_token, status_code, peer_capability, 10457 initiator, 10458 nla_data(info->attrs[NL80211_ATTR_IE]), 10459 nla_len(info->attrs[NL80211_ATTR_IE])); 10460 } 10461 10462 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info) 10463 { 10464 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10465 struct net_device *dev = info->user_ptr[1]; 10466 enum nl80211_tdls_operation operation; 10467 u8 *peer; 10468 10469 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 10470 !rdev->ops->tdls_oper) 10471 return -EOPNOTSUPP; 10472 10473 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] || 10474 !info->attrs[NL80211_ATTR_MAC]) 10475 return -EINVAL; 10476 10477 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]); 10478 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 10479 10480 return rdev_tdls_oper(rdev, dev, peer, operation); 10481 } 10482 10483 static int nl80211_remain_on_channel(struct sk_buff *skb, 10484 struct genl_info *info) 10485 { 10486 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10487 struct wireless_dev *wdev = info->user_ptr[1]; 10488 struct cfg80211_chan_def chandef; 10489 const struct cfg80211_chan_def *compat_chandef; 10490 struct sk_buff *msg; 10491 void *hdr; 10492 u64 cookie; 10493 u32 duration; 10494 int err; 10495 10496 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 10497 !info->attrs[NL80211_ATTR_DURATION]) 10498 return -EINVAL; 10499 10500 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 10501 10502 if (!rdev->ops->remain_on_channel || 10503 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)) 10504 return -EOPNOTSUPP; 10505 10506 /* 10507 * We should be on that channel for at least a minimum amount of 10508 * time (10ms) but no longer than the driver supports. 10509 */ 10510 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 10511 duration > rdev->wiphy.max_remain_on_channel_duration) 10512 return -EINVAL; 10513 10514 err = nl80211_parse_chandef(rdev, info, &chandef); 10515 if (err) 10516 return err; 10517 10518 wdev_lock(wdev); 10519 if (!cfg80211_off_channel_oper_allowed(wdev) && 10520 !cfg80211_chandef_identical(&wdev->chandef, &chandef)) { 10521 compat_chandef = cfg80211_chandef_compatible(&wdev->chandef, 10522 &chandef); 10523 if (compat_chandef != &chandef) { 10524 wdev_unlock(wdev); 10525 return -EBUSY; 10526 } 10527 } 10528 wdev_unlock(wdev); 10529 10530 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 10531 if (!msg) 10532 return -ENOMEM; 10533 10534 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 10535 NL80211_CMD_REMAIN_ON_CHANNEL); 10536 if (!hdr) { 10537 err = -ENOBUFS; 10538 goto free_msg; 10539 } 10540 10541 err = rdev_remain_on_channel(rdev, wdev, chandef.chan, 10542 duration, &cookie); 10543 10544 if (err) 10545 goto free_msg; 10546 10547 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 10548 NL80211_ATTR_PAD)) 10549 goto nla_put_failure; 10550 10551 genlmsg_end(msg, hdr); 10552 10553 return genlmsg_reply(msg, info); 10554 10555 nla_put_failure: 10556 err = -ENOBUFS; 10557 free_msg: 10558 nlmsg_free(msg); 10559 return err; 10560 } 10561 10562 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb, 10563 struct genl_info *info) 10564 { 10565 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10566 struct wireless_dev *wdev = info->user_ptr[1]; 10567 u64 cookie; 10568 10569 if (!info->attrs[NL80211_ATTR_COOKIE]) 10570 return -EINVAL; 10571 10572 if (!rdev->ops->cancel_remain_on_channel) 10573 return -EOPNOTSUPP; 10574 10575 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 10576 10577 return rdev_cancel_remain_on_channel(rdev, wdev, cookie); 10578 } 10579 10580 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb, 10581 struct genl_info *info) 10582 { 10583 struct cfg80211_bitrate_mask mask; 10584 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10585 struct net_device *dev = info->user_ptr[1]; 10586 int err; 10587 10588 if (!rdev->ops->set_bitrate_mask) 10589 return -EOPNOTSUPP; 10590 10591 err = nl80211_parse_tx_bitrate_mask(info, &mask); 10592 if (err) 10593 return err; 10594 10595 return rdev_set_bitrate_mask(rdev, dev, NULL, &mask); 10596 } 10597 10598 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info) 10599 { 10600 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10601 struct wireless_dev *wdev = info->user_ptr[1]; 10602 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION; 10603 10604 if (!info->attrs[NL80211_ATTR_FRAME_MATCH]) 10605 return -EINVAL; 10606 10607 if (info->attrs[NL80211_ATTR_FRAME_TYPE]) 10608 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]); 10609 10610 switch (wdev->iftype) { 10611 case NL80211_IFTYPE_STATION: 10612 case NL80211_IFTYPE_ADHOC: 10613 case NL80211_IFTYPE_P2P_CLIENT: 10614 case NL80211_IFTYPE_AP: 10615 case NL80211_IFTYPE_AP_VLAN: 10616 case NL80211_IFTYPE_MESH_POINT: 10617 case NL80211_IFTYPE_P2P_GO: 10618 case NL80211_IFTYPE_P2P_DEVICE: 10619 break; 10620 case NL80211_IFTYPE_NAN: 10621 default: 10622 return -EOPNOTSUPP; 10623 } 10624 10625 /* not much point in registering if we can't reply */ 10626 if (!rdev->ops->mgmt_tx) 10627 return -EOPNOTSUPP; 10628 10629 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type, 10630 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]), 10631 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]), 10632 info->extack); 10633 } 10634 10635 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info) 10636 { 10637 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10638 struct wireless_dev *wdev = info->user_ptr[1]; 10639 struct cfg80211_chan_def chandef; 10640 int err; 10641 void *hdr = NULL; 10642 u64 cookie; 10643 struct sk_buff *msg = NULL; 10644 struct cfg80211_mgmt_tx_params params = { 10645 .dont_wait_for_ack = 10646 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK], 10647 }; 10648 10649 if (!info->attrs[NL80211_ATTR_FRAME]) 10650 return -EINVAL; 10651 10652 if (!rdev->ops->mgmt_tx) 10653 return -EOPNOTSUPP; 10654 10655 switch (wdev->iftype) { 10656 case NL80211_IFTYPE_P2P_DEVICE: 10657 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 10658 return -EINVAL; 10659 case NL80211_IFTYPE_STATION: 10660 case NL80211_IFTYPE_ADHOC: 10661 case NL80211_IFTYPE_P2P_CLIENT: 10662 case NL80211_IFTYPE_AP: 10663 case NL80211_IFTYPE_AP_VLAN: 10664 case NL80211_IFTYPE_MESH_POINT: 10665 case NL80211_IFTYPE_P2P_GO: 10666 break; 10667 case NL80211_IFTYPE_NAN: 10668 default: 10669 return -EOPNOTSUPP; 10670 } 10671 10672 if (info->attrs[NL80211_ATTR_DURATION]) { 10673 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 10674 return -EINVAL; 10675 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 10676 10677 /* 10678 * We should wait on the channel for at least a minimum amount 10679 * of time (10ms) but no longer than the driver supports. 10680 */ 10681 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 10682 params.wait > rdev->wiphy.max_remain_on_channel_duration) 10683 return -EINVAL; 10684 } 10685 10686 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK]; 10687 10688 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 10689 return -EINVAL; 10690 10691 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 10692 10693 /* get the channel if any has been specified, otherwise pass NULL to 10694 * the driver. The latter will use the current one 10695 */ 10696 chandef.chan = NULL; 10697 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 10698 err = nl80211_parse_chandef(rdev, info, &chandef); 10699 if (err) 10700 return err; 10701 } 10702 10703 if (!chandef.chan && params.offchan) 10704 return -EINVAL; 10705 10706 wdev_lock(wdev); 10707 if (params.offchan && !cfg80211_off_channel_oper_allowed(wdev)) { 10708 wdev_unlock(wdev); 10709 return -EBUSY; 10710 } 10711 wdev_unlock(wdev); 10712 10713 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 10714 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 10715 10716 if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) { 10717 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]); 10718 int i; 10719 10720 if (len % sizeof(u16)) 10721 return -EINVAL; 10722 10723 params.n_csa_offsets = len / sizeof(u16); 10724 params.csa_offsets = 10725 nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]); 10726 10727 /* check that all the offsets fit the frame */ 10728 for (i = 0; i < params.n_csa_offsets; i++) { 10729 if (params.csa_offsets[i] >= params.len) 10730 return -EINVAL; 10731 } 10732 } 10733 10734 if (!params.dont_wait_for_ack) { 10735 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 10736 if (!msg) 10737 return -ENOMEM; 10738 10739 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 10740 NL80211_CMD_FRAME); 10741 if (!hdr) { 10742 err = -ENOBUFS; 10743 goto free_msg; 10744 } 10745 } 10746 10747 params.chan = chandef.chan; 10748 err = cfg80211_mlme_mgmt_tx(rdev, wdev, ¶ms, &cookie); 10749 if (err) 10750 goto free_msg; 10751 10752 if (msg) { 10753 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 10754 NL80211_ATTR_PAD)) 10755 goto nla_put_failure; 10756 10757 genlmsg_end(msg, hdr); 10758 return genlmsg_reply(msg, info); 10759 } 10760 10761 return 0; 10762 10763 nla_put_failure: 10764 err = -ENOBUFS; 10765 free_msg: 10766 nlmsg_free(msg); 10767 return err; 10768 } 10769 10770 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info) 10771 { 10772 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10773 struct wireless_dev *wdev = info->user_ptr[1]; 10774 u64 cookie; 10775 10776 if (!info->attrs[NL80211_ATTR_COOKIE]) 10777 return -EINVAL; 10778 10779 if (!rdev->ops->mgmt_tx_cancel_wait) 10780 return -EOPNOTSUPP; 10781 10782 switch (wdev->iftype) { 10783 case NL80211_IFTYPE_STATION: 10784 case NL80211_IFTYPE_ADHOC: 10785 case NL80211_IFTYPE_P2P_CLIENT: 10786 case NL80211_IFTYPE_AP: 10787 case NL80211_IFTYPE_AP_VLAN: 10788 case NL80211_IFTYPE_P2P_GO: 10789 case NL80211_IFTYPE_P2P_DEVICE: 10790 break; 10791 case NL80211_IFTYPE_NAN: 10792 default: 10793 return -EOPNOTSUPP; 10794 } 10795 10796 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 10797 10798 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie); 10799 } 10800 10801 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info) 10802 { 10803 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10804 struct wireless_dev *wdev; 10805 struct net_device *dev = info->user_ptr[1]; 10806 u8 ps_state; 10807 bool state; 10808 int err; 10809 10810 if (!info->attrs[NL80211_ATTR_PS_STATE]) 10811 return -EINVAL; 10812 10813 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]); 10814 10815 wdev = dev->ieee80211_ptr; 10816 10817 if (!rdev->ops->set_power_mgmt) 10818 return -EOPNOTSUPP; 10819 10820 state = (ps_state == NL80211_PS_ENABLED) ? true : false; 10821 10822 if (state == wdev->ps) 10823 return 0; 10824 10825 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout); 10826 if (!err) 10827 wdev->ps = state; 10828 return err; 10829 } 10830 10831 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info) 10832 { 10833 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10834 enum nl80211_ps_state ps_state; 10835 struct wireless_dev *wdev; 10836 struct net_device *dev = info->user_ptr[1]; 10837 struct sk_buff *msg; 10838 void *hdr; 10839 int err; 10840 10841 wdev = dev->ieee80211_ptr; 10842 10843 if (!rdev->ops->set_power_mgmt) 10844 return -EOPNOTSUPP; 10845 10846 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 10847 if (!msg) 10848 return -ENOMEM; 10849 10850 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 10851 NL80211_CMD_GET_POWER_SAVE); 10852 if (!hdr) { 10853 err = -ENOBUFS; 10854 goto free_msg; 10855 } 10856 10857 if (wdev->ps) 10858 ps_state = NL80211_PS_ENABLED; 10859 else 10860 ps_state = NL80211_PS_DISABLED; 10861 10862 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state)) 10863 goto nla_put_failure; 10864 10865 genlmsg_end(msg, hdr); 10866 return genlmsg_reply(msg, info); 10867 10868 nla_put_failure: 10869 err = -ENOBUFS; 10870 free_msg: 10871 nlmsg_free(msg); 10872 return err; 10873 } 10874 10875 static const struct nla_policy 10876 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = { 10877 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY }, 10878 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 }, 10879 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 }, 10880 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 }, 10881 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 }, 10882 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 }, 10883 [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 }, 10884 }; 10885 10886 static int nl80211_set_cqm_txe(struct genl_info *info, 10887 u32 rate, u32 pkts, u32 intvl) 10888 { 10889 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10890 struct net_device *dev = info->user_ptr[1]; 10891 struct wireless_dev *wdev = dev->ieee80211_ptr; 10892 10893 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL) 10894 return -EINVAL; 10895 10896 if (!rdev->ops->set_cqm_txe_config) 10897 return -EOPNOTSUPP; 10898 10899 if (wdev->iftype != NL80211_IFTYPE_STATION && 10900 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 10901 return -EOPNOTSUPP; 10902 10903 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl); 10904 } 10905 10906 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev, 10907 struct net_device *dev) 10908 { 10909 struct wireless_dev *wdev = dev->ieee80211_ptr; 10910 s32 last, low, high; 10911 u32 hyst; 10912 int i, n, low_index; 10913 int err; 10914 10915 /* RSSI reporting disabled? */ 10916 if (!wdev->cqm_config) 10917 return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0); 10918 10919 /* 10920 * Obtain current RSSI value if possible, if not and no RSSI threshold 10921 * event has been received yet, we should receive an event after a 10922 * connection is established and enough beacons received to calculate 10923 * the average. 10924 */ 10925 if (!wdev->cqm_config->last_rssi_event_value && wdev->current_bss && 10926 rdev->ops->get_station) { 10927 struct station_info sinfo = {}; 10928 u8 *mac_addr; 10929 10930 mac_addr = wdev->current_bss->pub.bssid; 10931 10932 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 10933 if (err) 10934 return err; 10935 10936 cfg80211_sinfo_release_content(&sinfo); 10937 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG)) 10938 wdev->cqm_config->last_rssi_event_value = 10939 (s8) sinfo.rx_beacon_signal_avg; 10940 } 10941 10942 last = wdev->cqm_config->last_rssi_event_value; 10943 hyst = wdev->cqm_config->rssi_hyst; 10944 n = wdev->cqm_config->n_rssi_thresholds; 10945 10946 for (i = 0; i < n; i++) { 10947 i = array_index_nospec(i, n); 10948 if (last < wdev->cqm_config->rssi_thresholds[i]) 10949 break; 10950 } 10951 10952 low_index = i - 1; 10953 if (low_index >= 0) { 10954 low_index = array_index_nospec(low_index, n); 10955 low = wdev->cqm_config->rssi_thresholds[low_index] - hyst; 10956 } else { 10957 low = S32_MIN; 10958 } 10959 if (i < n) { 10960 i = array_index_nospec(i, n); 10961 high = wdev->cqm_config->rssi_thresholds[i] + hyst - 1; 10962 } else { 10963 high = S32_MAX; 10964 } 10965 10966 return rdev_set_cqm_rssi_range_config(rdev, dev, low, high); 10967 } 10968 10969 static int nl80211_set_cqm_rssi(struct genl_info *info, 10970 const s32 *thresholds, int n_thresholds, 10971 u32 hysteresis) 10972 { 10973 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10974 struct net_device *dev = info->user_ptr[1]; 10975 struct wireless_dev *wdev = dev->ieee80211_ptr; 10976 int i, err; 10977 s32 prev = S32_MIN; 10978 10979 /* Check all values negative and sorted */ 10980 for (i = 0; i < n_thresholds; i++) { 10981 if (thresholds[i] > 0 || thresholds[i] <= prev) 10982 return -EINVAL; 10983 10984 prev = thresholds[i]; 10985 } 10986 10987 if (wdev->iftype != NL80211_IFTYPE_STATION && 10988 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 10989 return -EOPNOTSUPP; 10990 10991 wdev_lock(wdev); 10992 cfg80211_cqm_config_free(wdev); 10993 wdev_unlock(wdev); 10994 10995 if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) { 10996 if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */ 10997 return rdev_set_cqm_rssi_config(rdev, dev, 0, 0); 10998 10999 return rdev_set_cqm_rssi_config(rdev, dev, 11000 thresholds[0], hysteresis); 11001 } 11002 11003 if (!wiphy_ext_feature_isset(&rdev->wiphy, 11004 NL80211_EXT_FEATURE_CQM_RSSI_LIST)) 11005 return -EOPNOTSUPP; 11006 11007 if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */ 11008 n_thresholds = 0; 11009 11010 wdev_lock(wdev); 11011 if (n_thresholds) { 11012 struct cfg80211_cqm_config *cqm_config; 11013 11014 cqm_config = kzalloc(sizeof(struct cfg80211_cqm_config) + 11015 n_thresholds * sizeof(s32), GFP_KERNEL); 11016 if (!cqm_config) { 11017 err = -ENOMEM; 11018 goto unlock; 11019 } 11020 11021 cqm_config->rssi_hyst = hysteresis; 11022 cqm_config->n_rssi_thresholds = n_thresholds; 11023 memcpy(cqm_config->rssi_thresholds, thresholds, 11024 n_thresholds * sizeof(s32)); 11025 11026 wdev->cqm_config = cqm_config; 11027 } 11028 11029 err = cfg80211_cqm_rssi_update(rdev, dev); 11030 11031 unlock: 11032 wdev_unlock(wdev); 11033 11034 return err; 11035 } 11036 11037 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info) 11038 { 11039 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1]; 11040 struct nlattr *cqm; 11041 int err; 11042 11043 cqm = info->attrs[NL80211_ATTR_CQM]; 11044 if (!cqm) 11045 return -EINVAL; 11046 11047 err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm, 11048 nl80211_attr_cqm_policy, 11049 info->extack); 11050 if (err) 11051 return err; 11052 11053 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] && 11054 attrs[NL80211_ATTR_CQM_RSSI_HYST]) { 11055 const s32 *thresholds = 11056 nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 11057 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 11058 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]); 11059 11060 if (len % 4) 11061 return -EINVAL; 11062 11063 return nl80211_set_cqm_rssi(info, thresholds, len / 4, 11064 hysteresis); 11065 } 11066 11067 if (attrs[NL80211_ATTR_CQM_TXE_RATE] && 11068 attrs[NL80211_ATTR_CQM_TXE_PKTS] && 11069 attrs[NL80211_ATTR_CQM_TXE_INTVL]) { 11070 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]); 11071 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]); 11072 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]); 11073 11074 return nl80211_set_cqm_txe(info, rate, pkts, intvl); 11075 } 11076 11077 return -EINVAL; 11078 } 11079 11080 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info) 11081 { 11082 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11083 struct net_device *dev = info->user_ptr[1]; 11084 struct ocb_setup setup = {}; 11085 int err; 11086 11087 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 11088 if (err) 11089 return err; 11090 11091 return cfg80211_join_ocb(rdev, dev, &setup); 11092 } 11093 11094 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info) 11095 { 11096 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11097 struct net_device *dev = info->user_ptr[1]; 11098 11099 return cfg80211_leave_ocb(rdev, dev); 11100 } 11101 11102 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info) 11103 { 11104 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11105 struct net_device *dev = info->user_ptr[1]; 11106 struct mesh_config cfg; 11107 struct mesh_setup setup; 11108 int err; 11109 11110 /* start with default */ 11111 memcpy(&cfg, &default_mesh_config, sizeof(cfg)); 11112 memcpy(&setup, &default_mesh_setup, sizeof(setup)); 11113 11114 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) { 11115 /* and parse parameters if given */ 11116 err = nl80211_parse_mesh_config(info, &cfg, NULL); 11117 if (err) 11118 return err; 11119 } 11120 11121 if (!info->attrs[NL80211_ATTR_MESH_ID] || 11122 !nla_len(info->attrs[NL80211_ATTR_MESH_ID])) 11123 return -EINVAL; 11124 11125 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]); 11126 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 11127 11128 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 11129 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate, 11130 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 11131 return -EINVAL; 11132 11133 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) { 11134 setup.beacon_interval = 11135 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 11136 11137 err = cfg80211_validate_beacon_int(rdev, 11138 NL80211_IFTYPE_MESH_POINT, 11139 setup.beacon_interval); 11140 if (err) 11141 return err; 11142 } 11143 11144 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) { 11145 setup.dtim_period = 11146 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 11147 if (setup.dtim_period < 1 || setup.dtim_period > 100) 11148 return -EINVAL; 11149 } 11150 11151 if (info->attrs[NL80211_ATTR_MESH_SETUP]) { 11152 /* parse additional setup parameters if given */ 11153 err = nl80211_parse_mesh_setup(info, &setup); 11154 if (err) 11155 return err; 11156 } 11157 11158 if (setup.user_mpm) 11159 cfg.auto_open_plinks = false; 11160 11161 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 11162 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 11163 if (err) 11164 return err; 11165 } else { 11166 /* __cfg80211_join_mesh() will sort it out */ 11167 setup.chandef.chan = NULL; 11168 } 11169 11170 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 11171 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 11172 int n_rates = 11173 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 11174 struct ieee80211_supported_band *sband; 11175 11176 if (!setup.chandef.chan) 11177 return -EINVAL; 11178 11179 sband = rdev->wiphy.bands[setup.chandef.chan->band]; 11180 11181 err = ieee80211_get_ratemask(sband, rates, n_rates, 11182 &setup.basic_rates); 11183 if (err) 11184 return err; 11185 } 11186 11187 if (info->attrs[NL80211_ATTR_TX_RATES]) { 11188 err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate); 11189 if (err) 11190 return err; 11191 11192 if (!setup.chandef.chan) 11193 return -EINVAL; 11194 11195 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band, 11196 &setup.beacon_rate); 11197 if (err) 11198 return err; 11199 } 11200 11201 setup.userspace_handles_dfs = 11202 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 11203 11204 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 11205 int r = validate_pae_over_nl80211(rdev, info); 11206 11207 if (r < 0) 11208 return r; 11209 11210 setup.control_port_over_nl80211 = true; 11211 } 11212 11213 wdev_lock(dev->ieee80211_ptr); 11214 err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg); 11215 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) 11216 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 11217 wdev_unlock(dev->ieee80211_ptr); 11218 11219 return err; 11220 } 11221 11222 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info) 11223 { 11224 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11225 struct net_device *dev = info->user_ptr[1]; 11226 11227 return cfg80211_leave_mesh(rdev, dev); 11228 } 11229 11230 #ifdef CONFIG_PM 11231 static int nl80211_send_wowlan_patterns(struct sk_buff *msg, 11232 struct cfg80211_registered_device *rdev) 11233 { 11234 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config; 11235 struct nlattr *nl_pats, *nl_pat; 11236 int i, pat_len; 11237 11238 if (!wowlan->n_patterns) 11239 return 0; 11240 11241 nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN); 11242 if (!nl_pats) 11243 return -ENOBUFS; 11244 11245 for (i = 0; i < wowlan->n_patterns; i++) { 11246 nl_pat = nla_nest_start_noflag(msg, i + 1); 11247 if (!nl_pat) 11248 return -ENOBUFS; 11249 pat_len = wowlan->patterns[i].pattern_len; 11250 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8), 11251 wowlan->patterns[i].mask) || 11252 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 11253 wowlan->patterns[i].pattern) || 11254 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 11255 wowlan->patterns[i].pkt_offset)) 11256 return -ENOBUFS; 11257 nla_nest_end(msg, nl_pat); 11258 } 11259 nla_nest_end(msg, nl_pats); 11260 11261 return 0; 11262 } 11263 11264 static int nl80211_send_wowlan_tcp(struct sk_buff *msg, 11265 struct cfg80211_wowlan_tcp *tcp) 11266 { 11267 struct nlattr *nl_tcp; 11268 11269 if (!tcp) 11270 return 0; 11271 11272 nl_tcp = nla_nest_start_noflag(msg, 11273 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 11274 if (!nl_tcp) 11275 return -ENOBUFS; 11276 11277 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) || 11278 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) || 11279 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) || 11280 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) || 11281 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) || 11282 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 11283 tcp->payload_len, tcp->payload) || 11284 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 11285 tcp->data_interval) || 11286 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 11287 tcp->wake_len, tcp->wake_data) || 11288 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK, 11289 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask)) 11290 return -ENOBUFS; 11291 11292 if (tcp->payload_seq.len && 11293 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ, 11294 sizeof(tcp->payload_seq), &tcp->payload_seq)) 11295 return -ENOBUFS; 11296 11297 if (tcp->payload_tok.len && 11298 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 11299 sizeof(tcp->payload_tok) + tcp->tokens_size, 11300 &tcp->payload_tok)) 11301 return -ENOBUFS; 11302 11303 nla_nest_end(msg, nl_tcp); 11304 11305 return 0; 11306 } 11307 11308 static int nl80211_send_wowlan_nd(struct sk_buff *msg, 11309 struct cfg80211_sched_scan_request *req) 11310 { 11311 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan; 11312 int i; 11313 11314 if (!req) 11315 return 0; 11316 11317 nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT); 11318 if (!nd) 11319 return -ENOBUFS; 11320 11321 if (req->n_scan_plans == 1 && 11322 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL, 11323 req->scan_plans[0].interval * 1000)) 11324 return -ENOBUFS; 11325 11326 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay)) 11327 return -ENOBUFS; 11328 11329 if (req->relative_rssi_set) { 11330 struct nl80211_bss_select_rssi_adjust rssi_adjust; 11331 11332 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI, 11333 req->relative_rssi)) 11334 return -ENOBUFS; 11335 11336 rssi_adjust.band = req->rssi_adjust.band; 11337 rssi_adjust.delta = req->rssi_adjust.delta; 11338 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST, 11339 sizeof(rssi_adjust), &rssi_adjust)) 11340 return -ENOBUFS; 11341 } 11342 11343 freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES); 11344 if (!freqs) 11345 return -ENOBUFS; 11346 11347 for (i = 0; i < req->n_channels; i++) { 11348 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 11349 return -ENOBUFS; 11350 } 11351 11352 nla_nest_end(msg, freqs); 11353 11354 if (req->n_match_sets) { 11355 matches = nla_nest_start_noflag(msg, 11356 NL80211_ATTR_SCHED_SCAN_MATCH); 11357 if (!matches) 11358 return -ENOBUFS; 11359 11360 for (i = 0; i < req->n_match_sets; i++) { 11361 match = nla_nest_start_noflag(msg, i); 11362 if (!match) 11363 return -ENOBUFS; 11364 11365 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID, 11366 req->match_sets[i].ssid.ssid_len, 11367 req->match_sets[i].ssid.ssid)) 11368 return -ENOBUFS; 11369 nla_nest_end(msg, match); 11370 } 11371 nla_nest_end(msg, matches); 11372 } 11373 11374 scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS); 11375 if (!scan_plans) 11376 return -ENOBUFS; 11377 11378 for (i = 0; i < req->n_scan_plans; i++) { 11379 scan_plan = nla_nest_start_noflag(msg, i + 1); 11380 if (!scan_plan) 11381 return -ENOBUFS; 11382 11383 if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL, 11384 req->scan_plans[i].interval) || 11385 (req->scan_plans[i].iterations && 11386 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS, 11387 req->scan_plans[i].iterations))) 11388 return -ENOBUFS; 11389 nla_nest_end(msg, scan_plan); 11390 } 11391 nla_nest_end(msg, scan_plans); 11392 11393 nla_nest_end(msg, nd); 11394 11395 return 0; 11396 } 11397 11398 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info) 11399 { 11400 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11401 struct sk_buff *msg; 11402 void *hdr; 11403 u32 size = NLMSG_DEFAULT_SIZE; 11404 11405 if (!rdev->wiphy.wowlan) 11406 return -EOPNOTSUPP; 11407 11408 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) { 11409 /* adjust size to have room for all the data */ 11410 size += rdev->wiphy.wowlan_config->tcp->tokens_size + 11411 rdev->wiphy.wowlan_config->tcp->payload_len + 11412 rdev->wiphy.wowlan_config->tcp->wake_len + 11413 rdev->wiphy.wowlan_config->tcp->wake_len / 8; 11414 } 11415 11416 msg = nlmsg_new(size, GFP_KERNEL); 11417 if (!msg) 11418 return -ENOMEM; 11419 11420 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 11421 NL80211_CMD_GET_WOWLAN); 11422 if (!hdr) 11423 goto nla_put_failure; 11424 11425 if (rdev->wiphy.wowlan_config) { 11426 struct nlattr *nl_wowlan; 11427 11428 nl_wowlan = nla_nest_start_noflag(msg, 11429 NL80211_ATTR_WOWLAN_TRIGGERS); 11430 if (!nl_wowlan) 11431 goto nla_put_failure; 11432 11433 if ((rdev->wiphy.wowlan_config->any && 11434 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 11435 (rdev->wiphy.wowlan_config->disconnect && 11436 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 11437 (rdev->wiphy.wowlan_config->magic_pkt && 11438 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 11439 (rdev->wiphy.wowlan_config->gtk_rekey_failure && 11440 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 11441 (rdev->wiphy.wowlan_config->eap_identity_req && 11442 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 11443 (rdev->wiphy.wowlan_config->four_way_handshake && 11444 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 11445 (rdev->wiphy.wowlan_config->rfkill_release && 11446 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 11447 goto nla_put_failure; 11448 11449 if (nl80211_send_wowlan_patterns(msg, rdev)) 11450 goto nla_put_failure; 11451 11452 if (nl80211_send_wowlan_tcp(msg, 11453 rdev->wiphy.wowlan_config->tcp)) 11454 goto nla_put_failure; 11455 11456 if (nl80211_send_wowlan_nd( 11457 msg, 11458 rdev->wiphy.wowlan_config->nd_config)) 11459 goto nla_put_failure; 11460 11461 nla_nest_end(msg, nl_wowlan); 11462 } 11463 11464 genlmsg_end(msg, hdr); 11465 return genlmsg_reply(msg, info); 11466 11467 nla_put_failure: 11468 nlmsg_free(msg); 11469 return -ENOBUFS; 11470 } 11471 11472 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev, 11473 struct nlattr *attr, 11474 struct cfg80211_wowlan *trig) 11475 { 11476 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP]; 11477 struct cfg80211_wowlan_tcp *cfg; 11478 struct nl80211_wowlan_tcp_data_token *tok = NULL; 11479 struct nl80211_wowlan_tcp_data_seq *seq = NULL; 11480 u32 size; 11481 u32 data_size, wake_size, tokens_size = 0, wake_mask_size; 11482 int err, port; 11483 11484 if (!rdev->wiphy.wowlan->tcp) 11485 return -EINVAL; 11486 11487 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr, 11488 nl80211_wowlan_tcp_policy, NULL); 11489 if (err) 11490 return err; 11491 11492 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] || 11493 !tb[NL80211_WOWLAN_TCP_DST_IPV4] || 11494 !tb[NL80211_WOWLAN_TCP_DST_MAC] || 11495 !tb[NL80211_WOWLAN_TCP_DST_PORT] || 11496 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] || 11497 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] || 11498 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] || 11499 !tb[NL80211_WOWLAN_TCP_WAKE_MASK]) 11500 return -EINVAL; 11501 11502 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]); 11503 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max) 11504 return -EINVAL; 11505 11506 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) > 11507 rdev->wiphy.wowlan->tcp->data_interval_max || 11508 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0) 11509 return -EINVAL; 11510 11511 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]); 11512 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max) 11513 return -EINVAL; 11514 11515 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]); 11516 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8)) 11517 return -EINVAL; 11518 11519 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) { 11520 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 11521 11522 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 11523 tokens_size = tokln - sizeof(*tok); 11524 11525 if (!tok->len || tokens_size % tok->len) 11526 return -EINVAL; 11527 if (!rdev->wiphy.wowlan->tcp->tok) 11528 return -EINVAL; 11529 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len) 11530 return -EINVAL; 11531 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len) 11532 return -EINVAL; 11533 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize) 11534 return -EINVAL; 11535 if (tok->offset + tok->len > data_size) 11536 return -EINVAL; 11537 } 11538 11539 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) { 11540 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]); 11541 if (!rdev->wiphy.wowlan->tcp->seq) 11542 return -EINVAL; 11543 if (seq->len == 0 || seq->len > 4) 11544 return -EINVAL; 11545 if (seq->len + seq->offset > data_size) 11546 return -EINVAL; 11547 } 11548 11549 size = sizeof(*cfg); 11550 size += data_size; 11551 size += wake_size + wake_mask_size; 11552 size += tokens_size; 11553 11554 cfg = kzalloc(size, GFP_KERNEL); 11555 if (!cfg) 11556 return -ENOMEM; 11557 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]); 11558 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]); 11559 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]), 11560 ETH_ALEN); 11561 if (tb[NL80211_WOWLAN_TCP_SRC_PORT]) 11562 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]); 11563 else 11564 port = 0; 11565 #ifdef CONFIG_INET 11566 /* allocate a socket and port for it and use it */ 11567 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM, 11568 IPPROTO_TCP, &cfg->sock, 1); 11569 if (err) { 11570 kfree(cfg); 11571 return err; 11572 } 11573 if (inet_csk_get_port(cfg->sock->sk, port)) { 11574 sock_release(cfg->sock); 11575 kfree(cfg); 11576 return -EADDRINUSE; 11577 } 11578 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num; 11579 #else 11580 if (!port) { 11581 kfree(cfg); 11582 return -EINVAL; 11583 } 11584 cfg->src_port = port; 11585 #endif 11586 11587 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]); 11588 cfg->payload_len = data_size; 11589 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size; 11590 memcpy((void *)cfg->payload, 11591 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]), 11592 data_size); 11593 if (seq) 11594 cfg->payload_seq = *seq; 11595 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]); 11596 cfg->wake_len = wake_size; 11597 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size; 11598 memcpy((void *)cfg->wake_data, 11599 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]), 11600 wake_size); 11601 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size + 11602 data_size + wake_size; 11603 memcpy((void *)cfg->wake_mask, 11604 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]), 11605 wake_mask_size); 11606 if (tok) { 11607 cfg->tokens_size = tokens_size; 11608 memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size); 11609 } 11610 11611 trig->tcp = cfg; 11612 11613 return 0; 11614 } 11615 11616 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev, 11617 const struct wiphy_wowlan_support *wowlan, 11618 struct nlattr *attr, 11619 struct cfg80211_wowlan *trig) 11620 { 11621 struct nlattr **tb; 11622 int err; 11623 11624 tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 11625 if (!tb) 11626 return -ENOMEM; 11627 11628 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) { 11629 err = -EOPNOTSUPP; 11630 goto out; 11631 } 11632 11633 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr, 11634 nl80211_policy, NULL); 11635 if (err) 11636 goto out; 11637 11638 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb, 11639 wowlan->max_nd_match_sets); 11640 err = PTR_ERR_OR_ZERO(trig->nd_config); 11641 if (err) 11642 trig->nd_config = NULL; 11643 11644 out: 11645 kfree(tb); 11646 return err; 11647 } 11648 11649 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info) 11650 { 11651 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11652 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG]; 11653 struct cfg80211_wowlan new_triggers = {}; 11654 struct cfg80211_wowlan *ntrig; 11655 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan; 11656 int err, i; 11657 bool prev_enabled = rdev->wiphy.wowlan_config; 11658 bool regular = false; 11659 11660 if (!wowlan) 11661 return -EOPNOTSUPP; 11662 11663 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) { 11664 cfg80211_rdev_free_wowlan(rdev); 11665 rdev->wiphy.wowlan_config = NULL; 11666 goto set_wakeup; 11667 } 11668 11669 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG, 11670 info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS], 11671 nl80211_wowlan_policy, info->extack); 11672 if (err) 11673 return err; 11674 11675 if (tb[NL80211_WOWLAN_TRIG_ANY]) { 11676 if (!(wowlan->flags & WIPHY_WOWLAN_ANY)) 11677 return -EINVAL; 11678 new_triggers.any = true; 11679 } 11680 11681 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) { 11682 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT)) 11683 return -EINVAL; 11684 new_triggers.disconnect = true; 11685 regular = true; 11686 } 11687 11688 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) { 11689 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT)) 11690 return -EINVAL; 11691 new_triggers.magic_pkt = true; 11692 regular = true; 11693 } 11694 11695 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED]) 11696 return -EINVAL; 11697 11698 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) { 11699 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE)) 11700 return -EINVAL; 11701 new_triggers.gtk_rekey_failure = true; 11702 regular = true; 11703 } 11704 11705 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) { 11706 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ)) 11707 return -EINVAL; 11708 new_triggers.eap_identity_req = true; 11709 regular = true; 11710 } 11711 11712 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) { 11713 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE)) 11714 return -EINVAL; 11715 new_triggers.four_way_handshake = true; 11716 regular = true; 11717 } 11718 11719 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) { 11720 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE)) 11721 return -EINVAL; 11722 new_triggers.rfkill_release = true; 11723 regular = true; 11724 } 11725 11726 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) { 11727 struct nlattr *pat; 11728 int n_patterns = 0; 11729 int rem, pat_len, mask_len, pkt_offset; 11730 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 11731 11732 regular = true; 11733 11734 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 11735 rem) 11736 n_patterns++; 11737 if (n_patterns > wowlan->n_patterns) 11738 return -EINVAL; 11739 11740 new_triggers.patterns = kcalloc(n_patterns, 11741 sizeof(new_triggers.patterns[0]), 11742 GFP_KERNEL); 11743 if (!new_triggers.patterns) 11744 return -ENOMEM; 11745 11746 new_triggers.n_patterns = n_patterns; 11747 i = 0; 11748 11749 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 11750 rem) { 11751 u8 *mask_pat; 11752 11753 err = nla_parse_nested_deprecated(pat_tb, 11754 MAX_NL80211_PKTPAT, 11755 pat, 11756 nl80211_packet_pattern_policy, 11757 info->extack); 11758 if (err) 11759 goto error; 11760 11761 err = -EINVAL; 11762 if (!pat_tb[NL80211_PKTPAT_MASK] || 11763 !pat_tb[NL80211_PKTPAT_PATTERN]) 11764 goto error; 11765 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 11766 mask_len = DIV_ROUND_UP(pat_len, 8); 11767 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 11768 goto error; 11769 if (pat_len > wowlan->pattern_max_len || 11770 pat_len < wowlan->pattern_min_len) 11771 goto error; 11772 11773 if (!pat_tb[NL80211_PKTPAT_OFFSET]) 11774 pkt_offset = 0; 11775 else 11776 pkt_offset = nla_get_u32( 11777 pat_tb[NL80211_PKTPAT_OFFSET]); 11778 if (pkt_offset > wowlan->max_pkt_offset) 11779 goto error; 11780 new_triggers.patterns[i].pkt_offset = pkt_offset; 11781 11782 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 11783 if (!mask_pat) { 11784 err = -ENOMEM; 11785 goto error; 11786 } 11787 new_triggers.patterns[i].mask = mask_pat; 11788 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 11789 mask_len); 11790 mask_pat += mask_len; 11791 new_triggers.patterns[i].pattern = mask_pat; 11792 new_triggers.patterns[i].pattern_len = pat_len; 11793 memcpy(mask_pat, 11794 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 11795 pat_len); 11796 i++; 11797 } 11798 } 11799 11800 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) { 11801 regular = true; 11802 err = nl80211_parse_wowlan_tcp( 11803 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION], 11804 &new_triggers); 11805 if (err) 11806 goto error; 11807 } 11808 11809 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) { 11810 regular = true; 11811 err = nl80211_parse_wowlan_nd( 11812 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT], 11813 &new_triggers); 11814 if (err) 11815 goto error; 11816 } 11817 11818 /* The 'any' trigger means the device continues operating more or less 11819 * as in its normal operation mode and wakes up the host on most of the 11820 * normal interrupts (like packet RX, ...) 11821 * It therefore makes little sense to combine with the more constrained 11822 * wakeup trigger modes. 11823 */ 11824 if (new_triggers.any && regular) { 11825 err = -EINVAL; 11826 goto error; 11827 } 11828 11829 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL); 11830 if (!ntrig) { 11831 err = -ENOMEM; 11832 goto error; 11833 } 11834 cfg80211_rdev_free_wowlan(rdev); 11835 rdev->wiphy.wowlan_config = ntrig; 11836 11837 set_wakeup: 11838 if (rdev->ops->set_wakeup && 11839 prev_enabled != !!rdev->wiphy.wowlan_config) 11840 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config); 11841 11842 return 0; 11843 error: 11844 for (i = 0; i < new_triggers.n_patterns; i++) 11845 kfree(new_triggers.patterns[i].mask); 11846 kfree(new_triggers.patterns); 11847 if (new_triggers.tcp && new_triggers.tcp->sock) 11848 sock_release(new_triggers.tcp->sock); 11849 kfree(new_triggers.tcp); 11850 kfree(new_triggers.nd_config); 11851 return err; 11852 } 11853 #endif 11854 11855 static int nl80211_send_coalesce_rules(struct sk_buff *msg, 11856 struct cfg80211_registered_device *rdev) 11857 { 11858 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules; 11859 int i, j, pat_len; 11860 struct cfg80211_coalesce_rules *rule; 11861 11862 if (!rdev->coalesce->n_rules) 11863 return 0; 11864 11865 nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE); 11866 if (!nl_rules) 11867 return -ENOBUFS; 11868 11869 for (i = 0; i < rdev->coalesce->n_rules; i++) { 11870 nl_rule = nla_nest_start_noflag(msg, i + 1); 11871 if (!nl_rule) 11872 return -ENOBUFS; 11873 11874 rule = &rdev->coalesce->rules[i]; 11875 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY, 11876 rule->delay)) 11877 return -ENOBUFS; 11878 11879 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION, 11880 rule->condition)) 11881 return -ENOBUFS; 11882 11883 nl_pats = nla_nest_start_noflag(msg, 11884 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN); 11885 if (!nl_pats) 11886 return -ENOBUFS; 11887 11888 for (j = 0; j < rule->n_patterns; j++) { 11889 nl_pat = nla_nest_start_noflag(msg, j + 1); 11890 if (!nl_pat) 11891 return -ENOBUFS; 11892 pat_len = rule->patterns[j].pattern_len; 11893 if (nla_put(msg, NL80211_PKTPAT_MASK, 11894 DIV_ROUND_UP(pat_len, 8), 11895 rule->patterns[j].mask) || 11896 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 11897 rule->patterns[j].pattern) || 11898 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 11899 rule->patterns[j].pkt_offset)) 11900 return -ENOBUFS; 11901 nla_nest_end(msg, nl_pat); 11902 } 11903 nla_nest_end(msg, nl_pats); 11904 nla_nest_end(msg, nl_rule); 11905 } 11906 nla_nest_end(msg, nl_rules); 11907 11908 return 0; 11909 } 11910 11911 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info) 11912 { 11913 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11914 struct sk_buff *msg; 11915 void *hdr; 11916 11917 if (!rdev->wiphy.coalesce) 11918 return -EOPNOTSUPP; 11919 11920 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 11921 if (!msg) 11922 return -ENOMEM; 11923 11924 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 11925 NL80211_CMD_GET_COALESCE); 11926 if (!hdr) 11927 goto nla_put_failure; 11928 11929 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev)) 11930 goto nla_put_failure; 11931 11932 genlmsg_end(msg, hdr); 11933 return genlmsg_reply(msg, info); 11934 11935 nla_put_failure: 11936 nlmsg_free(msg); 11937 return -ENOBUFS; 11938 } 11939 11940 void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev) 11941 { 11942 struct cfg80211_coalesce *coalesce = rdev->coalesce; 11943 int i, j; 11944 struct cfg80211_coalesce_rules *rule; 11945 11946 if (!coalesce) 11947 return; 11948 11949 for (i = 0; i < coalesce->n_rules; i++) { 11950 rule = &coalesce->rules[i]; 11951 for (j = 0; j < rule->n_patterns; j++) 11952 kfree(rule->patterns[j].mask); 11953 kfree(rule->patterns); 11954 } 11955 kfree(coalesce->rules); 11956 kfree(coalesce); 11957 rdev->coalesce = NULL; 11958 } 11959 11960 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev, 11961 struct nlattr *rule, 11962 struct cfg80211_coalesce_rules *new_rule) 11963 { 11964 int err, i; 11965 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 11966 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat; 11967 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0; 11968 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 11969 11970 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX, 11971 rule, nl80211_coalesce_policy, NULL); 11972 if (err) 11973 return err; 11974 11975 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY]) 11976 new_rule->delay = 11977 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]); 11978 if (new_rule->delay > coalesce->max_delay) 11979 return -EINVAL; 11980 11981 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION]) 11982 new_rule->condition = 11983 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]); 11984 11985 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN]) 11986 return -EINVAL; 11987 11988 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 11989 rem) 11990 n_patterns++; 11991 if (n_patterns > coalesce->n_patterns) 11992 return -EINVAL; 11993 11994 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]), 11995 GFP_KERNEL); 11996 if (!new_rule->patterns) 11997 return -ENOMEM; 11998 11999 new_rule->n_patterns = n_patterns; 12000 i = 0; 12001 12002 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 12003 rem) { 12004 u8 *mask_pat; 12005 12006 err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT, 12007 pat, 12008 nl80211_packet_pattern_policy, 12009 NULL); 12010 if (err) 12011 return err; 12012 12013 if (!pat_tb[NL80211_PKTPAT_MASK] || 12014 !pat_tb[NL80211_PKTPAT_PATTERN]) 12015 return -EINVAL; 12016 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 12017 mask_len = DIV_ROUND_UP(pat_len, 8); 12018 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 12019 return -EINVAL; 12020 if (pat_len > coalesce->pattern_max_len || 12021 pat_len < coalesce->pattern_min_len) 12022 return -EINVAL; 12023 12024 if (!pat_tb[NL80211_PKTPAT_OFFSET]) 12025 pkt_offset = 0; 12026 else 12027 pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]); 12028 if (pkt_offset > coalesce->max_pkt_offset) 12029 return -EINVAL; 12030 new_rule->patterns[i].pkt_offset = pkt_offset; 12031 12032 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 12033 if (!mask_pat) 12034 return -ENOMEM; 12035 12036 new_rule->patterns[i].mask = mask_pat; 12037 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 12038 mask_len); 12039 12040 mask_pat += mask_len; 12041 new_rule->patterns[i].pattern = mask_pat; 12042 new_rule->patterns[i].pattern_len = pat_len; 12043 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 12044 pat_len); 12045 i++; 12046 } 12047 12048 return 0; 12049 } 12050 12051 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info) 12052 { 12053 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12054 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 12055 struct cfg80211_coalesce new_coalesce = {}; 12056 struct cfg80211_coalesce *n_coalesce; 12057 int err, rem_rule, n_rules = 0, i, j; 12058 struct nlattr *rule; 12059 struct cfg80211_coalesce_rules *tmp_rule; 12060 12061 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce) 12062 return -EOPNOTSUPP; 12063 12064 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) { 12065 cfg80211_rdev_free_coalesce(rdev); 12066 rdev_set_coalesce(rdev, NULL); 12067 return 0; 12068 } 12069 12070 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 12071 rem_rule) 12072 n_rules++; 12073 if (n_rules > coalesce->n_rules) 12074 return -EINVAL; 12075 12076 new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]), 12077 GFP_KERNEL); 12078 if (!new_coalesce.rules) 12079 return -ENOMEM; 12080 12081 new_coalesce.n_rules = n_rules; 12082 i = 0; 12083 12084 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 12085 rem_rule) { 12086 err = nl80211_parse_coalesce_rule(rdev, rule, 12087 &new_coalesce.rules[i]); 12088 if (err) 12089 goto error; 12090 12091 i++; 12092 } 12093 12094 err = rdev_set_coalesce(rdev, &new_coalesce); 12095 if (err) 12096 goto error; 12097 12098 n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL); 12099 if (!n_coalesce) { 12100 err = -ENOMEM; 12101 goto error; 12102 } 12103 cfg80211_rdev_free_coalesce(rdev); 12104 rdev->coalesce = n_coalesce; 12105 12106 return 0; 12107 error: 12108 for (i = 0; i < new_coalesce.n_rules; i++) { 12109 tmp_rule = &new_coalesce.rules[i]; 12110 for (j = 0; j < tmp_rule->n_patterns; j++) 12111 kfree(tmp_rule->patterns[j].mask); 12112 kfree(tmp_rule->patterns); 12113 } 12114 kfree(new_coalesce.rules); 12115 12116 return err; 12117 } 12118 12119 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info) 12120 { 12121 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12122 struct net_device *dev = info->user_ptr[1]; 12123 struct wireless_dev *wdev = dev->ieee80211_ptr; 12124 struct nlattr *tb[NUM_NL80211_REKEY_DATA]; 12125 struct cfg80211_gtk_rekey_data rekey_data; 12126 int err; 12127 12128 if (!info->attrs[NL80211_ATTR_REKEY_DATA]) 12129 return -EINVAL; 12130 12131 err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA, 12132 info->attrs[NL80211_ATTR_REKEY_DATA], 12133 nl80211_rekey_policy, info->extack); 12134 if (err) 12135 return err; 12136 12137 if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] || 12138 !tb[NL80211_REKEY_DATA_KCK]) 12139 return -EINVAL; 12140 if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN) 12141 return -ERANGE; 12142 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN) 12143 return -ERANGE; 12144 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN) 12145 return -ERANGE; 12146 12147 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]); 12148 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]); 12149 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]); 12150 12151 wdev_lock(wdev); 12152 if (!wdev->current_bss) { 12153 err = -ENOTCONN; 12154 goto out; 12155 } 12156 12157 if (!rdev->ops->set_rekey_data) { 12158 err = -EOPNOTSUPP; 12159 goto out; 12160 } 12161 12162 err = rdev_set_rekey_data(rdev, dev, &rekey_data); 12163 out: 12164 wdev_unlock(wdev); 12165 return err; 12166 } 12167 12168 static int nl80211_register_unexpected_frame(struct sk_buff *skb, 12169 struct genl_info *info) 12170 { 12171 struct net_device *dev = info->user_ptr[1]; 12172 struct wireless_dev *wdev = dev->ieee80211_ptr; 12173 12174 if (wdev->iftype != NL80211_IFTYPE_AP && 12175 wdev->iftype != NL80211_IFTYPE_P2P_GO) 12176 return -EINVAL; 12177 12178 if (wdev->ap_unexpected_nlportid) 12179 return -EBUSY; 12180 12181 wdev->ap_unexpected_nlportid = info->snd_portid; 12182 return 0; 12183 } 12184 12185 static int nl80211_probe_client(struct sk_buff *skb, 12186 struct genl_info *info) 12187 { 12188 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12189 struct net_device *dev = info->user_ptr[1]; 12190 struct wireless_dev *wdev = dev->ieee80211_ptr; 12191 struct sk_buff *msg; 12192 void *hdr; 12193 const u8 *addr; 12194 u64 cookie; 12195 int err; 12196 12197 if (wdev->iftype != NL80211_IFTYPE_AP && 12198 wdev->iftype != NL80211_IFTYPE_P2P_GO) 12199 return -EOPNOTSUPP; 12200 12201 if (!info->attrs[NL80211_ATTR_MAC]) 12202 return -EINVAL; 12203 12204 if (!rdev->ops->probe_client) 12205 return -EOPNOTSUPP; 12206 12207 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12208 if (!msg) 12209 return -ENOMEM; 12210 12211 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12212 NL80211_CMD_PROBE_CLIENT); 12213 if (!hdr) { 12214 err = -ENOBUFS; 12215 goto free_msg; 12216 } 12217 12218 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 12219 12220 err = rdev_probe_client(rdev, dev, addr, &cookie); 12221 if (err) 12222 goto free_msg; 12223 12224 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 12225 NL80211_ATTR_PAD)) 12226 goto nla_put_failure; 12227 12228 genlmsg_end(msg, hdr); 12229 12230 return genlmsg_reply(msg, info); 12231 12232 nla_put_failure: 12233 err = -ENOBUFS; 12234 free_msg: 12235 nlmsg_free(msg); 12236 return err; 12237 } 12238 12239 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info) 12240 { 12241 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12242 struct cfg80211_beacon_registration *reg, *nreg; 12243 int rv; 12244 12245 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS)) 12246 return -EOPNOTSUPP; 12247 12248 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL); 12249 if (!nreg) 12250 return -ENOMEM; 12251 12252 /* First, check if already registered. */ 12253 spin_lock_bh(&rdev->beacon_registrations_lock); 12254 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 12255 if (reg->nlportid == info->snd_portid) { 12256 rv = -EALREADY; 12257 goto out_err; 12258 } 12259 } 12260 /* Add it to the list */ 12261 nreg->nlportid = info->snd_portid; 12262 list_add(&nreg->list, &rdev->beacon_registrations); 12263 12264 spin_unlock_bh(&rdev->beacon_registrations_lock); 12265 12266 return 0; 12267 out_err: 12268 spin_unlock_bh(&rdev->beacon_registrations_lock); 12269 kfree(nreg); 12270 return rv; 12271 } 12272 12273 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info) 12274 { 12275 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12276 struct wireless_dev *wdev = info->user_ptr[1]; 12277 int err; 12278 12279 if (!rdev->ops->start_p2p_device) 12280 return -EOPNOTSUPP; 12281 12282 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 12283 return -EOPNOTSUPP; 12284 12285 if (wdev_running(wdev)) 12286 return 0; 12287 12288 if (rfkill_blocked(rdev->rfkill)) 12289 return -ERFKILL; 12290 12291 err = rdev_start_p2p_device(rdev, wdev); 12292 if (err) 12293 return err; 12294 12295 wdev->is_running = true; 12296 rdev->opencount++; 12297 12298 return 0; 12299 } 12300 12301 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info) 12302 { 12303 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12304 struct wireless_dev *wdev = info->user_ptr[1]; 12305 12306 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 12307 return -EOPNOTSUPP; 12308 12309 if (!rdev->ops->stop_p2p_device) 12310 return -EOPNOTSUPP; 12311 12312 cfg80211_stop_p2p_device(rdev, wdev); 12313 12314 return 0; 12315 } 12316 12317 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info) 12318 { 12319 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12320 struct wireless_dev *wdev = info->user_ptr[1]; 12321 struct cfg80211_nan_conf conf = {}; 12322 int err; 12323 12324 if (wdev->iftype != NL80211_IFTYPE_NAN) 12325 return -EOPNOTSUPP; 12326 12327 if (wdev_running(wdev)) 12328 return -EEXIST; 12329 12330 if (rfkill_blocked(rdev->rfkill)) 12331 return -ERFKILL; 12332 12333 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) 12334 return -EINVAL; 12335 12336 conf.master_pref = 12337 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 12338 12339 if (info->attrs[NL80211_ATTR_BANDS]) { 12340 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 12341 12342 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 12343 return -EOPNOTSUPP; 12344 12345 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 12346 return -EINVAL; 12347 12348 conf.bands = bands; 12349 } 12350 12351 err = rdev_start_nan(rdev, wdev, &conf); 12352 if (err) 12353 return err; 12354 12355 wdev->is_running = true; 12356 rdev->opencount++; 12357 12358 return 0; 12359 } 12360 12361 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info) 12362 { 12363 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12364 struct wireless_dev *wdev = info->user_ptr[1]; 12365 12366 if (wdev->iftype != NL80211_IFTYPE_NAN) 12367 return -EOPNOTSUPP; 12368 12369 cfg80211_stop_nan(rdev, wdev); 12370 12371 return 0; 12372 } 12373 12374 static int validate_nan_filter(struct nlattr *filter_attr) 12375 { 12376 struct nlattr *attr; 12377 int len = 0, n_entries = 0, rem; 12378 12379 nla_for_each_nested(attr, filter_attr, rem) { 12380 len += nla_len(attr); 12381 n_entries++; 12382 } 12383 12384 if (len >= U8_MAX) 12385 return -EINVAL; 12386 12387 return n_entries; 12388 } 12389 12390 static int handle_nan_filter(struct nlattr *attr_filter, 12391 struct cfg80211_nan_func *func, 12392 bool tx) 12393 { 12394 struct nlattr *attr; 12395 int n_entries, rem, i; 12396 struct cfg80211_nan_func_filter *filter; 12397 12398 n_entries = validate_nan_filter(attr_filter); 12399 if (n_entries < 0) 12400 return n_entries; 12401 12402 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters)); 12403 12404 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL); 12405 if (!filter) 12406 return -ENOMEM; 12407 12408 i = 0; 12409 nla_for_each_nested(attr, attr_filter, rem) { 12410 filter[i].filter = nla_memdup(attr, GFP_KERNEL); 12411 filter[i].len = nla_len(attr); 12412 i++; 12413 } 12414 if (tx) { 12415 func->num_tx_filters = n_entries; 12416 func->tx_filters = filter; 12417 } else { 12418 func->num_rx_filters = n_entries; 12419 func->rx_filters = filter; 12420 } 12421 12422 return 0; 12423 } 12424 12425 static int nl80211_nan_add_func(struct sk_buff *skb, 12426 struct genl_info *info) 12427 { 12428 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12429 struct wireless_dev *wdev = info->user_ptr[1]; 12430 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr; 12431 struct cfg80211_nan_func *func; 12432 struct sk_buff *msg = NULL; 12433 void *hdr = NULL; 12434 int err = 0; 12435 12436 if (wdev->iftype != NL80211_IFTYPE_NAN) 12437 return -EOPNOTSUPP; 12438 12439 if (!wdev_running(wdev)) 12440 return -ENOTCONN; 12441 12442 if (!info->attrs[NL80211_ATTR_NAN_FUNC]) 12443 return -EINVAL; 12444 12445 err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX, 12446 info->attrs[NL80211_ATTR_NAN_FUNC], 12447 nl80211_nan_func_policy, 12448 info->extack); 12449 if (err) 12450 return err; 12451 12452 func = kzalloc(sizeof(*func), GFP_KERNEL); 12453 if (!func) 12454 return -ENOMEM; 12455 12456 func->cookie = cfg80211_assign_cookie(rdev); 12457 12458 if (!tb[NL80211_NAN_FUNC_TYPE] || 12459 nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) { 12460 err = -EINVAL; 12461 goto out; 12462 } 12463 12464 12465 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]); 12466 12467 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) { 12468 err = -EINVAL; 12469 goto out; 12470 } 12471 12472 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]), 12473 sizeof(func->service_id)); 12474 12475 func->close_range = 12476 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]); 12477 12478 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) { 12479 func->serv_spec_info_len = 12480 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]); 12481 func->serv_spec_info = 12482 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]), 12483 func->serv_spec_info_len, 12484 GFP_KERNEL); 12485 if (!func->serv_spec_info) { 12486 err = -ENOMEM; 12487 goto out; 12488 } 12489 } 12490 12491 if (tb[NL80211_NAN_FUNC_TTL]) 12492 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]); 12493 12494 switch (func->type) { 12495 case NL80211_NAN_FUNC_PUBLISH: 12496 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) { 12497 err = -EINVAL; 12498 goto out; 12499 } 12500 12501 func->publish_type = 12502 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]); 12503 func->publish_bcast = 12504 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]); 12505 12506 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) && 12507 func->publish_bcast) { 12508 err = -EINVAL; 12509 goto out; 12510 } 12511 break; 12512 case NL80211_NAN_FUNC_SUBSCRIBE: 12513 func->subscribe_active = 12514 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]); 12515 break; 12516 case NL80211_NAN_FUNC_FOLLOW_UP: 12517 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] || 12518 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] || 12519 !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) { 12520 err = -EINVAL; 12521 goto out; 12522 } 12523 12524 func->followup_id = 12525 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]); 12526 func->followup_reqid = 12527 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]); 12528 memcpy(func->followup_dest.addr, 12529 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]), 12530 sizeof(func->followup_dest.addr)); 12531 if (func->ttl) { 12532 err = -EINVAL; 12533 goto out; 12534 } 12535 break; 12536 default: 12537 err = -EINVAL; 12538 goto out; 12539 } 12540 12541 if (tb[NL80211_NAN_FUNC_SRF]) { 12542 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR]; 12543 12544 err = nla_parse_nested_deprecated(srf_tb, 12545 NL80211_NAN_SRF_ATTR_MAX, 12546 tb[NL80211_NAN_FUNC_SRF], 12547 nl80211_nan_srf_policy, 12548 info->extack); 12549 if (err) 12550 goto out; 12551 12552 func->srf_include = 12553 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]); 12554 12555 if (srf_tb[NL80211_NAN_SRF_BF]) { 12556 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] || 12557 !srf_tb[NL80211_NAN_SRF_BF_IDX]) { 12558 err = -EINVAL; 12559 goto out; 12560 } 12561 12562 func->srf_bf_len = 12563 nla_len(srf_tb[NL80211_NAN_SRF_BF]); 12564 func->srf_bf = 12565 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]), 12566 func->srf_bf_len, GFP_KERNEL); 12567 if (!func->srf_bf) { 12568 err = -ENOMEM; 12569 goto out; 12570 } 12571 12572 func->srf_bf_idx = 12573 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]); 12574 } else { 12575 struct nlattr *attr, *mac_attr = 12576 srf_tb[NL80211_NAN_SRF_MAC_ADDRS]; 12577 int n_entries, rem, i = 0; 12578 12579 if (!mac_attr) { 12580 err = -EINVAL; 12581 goto out; 12582 } 12583 12584 n_entries = validate_acl_mac_addrs(mac_attr); 12585 if (n_entries <= 0) { 12586 err = -EINVAL; 12587 goto out; 12588 } 12589 12590 func->srf_num_macs = n_entries; 12591 func->srf_macs = 12592 kcalloc(n_entries, sizeof(*func->srf_macs), 12593 GFP_KERNEL); 12594 if (!func->srf_macs) { 12595 err = -ENOMEM; 12596 goto out; 12597 } 12598 12599 nla_for_each_nested(attr, mac_attr, rem) 12600 memcpy(func->srf_macs[i++].addr, nla_data(attr), 12601 sizeof(*func->srf_macs)); 12602 } 12603 } 12604 12605 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) { 12606 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER], 12607 func, true); 12608 if (err) 12609 goto out; 12610 } 12611 12612 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) { 12613 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER], 12614 func, false); 12615 if (err) 12616 goto out; 12617 } 12618 12619 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12620 if (!msg) { 12621 err = -ENOMEM; 12622 goto out; 12623 } 12624 12625 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12626 NL80211_CMD_ADD_NAN_FUNCTION); 12627 /* This can't really happen - we just allocated 4KB */ 12628 if (WARN_ON(!hdr)) { 12629 err = -ENOMEM; 12630 goto out; 12631 } 12632 12633 err = rdev_add_nan_func(rdev, wdev, func); 12634 out: 12635 if (err < 0) { 12636 cfg80211_free_nan_func(func); 12637 nlmsg_free(msg); 12638 return err; 12639 } 12640 12641 /* propagate the instance id and cookie to userspace */ 12642 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie, 12643 NL80211_ATTR_PAD)) 12644 goto nla_put_failure; 12645 12646 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 12647 if (!func_attr) 12648 goto nla_put_failure; 12649 12650 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, 12651 func->instance_id)) 12652 goto nla_put_failure; 12653 12654 nla_nest_end(msg, func_attr); 12655 12656 genlmsg_end(msg, hdr); 12657 return genlmsg_reply(msg, info); 12658 12659 nla_put_failure: 12660 nlmsg_free(msg); 12661 return -ENOBUFS; 12662 } 12663 12664 static int nl80211_nan_del_func(struct sk_buff *skb, 12665 struct genl_info *info) 12666 { 12667 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12668 struct wireless_dev *wdev = info->user_ptr[1]; 12669 u64 cookie; 12670 12671 if (wdev->iftype != NL80211_IFTYPE_NAN) 12672 return -EOPNOTSUPP; 12673 12674 if (!wdev_running(wdev)) 12675 return -ENOTCONN; 12676 12677 if (!info->attrs[NL80211_ATTR_COOKIE]) 12678 return -EINVAL; 12679 12680 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 12681 12682 rdev_del_nan_func(rdev, wdev, cookie); 12683 12684 return 0; 12685 } 12686 12687 static int nl80211_nan_change_config(struct sk_buff *skb, 12688 struct genl_info *info) 12689 { 12690 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12691 struct wireless_dev *wdev = info->user_ptr[1]; 12692 struct cfg80211_nan_conf conf = {}; 12693 u32 changed = 0; 12694 12695 if (wdev->iftype != NL80211_IFTYPE_NAN) 12696 return -EOPNOTSUPP; 12697 12698 if (!wdev_running(wdev)) 12699 return -ENOTCONN; 12700 12701 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) { 12702 conf.master_pref = 12703 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 12704 if (conf.master_pref <= 1 || conf.master_pref == 255) 12705 return -EINVAL; 12706 12707 changed |= CFG80211_NAN_CONF_CHANGED_PREF; 12708 } 12709 12710 if (info->attrs[NL80211_ATTR_BANDS]) { 12711 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 12712 12713 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 12714 return -EOPNOTSUPP; 12715 12716 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 12717 return -EINVAL; 12718 12719 conf.bands = bands; 12720 changed |= CFG80211_NAN_CONF_CHANGED_BANDS; 12721 } 12722 12723 if (!changed) 12724 return -EINVAL; 12725 12726 return rdev_nan_change_conf(rdev, wdev, &conf, changed); 12727 } 12728 12729 void cfg80211_nan_match(struct wireless_dev *wdev, 12730 struct cfg80211_nan_match_params *match, gfp_t gfp) 12731 { 12732 struct wiphy *wiphy = wdev->wiphy; 12733 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 12734 struct nlattr *match_attr, *local_func_attr, *peer_func_attr; 12735 struct sk_buff *msg; 12736 void *hdr; 12737 12738 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr)) 12739 return; 12740 12741 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 12742 if (!msg) 12743 return; 12744 12745 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH); 12746 if (!hdr) { 12747 nlmsg_free(msg); 12748 return; 12749 } 12750 12751 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 12752 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 12753 wdev->netdev->ifindex)) || 12754 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 12755 NL80211_ATTR_PAD)) 12756 goto nla_put_failure; 12757 12758 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie, 12759 NL80211_ATTR_PAD) || 12760 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr)) 12761 goto nla_put_failure; 12762 12763 match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH); 12764 if (!match_attr) 12765 goto nla_put_failure; 12766 12767 local_func_attr = nla_nest_start_noflag(msg, 12768 NL80211_NAN_MATCH_FUNC_LOCAL); 12769 if (!local_func_attr) 12770 goto nla_put_failure; 12771 12772 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id)) 12773 goto nla_put_failure; 12774 12775 nla_nest_end(msg, local_func_attr); 12776 12777 peer_func_attr = nla_nest_start_noflag(msg, 12778 NL80211_NAN_MATCH_FUNC_PEER); 12779 if (!peer_func_attr) 12780 goto nla_put_failure; 12781 12782 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) || 12783 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id)) 12784 goto nla_put_failure; 12785 12786 if (match->info && match->info_len && 12787 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len, 12788 match->info)) 12789 goto nla_put_failure; 12790 12791 nla_nest_end(msg, peer_func_attr); 12792 nla_nest_end(msg, match_attr); 12793 genlmsg_end(msg, hdr); 12794 12795 if (!wdev->owner_nlportid) 12796 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 12797 msg, 0, NL80211_MCGRP_NAN, gfp); 12798 else 12799 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 12800 wdev->owner_nlportid); 12801 12802 return; 12803 12804 nla_put_failure: 12805 nlmsg_free(msg); 12806 } 12807 EXPORT_SYMBOL(cfg80211_nan_match); 12808 12809 void cfg80211_nan_func_terminated(struct wireless_dev *wdev, 12810 u8 inst_id, 12811 enum nl80211_nan_func_term_reason reason, 12812 u64 cookie, gfp_t gfp) 12813 { 12814 struct wiphy *wiphy = wdev->wiphy; 12815 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 12816 struct sk_buff *msg; 12817 struct nlattr *func_attr; 12818 void *hdr; 12819 12820 if (WARN_ON(!inst_id)) 12821 return; 12822 12823 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 12824 if (!msg) 12825 return; 12826 12827 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION); 12828 if (!hdr) { 12829 nlmsg_free(msg); 12830 return; 12831 } 12832 12833 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 12834 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 12835 wdev->netdev->ifindex)) || 12836 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 12837 NL80211_ATTR_PAD)) 12838 goto nla_put_failure; 12839 12840 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 12841 NL80211_ATTR_PAD)) 12842 goto nla_put_failure; 12843 12844 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 12845 if (!func_attr) 12846 goto nla_put_failure; 12847 12848 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) || 12849 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason)) 12850 goto nla_put_failure; 12851 12852 nla_nest_end(msg, func_attr); 12853 genlmsg_end(msg, hdr); 12854 12855 if (!wdev->owner_nlportid) 12856 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 12857 msg, 0, NL80211_MCGRP_NAN, gfp); 12858 else 12859 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 12860 wdev->owner_nlportid); 12861 12862 return; 12863 12864 nla_put_failure: 12865 nlmsg_free(msg); 12866 } 12867 EXPORT_SYMBOL(cfg80211_nan_func_terminated); 12868 12869 static int nl80211_get_protocol_features(struct sk_buff *skb, 12870 struct genl_info *info) 12871 { 12872 void *hdr; 12873 struct sk_buff *msg; 12874 12875 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12876 if (!msg) 12877 return -ENOMEM; 12878 12879 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12880 NL80211_CMD_GET_PROTOCOL_FEATURES); 12881 if (!hdr) 12882 goto nla_put_failure; 12883 12884 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES, 12885 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP)) 12886 goto nla_put_failure; 12887 12888 genlmsg_end(msg, hdr); 12889 return genlmsg_reply(msg, info); 12890 12891 nla_put_failure: 12892 kfree_skb(msg); 12893 return -ENOBUFS; 12894 } 12895 12896 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info) 12897 { 12898 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12899 struct cfg80211_update_ft_ies_params ft_params; 12900 struct net_device *dev = info->user_ptr[1]; 12901 12902 if (!rdev->ops->update_ft_ies) 12903 return -EOPNOTSUPP; 12904 12905 if (!info->attrs[NL80211_ATTR_MDID] || 12906 !info->attrs[NL80211_ATTR_IE]) 12907 return -EINVAL; 12908 12909 memset(&ft_params, 0, sizeof(ft_params)); 12910 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]); 12911 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12912 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12913 12914 return rdev_update_ft_ies(rdev, dev, &ft_params); 12915 } 12916 12917 static int nl80211_crit_protocol_start(struct sk_buff *skb, 12918 struct genl_info *info) 12919 { 12920 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12921 struct wireless_dev *wdev = info->user_ptr[1]; 12922 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC; 12923 u16 duration; 12924 int ret; 12925 12926 if (!rdev->ops->crit_proto_start) 12927 return -EOPNOTSUPP; 12928 12929 if (WARN_ON(!rdev->ops->crit_proto_stop)) 12930 return -EINVAL; 12931 12932 if (rdev->crit_proto_nlportid) 12933 return -EBUSY; 12934 12935 /* determine protocol if provided */ 12936 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID]) 12937 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]); 12938 12939 if (proto >= NUM_NL80211_CRIT_PROTO) 12940 return -EINVAL; 12941 12942 /* timeout must be provided */ 12943 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]) 12944 return -EINVAL; 12945 12946 duration = 12947 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]); 12948 12949 if (duration > NL80211_CRIT_PROTO_MAX_DURATION) 12950 return -ERANGE; 12951 12952 ret = rdev_crit_proto_start(rdev, wdev, proto, duration); 12953 if (!ret) 12954 rdev->crit_proto_nlportid = info->snd_portid; 12955 12956 return ret; 12957 } 12958 12959 static int nl80211_crit_protocol_stop(struct sk_buff *skb, 12960 struct genl_info *info) 12961 { 12962 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12963 struct wireless_dev *wdev = info->user_ptr[1]; 12964 12965 if (!rdev->ops->crit_proto_stop) 12966 return -EOPNOTSUPP; 12967 12968 if (rdev->crit_proto_nlportid) { 12969 rdev->crit_proto_nlportid = 0; 12970 rdev_crit_proto_stop(rdev, wdev); 12971 } 12972 return 0; 12973 } 12974 12975 static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd, 12976 struct nlattr *attr, 12977 struct netlink_ext_ack *extack) 12978 { 12979 if (vcmd->policy == VENDOR_CMD_RAW_DATA) { 12980 if (attr->nla_type & NLA_F_NESTED) { 12981 NL_SET_ERR_MSG_ATTR(extack, attr, 12982 "unexpected nested data"); 12983 return -EINVAL; 12984 } 12985 12986 return 0; 12987 } 12988 12989 if (!(attr->nla_type & NLA_F_NESTED)) { 12990 NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data"); 12991 return -EINVAL; 12992 } 12993 12994 return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack); 12995 } 12996 12997 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info) 12998 { 12999 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13000 struct wireless_dev *wdev = 13001 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs); 13002 int i, err; 13003 u32 vid, subcmd; 13004 13005 if (!rdev->wiphy.vendor_commands) 13006 return -EOPNOTSUPP; 13007 13008 if (IS_ERR(wdev)) { 13009 err = PTR_ERR(wdev); 13010 if (err != -EINVAL) 13011 return err; 13012 wdev = NULL; 13013 } else if (wdev->wiphy != &rdev->wiphy) { 13014 return -EINVAL; 13015 } 13016 13017 if (!info->attrs[NL80211_ATTR_VENDOR_ID] || 13018 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD]) 13019 return -EINVAL; 13020 13021 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]); 13022 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]); 13023 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 13024 const struct wiphy_vendor_command *vcmd; 13025 void *data = NULL; 13026 int len = 0; 13027 13028 vcmd = &rdev->wiphy.vendor_commands[i]; 13029 13030 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 13031 continue; 13032 13033 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 13034 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 13035 if (!wdev) 13036 return -EINVAL; 13037 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 13038 !wdev->netdev) 13039 return -EINVAL; 13040 13041 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 13042 if (!wdev_running(wdev)) 13043 return -ENETDOWN; 13044 } 13045 13046 if (!vcmd->doit) 13047 return -EOPNOTSUPP; 13048 } else { 13049 wdev = NULL; 13050 } 13051 13052 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) { 13053 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]); 13054 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]); 13055 13056 err = nl80211_vendor_check_policy(vcmd, 13057 info->attrs[NL80211_ATTR_VENDOR_DATA], 13058 info->extack); 13059 if (err) 13060 return err; 13061 } 13062 13063 rdev->cur_cmd_info = info; 13064 err = vcmd->doit(&rdev->wiphy, wdev, data, len); 13065 rdev->cur_cmd_info = NULL; 13066 return err; 13067 } 13068 13069 return -EOPNOTSUPP; 13070 } 13071 13072 static int nl80211_prepare_vendor_dump(struct sk_buff *skb, 13073 struct netlink_callback *cb, 13074 struct cfg80211_registered_device **rdev, 13075 struct wireless_dev **wdev) 13076 { 13077 struct nlattr **attrbuf; 13078 u32 vid, subcmd; 13079 unsigned int i; 13080 int vcmd_idx = -1; 13081 int err; 13082 void *data = NULL; 13083 unsigned int data_len = 0; 13084 13085 if (cb->args[0]) { 13086 /* subtract the 1 again here */ 13087 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 13088 struct wireless_dev *tmp; 13089 13090 if (!wiphy) 13091 return -ENODEV; 13092 *rdev = wiphy_to_rdev(wiphy); 13093 *wdev = NULL; 13094 13095 if (cb->args[1]) { 13096 list_for_each_entry(tmp, &wiphy->wdev_list, list) { 13097 if (tmp->identifier == cb->args[1] - 1) { 13098 *wdev = tmp; 13099 break; 13100 } 13101 } 13102 } 13103 13104 /* keep rtnl locked in successful case */ 13105 return 0; 13106 } 13107 13108 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 13109 if (!attrbuf) 13110 return -ENOMEM; 13111 13112 err = nlmsg_parse_deprecated(cb->nlh, 13113 GENL_HDRLEN + nl80211_fam.hdrsize, 13114 attrbuf, nl80211_fam.maxattr, 13115 nl80211_policy, NULL); 13116 if (err) 13117 goto out; 13118 13119 if (!attrbuf[NL80211_ATTR_VENDOR_ID] || 13120 !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) { 13121 err = -EINVAL; 13122 goto out; 13123 } 13124 13125 *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk), attrbuf); 13126 if (IS_ERR(*wdev)) 13127 *wdev = NULL; 13128 13129 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 13130 if (IS_ERR(*rdev)) { 13131 err = PTR_ERR(*rdev); 13132 goto out; 13133 } 13134 13135 vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]); 13136 subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]); 13137 13138 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) { 13139 const struct wiphy_vendor_command *vcmd; 13140 13141 vcmd = &(*rdev)->wiphy.vendor_commands[i]; 13142 13143 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 13144 continue; 13145 13146 if (!vcmd->dumpit) { 13147 err = -EOPNOTSUPP; 13148 goto out; 13149 } 13150 13151 vcmd_idx = i; 13152 break; 13153 } 13154 13155 if (vcmd_idx < 0) { 13156 err = -EOPNOTSUPP; 13157 goto out; 13158 } 13159 13160 if (attrbuf[NL80211_ATTR_VENDOR_DATA]) { 13161 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]); 13162 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]); 13163 13164 err = nl80211_vendor_check_policy( 13165 &(*rdev)->wiphy.vendor_commands[vcmd_idx], 13166 attrbuf[NL80211_ATTR_VENDOR_DATA], 13167 cb->extack); 13168 if (err) 13169 goto out; 13170 } 13171 13172 /* 0 is the first index - add 1 to parse only once */ 13173 cb->args[0] = (*rdev)->wiphy_idx + 1; 13174 /* add 1 to know if it was NULL */ 13175 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0; 13176 cb->args[2] = vcmd_idx; 13177 cb->args[3] = (unsigned long)data; 13178 cb->args[4] = data_len; 13179 13180 /* keep rtnl locked in successful case */ 13181 err = 0; 13182 out: 13183 kfree(attrbuf); 13184 return err; 13185 } 13186 13187 static int nl80211_vendor_cmd_dump(struct sk_buff *skb, 13188 struct netlink_callback *cb) 13189 { 13190 struct cfg80211_registered_device *rdev; 13191 struct wireless_dev *wdev; 13192 unsigned int vcmd_idx; 13193 const struct wiphy_vendor_command *vcmd; 13194 void *data; 13195 int data_len; 13196 int err; 13197 struct nlattr *vendor_data; 13198 13199 rtnl_lock(); 13200 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev); 13201 if (err) 13202 goto out; 13203 13204 vcmd_idx = cb->args[2]; 13205 data = (void *)cb->args[3]; 13206 data_len = cb->args[4]; 13207 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx]; 13208 13209 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 13210 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 13211 if (!wdev) { 13212 err = -EINVAL; 13213 goto out; 13214 } 13215 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 13216 !wdev->netdev) { 13217 err = -EINVAL; 13218 goto out; 13219 } 13220 13221 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 13222 if (!wdev_running(wdev)) { 13223 err = -ENETDOWN; 13224 goto out; 13225 } 13226 } 13227 } 13228 13229 while (1) { 13230 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 13231 cb->nlh->nlmsg_seq, NLM_F_MULTI, 13232 NL80211_CMD_VENDOR); 13233 if (!hdr) 13234 break; 13235 13236 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 13237 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 13238 wdev_id(wdev), 13239 NL80211_ATTR_PAD))) { 13240 genlmsg_cancel(skb, hdr); 13241 break; 13242 } 13243 13244 vendor_data = nla_nest_start_noflag(skb, 13245 NL80211_ATTR_VENDOR_DATA); 13246 if (!vendor_data) { 13247 genlmsg_cancel(skb, hdr); 13248 break; 13249 } 13250 13251 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len, 13252 (unsigned long *)&cb->args[5]); 13253 nla_nest_end(skb, vendor_data); 13254 13255 if (err == -ENOBUFS || err == -ENOENT) { 13256 genlmsg_cancel(skb, hdr); 13257 break; 13258 } else if (err) { 13259 genlmsg_cancel(skb, hdr); 13260 goto out; 13261 } 13262 13263 genlmsg_end(skb, hdr); 13264 } 13265 13266 err = skb->len; 13267 out: 13268 rtnl_unlock(); 13269 return err; 13270 } 13271 13272 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy, 13273 enum nl80211_commands cmd, 13274 enum nl80211_attrs attr, 13275 int approxlen) 13276 { 13277 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 13278 13279 if (WARN_ON(!rdev->cur_cmd_info)) 13280 return NULL; 13281 13282 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen, 13283 rdev->cur_cmd_info->snd_portid, 13284 rdev->cur_cmd_info->snd_seq, 13285 cmd, attr, NULL, GFP_KERNEL); 13286 } 13287 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb); 13288 13289 int cfg80211_vendor_cmd_reply(struct sk_buff *skb) 13290 { 13291 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 13292 void *hdr = ((void **)skb->cb)[1]; 13293 struct nlattr *data = ((void **)skb->cb)[2]; 13294 13295 /* clear CB data for netlink core to own from now on */ 13296 memset(skb->cb, 0, sizeof(skb->cb)); 13297 13298 if (WARN_ON(!rdev->cur_cmd_info)) { 13299 kfree_skb(skb); 13300 return -EINVAL; 13301 } 13302 13303 nla_nest_end(skb, data); 13304 genlmsg_end(skb, hdr); 13305 return genlmsg_reply(skb, rdev->cur_cmd_info); 13306 } 13307 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply); 13308 13309 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy) 13310 { 13311 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 13312 13313 if (WARN_ON(!rdev->cur_cmd_info)) 13314 return 0; 13315 13316 return rdev->cur_cmd_info->snd_portid; 13317 } 13318 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender); 13319 13320 static int nl80211_set_qos_map(struct sk_buff *skb, 13321 struct genl_info *info) 13322 { 13323 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13324 struct cfg80211_qos_map *qos_map = NULL; 13325 struct net_device *dev = info->user_ptr[1]; 13326 u8 *pos, len, num_des, des_len, des; 13327 int ret; 13328 13329 if (!rdev->ops->set_qos_map) 13330 return -EOPNOTSUPP; 13331 13332 if (info->attrs[NL80211_ATTR_QOS_MAP]) { 13333 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]); 13334 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]); 13335 13336 if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN || 13337 len > IEEE80211_QOS_MAP_LEN_MAX) 13338 return -EINVAL; 13339 13340 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL); 13341 if (!qos_map) 13342 return -ENOMEM; 13343 13344 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1; 13345 if (num_des) { 13346 des_len = num_des * 13347 sizeof(struct cfg80211_dscp_exception); 13348 memcpy(qos_map->dscp_exception, pos, des_len); 13349 qos_map->num_des = num_des; 13350 for (des = 0; des < num_des; des++) { 13351 if (qos_map->dscp_exception[des].up > 7) { 13352 kfree(qos_map); 13353 return -EINVAL; 13354 } 13355 } 13356 pos += des_len; 13357 } 13358 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN); 13359 } 13360 13361 wdev_lock(dev->ieee80211_ptr); 13362 ret = nl80211_key_allowed(dev->ieee80211_ptr); 13363 if (!ret) 13364 ret = rdev_set_qos_map(rdev, dev, qos_map); 13365 wdev_unlock(dev->ieee80211_ptr); 13366 13367 kfree(qos_map); 13368 return ret; 13369 } 13370 13371 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info) 13372 { 13373 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13374 struct net_device *dev = info->user_ptr[1]; 13375 struct wireless_dev *wdev = dev->ieee80211_ptr; 13376 const u8 *peer; 13377 u8 tsid, up; 13378 u16 admitted_time = 0; 13379 int err; 13380 13381 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)) 13382 return -EOPNOTSUPP; 13383 13384 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] || 13385 !info->attrs[NL80211_ATTR_USER_PRIO]) 13386 return -EINVAL; 13387 13388 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 13389 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]); 13390 13391 /* WMM uses TIDs 0-7 even for TSPEC */ 13392 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) { 13393 /* TODO: handle 802.11 TSPEC/admission control 13394 * need more attributes for that (e.g. BA session requirement); 13395 * change the WMM adminssion test above to allow both then 13396 */ 13397 return -EINVAL; 13398 } 13399 13400 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 13401 13402 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) { 13403 admitted_time = 13404 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]); 13405 if (!admitted_time) 13406 return -EINVAL; 13407 } 13408 13409 wdev_lock(wdev); 13410 switch (wdev->iftype) { 13411 case NL80211_IFTYPE_STATION: 13412 case NL80211_IFTYPE_P2P_CLIENT: 13413 if (wdev->current_bss) 13414 break; 13415 err = -ENOTCONN; 13416 goto out; 13417 default: 13418 err = -EOPNOTSUPP; 13419 goto out; 13420 } 13421 13422 err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time); 13423 13424 out: 13425 wdev_unlock(wdev); 13426 return err; 13427 } 13428 13429 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info) 13430 { 13431 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13432 struct net_device *dev = info->user_ptr[1]; 13433 struct wireless_dev *wdev = dev->ieee80211_ptr; 13434 const u8 *peer; 13435 u8 tsid; 13436 int err; 13437 13438 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC]) 13439 return -EINVAL; 13440 13441 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 13442 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 13443 13444 wdev_lock(wdev); 13445 err = rdev_del_tx_ts(rdev, dev, tsid, peer); 13446 wdev_unlock(wdev); 13447 13448 return err; 13449 } 13450 13451 static int nl80211_tdls_channel_switch(struct sk_buff *skb, 13452 struct genl_info *info) 13453 { 13454 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13455 struct net_device *dev = info->user_ptr[1]; 13456 struct wireless_dev *wdev = dev->ieee80211_ptr; 13457 struct cfg80211_chan_def chandef = {}; 13458 const u8 *addr; 13459 u8 oper_class; 13460 int err; 13461 13462 if (!rdev->ops->tdls_channel_switch || 13463 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 13464 return -EOPNOTSUPP; 13465 13466 switch (dev->ieee80211_ptr->iftype) { 13467 case NL80211_IFTYPE_STATION: 13468 case NL80211_IFTYPE_P2P_CLIENT: 13469 break; 13470 default: 13471 return -EOPNOTSUPP; 13472 } 13473 13474 if (!info->attrs[NL80211_ATTR_MAC] || 13475 !info->attrs[NL80211_ATTR_OPER_CLASS]) 13476 return -EINVAL; 13477 13478 err = nl80211_parse_chandef(rdev, info, &chandef); 13479 if (err) 13480 return err; 13481 13482 /* 13483 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012 13484 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the 13485 * specification is not defined for them. 13486 */ 13487 if (chandef.chan->band == NL80211_BAND_2GHZ && 13488 chandef.width != NL80211_CHAN_WIDTH_20_NOHT && 13489 chandef.width != NL80211_CHAN_WIDTH_20) 13490 return -EINVAL; 13491 13492 /* we will be active on the TDLS link */ 13493 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 13494 wdev->iftype)) 13495 return -EINVAL; 13496 13497 /* don't allow switching to DFS channels */ 13498 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype)) 13499 return -EINVAL; 13500 13501 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 13502 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]); 13503 13504 wdev_lock(wdev); 13505 err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef); 13506 wdev_unlock(wdev); 13507 13508 return err; 13509 } 13510 13511 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb, 13512 struct genl_info *info) 13513 { 13514 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13515 struct net_device *dev = info->user_ptr[1]; 13516 struct wireless_dev *wdev = dev->ieee80211_ptr; 13517 const u8 *addr; 13518 13519 if (!rdev->ops->tdls_channel_switch || 13520 !rdev->ops->tdls_cancel_channel_switch || 13521 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 13522 return -EOPNOTSUPP; 13523 13524 switch (dev->ieee80211_ptr->iftype) { 13525 case NL80211_IFTYPE_STATION: 13526 case NL80211_IFTYPE_P2P_CLIENT: 13527 break; 13528 default: 13529 return -EOPNOTSUPP; 13530 } 13531 13532 if (!info->attrs[NL80211_ATTR_MAC]) 13533 return -EINVAL; 13534 13535 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 13536 13537 wdev_lock(wdev); 13538 rdev_tdls_cancel_channel_switch(rdev, dev, addr); 13539 wdev_unlock(wdev); 13540 13541 return 0; 13542 } 13543 13544 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb, 13545 struct genl_info *info) 13546 { 13547 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13548 struct net_device *dev = info->user_ptr[1]; 13549 struct wireless_dev *wdev = dev->ieee80211_ptr; 13550 const struct nlattr *nla; 13551 bool enabled; 13552 13553 if (!rdev->ops->set_multicast_to_unicast) 13554 return -EOPNOTSUPP; 13555 13556 if (wdev->iftype != NL80211_IFTYPE_AP && 13557 wdev->iftype != NL80211_IFTYPE_P2P_GO) 13558 return -EOPNOTSUPP; 13559 13560 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED]; 13561 enabled = nla_get_flag(nla); 13562 13563 return rdev_set_multicast_to_unicast(rdev, dev, enabled); 13564 } 13565 13566 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info) 13567 { 13568 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13569 struct net_device *dev = info->user_ptr[1]; 13570 struct wireless_dev *wdev = dev->ieee80211_ptr; 13571 struct cfg80211_pmk_conf pmk_conf = {}; 13572 int ret; 13573 13574 if (wdev->iftype != NL80211_IFTYPE_STATION && 13575 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 13576 return -EOPNOTSUPP; 13577 13578 if (!wiphy_ext_feature_isset(&rdev->wiphy, 13579 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 13580 return -EOPNOTSUPP; 13581 13582 if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK]) 13583 return -EINVAL; 13584 13585 wdev_lock(wdev); 13586 if (!wdev->current_bss) { 13587 ret = -ENOTCONN; 13588 goto out; 13589 } 13590 13591 pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 13592 if (memcmp(pmk_conf.aa, wdev->current_bss->pub.bssid, ETH_ALEN)) { 13593 ret = -EINVAL; 13594 goto out; 13595 } 13596 13597 pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 13598 pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 13599 if (pmk_conf.pmk_len != WLAN_PMK_LEN && 13600 pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) { 13601 ret = -EINVAL; 13602 goto out; 13603 } 13604 13605 if (info->attrs[NL80211_ATTR_PMKR0_NAME]) { 13606 int r0_name_len = nla_len(info->attrs[NL80211_ATTR_PMKR0_NAME]); 13607 13608 if (r0_name_len != WLAN_PMK_NAME_LEN) { 13609 ret = -EINVAL; 13610 goto out; 13611 } 13612 13613 pmk_conf.pmk_r0_name = 13614 nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]); 13615 } 13616 13617 ret = rdev_set_pmk(rdev, dev, &pmk_conf); 13618 out: 13619 wdev_unlock(wdev); 13620 return ret; 13621 } 13622 13623 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info) 13624 { 13625 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13626 struct net_device *dev = info->user_ptr[1]; 13627 struct wireless_dev *wdev = dev->ieee80211_ptr; 13628 const u8 *aa; 13629 int ret; 13630 13631 if (wdev->iftype != NL80211_IFTYPE_STATION && 13632 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 13633 return -EOPNOTSUPP; 13634 13635 if (!wiphy_ext_feature_isset(&rdev->wiphy, 13636 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 13637 return -EOPNOTSUPP; 13638 13639 if (!info->attrs[NL80211_ATTR_MAC]) 13640 return -EINVAL; 13641 13642 wdev_lock(wdev); 13643 aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 13644 ret = rdev_del_pmk(rdev, dev, aa); 13645 wdev_unlock(wdev); 13646 13647 return ret; 13648 } 13649 13650 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info) 13651 { 13652 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13653 struct net_device *dev = info->user_ptr[1]; 13654 struct cfg80211_external_auth_params params; 13655 13656 if (!rdev->ops->external_auth) 13657 return -EOPNOTSUPP; 13658 13659 if (!info->attrs[NL80211_ATTR_SSID] && 13660 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 13661 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 13662 return -EINVAL; 13663 13664 if (!info->attrs[NL80211_ATTR_BSSID]) 13665 return -EINVAL; 13666 13667 if (!info->attrs[NL80211_ATTR_STATUS_CODE]) 13668 return -EINVAL; 13669 13670 memset(¶ms, 0, sizeof(params)); 13671 13672 if (info->attrs[NL80211_ATTR_SSID]) { 13673 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 13674 if (params.ssid.ssid_len == 0 || 13675 params.ssid.ssid_len > IEEE80211_MAX_SSID_LEN) 13676 return -EINVAL; 13677 memcpy(params.ssid.ssid, 13678 nla_data(info->attrs[NL80211_ATTR_SSID]), 13679 params.ssid.ssid_len); 13680 } 13681 13682 memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]), 13683 ETH_ALEN); 13684 13685 params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 13686 13687 if (info->attrs[NL80211_ATTR_PMKID]) 13688 params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 13689 13690 return rdev_external_auth(rdev, dev, ¶ms); 13691 } 13692 13693 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info) 13694 { 13695 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13696 struct net_device *dev = info->user_ptr[1]; 13697 struct wireless_dev *wdev = dev->ieee80211_ptr; 13698 const u8 *buf; 13699 size_t len; 13700 u8 *dest; 13701 u8 src[ETH_ALEN]; 13702 u16 proto; 13703 bool noencrypt; 13704 int err; 13705 13706 if (!wiphy_ext_feature_isset(&rdev->wiphy, 13707 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 13708 return -EOPNOTSUPP; 13709 13710 if (!rdev->ops->tx_control_port) 13711 return -EOPNOTSUPP; 13712 13713 if (!info->attrs[NL80211_ATTR_FRAME] || 13714 !info->attrs[NL80211_ATTR_MAC] || 13715 !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 13716 GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing"); 13717 return -EINVAL; 13718 } 13719 13720 wdev_lock(wdev); 13721 13722 switch (wdev->iftype) { 13723 case NL80211_IFTYPE_AP: 13724 case NL80211_IFTYPE_P2P_GO: 13725 case NL80211_IFTYPE_MESH_POINT: 13726 break; 13727 case NL80211_IFTYPE_ADHOC: 13728 case NL80211_IFTYPE_STATION: 13729 case NL80211_IFTYPE_P2P_CLIENT: 13730 if (wdev->current_bss) 13731 break; 13732 err = -ENOTCONN; 13733 goto out; 13734 default: 13735 err = -EOPNOTSUPP; 13736 goto out; 13737 } 13738 13739 /* copy src address under wdev_lock, as we may copy wdev_address */ 13740 if (info->attrs[NL80211_ATTR_SRC_MAC]) 13741 ether_addr_copy(src, 13742 nla_data(info->attrs[NL80211_ATTR_SRC_MAC])); 13743 else 13744 ether_addr_copy(src, wdev_address(wdev)); 13745 13746 wdev_unlock(wdev); 13747 13748 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 13749 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 13750 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 13751 proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 13752 noencrypt = 13753 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]); 13754 13755 return rdev_tx_control_port(rdev, dev, buf, len, 13756 dest, src, cpu_to_be16(proto), noencrypt); 13757 13758 out: 13759 wdev_unlock(wdev); 13760 return err; 13761 } 13762 13763 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb, 13764 struct genl_info *info) 13765 { 13766 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13767 struct net_device *dev = info->user_ptr[1]; 13768 struct wireless_dev *wdev = dev->ieee80211_ptr; 13769 struct cfg80211_ftm_responder_stats ftm_stats = {}; 13770 struct sk_buff *msg; 13771 void *hdr; 13772 struct nlattr *ftm_stats_attr; 13773 int err; 13774 13775 if (wdev->iftype != NL80211_IFTYPE_AP || !wdev->beacon_interval) 13776 return -EOPNOTSUPP; 13777 13778 err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats); 13779 if (err) 13780 return err; 13781 13782 if (!ftm_stats.filled) 13783 return -ENODATA; 13784 13785 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 13786 if (!msg) 13787 return -ENOMEM; 13788 13789 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13790 NL80211_CMD_GET_FTM_RESPONDER_STATS); 13791 if (!hdr) 13792 goto nla_put_failure; 13793 13794 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 13795 goto nla_put_failure; 13796 13797 ftm_stats_attr = nla_nest_start_noflag(msg, 13798 NL80211_ATTR_FTM_RESPONDER_STATS); 13799 if (!ftm_stats_attr) 13800 goto nla_put_failure; 13801 13802 #define SET_FTM(field, name, type) \ 13803 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 13804 nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name, \ 13805 ftm_stats.field)) \ 13806 goto nla_put_failure; } while (0) 13807 #define SET_FTM_U64(field, name) \ 13808 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 13809 nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name, \ 13810 ftm_stats.field, NL80211_FTM_STATS_PAD)) \ 13811 goto nla_put_failure; } while (0) 13812 13813 SET_FTM(success_num, SUCCESS_NUM, u32); 13814 SET_FTM(partial_num, PARTIAL_NUM, u32); 13815 SET_FTM(failed_num, FAILED_NUM, u32); 13816 SET_FTM(asap_num, ASAP_NUM, u32); 13817 SET_FTM(non_asap_num, NON_ASAP_NUM, u32); 13818 SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC); 13819 SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32); 13820 SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32); 13821 SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32); 13822 #undef SET_FTM 13823 13824 nla_nest_end(msg, ftm_stats_attr); 13825 13826 genlmsg_end(msg, hdr); 13827 return genlmsg_reply(msg, info); 13828 13829 nla_put_failure: 13830 nlmsg_free(msg); 13831 return -ENOBUFS; 13832 } 13833 13834 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info) 13835 { 13836 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13837 struct cfg80211_update_owe_info owe_info; 13838 struct net_device *dev = info->user_ptr[1]; 13839 13840 if (!rdev->ops->update_owe_info) 13841 return -EOPNOTSUPP; 13842 13843 if (!info->attrs[NL80211_ATTR_STATUS_CODE] || 13844 !info->attrs[NL80211_ATTR_MAC]) 13845 return -EINVAL; 13846 13847 memset(&owe_info, 0, sizeof(owe_info)); 13848 owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 13849 nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN); 13850 13851 if (info->attrs[NL80211_ATTR_IE]) { 13852 owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 13853 owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 13854 } 13855 13856 return rdev_update_owe_info(rdev, dev, &owe_info); 13857 } 13858 13859 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info) 13860 { 13861 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13862 struct net_device *dev = info->user_ptr[1]; 13863 struct wireless_dev *wdev = dev->ieee80211_ptr; 13864 struct station_info sinfo = {}; 13865 const u8 *buf; 13866 size_t len; 13867 u8 *dest; 13868 int err; 13869 13870 if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station) 13871 return -EOPNOTSUPP; 13872 13873 if (!info->attrs[NL80211_ATTR_MAC] || 13874 !info->attrs[NL80211_ATTR_FRAME]) { 13875 GENL_SET_ERR_MSG(info, "Frame or MAC missing"); 13876 return -EINVAL; 13877 } 13878 13879 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 13880 return -EOPNOTSUPP; 13881 13882 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 13883 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 13884 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 13885 13886 if (len < sizeof(struct ethhdr)) 13887 return -EINVAL; 13888 13889 if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) || 13890 !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr)) 13891 return -EINVAL; 13892 13893 err = rdev_get_station(rdev, dev, dest, &sinfo); 13894 if (err) 13895 return err; 13896 13897 cfg80211_sinfo_release_content(&sinfo); 13898 13899 return rdev_probe_mesh_link(rdev, dev, dest, buf, len); 13900 } 13901 13902 #define NL80211_FLAG_NEED_WIPHY 0x01 13903 #define NL80211_FLAG_NEED_NETDEV 0x02 13904 #define NL80211_FLAG_NEED_RTNL 0x04 13905 #define NL80211_FLAG_CHECK_NETDEV_UP 0x08 13906 #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\ 13907 NL80211_FLAG_CHECK_NETDEV_UP) 13908 #define NL80211_FLAG_NEED_WDEV 0x10 13909 /* If a netdev is associated, it must be UP, P2P must be started */ 13910 #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\ 13911 NL80211_FLAG_CHECK_NETDEV_UP) 13912 #define NL80211_FLAG_CLEAR_SKB 0x20 13913 13914 static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb, 13915 struct genl_info *info) 13916 { 13917 struct cfg80211_registered_device *rdev; 13918 struct wireless_dev *wdev; 13919 struct net_device *dev; 13920 bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL; 13921 13922 if (rtnl) 13923 rtnl_lock(); 13924 13925 if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) { 13926 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 13927 if (IS_ERR(rdev)) { 13928 if (rtnl) 13929 rtnl_unlock(); 13930 return PTR_ERR(rdev); 13931 } 13932 info->user_ptr[0] = rdev; 13933 } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV || 13934 ops->internal_flags & NL80211_FLAG_NEED_WDEV) { 13935 ASSERT_RTNL(); 13936 13937 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info), 13938 info->attrs); 13939 if (IS_ERR(wdev)) { 13940 if (rtnl) 13941 rtnl_unlock(); 13942 return PTR_ERR(wdev); 13943 } 13944 13945 dev = wdev->netdev; 13946 rdev = wiphy_to_rdev(wdev->wiphy); 13947 13948 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) { 13949 if (!dev) { 13950 if (rtnl) 13951 rtnl_unlock(); 13952 return -EINVAL; 13953 } 13954 13955 info->user_ptr[1] = dev; 13956 } else { 13957 info->user_ptr[1] = wdev; 13958 } 13959 13960 if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP && 13961 !wdev_running(wdev)) { 13962 if (rtnl) 13963 rtnl_unlock(); 13964 return -ENETDOWN; 13965 } 13966 13967 if (dev) 13968 dev_hold(dev); 13969 13970 info->user_ptr[0] = rdev; 13971 } 13972 13973 return 0; 13974 } 13975 13976 static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb, 13977 struct genl_info *info) 13978 { 13979 if (info->user_ptr[1]) { 13980 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) { 13981 struct wireless_dev *wdev = info->user_ptr[1]; 13982 13983 if (wdev->netdev) 13984 dev_put(wdev->netdev); 13985 } else { 13986 dev_put(info->user_ptr[1]); 13987 } 13988 } 13989 13990 if (ops->internal_flags & NL80211_FLAG_NEED_RTNL) 13991 rtnl_unlock(); 13992 13993 /* If needed, clear the netlink message payload from the SKB 13994 * as it might contain key data that shouldn't stick around on 13995 * the heap after the SKB is freed. The netlink message header 13996 * is still needed for further processing, so leave it intact. 13997 */ 13998 if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) { 13999 struct nlmsghdr *nlh = nlmsg_hdr(skb); 14000 14001 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh)); 14002 } 14003 } 14004 14005 static const struct genl_ops nl80211_ops[] = { 14006 { 14007 .cmd = NL80211_CMD_GET_WIPHY, 14008 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14009 .doit = nl80211_get_wiphy, 14010 .dumpit = nl80211_dump_wiphy, 14011 .done = nl80211_dump_wiphy_done, 14012 /* can be retrieved by unprivileged users */ 14013 .internal_flags = NL80211_FLAG_NEED_WIPHY | 14014 NL80211_FLAG_NEED_RTNL, 14015 }, 14016 { 14017 .cmd = NL80211_CMD_SET_WIPHY, 14018 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14019 .doit = nl80211_set_wiphy, 14020 .flags = GENL_UNS_ADMIN_PERM, 14021 .internal_flags = NL80211_FLAG_NEED_RTNL, 14022 }, 14023 { 14024 .cmd = NL80211_CMD_GET_INTERFACE, 14025 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14026 .doit = nl80211_get_interface, 14027 .dumpit = nl80211_dump_interface, 14028 /* can be retrieved by unprivileged users */ 14029 .internal_flags = NL80211_FLAG_NEED_WDEV | 14030 NL80211_FLAG_NEED_RTNL, 14031 }, 14032 { 14033 .cmd = NL80211_CMD_SET_INTERFACE, 14034 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14035 .doit = nl80211_set_interface, 14036 .flags = GENL_UNS_ADMIN_PERM, 14037 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14038 NL80211_FLAG_NEED_RTNL, 14039 }, 14040 { 14041 .cmd = NL80211_CMD_NEW_INTERFACE, 14042 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14043 .doit = nl80211_new_interface, 14044 .flags = GENL_UNS_ADMIN_PERM, 14045 .internal_flags = NL80211_FLAG_NEED_WIPHY | 14046 NL80211_FLAG_NEED_RTNL, 14047 }, 14048 { 14049 .cmd = NL80211_CMD_DEL_INTERFACE, 14050 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14051 .doit = nl80211_del_interface, 14052 .flags = GENL_UNS_ADMIN_PERM, 14053 .internal_flags = NL80211_FLAG_NEED_WDEV | 14054 NL80211_FLAG_NEED_RTNL, 14055 }, 14056 { 14057 .cmd = NL80211_CMD_GET_KEY, 14058 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14059 .doit = nl80211_get_key, 14060 .flags = GENL_UNS_ADMIN_PERM, 14061 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14062 NL80211_FLAG_NEED_RTNL, 14063 }, 14064 { 14065 .cmd = NL80211_CMD_SET_KEY, 14066 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14067 .doit = nl80211_set_key, 14068 .flags = GENL_UNS_ADMIN_PERM, 14069 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14070 NL80211_FLAG_NEED_RTNL | 14071 NL80211_FLAG_CLEAR_SKB, 14072 }, 14073 { 14074 .cmd = NL80211_CMD_NEW_KEY, 14075 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14076 .doit = nl80211_new_key, 14077 .flags = GENL_UNS_ADMIN_PERM, 14078 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14079 NL80211_FLAG_NEED_RTNL | 14080 NL80211_FLAG_CLEAR_SKB, 14081 }, 14082 { 14083 .cmd = NL80211_CMD_DEL_KEY, 14084 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14085 .doit = nl80211_del_key, 14086 .flags = GENL_UNS_ADMIN_PERM, 14087 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14088 NL80211_FLAG_NEED_RTNL, 14089 }, 14090 { 14091 .cmd = NL80211_CMD_SET_BEACON, 14092 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14093 .flags = GENL_UNS_ADMIN_PERM, 14094 .doit = nl80211_set_beacon, 14095 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14096 NL80211_FLAG_NEED_RTNL, 14097 }, 14098 { 14099 .cmd = NL80211_CMD_START_AP, 14100 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14101 .flags = GENL_UNS_ADMIN_PERM, 14102 .doit = nl80211_start_ap, 14103 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14104 NL80211_FLAG_NEED_RTNL, 14105 }, 14106 { 14107 .cmd = NL80211_CMD_STOP_AP, 14108 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14109 .flags = GENL_UNS_ADMIN_PERM, 14110 .doit = nl80211_stop_ap, 14111 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14112 NL80211_FLAG_NEED_RTNL, 14113 }, 14114 { 14115 .cmd = NL80211_CMD_GET_STATION, 14116 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14117 .doit = nl80211_get_station, 14118 .dumpit = nl80211_dump_station, 14119 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14120 NL80211_FLAG_NEED_RTNL, 14121 }, 14122 { 14123 .cmd = NL80211_CMD_SET_STATION, 14124 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14125 .doit = nl80211_set_station, 14126 .flags = GENL_UNS_ADMIN_PERM, 14127 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14128 NL80211_FLAG_NEED_RTNL, 14129 }, 14130 { 14131 .cmd = NL80211_CMD_NEW_STATION, 14132 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14133 .doit = nl80211_new_station, 14134 .flags = GENL_UNS_ADMIN_PERM, 14135 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14136 NL80211_FLAG_NEED_RTNL, 14137 }, 14138 { 14139 .cmd = NL80211_CMD_DEL_STATION, 14140 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14141 .doit = nl80211_del_station, 14142 .flags = GENL_UNS_ADMIN_PERM, 14143 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14144 NL80211_FLAG_NEED_RTNL, 14145 }, 14146 { 14147 .cmd = NL80211_CMD_GET_MPATH, 14148 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14149 .doit = nl80211_get_mpath, 14150 .dumpit = nl80211_dump_mpath, 14151 .flags = GENL_UNS_ADMIN_PERM, 14152 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14153 NL80211_FLAG_NEED_RTNL, 14154 }, 14155 { 14156 .cmd = NL80211_CMD_GET_MPP, 14157 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14158 .doit = nl80211_get_mpp, 14159 .dumpit = nl80211_dump_mpp, 14160 .flags = GENL_UNS_ADMIN_PERM, 14161 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14162 NL80211_FLAG_NEED_RTNL, 14163 }, 14164 { 14165 .cmd = NL80211_CMD_SET_MPATH, 14166 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14167 .doit = nl80211_set_mpath, 14168 .flags = GENL_UNS_ADMIN_PERM, 14169 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14170 NL80211_FLAG_NEED_RTNL, 14171 }, 14172 { 14173 .cmd = NL80211_CMD_NEW_MPATH, 14174 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14175 .doit = nl80211_new_mpath, 14176 .flags = GENL_UNS_ADMIN_PERM, 14177 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14178 NL80211_FLAG_NEED_RTNL, 14179 }, 14180 { 14181 .cmd = NL80211_CMD_DEL_MPATH, 14182 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14183 .doit = nl80211_del_mpath, 14184 .flags = GENL_UNS_ADMIN_PERM, 14185 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14186 NL80211_FLAG_NEED_RTNL, 14187 }, 14188 { 14189 .cmd = NL80211_CMD_SET_BSS, 14190 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14191 .doit = nl80211_set_bss, 14192 .flags = GENL_UNS_ADMIN_PERM, 14193 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14194 NL80211_FLAG_NEED_RTNL, 14195 }, 14196 { 14197 .cmd = NL80211_CMD_GET_REG, 14198 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14199 .doit = nl80211_get_reg_do, 14200 .dumpit = nl80211_get_reg_dump, 14201 .internal_flags = NL80211_FLAG_NEED_RTNL, 14202 /* can be retrieved by unprivileged users */ 14203 }, 14204 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 14205 { 14206 .cmd = NL80211_CMD_SET_REG, 14207 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14208 .doit = nl80211_set_reg, 14209 .flags = GENL_ADMIN_PERM, 14210 .internal_flags = NL80211_FLAG_NEED_RTNL, 14211 }, 14212 #endif 14213 { 14214 .cmd = NL80211_CMD_REQ_SET_REG, 14215 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14216 .doit = nl80211_req_set_reg, 14217 .flags = GENL_ADMIN_PERM, 14218 }, 14219 { 14220 .cmd = NL80211_CMD_RELOAD_REGDB, 14221 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14222 .doit = nl80211_reload_regdb, 14223 .flags = GENL_ADMIN_PERM, 14224 }, 14225 { 14226 .cmd = NL80211_CMD_GET_MESH_CONFIG, 14227 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14228 .doit = nl80211_get_mesh_config, 14229 /* can be retrieved by unprivileged users */ 14230 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14231 NL80211_FLAG_NEED_RTNL, 14232 }, 14233 { 14234 .cmd = NL80211_CMD_SET_MESH_CONFIG, 14235 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14236 .doit = nl80211_update_mesh_config, 14237 .flags = GENL_UNS_ADMIN_PERM, 14238 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14239 NL80211_FLAG_NEED_RTNL, 14240 }, 14241 { 14242 .cmd = NL80211_CMD_TRIGGER_SCAN, 14243 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14244 .doit = nl80211_trigger_scan, 14245 .flags = GENL_UNS_ADMIN_PERM, 14246 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14247 NL80211_FLAG_NEED_RTNL, 14248 }, 14249 { 14250 .cmd = NL80211_CMD_ABORT_SCAN, 14251 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14252 .doit = nl80211_abort_scan, 14253 .flags = GENL_UNS_ADMIN_PERM, 14254 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14255 NL80211_FLAG_NEED_RTNL, 14256 }, 14257 { 14258 .cmd = NL80211_CMD_GET_SCAN, 14259 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14260 .dumpit = nl80211_dump_scan, 14261 }, 14262 { 14263 .cmd = NL80211_CMD_START_SCHED_SCAN, 14264 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14265 .doit = nl80211_start_sched_scan, 14266 .flags = GENL_UNS_ADMIN_PERM, 14267 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14268 NL80211_FLAG_NEED_RTNL, 14269 }, 14270 { 14271 .cmd = NL80211_CMD_STOP_SCHED_SCAN, 14272 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14273 .doit = nl80211_stop_sched_scan, 14274 .flags = GENL_UNS_ADMIN_PERM, 14275 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14276 NL80211_FLAG_NEED_RTNL, 14277 }, 14278 { 14279 .cmd = NL80211_CMD_AUTHENTICATE, 14280 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14281 .doit = nl80211_authenticate, 14282 .flags = GENL_UNS_ADMIN_PERM, 14283 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14284 NL80211_FLAG_NEED_RTNL | 14285 NL80211_FLAG_CLEAR_SKB, 14286 }, 14287 { 14288 .cmd = NL80211_CMD_ASSOCIATE, 14289 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14290 .doit = nl80211_associate, 14291 .flags = GENL_UNS_ADMIN_PERM, 14292 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14293 NL80211_FLAG_NEED_RTNL | 14294 NL80211_FLAG_CLEAR_SKB, 14295 }, 14296 { 14297 .cmd = NL80211_CMD_DEAUTHENTICATE, 14298 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14299 .doit = nl80211_deauthenticate, 14300 .flags = GENL_UNS_ADMIN_PERM, 14301 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14302 NL80211_FLAG_NEED_RTNL, 14303 }, 14304 { 14305 .cmd = NL80211_CMD_DISASSOCIATE, 14306 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14307 .doit = nl80211_disassociate, 14308 .flags = GENL_UNS_ADMIN_PERM, 14309 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14310 NL80211_FLAG_NEED_RTNL, 14311 }, 14312 { 14313 .cmd = NL80211_CMD_JOIN_IBSS, 14314 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14315 .doit = nl80211_join_ibss, 14316 .flags = GENL_UNS_ADMIN_PERM, 14317 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14318 NL80211_FLAG_NEED_RTNL, 14319 }, 14320 { 14321 .cmd = NL80211_CMD_LEAVE_IBSS, 14322 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14323 .doit = nl80211_leave_ibss, 14324 .flags = GENL_UNS_ADMIN_PERM, 14325 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14326 NL80211_FLAG_NEED_RTNL, 14327 }, 14328 #ifdef CONFIG_NL80211_TESTMODE 14329 { 14330 .cmd = NL80211_CMD_TESTMODE, 14331 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14332 .doit = nl80211_testmode_do, 14333 .dumpit = nl80211_testmode_dump, 14334 .flags = GENL_UNS_ADMIN_PERM, 14335 .internal_flags = NL80211_FLAG_NEED_WIPHY | 14336 NL80211_FLAG_NEED_RTNL, 14337 }, 14338 #endif 14339 { 14340 .cmd = NL80211_CMD_CONNECT, 14341 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14342 .doit = nl80211_connect, 14343 .flags = GENL_UNS_ADMIN_PERM, 14344 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14345 NL80211_FLAG_NEED_RTNL | 14346 NL80211_FLAG_CLEAR_SKB, 14347 }, 14348 { 14349 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS, 14350 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14351 .doit = nl80211_update_connect_params, 14352 .flags = GENL_ADMIN_PERM, 14353 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14354 NL80211_FLAG_NEED_RTNL | 14355 NL80211_FLAG_CLEAR_SKB, 14356 }, 14357 { 14358 .cmd = NL80211_CMD_DISCONNECT, 14359 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14360 .doit = nl80211_disconnect, 14361 .flags = GENL_UNS_ADMIN_PERM, 14362 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14363 NL80211_FLAG_NEED_RTNL, 14364 }, 14365 { 14366 .cmd = NL80211_CMD_SET_WIPHY_NETNS, 14367 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14368 .doit = nl80211_wiphy_netns, 14369 .flags = GENL_UNS_ADMIN_PERM, 14370 .internal_flags = NL80211_FLAG_NEED_WIPHY | 14371 NL80211_FLAG_NEED_RTNL, 14372 }, 14373 { 14374 .cmd = NL80211_CMD_GET_SURVEY, 14375 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14376 .dumpit = nl80211_dump_survey, 14377 }, 14378 { 14379 .cmd = NL80211_CMD_SET_PMKSA, 14380 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14381 .doit = nl80211_setdel_pmksa, 14382 .flags = GENL_UNS_ADMIN_PERM, 14383 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14384 NL80211_FLAG_NEED_RTNL | 14385 NL80211_FLAG_CLEAR_SKB, 14386 }, 14387 { 14388 .cmd = NL80211_CMD_DEL_PMKSA, 14389 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14390 .doit = nl80211_setdel_pmksa, 14391 .flags = GENL_UNS_ADMIN_PERM, 14392 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14393 NL80211_FLAG_NEED_RTNL, 14394 }, 14395 { 14396 .cmd = NL80211_CMD_FLUSH_PMKSA, 14397 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14398 .doit = nl80211_flush_pmksa, 14399 .flags = GENL_UNS_ADMIN_PERM, 14400 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14401 NL80211_FLAG_NEED_RTNL, 14402 }, 14403 { 14404 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL, 14405 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14406 .doit = nl80211_remain_on_channel, 14407 .flags = GENL_UNS_ADMIN_PERM, 14408 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14409 NL80211_FLAG_NEED_RTNL, 14410 }, 14411 { 14412 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 14413 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14414 .doit = nl80211_cancel_remain_on_channel, 14415 .flags = GENL_UNS_ADMIN_PERM, 14416 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14417 NL80211_FLAG_NEED_RTNL, 14418 }, 14419 { 14420 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK, 14421 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14422 .doit = nl80211_set_tx_bitrate_mask, 14423 .flags = GENL_UNS_ADMIN_PERM, 14424 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14425 NL80211_FLAG_NEED_RTNL, 14426 }, 14427 { 14428 .cmd = NL80211_CMD_REGISTER_FRAME, 14429 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14430 .doit = nl80211_register_mgmt, 14431 .flags = GENL_UNS_ADMIN_PERM, 14432 .internal_flags = NL80211_FLAG_NEED_WDEV | 14433 NL80211_FLAG_NEED_RTNL, 14434 }, 14435 { 14436 .cmd = NL80211_CMD_FRAME, 14437 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14438 .doit = nl80211_tx_mgmt, 14439 .flags = GENL_UNS_ADMIN_PERM, 14440 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14441 NL80211_FLAG_NEED_RTNL, 14442 }, 14443 { 14444 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL, 14445 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14446 .doit = nl80211_tx_mgmt_cancel_wait, 14447 .flags = GENL_UNS_ADMIN_PERM, 14448 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14449 NL80211_FLAG_NEED_RTNL, 14450 }, 14451 { 14452 .cmd = NL80211_CMD_SET_POWER_SAVE, 14453 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14454 .doit = nl80211_set_power_save, 14455 .flags = GENL_UNS_ADMIN_PERM, 14456 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14457 NL80211_FLAG_NEED_RTNL, 14458 }, 14459 { 14460 .cmd = NL80211_CMD_GET_POWER_SAVE, 14461 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14462 .doit = nl80211_get_power_save, 14463 /* can be retrieved by unprivileged users */ 14464 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14465 NL80211_FLAG_NEED_RTNL, 14466 }, 14467 { 14468 .cmd = NL80211_CMD_SET_CQM, 14469 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14470 .doit = nl80211_set_cqm, 14471 .flags = GENL_UNS_ADMIN_PERM, 14472 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14473 NL80211_FLAG_NEED_RTNL, 14474 }, 14475 { 14476 .cmd = NL80211_CMD_SET_CHANNEL, 14477 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14478 .doit = nl80211_set_channel, 14479 .flags = GENL_UNS_ADMIN_PERM, 14480 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14481 NL80211_FLAG_NEED_RTNL, 14482 }, 14483 { 14484 .cmd = NL80211_CMD_SET_WDS_PEER, 14485 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14486 .doit = nl80211_set_wds_peer, 14487 .flags = GENL_UNS_ADMIN_PERM, 14488 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14489 NL80211_FLAG_NEED_RTNL, 14490 }, 14491 { 14492 .cmd = NL80211_CMD_JOIN_MESH, 14493 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14494 .doit = nl80211_join_mesh, 14495 .flags = GENL_UNS_ADMIN_PERM, 14496 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14497 NL80211_FLAG_NEED_RTNL, 14498 }, 14499 { 14500 .cmd = NL80211_CMD_LEAVE_MESH, 14501 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14502 .doit = nl80211_leave_mesh, 14503 .flags = GENL_UNS_ADMIN_PERM, 14504 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14505 NL80211_FLAG_NEED_RTNL, 14506 }, 14507 { 14508 .cmd = NL80211_CMD_JOIN_OCB, 14509 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14510 .doit = nl80211_join_ocb, 14511 .flags = GENL_UNS_ADMIN_PERM, 14512 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14513 NL80211_FLAG_NEED_RTNL, 14514 }, 14515 { 14516 .cmd = NL80211_CMD_LEAVE_OCB, 14517 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14518 .doit = nl80211_leave_ocb, 14519 .flags = GENL_UNS_ADMIN_PERM, 14520 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14521 NL80211_FLAG_NEED_RTNL, 14522 }, 14523 #ifdef CONFIG_PM 14524 { 14525 .cmd = NL80211_CMD_GET_WOWLAN, 14526 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14527 .doit = nl80211_get_wowlan, 14528 /* can be retrieved by unprivileged users */ 14529 .internal_flags = NL80211_FLAG_NEED_WIPHY | 14530 NL80211_FLAG_NEED_RTNL, 14531 }, 14532 { 14533 .cmd = NL80211_CMD_SET_WOWLAN, 14534 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14535 .doit = nl80211_set_wowlan, 14536 .flags = GENL_UNS_ADMIN_PERM, 14537 .internal_flags = NL80211_FLAG_NEED_WIPHY | 14538 NL80211_FLAG_NEED_RTNL, 14539 }, 14540 #endif 14541 { 14542 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD, 14543 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14544 .doit = nl80211_set_rekey_data, 14545 .flags = GENL_UNS_ADMIN_PERM, 14546 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14547 NL80211_FLAG_NEED_RTNL | 14548 NL80211_FLAG_CLEAR_SKB, 14549 }, 14550 { 14551 .cmd = NL80211_CMD_TDLS_MGMT, 14552 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14553 .doit = nl80211_tdls_mgmt, 14554 .flags = GENL_UNS_ADMIN_PERM, 14555 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14556 NL80211_FLAG_NEED_RTNL, 14557 }, 14558 { 14559 .cmd = NL80211_CMD_TDLS_OPER, 14560 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14561 .doit = nl80211_tdls_oper, 14562 .flags = GENL_UNS_ADMIN_PERM, 14563 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14564 NL80211_FLAG_NEED_RTNL, 14565 }, 14566 { 14567 .cmd = NL80211_CMD_UNEXPECTED_FRAME, 14568 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14569 .doit = nl80211_register_unexpected_frame, 14570 .flags = GENL_UNS_ADMIN_PERM, 14571 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14572 NL80211_FLAG_NEED_RTNL, 14573 }, 14574 { 14575 .cmd = NL80211_CMD_PROBE_CLIENT, 14576 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14577 .doit = nl80211_probe_client, 14578 .flags = GENL_UNS_ADMIN_PERM, 14579 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14580 NL80211_FLAG_NEED_RTNL, 14581 }, 14582 { 14583 .cmd = NL80211_CMD_REGISTER_BEACONS, 14584 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14585 .doit = nl80211_register_beacons, 14586 .flags = GENL_UNS_ADMIN_PERM, 14587 .internal_flags = NL80211_FLAG_NEED_WIPHY | 14588 NL80211_FLAG_NEED_RTNL, 14589 }, 14590 { 14591 .cmd = NL80211_CMD_SET_NOACK_MAP, 14592 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14593 .doit = nl80211_set_noack_map, 14594 .flags = GENL_UNS_ADMIN_PERM, 14595 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14596 NL80211_FLAG_NEED_RTNL, 14597 }, 14598 { 14599 .cmd = NL80211_CMD_START_P2P_DEVICE, 14600 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14601 .doit = nl80211_start_p2p_device, 14602 .flags = GENL_UNS_ADMIN_PERM, 14603 .internal_flags = NL80211_FLAG_NEED_WDEV | 14604 NL80211_FLAG_NEED_RTNL, 14605 }, 14606 { 14607 .cmd = NL80211_CMD_STOP_P2P_DEVICE, 14608 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14609 .doit = nl80211_stop_p2p_device, 14610 .flags = GENL_UNS_ADMIN_PERM, 14611 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14612 NL80211_FLAG_NEED_RTNL, 14613 }, 14614 { 14615 .cmd = NL80211_CMD_START_NAN, 14616 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14617 .doit = nl80211_start_nan, 14618 .flags = GENL_ADMIN_PERM, 14619 .internal_flags = NL80211_FLAG_NEED_WDEV | 14620 NL80211_FLAG_NEED_RTNL, 14621 }, 14622 { 14623 .cmd = NL80211_CMD_STOP_NAN, 14624 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14625 .doit = nl80211_stop_nan, 14626 .flags = GENL_ADMIN_PERM, 14627 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14628 NL80211_FLAG_NEED_RTNL, 14629 }, 14630 { 14631 .cmd = NL80211_CMD_ADD_NAN_FUNCTION, 14632 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14633 .doit = nl80211_nan_add_func, 14634 .flags = GENL_ADMIN_PERM, 14635 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14636 NL80211_FLAG_NEED_RTNL, 14637 }, 14638 { 14639 .cmd = NL80211_CMD_DEL_NAN_FUNCTION, 14640 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14641 .doit = nl80211_nan_del_func, 14642 .flags = GENL_ADMIN_PERM, 14643 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14644 NL80211_FLAG_NEED_RTNL, 14645 }, 14646 { 14647 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG, 14648 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14649 .doit = nl80211_nan_change_config, 14650 .flags = GENL_ADMIN_PERM, 14651 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14652 NL80211_FLAG_NEED_RTNL, 14653 }, 14654 { 14655 .cmd = NL80211_CMD_SET_MCAST_RATE, 14656 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14657 .doit = nl80211_set_mcast_rate, 14658 .flags = GENL_UNS_ADMIN_PERM, 14659 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14660 NL80211_FLAG_NEED_RTNL, 14661 }, 14662 { 14663 .cmd = NL80211_CMD_SET_MAC_ACL, 14664 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14665 .doit = nl80211_set_mac_acl, 14666 .flags = GENL_UNS_ADMIN_PERM, 14667 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14668 NL80211_FLAG_NEED_RTNL, 14669 }, 14670 { 14671 .cmd = NL80211_CMD_RADAR_DETECT, 14672 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14673 .doit = nl80211_start_radar_detection, 14674 .flags = GENL_UNS_ADMIN_PERM, 14675 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14676 NL80211_FLAG_NEED_RTNL, 14677 }, 14678 { 14679 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES, 14680 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14681 .doit = nl80211_get_protocol_features, 14682 }, 14683 { 14684 .cmd = NL80211_CMD_UPDATE_FT_IES, 14685 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14686 .doit = nl80211_update_ft_ies, 14687 .flags = GENL_UNS_ADMIN_PERM, 14688 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14689 NL80211_FLAG_NEED_RTNL, 14690 }, 14691 { 14692 .cmd = NL80211_CMD_CRIT_PROTOCOL_START, 14693 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14694 .doit = nl80211_crit_protocol_start, 14695 .flags = GENL_UNS_ADMIN_PERM, 14696 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14697 NL80211_FLAG_NEED_RTNL, 14698 }, 14699 { 14700 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP, 14701 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14702 .doit = nl80211_crit_protocol_stop, 14703 .flags = GENL_UNS_ADMIN_PERM, 14704 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14705 NL80211_FLAG_NEED_RTNL, 14706 }, 14707 { 14708 .cmd = NL80211_CMD_GET_COALESCE, 14709 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14710 .doit = nl80211_get_coalesce, 14711 .internal_flags = NL80211_FLAG_NEED_WIPHY | 14712 NL80211_FLAG_NEED_RTNL, 14713 }, 14714 { 14715 .cmd = NL80211_CMD_SET_COALESCE, 14716 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14717 .doit = nl80211_set_coalesce, 14718 .flags = GENL_UNS_ADMIN_PERM, 14719 .internal_flags = NL80211_FLAG_NEED_WIPHY | 14720 NL80211_FLAG_NEED_RTNL, 14721 }, 14722 { 14723 .cmd = NL80211_CMD_CHANNEL_SWITCH, 14724 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14725 .doit = nl80211_channel_switch, 14726 .flags = GENL_UNS_ADMIN_PERM, 14727 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14728 NL80211_FLAG_NEED_RTNL, 14729 }, 14730 { 14731 .cmd = NL80211_CMD_VENDOR, 14732 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14733 .doit = nl80211_vendor_cmd, 14734 .dumpit = nl80211_vendor_cmd_dump, 14735 .flags = GENL_UNS_ADMIN_PERM, 14736 .internal_flags = NL80211_FLAG_NEED_WIPHY | 14737 NL80211_FLAG_NEED_RTNL | 14738 NL80211_FLAG_CLEAR_SKB, 14739 }, 14740 { 14741 .cmd = NL80211_CMD_SET_QOS_MAP, 14742 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14743 .doit = nl80211_set_qos_map, 14744 .flags = GENL_UNS_ADMIN_PERM, 14745 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14746 NL80211_FLAG_NEED_RTNL, 14747 }, 14748 { 14749 .cmd = NL80211_CMD_ADD_TX_TS, 14750 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14751 .doit = nl80211_add_tx_ts, 14752 .flags = GENL_UNS_ADMIN_PERM, 14753 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14754 NL80211_FLAG_NEED_RTNL, 14755 }, 14756 { 14757 .cmd = NL80211_CMD_DEL_TX_TS, 14758 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14759 .doit = nl80211_del_tx_ts, 14760 .flags = GENL_UNS_ADMIN_PERM, 14761 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14762 NL80211_FLAG_NEED_RTNL, 14763 }, 14764 { 14765 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH, 14766 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14767 .doit = nl80211_tdls_channel_switch, 14768 .flags = GENL_UNS_ADMIN_PERM, 14769 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14770 NL80211_FLAG_NEED_RTNL, 14771 }, 14772 { 14773 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH, 14774 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14775 .doit = nl80211_tdls_cancel_channel_switch, 14776 .flags = GENL_UNS_ADMIN_PERM, 14777 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14778 NL80211_FLAG_NEED_RTNL, 14779 }, 14780 { 14781 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST, 14782 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14783 .doit = nl80211_set_multicast_to_unicast, 14784 .flags = GENL_UNS_ADMIN_PERM, 14785 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14786 NL80211_FLAG_NEED_RTNL, 14787 }, 14788 { 14789 .cmd = NL80211_CMD_SET_PMK, 14790 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14791 .doit = nl80211_set_pmk, 14792 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14793 NL80211_FLAG_NEED_RTNL | 14794 NL80211_FLAG_CLEAR_SKB, 14795 }, 14796 { 14797 .cmd = NL80211_CMD_DEL_PMK, 14798 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14799 .doit = nl80211_del_pmk, 14800 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14801 NL80211_FLAG_NEED_RTNL, 14802 }, 14803 { 14804 .cmd = NL80211_CMD_EXTERNAL_AUTH, 14805 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14806 .doit = nl80211_external_auth, 14807 .flags = GENL_ADMIN_PERM, 14808 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14809 NL80211_FLAG_NEED_RTNL, 14810 }, 14811 { 14812 .cmd = NL80211_CMD_CONTROL_PORT_FRAME, 14813 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14814 .doit = nl80211_tx_control_port, 14815 .flags = GENL_UNS_ADMIN_PERM, 14816 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14817 NL80211_FLAG_NEED_RTNL, 14818 }, 14819 { 14820 .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS, 14821 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14822 .doit = nl80211_get_ftm_responder_stats, 14823 .internal_flags = NL80211_FLAG_NEED_NETDEV | 14824 NL80211_FLAG_NEED_RTNL, 14825 }, 14826 { 14827 .cmd = NL80211_CMD_PEER_MEASUREMENT_START, 14828 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14829 .doit = nl80211_pmsr_start, 14830 .flags = GENL_UNS_ADMIN_PERM, 14831 .internal_flags = NL80211_FLAG_NEED_WDEV_UP | 14832 NL80211_FLAG_NEED_RTNL, 14833 }, 14834 { 14835 .cmd = NL80211_CMD_NOTIFY_RADAR, 14836 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 14837 .doit = nl80211_notify_radar_detection, 14838 .flags = GENL_UNS_ADMIN_PERM, 14839 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14840 NL80211_FLAG_NEED_RTNL, 14841 }, 14842 { 14843 .cmd = NL80211_CMD_UPDATE_OWE_INFO, 14844 .doit = nl80211_update_owe_info, 14845 .flags = GENL_ADMIN_PERM, 14846 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14847 NL80211_FLAG_NEED_RTNL, 14848 }, 14849 { 14850 .cmd = NL80211_CMD_PROBE_MESH_LINK, 14851 .doit = nl80211_probe_mesh_link, 14852 .flags = GENL_UNS_ADMIN_PERM, 14853 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP | 14854 NL80211_FLAG_NEED_RTNL, 14855 }, 14856 }; 14857 14858 static struct genl_family nl80211_fam __ro_after_init = { 14859 .name = NL80211_GENL_NAME, /* have users key off the name instead */ 14860 .hdrsize = 0, /* no private header */ 14861 .version = 1, /* no particular meaning now */ 14862 .maxattr = NL80211_ATTR_MAX, 14863 .policy = nl80211_policy, 14864 .netnsok = true, 14865 .pre_doit = nl80211_pre_doit, 14866 .post_doit = nl80211_post_doit, 14867 .module = THIS_MODULE, 14868 .ops = nl80211_ops, 14869 .n_ops = ARRAY_SIZE(nl80211_ops), 14870 .mcgrps = nl80211_mcgrps, 14871 .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps), 14872 .parallel_ops = true, 14873 }; 14874 14875 /* notification functions */ 14876 14877 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev, 14878 enum nl80211_commands cmd) 14879 { 14880 struct sk_buff *msg; 14881 struct nl80211_dump_wiphy_state state = {}; 14882 14883 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY && 14884 cmd != NL80211_CMD_DEL_WIPHY); 14885 14886 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14887 if (!msg) 14888 return; 14889 14890 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) { 14891 nlmsg_free(msg); 14892 return; 14893 } 14894 14895 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 14896 NL80211_MCGRP_CONFIG, GFP_KERNEL); 14897 } 14898 14899 void nl80211_notify_iface(struct cfg80211_registered_device *rdev, 14900 struct wireless_dev *wdev, 14901 enum nl80211_commands cmd) 14902 { 14903 struct sk_buff *msg; 14904 14905 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14906 if (!msg) 14907 return; 14908 14909 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) { 14910 nlmsg_free(msg); 14911 return; 14912 } 14913 14914 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 14915 NL80211_MCGRP_CONFIG, GFP_KERNEL); 14916 } 14917 14918 static int nl80211_add_scan_req(struct sk_buff *msg, 14919 struct cfg80211_registered_device *rdev) 14920 { 14921 struct cfg80211_scan_request *req = rdev->scan_req; 14922 struct nlattr *nest; 14923 int i; 14924 14925 if (WARN_ON(!req)) 14926 return 0; 14927 14928 nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS); 14929 if (!nest) 14930 goto nla_put_failure; 14931 for (i = 0; i < req->n_ssids; i++) { 14932 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid)) 14933 goto nla_put_failure; 14934 } 14935 nla_nest_end(msg, nest); 14936 14937 nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES); 14938 if (!nest) 14939 goto nla_put_failure; 14940 for (i = 0; i < req->n_channels; i++) { 14941 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 14942 goto nla_put_failure; 14943 } 14944 nla_nest_end(msg, nest); 14945 14946 if (req->ie && 14947 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie)) 14948 goto nla_put_failure; 14949 14950 if (req->flags && 14951 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags)) 14952 goto nla_put_failure; 14953 14954 if (req->info.scan_start_tsf && 14955 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF, 14956 req->info.scan_start_tsf, NL80211_BSS_PAD) || 14957 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN, 14958 req->info.tsf_bssid))) 14959 goto nla_put_failure; 14960 14961 return 0; 14962 nla_put_failure: 14963 return -ENOBUFS; 14964 } 14965 14966 static int nl80211_prep_scan_msg(struct sk_buff *msg, 14967 struct cfg80211_registered_device *rdev, 14968 struct wireless_dev *wdev, 14969 u32 portid, u32 seq, int flags, 14970 u32 cmd) 14971 { 14972 void *hdr; 14973 14974 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 14975 if (!hdr) 14976 return -1; 14977 14978 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 14979 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 14980 wdev->netdev->ifindex)) || 14981 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 14982 NL80211_ATTR_PAD)) 14983 goto nla_put_failure; 14984 14985 /* ignore errors and send incomplete event anyway */ 14986 nl80211_add_scan_req(msg, rdev); 14987 14988 genlmsg_end(msg, hdr); 14989 return 0; 14990 14991 nla_put_failure: 14992 genlmsg_cancel(msg, hdr); 14993 return -EMSGSIZE; 14994 } 14995 14996 static int 14997 nl80211_prep_sched_scan_msg(struct sk_buff *msg, 14998 struct cfg80211_sched_scan_request *req, u32 cmd) 14999 { 15000 void *hdr; 15001 15002 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 15003 if (!hdr) 15004 return -1; 15005 15006 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, 15007 wiphy_to_rdev(req->wiphy)->wiphy_idx) || 15008 nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) || 15009 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid, 15010 NL80211_ATTR_PAD)) 15011 goto nla_put_failure; 15012 15013 genlmsg_end(msg, hdr); 15014 return 0; 15015 15016 nla_put_failure: 15017 genlmsg_cancel(msg, hdr); 15018 return -EMSGSIZE; 15019 } 15020 15021 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev, 15022 struct wireless_dev *wdev) 15023 { 15024 struct sk_buff *msg; 15025 15026 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15027 if (!msg) 15028 return; 15029 15030 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 15031 NL80211_CMD_TRIGGER_SCAN) < 0) { 15032 nlmsg_free(msg); 15033 return; 15034 } 15035 15036 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15037 NL80211_MCGRP_SCAN, GFP_KERNEL); 15038 } 15039 15040 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev, 15041 struct wireless_dev *wdev, bool aborted) 15042 { 15043 struct sk_buff *msg; 15044 15045 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15046 if (!msg) 15047 return NULL; 15048 15049 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 15050 aborted ? NL80211_CMD_SCAN_ABORTED : 15051 NL80211_CMD_NEW_SCAN_RESULTS) < 0) { 15052 nlmsg_free(msg); 15053 return NULL; 15054 } 15055 15056 return msg; 15057 } 15058 15059 /* send message created by nl80211_build_scan_msg() */ 15060 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev, 15061 struct sk_buff *msg) 15062 { 15063 if (!msg) 15064 return; 15065 15066 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15067 NL80211_MCGRP_SCAN, GFP_KERNEL); 15068 } 15069 15070 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd) 15071 { 15072 struct sk_buff *msg; 15073 15074 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15075 if (!msg) 15076 return; 15077 15078 if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) { 15079 nlmsg_free(msg); 15080 return; 15081 } 15082 15083 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0, 15084 NL80211_MCGRP_SCAN, GFP_KERNEL); 15085 } 15086 15087 static bool nl80211_reg_change_event_fill(struct sk_buff *msg, 15088 struct regulatory_request *request) 15089 { 15090 /* Userspace can always count this one always being set */ 15091 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator)) 15092 goto nla_put_failure; 15093 15094 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') { 15095 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 15096 NL80211_REGDOM_TYPE_WORLD)) 15097 goto nla_put_failure; 15098 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') { 15099 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 15100 NL80211_REGDOM_TYPE_CUSTOM_WORLD)) 15101 goto nla_put_failure; 15102 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') || 15103 request->intersect) { 15104 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 15105 NL80211_REGDOM_TYPE_INTERSECTION)) 15106 goto nla_put_failure; 15107 } else { 15108 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 15109 NL80211_REGDOM_TYPE_COUNTRY) || 15110 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, 15111 request->alpha2)) 15112 goto nla_put_failure; 15113 } 15114 15115 if (request->wiphy_idx != WIPHY_IDX_INVALID) { 15116 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx); 15117 15118 if (wiphy && 15119 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx)) 15120 goto nla_put_failure; 15121 15122 if (wiphy && 15123 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 15124 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 15125 goto nla_put_failure; 15126 } 15127 15128 return true; 15129 15130 nla_put_failure: 15131 return false; 15132 } 15133 15134 /* 15135 * This can happen on global regulatory changes or device specific settings 15136 * based on custom regulatory domains. 15137 */ 15138 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id, 15139 struct regulatory_request *request) 15140 { 15141 struct sk_buff *msg; 15142 void *hdr; 15143 15144 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15145 if (!msg) 15146 return; 15147 15148 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id); 15149 if (!hdr) 15150 goto nla_put_failure; 15151 15152 if (!nl80211_reg_change_event_fill(msg, request)) 15153 goto nla_put_failure; 15154 15155 genlmsg_end(msg, hdr); 15156 15157 rcu_read_lock(); 15158 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 15159 NL80211_MCGRP_REGULATORY, GFP_ATOMIC); 15160 rcu_read_unlock(); 15161 15162 return; 15163 15164 nla_put_failure: 15165 nlmsg_free(msg); 15166 } 15167 15168 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev, 15169 struct net_device *netdev, 15170 const u8 *buf, size_t len, 15171 enum nl80211_commands cmd, gfp_t gfp, 15172 int uapsd_queues, const u8 *req_ies, 15173 size_t req_ies_len) 15174 { 15175 struct sk_buff *msg; 15176 void *hdr; 15177 15178 msg = nlmsg_new(100 + len + req_ies_len, gfp); 15179 if (!msg) 15180 return; 15181 15182 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 15183 if (!hdr) { 15184 nlmsg_free(msg); 15185 return; 15186 } 15187 15188 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15189 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 15190 nla_put(msg, NL80211_ATTR_FRAME, len, buf) || 15191 (req_ies && 15192 nla_put(msg, NL80211_ATTR_REQ_IE, req_ies_len, req_ies))) 15193 goto nla_put_failure; 15194 15195 if (uapsd_queues >= 0) { 15196 struct nlattr *nla_wmm = 15197 nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME); 15198 if (!nla_wmm) 15199 goto nla_put_failure; 15200 15201 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES, 15202 uapsd_queues)) 15203 goto nla_put_failure; 15204 15205 nla_nest_end(msg, nla_wmm); 15206 } 15207 15208 genlmsg_end(msg, hdr); 15209 15210 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15211 NL80211_MCGRP_MLME, gfp); 15212 return; 15213 15214 nla_put_failure: 15215 nlmsg_free(msg); 15216 } 15217 15218 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev, 15219 struct net_device *netdev, const u8 *buf, 15220 size_t len, gfp_t gfp) 15221 { 15222 nl80211_send_mlme_event(rdev, netdev, buf, len, 15223 NL80211_CMD_AUTHENTICATE, gfp, -1, NULL, 0); 15224 } 15225 15226 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev, 15227 struct net_device *netdev, const u8 *buf, 15228 size_t len, gfp_t gfp, int uapsd_queues, 15229 const u8 *req_ies, size_t req_ies_len) 15230 { 15231 nl80211_send_mlme_event(rdev, netdev, buf, len, 15232 NL80211_CMD_ASSOCIATE, gfp, uapsd_queues, 15233 req_ies, req_ies_len); 15234 } 15235 15236 void nl80211_send_deauth(struct cfg80211_registered_device *rdev, 15237 struct net_device *netdev, const u8 *buf, 15238 size_t len, gfp_t gfp) 15239 { 15240 nl80211_send_mlme_event(rdev, netdev, buf, len, 15241 NL80211_CMD_DEAUTHENTICATE, gfp, -1, NULL, 0); 15242 } 15243 15244 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev, 15245 struct net_device *netdev, const u8 *buf, 15246 size_t len, gfp_t gfp) 15247 { 15248 nl80211_send_mlme_event(rdev, netdev, buf, len, 15249 NL80211_CMD_DISASSOCIATE, gfp, -1, NULL, 0); 15250 } 15251 15252 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf, 15253 size_t len) 15254 { 15255 struct wireless_dev *wdev = dev->ieee80211_ptr; 15256 struct wiphy *wiphy = wdev->wiphy; 15257 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15258 const struct ieee80211_mgmt *mgmt = (void *)buf; 15259 u32 cmd; 15260 15261 if (WARN_ON(len < 2)) 15262 return; 15263 15264 if (ieee80211_is_deauth(mgmt->frame_control)) 15265 cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE; 15266 else 15267 cmd = NL80211_CMD_UNPROT_DISASSOCIATE; 15268 15269 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len); 15270 nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1, 15271 NULL, 0); 15272 } 15273 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt); 15274 15275 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev, 15276 struct net_device *netdev, int cmd, 15277 const u8 *addr, gfp_t gfp) 15278 { 15279 struct sk_buff *msg; 15280 void *hdr; 15281 15282 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 15283 if (!msg) 15284 return; 15285 15286 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 15287 if (!hdr) { 15288 nlmsg_free(msg); 15289 return; 15290 } 15291 15292 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15293 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 15294 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 15295 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 15296 goto nla_put_failure; 15297 15298 genlmsg_end(msg, hdr); 15299 15300 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15301 NL80211_MCGRP_MLME, gfp); 15302 return; 15303 15304 nla_put_failure: 15305 nlmsg_free(msg); 15306 } 15307 15308 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev, 15309 struct net_device *netdev, const u8 *addr, 15310 gfp_t gfp) 15311 { 15312 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE, 15313 addr, gfp); 15314 } 15315 15316 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev, 15317 struct net_device *netdev, const u8 *addr, 15318 gfp_t gfp) 15319 { 15320 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE, 15321 addr, gfp); 15322 } 15323 15324 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev, 15325 struct net_device *netdev, 15326 struct cfg80211_connect_resp_params *cr, 15327 gfp_t gfp) 15328 { 15329 struct sk_buff *msg; 15330 void *hdr; 15331 15332 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len + 15333 cr->fils.kek_len + cr->fils.pmk_len + 15334 (cr->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp); 15335 if (!msg) 15336 return; 15337 15338 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT); 15339 if (!hdr) { 15340 nlmsg_free(msg); 15341 return; 15342 } 15343 15344 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15345 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 15346 (cr->bssid && 15347 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cr->bssid)) || 15348 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 15349 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE : 15350 cr->status) || 15351 (cr->status < 0 && 15352 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 15353 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON, 15354 cr->timeout_reason))) || 15355 (cr->req_ie && 15356 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) || 15357 (cr->resp_ie && 15358 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len, 15359 cr->resp_ie)) || 15360 (cr->fils.update_erp_next_seq_num && 15361 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 15362 cr->fils.erp_next_seq_num)) || 15363 (cr->status == WLAN_STATUS_SUCCESS && 15364 ((cr->fils.kek && 15365 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len, 15366 cr->fils.kek)) || 15367 (cr->fils.pmk && 15368 nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) || 15369 (cr->fils.pmkid && 15370 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid))))) 15371 goto nla_put_failure; 15372 15373 genlmsg_end(msg, hdr); 15374 15375 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15376 NL80211_MCGRP_MLME, gfp); 15377 return; 15378 15379 nla_put_failure: 15380 nlmsg_free(msg); 15381 } 15382 15383 void nl80211_send_roamed(struct cfg80211_registered_device *rdev, 15384 struct net_device *netdev, 15385 struct cfg80211_roam_info *info, gfp_t gfp) 15386 { 15387 struct sk_buff *msg; 15388 void *hdr; 15389 const u8 *bssid = info->bss ? info->bss->bssid : info->bssid; 15390 15391 msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len + 15392 info->fils.kek_len + info->fils.pmk_len + 15393 (info->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp); 15394 if (!msg) 15395 return; 15396 15397 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM); 15398 if (!hdr) { 15399 nlmsg_free(msg); 15400 return; 15401 } 15402 15403 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15404 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 15405 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) || 15406 (info->req_ie && 15407 nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len, 15408 info->req_ie)) || 15409 (info->resp_ie && 15410 nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len, 15411 info->resp_ie)) || 15412 (info->fils.update_erp_next_seq_num && 15413 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 15414 info->fils.erp_next_seq_num)) || 15415 (info->fils.kek && 15416 nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len, 15417 info->fils.kek)) || 15418 (info->fils.pmk && 15419 nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) || 15420 (info->fils.pmkid && 15421 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid))) 15422 goto nla_put_failure; 15423 15424 genlmsg_end(msg, hdr); 15425 15426 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15427 NL80211_MCGRP_MLME, gfp); 15428 return; 15429 15430 nla_put_failure: 15431 nlmsg_free(msg); 15432 } 15433 15434 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev, 15435 struct net_device *netdev, const u8 *bssid) 15436 { 15437 struct sk_buff *msg; 15438 void *hdr; 15439 15440 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15441 if (!msg) 15442 return; 15443 15444 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED); 15445 if (!hdr) { 15446 nlmsg_free(msg); 15447 return; 15448 } 15449 15450 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15451 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 15452 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 15453 goto nla_put_failure; 15454 15455 genlmsg_end(msg, hdr); 15456 15457 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15458 NL80211_MCGRP_MLME, GFP_KERNEL); 15459 return; 15460 15461 nla_put_failure: 15462 nlmsg_free(msg); 15463 } 15464 15465 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev, 15466 struct net_device *netdev, u16 reason, 15467 const u8 *ie, size_t ie_len, bool from_ap) 15468 { 15469 struct sk_buff *msg; 15470 void *hdr; 15471 15472 msg = nlmsg_new(100 + ie_len, GFP_KERNEL); 15473 if (!msg) 15474 return; 15475 15476 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT); 15477 if (!hdr) { 15478 nlmsg_free(msg); 15479 return; 15480 } 15481 15482 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15483 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 15484 (reason && 15485 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) || 15486 (from_ap && 15487 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) || 15488 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie))) 15489 goto nla_put_failure; 15490 15491 genlmsg_end(msg, hdr); 15492 15493 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15494 NL80211_MCGRP_MLME, GFP_KERNEL); 15495 return; 15496 15497 nla_put_failure: 15498 nlmsg_free(msg); 15499 } 15500 15501 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev, 15502 struct net_device *netdev, const u8 *bssid, 15503 gfp_t gfp) 15504 { 15505 struct sk_buff *msg; 15506 void *hdr; 15507 15508 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 15509 if (!msg) 15510 return; 15511 15512 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS); 15513 if (!hdr) { 15514 nlmsg_free(msg); 15515 return; 15516 } 15517 15518 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15519 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 15520 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 15521 goto nla_put_failure; 15522 15523 genlmsg_end(msg, hdr); 15524 15525 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15526 NL80211_MCGRP_MLME, gfp); 15527 return; 15528 15529 nla_put_failure: 15530 nlmsg_free(msg); 15531 } 15532 15533 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr, 15534 const u8 *ie, u8 ie_len, 15535 int sig_dbm, gfp_t gfp) 15536 { 15537 struct wireless_dev *wdev = dev->ieee80211_ptr; 15538 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 15539 struct sk_buff *msg; 15540 void *hdr; 15541 15542 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT)) 15543 return; 15544 15545 trace_cfg80211_notify_new_peer_candidate(dev, addr); 15546 15547 msg = nlmsg_new(100 + ie_len, gfp); 15548 if (!msg) 15549 return; 15550 15551 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE); 15552 if (!hdr) { 15553 nlmsg_free(msg); 15554 return; 15555 } 15556 15557 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15558 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 15559 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 15560 (ie_len && ie && 15561 nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) || 15562 (sig_dbm && 15563 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm))) 15564 goto nla_put_failure; 15565 15566 genlmsg_end(msg, hdr); 15567 15568 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15569 NL80211_MCGRP_MLME, gfp); 15570 return; 15571 15572 nla_put_failure: 15573 nlmsg_free(msg); 15574 } 15575 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate); 15576 15577 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev, 15578 struct net_device *netdev, const u8 *addr, 15579 enum nl80211_key_type key_type, int key_id, 15580 const u8 *tsc, gfp_t gfp) 15581 { 15582 struct sk_buff *msg; 15583 void *hdr; 15584 15585 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 15586 if (!msg) 15587 return; 15588 15589 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE); 15590 if (!hdr) { 15591 nlmsg_free(msg); 15592 return; 15593 } 15594 15595 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15596 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 15597 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) || 15598 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) || 15599 (key_id != -1 && 15600 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) || 15601 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc))) 15602 goto nla_put_failure; 15603 15604 genlmsg_end(msg, hdr); 15605 15606 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15607 NL80211_MCGRP_MLME, gfp); 15608 return; 15609 15610 nla_put_failure: 15611 nlmsg_free(msg); 15612 } 15613 15614 void nl80211_send_beacon_hint_event(struct wiphy *wiphy, 15615 struct ieee80211_channel *channel_before, 15616 struct ieee80211_channel *channel_after) 15617 { 15618 struct sk_buff *msg; 15619 void *hdr; 15620 struct nlattr *nl_freq; 15621 15622 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC); 15623 if (!msg) 15624 return; 15625 15626 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT); 15627 if (!hdr) { 15628 nlmsg_free(msg); 15629 return; 15630 } 15631 15632 /* 15633 * Since we are applying the beacon hint to a wiphy we know its 15634 * wiphy_idx is valid 15635 */ 15636 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 15637 goto nla_put_failure; 15638 15639 /* Before */ 15640 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE); 15641 if (!nl_freq) 15642 goto nla_put_failure; 15643 15644 if (nl80211_msg_put_channel(msg, wiphy, channel_before, false)) 15645 goto nla_put_failure; 15646 nla_nest_end(msg, nl_freq); 15647 15648 /* After */ 15649 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER); 15650 if (!nl_freq) 15651 goto nla_put_failure; 15652 15653 if (nl80211_msg_put_channel(msg, wiphy, channel_after, false)) 15654 goto nla_put_failure; 15655 nla_nest_end(msg, nl_freq); 15656 15657 genlmsg_end(msg, hdr); 15658 15659 rcu_read_lock(); 15660 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 15661 NL80211_MCGRP_REGULATORY, GFP_ATOMIC); 15662 rcu_read_unlock(); 15663 15664 return; 15665 15666 nla_put_failure: 15667 nlmsg_free(msg); 15668 } 15669 15670 static void nl80211_send_remain_on_chan_event( 15671 int cmd, struct cfg80211_registered_device *rdev, 15672 struct wireless_dev *wdev, u64 cookie, 15673 struct ieee80211_channel *chan, 15674 unsigned int duration, gfp_t gfp) 15675 { 15676 struct sk_buff *msg; 15677 void *hdr; 15678 15679 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 15680 if (!msg) 15681 return; 15682 15683 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 15684 if (!hdr) { 15685 nlmsg_free(msg); 15686 return; 15687 } 15688 15689 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15690 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 15691 wdev->netdev->ifindex)) || 15692 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 15693 NL80211_ATTR_PAD) || 15694 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) || 15695 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 15696 NL80211_CHAN_NO_HT) || 15697 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 15698 NL80211_ATTR_PAD)) 15699 goto nla_put_failure; 15700 15701 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL && 15702 nla_put_u32(msg, NL80211_ATTR_DURATION, duration)) 15703 goto nla_put_failure; 15704 15705 genlmsg_end(msg, hdr); 15706 15707 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15708 NL80211_MCGRP_MLME, gfp); 15709 return; 15710 15711 nla_put_failure: 15712 nlmsg_free(msg); 15713 } 15714 15715 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie, 15716 struct ieee80211_channel *chan, 15717 unsigned int duration, gfp_t gfp) 15718 { 15719 struct wiphy *wiphy = wdev->wiphy; 15720 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15721 15722 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration); 15723 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL, 15724 rdev, wdev, cookie, chan, 15725 duration, gfp); 15726 } 15727 EXPORT_SYMBOL(cfg80211_ready_on_channel); 15728 15729 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie, 15730 struct ieee80211_channel *chan, 15731 gfp_t gfp) 15732 { 15733 struct wiphy *wiphy = wdev->wiphy; 15734 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15735 15736 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan); 15737 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 15738 rdev, wdev, cookie, chan, 0, gfp); 15739 } 15740 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired); 15741 15742 void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie, 15743 struct ieee80211_channel *chan, 15744 gfp_t gfp) 15745 { 15746 struct wiphy *wiphy = wdev->wiphy; 15747 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15748 15749 trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan); 15750 nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL, 15751 rdev, wdev, cookie, chan, 0, gfp); 15752 } 15753 EXPORT_SYMBOL(cfg80211_tx_mgmt_expired); 15754 15755 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr, 15756 struct station_info *sinfo, gfp_t gfp) 15757 { 15758 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 15759 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15760 struct sk_buff *msg; 15761 15762 trace_cfg80211_new_sta(dev, mac_addr, sinfo); 15763 15764 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 15765 if (!msg) 15766 return; 15767 15768 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0, 15769 rdev, dev, mac_addr, sinfo) < 0) { 15770 nlmsg_free(msg); 15771 return; 15772 } 15773 15774 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15775 NL80211_MCGRP_MLME, gfp); 15776 } 15777 EXPORT_SYMBOL(cfg80211_new_sta); 15778 15779 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr, 15780 struct station_info *sinfo, gfp_t gfp) 15781 { 15782 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 15783 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15784 struct sk_buff *msg; 15785 struct station_info empty_sinfo = {}; 15786 15787 if (!sinfo) 15788 sinfo = &empty_sinfo; 15789 15790 trace_cfg80211_del_sta(dev, mac_addr); 15791 15792 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 15793 if (!msg) { 15794 cfg80211_sinfo_release_content(sinfo); 15795 return; 15796 } 15797 15798 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0, 15799 rdev, dev, mac_addr, sinfo) < 0) { 15800 nlmsg_free(msg); 15801 return; 15802 } 15803 15804 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15805 NL80211_MCGRP_MLME, gfp); 15806 } 15807 EXPORT_SYMBOL(cfg80211_del_sta_sinfo); 15808 15809 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr, 15810 enum nl80211_connect_failed_reason reason, 15811 gfp_t gfp) 15812 { 15813 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 15814 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15815 struct sk_buff *msg; 15816 void *hdr; 15817 15818 msg = nlmsg_new(NLMSG_GOODSIZE, gfp); 15819 if (!msg) 15820 return; 15821 15822 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED); 15823 if (!hdr) { 15824 nlmsg_free(msg); 15825 return; 15826 } 15827 15828 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 15829 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 15830 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason)) 15831 goto nla_put_failure; 15832 15833 genlmsg_end(msg, hdr); 15834 15835 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15836 NL80211_MCGRP_MLME, gfp); 15837 return; 15838 15839 nla_put_failure: 15840 nlmsg_free(msg); 15841 } 15842 EXPORT_SYMBOL(cfg80211_conn_failed); 15843 15844 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd, 15845 const u8 *addr, gfp_t gfp) 15846 { 15847 struct wireless_dev *wdev = dev->ieee80211_ptr; 15848 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 15849 struct sk_buff *msg; 15850 void *hdr; 15851 u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid); 15852 15853 if (!nlportid) 15854 return false; 15855 15856 msg = nlmsg_new(100, gfp); 15857 if (!msg) 15858 return true; 15859 15860 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 15861 if (!hdr) { 15862 nlmsg_free(msg); 15863 return true; 15864 } 15865 15866 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15867 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 15868 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 15869 goto nla_put_failure; 15870 15871 genlmsg_end(msg, hdr); 15872 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 15873 return true; 15874 15875 nla_put_failure: 15876 nlmsg_free(msg); 15877 return true; 15878 } 15879 15880 bool cfg80211_rx_spurious_frame(struct net_device *dev, 15881 const u8 *addr, gfp_t gfp) 15882 { 15883 struct wireless_dev *wdev = dev->ieee80211_ptr; 15884 bool ret; 15885 15886 trace_cfg80211_rx_spurious_frame(dev, addr); 15887 15888 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 15889 wdev->iftype != NL80211_IFTYPE_P2P_GO)) { 15890 trace_cfg80211_return_bool(false); 15891 return false; 15892 } 15893 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME, 15894 addr, gfp); 15895 trace_cfg80211_return_bool(ret); 15896 return ret; 15897 } 15898 EXPORT_SYMBOL(cfg80211_rx_spurious_frame); 15899 15900 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev, 15901 const u8 *addr, gfp_t gfp) 15902 { 15903 struct wireless_dev *wdev = dev->ieee80211_ptr; 15904 bool ret; 15905 15906 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr); 15907 15908 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 15909 wdev->iftype != NL80211_IFTYPE_P2P_GO && 15910 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) { 15911 trace_cfg80211_return_bool(false); 15912 return false; 15913 } 15914 ret = __nl80211_unexpected_frame(dev, 15915 NL80211_CMD_UNEXPECTED_4ADDR_FRAME, 15916 addr, gfp); 15917 trace_cfg80211_return_bool(ret); 15918 return ret; 15919 } 15920 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame); 15921 15922 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev, 15923 struct wireless_dev *wdev, u32 nlportid, 15924 int freq, int sig_dbm, 15925 const u8 *buf, size_t len, u32 flags, gfp_t gfp) 15926 { 15927 struct net_device *netdev = wdev->netdev; 15928 struct sk_buff *msg; 15929 void *hdr; 15930 15931 msg = nlmsg_new(100 + len, gfp); 15932 if (!msg) 15933 return -ENOMEM; 15934 15935 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 15936 if (!hdr) { 15937 nlmsg_free(msg); 15938 return -ENOMEM; 15939 } 15940 15941 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15942 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 15943 netdev->ifindex)) || 15944 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 15945 NL80211_ATTR_PAD) || 15946 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) || 15947 (sig_dbm && 15948 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) || 15949 nla_put(msg, NL80211_ATTR_FRAME, len, buf) || 15950 (flags && 15951 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags))) 15952 goto nla_put_failure; 15953 15954 genlmsg_end(msg, hdr); 15955 15956 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 15957 15958 nla_put_failure: 15959 nlmsg_free(msg); 15960 return -ENOBUFS; 15961 } 15962 15963 void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie, 15964 const u8 *buf, size_t len, bool ack, gfp_t gfp) 15965 { 15966 struct wiphy *wiphy = wdev->wiphy; 15967 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15968 struct net_device *netdev = wdev->netdev; 15969 struct sk_buff *msg; 15970 void *hdr; 15971 15972 trace_cfg80211_mgmt_tx_status(wdev, cookie, ack); 15973 15974 msg = nlmsg_new(100 + len, gfp); 15975 if (!msg) 15976 return; 15977 15978 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS); 15979 if (!hdr) { 15980 nlmsg_free(msg); 15981 return; 15982 } 15983 15984 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15985 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 15986 netdev->ifindex)) || 15987 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 15988 NL80211_ATTR_PAD) || 15989 nla_put(msg, NL80211_ATTR_FRAME, len, buf) || 15990 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 15991 NL80211_ATTR_PAD) || 15992 (ack && nla_put_flag(msg, NL80211_ATTR_ACK))) 15993 goto nla_put_failure; 15994 15995 genlmsg_end(msg, hdr); 15996 15997 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 15998 NL80211_MCGRP_MLME, gfp); 15999 return; 16000 16001 nla_put_failure: 16002 nlmsg_free(msg); 16003 } 16004 EXPORT_SYMBOL(cfg80211_mgmt_tx_status); 16005 16006 static int __nl80211_rx_control_port(struct net_device *dev, 16007 struct sk_buff *skb, 16008 bool unencrypted, gfp_t gfp) 16009 { 16010 struct wireless_dev *wdev = dev->ieee80211_ptr; 16011 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 16012 struct ethhdr *ehdr = eth_hdr(skb); 16013 const u8 *daddr = ehdr->h_dest; 16014 const u8 *saddr = ehdr->h_source; 16015 u16 proto = be16_to_cpu(skb->protocol); 16016 struct sk_buff *msg; 16017 void *hdr; 16018 struct nlattr *frame; 16019 16020 u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid); 16021 16022 if (!nlportid) 16023 return -ENOENT; 16024 16025 msg = nlmsg_new(100 + skb->len, gfp); 16026 if (!msg) 16027 return -ENOMEM; 16028 16029 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME); 16030 if (!hdr) { 16031 nlmsg_free(msg); 16032 return -ENOBUFS; 16033 } 16034 16035 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16036 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 16037 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 16038 NL80211_ATTR_PAD) || 16039 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, saddr) || 16040 nla_put(msg, NL80211_ATTR_DST_MAC, ETH_ALEN, daddr) || 16041 nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) || 16042 (unencrypted && nla_put_flag(msg, 16043 NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT))) 16044 goto nla_put_failure; 16045 16046 frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len); 16047 if (!frame) 16048 goto nla_put_failure; 16049 16050 skb_copy_bits(skb, 0, nla_data(frame), skb->len); 16051 genlmsg_end(msg, hdr); 16052 16053 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 16054 16055 nla_put_failure: 16056 nlmsg_free(msg); 16057 return -ENOBUFS; 16058 } 16059 16060 bool cfg80211_rx_control_port(struct net_device *dev, 16061 struct sk_buff *skb, bool unencrypted) 16062 { 16063 int ret; 16064 16065 trace_cfg80211_rx_control_port(dev, skb, unencrypted); 16066 ret = __nl80211_rx_control_port(dev, skb, unencrypted, GFP_ATOMIC); 16067 trace_cfg80211_return_bool(ret == 0); 16068 return ret == 0; 16069 } 16070 EXPORT_SYMBOL(cfg80211_rx_control_port); 16071 16072 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev, 16073 const char *mac, gfp_t gfp) 16074 { 16075 struct wireless_dev *wdev = dev->ieee80211_ptr; 16076 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 16077 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16078 void **cb; 16079 16080 if (!msg) 16081 return NULL; 16082 16083 cb = (void **)msg->cb; 16084 16085 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM); 16086 if (!cb[0]) { 16087 nlmsg_free(msg); 16088 return NULL; 16089 } 16090 16091 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16092 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 16093 goto nla_put_failure; 16094 16095 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 16096 goto nla_put_failure; 16097 16098 cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM); 16099 if (!cb[1]) 16100 goto nla_put_failure; 16101 16102 cb[2] = rdev; 16103 16104 return msg; 16105 nla_put_failure: 16106 nlmsg_free(msg); 16107 return NULL; 16108 } 16109 16110 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp) 16111 { 16112 void **cb = (void **)msg->cb; 16113 struct cfg80211_registered_device *rdev = cb[2]; 16114 16115 nla_nest_end(msg, cb[1]); 16116 genlmsg_end(msg, cb[0]); 16117 16118 memset(msg->cb, 0, sizeof(msg->cb)); 16119 16120 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 16121 NL80211_MCGRP_MLME, gfp); 16122 } 16123 16124 void cfg80211_cqm_rssi_notify(struct net_device *dev, 16125 enum nl80211_cqm_rssi_threshold_event rssi_event, 16126 s32 rssi_level, gfp_t gfp) 16127 { 16128 struct sk_buff *msg; 16129 struct wireless_dev *wdev = dev->ieee80211_ptr; 16130 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 16131 16132 trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level); 16133 16134 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW && 16135 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH)) 16136 return; 16137 16138 if (wdev->cqm_config) { 16139 wdev->cqm_config->last_rssi_event_value = rssi_level; 16140 16141 cfg80211_cqm_rssi_update(rdev, dev); 16142 16143 if (rssi_level == 0) 16144 rssi_level = wdev->cqm_config->last_rssi_event_value; 16145 } 16146 16147 msg = cfg80211_prepare_cqm(dev, NULL, gfp); 16148 if (!msg) 16149 return; 16150 16151 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT, 16152 rssi_event)) 16153 goto nla_put_failure; 16154 16155 if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL, 16156 rssi_level)) 16157 goto nla_put_failure; 16158 16159 cfg80211_send_cqm(msg, gfp); 16160 16161 return; 16162 16163 nla_put_failure: 16164 nlmsg_free(msg); 16165 } 16166 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify); 16167 16168 void cfg80211_cqm_txe_notify(struct net_device *dev, 16169 const u8 *peer, u32 num_packets, 16170 u32 rate, u32 intvl, gfp_t gfp) 16171 { 16172 struct sk_buff *msg; 16173 16174 msg = cfg80211_prepare_cqm(dev, peer, gfp); 16175 if (!msg) 16176 return; 16177 16178 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets)) 16179 goto nla_put_failure; 16180 16181 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate)) 16182 goto nla_put_failure; 16183 16184 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl)) 16185 goto nla_put_failure; 16186 16187 cfg80211_send_cqm(msg, gfp); 16188 return; 16189 16190 nla_put_failure: 16191 nlmsg_free(msg); 16192 } 16193 EXPORT_SYMBOL(cfg80211_cqm_txe_notify); 16194 16195 void cfg80211_cqm_pktloss_notify(struct net_device *dev, 16196 const u8 *peer, u32 num_packets, gfp_t gfp) 16197 { 16198 struct sk_buff *msg; 16199 16200 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets); 16201 16202 msg = cfg80211_prepare_cqm(dev, peer, gfp); 16203 if (!msg) 16204 return; 16205 16206 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets)) 16207 goto nla_put_failure; 16208 16209 cfg80211_send_cqm(msg, gfp); 16210 return; 16211 16212 nla_put_failure: 16213 nlmsg_free(msg); 16214 } 16215 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify); 16216 16217 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp) 16218 { 16219 struct sk_buff *msg; 16220 16221 msg = cfg80211_prepare_cqm(dev, NULL, gfp); 16222 if (!msg) 16223 return; 16224 16225 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT)) 16226 goto nla_put_failure; 16227 16228 cfg80211_send_cqm(msg, gfp); 16229 return; 16230 16231 nla_put_failure: 16232 nlmsg_free(msg); 16233 } 16234 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify); 16235 16236 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev, 16237 struct net_device *netdev, const u8 *bssid, 16238 const u8 *replay_ctr, gfp_t gfp) 16239 { 16240 struct sk_buff *msg; 16241 struct nlattr *rekey_attr; 16242 void *hdr; 16243 16244 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16245 if (!msg) 16246 return; 16247 16248 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD); 16249 if (!hdr) { 16250 nlmsg_free(msg); 16251 return; 16252 } 16253 16254 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16255 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 16256 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 16257 goto nla_put_failure; 16258 16259 rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA); 16260 if (!rekey_attr) 16261 goto nla_put_failure; 16262 16263 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR, 16264 NL80211_REPLAY_CTR_LEN, replay_ctr)) 16265 goto nla_put_failure; 16266 16267 nla_nest_end(msg, rekey_attr); 16268 16269 genlmsg_end(msg, hdr); 16270 16271 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 16272 NL80211_MCGRP_MLME, gfp); 16273 return; 16274 16275 nla_put_failure: 16276 nlmsg_free(msg); 16277 } 16278 16279 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid, 16280 const u8 *replay_ctr, gfp_t gfp) 16281 { 16282 struct wireless_dev *wdev = dev->ieee80211_ptr; 16283 struct wiphy *wiphy = wdev->wiphy; 16284 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16285 16286 trace_cfg80211_gtk_rekey_notify(dev, bssid); 16287 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp); 16288 } 16289 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify); 16290 16291 static void 16292 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev, 16293 struct net_device *netdev, int index, 16294 const u8 *bssid, bool preauth, gfp_t gfp) 16295 { 16296 struct sk_buff *msg; 16297 struct nlattr *attr; 16298 void *hdr; 16299 16300 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16301 if (!msg) 16302 return; 16303 16304 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE); 16305 if (!hdr) { 16306 nlmsg_free(msg); 16307 return; 16308 } 16309 16310 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16311 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 16312 goto nla_put_failure; 16313 16314 attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE); 16315 if (!attr) 16316 goto nla_put_failure; 16317 16318 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) || 16319 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) || 16320 (preauth && 16321 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH))) 16322 goto nla_put_failure; 16323 16324 nla_nest_end(msg, attr); 16325 16326 genlmsg_end(msg, hdr); 16327 16328 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 16329 NL80211_MCGRP_MLME, gfp); 16330 return; 16331 16332 nla_put_failure: 16333 nlmsg_free(msg); 16334 } 16335 16336 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index, 16337 const u8 *bssid, bool preauth, gfp_t gfp) 16338 { 16339 struct wireless_dev *wdev = dev->ieee80211_ptr; 16340 struct wiphy *wiphy = wdev->wiphy; 16341 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16342 16343 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth); 16344 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp); 16345 } 16346 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify); 16347 16348 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev, 16349 struct net_device *netdev, 16350 struct cfg80211_chan_def *chandef, 16351 gfp_t gfp, 16352 enum nl80211_commands notif, 16353 u8 count) 16354 { 16355 struct sk_buff *msg; 16356 void *hdr; 16357 16358 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16359 if (!msg) 16360 return; 16361 16362 hdr = nl80211hdr_put(msg, 0, 0, 0, notif); 16363 if (!hdr) { 16364 nlmsg_free(msg); 16365 return; 16366 } 16367 16368 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 16369 goto nla_put_failure; 16370 16371 if (nl80211_send_chandef(msg, chandef)) 16372 goto nla_put_failure; 16373 16374 if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) && 16375 (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count))) 16376 goto nla_put_failure; 16377 16378 genlmsg_end(msg, hdr); 16379 16380 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 16381 NL80211_MCGRP_MLME, gfp); 16382 return; 16383 16384 nla_put_failure: 16385 nlmsg_free(msg); 16386 } 16387 16388 void cfg80211_ch_switch_notify(struct net_device *dev, 16389 struct cfg80211_chan_def *chandef) 16390 { 16391 struct wireless_dev *wdev = dev->ieee80211_ptr; 16392 struct wiphy *wiphy = wdev->wiphy; 16393 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16394 16395 ASSERT_WDEV_LOCK(wdev); 16396 16397 trace_cfg80211_ch_switch_notify(dev, chandef); 16398 16399 wdev->chandef = *chandef; 16400 wdev->preset_chandef = *chandef; 16401 16402 if (wdev->iftype == NL80211_IFTYPE_STATION && 16403 !WARN_ON(!wdev->current_bss)) 16404 cfg80211_update_assoc_bss_entry(wdev, chandef->chan); 16405 16406 cfg80211_sched_dfs_chan_update(rdev); 16407 16408 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL, 16409 NL80211_CMD_CH_SWITCH_NOTIFY, 0); 16410 } 16411 EXPORT_SYMBOL(cfg80211_ch_switch_notify); 16412 16413 void cfg80211_ch_switch_started_notify(struct net_device *dev, 16414 struct cfg80211_chan_def *chandef, 16415 u8 count) 16416 { 16417 struct wireless_dev *wdev = dev->ieee80211_ptr; 16418 struct wiphy *wiphy = wdev->wiphy; 16419 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16420 16421 trace_cfg80211_ch_switch_started_notify(dev, chandef); 16422 16423 nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL, 16424 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count); 16425 } 16426 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify); 16427 16428 void 16429 nl80211_radar_notify(struct cfg80211_registered_device *rdev, 16430 const struct cfg80211_chan_def *chandef, 16431 enum nl80211_radar_event event, 16432 struct net_device *netdev, gfp_t gfp) 16433 { 16434 struct sk_buff *msg; 16435 void *hdr; 16436 16437 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16438 if (!msg) 16439 return; 16440 16441 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT); 16442 if (!hdr) { 16443 nlmsg_free(msg); 16444 return; 16445 } 16446 16447 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 16448 goto nla_put_failure; 16449 16450 /* NOP and radar events don't need a netdev parameter */ 16451 if (netdev) { 16452 struct wireless_dev *wdev = netdev->ieee80211_ptr; 16453 16454 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 16455 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 16456 NL80211_ATTR_PAD)) 16457 goto nla_put_failure; 16458 } 16459 16460 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event)) 16461 goto nla_put_failure; 16462 16463 if (nl80211_send_chandef(msg, chandef)) 16464 goto nla_put_failure; 16465 16466 genlmsg_end(msg, hdr); 16467 16468 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 16469 NL80211_MCGRP_MLME, gfp); 16470 return; 16471 16472 nla_put_failure: 16473 nlmsg_free(msg); 16474 } 16475 16476 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac, 16477 struct sta_opmode_info *sta_opmode, 16478 gfp_t gfp) 16479 { 16480 struct sk_buff *msg; 16481 struct wireless_dev *wdev = dev->ieee80211_ptr; 16482 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 16483 void *hdr; 16484 16485 if (WARN_ON(!mac)) 16486 return; 16487 16488 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16489 if (!msg) 16490 return; 16491 16492 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED); 16493 if (!hdr) { 16494 nlmsg_free(msg); 16495 return; 16496 } 16497 16498 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 16499 goto nla_put_failure; 16500 16501 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 16502 goto nla_put_failure; 16503 16504 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 16505 goto nla_put_failure; 16506 16507 if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) && 16508 nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode)) 16509 goto nla_put_failure; 16510 16511 if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) && 16512 nla_put_u8(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw)) 16513 goto nla_put_failure; 16514 16515 if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) && 16516 nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss)) 16517 goto nla_put_failure; 16518 16519 genlmsg_end(msg, hdr); 16520 16521 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 16522 NL80211_MCGRP_MLME, gfp); 16523 16524 return; 16525 16526 nla_put_failure: 16527 nlmsg_free(msg); 16528 } 16529 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify); 16530 16531 void cfg80211_probe_status(struct net_device *dev, const u8 *addr, 16532 u64 cookie, bool acked, s32 ack_signal, 16533 bool is_valid_ack_signal, gfp_t gfp) 16534 { 16535 struct wireless_dev *wdev = dev->ieee80211_ptr; 16536 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 16537 struct sk_buff *msg; 16538 void *hdr; 16539 16540 trace_cfg80211_probe_status(dev, addr, cookie, acked); 16541 16542 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16543 16544 if (!msg) 16545 return; 16546 16547 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT); 16548 if (!hdr) { 16549 nlmsg_free(msg); 16550 return; 16551 } 16552 16553 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16554 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 16555 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 16556 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 16557 NL80211_ATTR_PAD) || 16558 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) || 16559 (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL, 16560 ack_signal))) 16561 goto nla_put_failure; 16562 16563 genlmsg_end(msg, hdr); 16564 16565 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 16566 NL80211_MCGRP_MLME, gfp); 16567 return; 16568 16569 nla_put_failure: 16570 nlmsg_free(msg); 16571 } 16572 EXPORT_SYMBOL(cfg80211_probe_status); 16573 16574 void cfg80211_report_obss_beacon(struct wiphy *wiphy, 16575 const u8 *frame, size_t len, 16576 int freq, int sig_dbm) 16577 { 16578 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16579 struct sk_buff *msg; 16580 void *hdr; 16581 struct cfg80211_beacon_registration *reg; 16582 16583 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm); 16584 16585 spin_lock_bh(&rdev->beacon_registrations_lock); 16586 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 16587 msg = nlmsg_new(len + 100, GFP_ATOMIC); 16588 if (!msg) { 16589 spin_unlock_bh(&rdev->beacon_registrations_lock); 16590 return; 16591 } 16592 16593 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 16594 if (!hdr) 16595 goto nla_put_failure; 16596 16597 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16598 (freq && 16599 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) || 16600 (sig_dbm && 16601 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) || 16602 nla_put(msg, NL80211_ATTR_FRAME, len, frame)) 16603 goto nla_put_failure; 16604 16605 genlmsg_end(msg, hdr); 16606 16607 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid); 16608 } 16609 spin_unlock_bh(&rdev->beacon_registrations_lock); 16610 return; 16611 16612 nla_put_failure: 16613 spin_unlock_bh(&rdev->beacon_registrations_lock); 16614 nlmsg_free(msg); 16615 } 16616 EXPORT_SYMBOL(cfg80211_report_obss_beacon); 16617 16618 #ifdef CONFIG_PM 16619 static int cfg80211_net_detect_results(struct sk_buff *msg, 16620 struct cfg80211_wowlan_wakeup *wakeup) 16621 { 16622 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect; 16623 struct nlattr *nl_results, *nl_match, *nl_freqs; 16624 int i, j; 16625 16626 nl_results = nla_nest_start_noflag(msg, 16627 NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS); 16628 if (!nl_results) 16629 return -EMSGSIZE; 16630 16631 for (i = 0; i < nd->n_matches; i++) { 16632 struct cfg80211_wowlan_nd_match *match = nd->matches[i]; 16633 16634 nl_match = nla_nest_start_noflag(msg, i); 16635 if (!nl_match) 16636 break; 16637 16638 /* The SSID attribute is optional in nl80211, but for 16639 * simplicity reasons it's always present in the 16640 * cfg80211 structure. If a driver can't pass the 16641 * SSID, that needs to be changed. A zero length SSID 16642 * is still a valid SSID (wildcard), so it cannot be 16643 * used for this purpose. 16644 */ 16645 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len, 16646 match->ssid.ssid)) { 16647 nla_nest_cancel(msg, nl_match); 16648 goto out; 16649 } 16650 16651 if (match->n_channels) { 16652 nl_freqs = nla_nest_start_noflag(msg, 16653 NL80211_ATTR_SCAN_FREQUENCIES); 16654 if (!nl_freqs) { 16655 nla_nest_cancel(msg, nl_match); 16656 goto out; 16657 } 16658 16659 for (j = 0; j < match->n_channels; j++) { 16660 if (nla_put_u32(msg, j, match->channels[j])) { 16661 nla_nest_cancel(msg, nl_freqs); 16662 nla_nest_cancel(msg, nl_match); 16663 goto out; 16664 } 16665 } 16666 16667 nla_nest_end(msg, nl_freqs); 16668 } 16669 16670 nla_nest_end(msg, nl_match); 16671 } 16672 16673 out: 16674 nla_nest_end(msg, nl_results); 16675 return 0; 16676 } 16677 16678 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev, 16679 struct cfg80211_wowlan_wakeup *wakeup, 16680 gfp_t gfp) 16681 { 16682 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 16683 struct sk_buff *msg; 16684 void *hdr; 16685 int size = 200; 16686 16687 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup); 16688 16689 if (wakeup) 16690 size += wakeup->packet_present_len; 16691 16692 msg = nlmsg_new(size, gfp); 16693 if (!msg) 16694 return; 16695 16696 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN); 16697 if (!hdr) 16698 goto free_msg; 16699 16700 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16701 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 16702 NL80211_ATTR_PAD)) 16703 goto free_msg; 16704 16705 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 16706 wdev->netdev->ifindex)) 16707 goto free_msg; 16708 16709 if (wakeup) { 16710 struct nlattr *reasons; 16711 16712 reasons = nla_nest_start_noflag(msg, 16713 NL80211_ATTR_WOWLAN_TRIGGERS); 16714 if (!reasons) 16715 goto free_msg; 16716 16717 if (wakeup->disconnect && 16718 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) 16719 goto free_msg; 16720 if (wakeup->magic_pkt && 16721 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) 16722 goto free_msg; 16723 if (wakeup->gtk_rekey_failure && 16724 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) 16725 goto free_msg; 16726 if (wakeup->eap_identity_req && 16727 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) 16728 goto free_msg; 16729 if (wakeup->four_way_handshake && 16730 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) 16731 goto free_msg; 16732 if (wakeup->rfkill_release && 16733 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)) 16734 goto free_msg; 16735 16736 if (wakeup->pattern_idx >= 0 && 16737 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 16738 wakeup->pattern_idx)) 16739 goto free_msg; 16740 16741 if (wakeup->tcp_match && 16742 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH)) 16743 goto free_msg; 16744 16745 if (wakeup->tcp_connlost && 16746 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST)) 16747 goto free_msg; 16748 16749 if (wakeup->tcp_nomoretokens && 16750 nla_put_flag(msg, 16751 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS)) 16752 goto free_msg; 16753 16754 if (wakeup->packet) { 16755 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211; 16756 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN; 16757 16758 if (!wakeup->packet_80211) { 16759 pkt_attr = 16760 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023; 16761 len_attr = 16762 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN; 16763 } 16764 16765 if (wakeup->packet_len && 16766 nla_put_u32(msg, len_attr, wakeup->packet_len)) 16767 goto free_msg; 16768 16769 if (nla_put(msg, pkt_attr, wakeup->packet_present_len, 16770 wakeup->packet)) 16771 goto free_msg; 16772 } 16773 16774 if (wakeup->net_detect && 16775 cfg80211_net_detect_results(msg, wakeup)) 16776 goto free_msg; 16777 16778 nla_nest_end(msg, reasons); 16779 } 16780 16781 genlmsg_end(msg, hdr); 16782 16783 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 16784 NL80211_MCGRP_MLME, gfp); 16785 return; 16786 16787 free_msg: 16788 nlmsg_free(msg); 16789 } 16790 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup); 16791 #endif 16792 16793 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer, 16794 enum nl80211_tdls_operation oper, 16795 u16 reason_code, gfp_t gfp) 16796 { 16797 struct wireless_dev *wdev = dev->ieee80211_ptr; 16798 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 16799 struct sk_buff *msg; 16800 void *hdr; 16801 16802 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper, 16803 reason_code); 16804 16805 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16806 if (!msg) 16807 return; 16808 16809 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER); 16810 if (!hdr) { 16811 nlmsg_free(msg); 16812 return; 16813 } 16814 16815 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16816 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 16817 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) || 16818 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) || 16819 (reason_code > 0 && 16820 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code))) 16821 goto nla_put_failure; 16822 16823 genlmsg_end(msg, hdr); 16824 16825 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 16826 NL80211_MCGRP_MLME, gfp); 16827 return; 16828 16829 nla_put_failure: 16830 nlmsg_free(msg); 16831 } 16832 EXPORT_SYMBOL(cfg80211_tdls_oper_request); 16833 16834 static int nl80211_netlink_notify(struct notifier_block * nb, 16835 unsigned long state, 16836 void *_notify) 16837 { 16838 struct netlink_notify *notify = _notify; 16839 struct cfg80211_registered_device *rdev; 16840 struct wireless_dev *wdev; 16841 struct cfg80211_beacon_registration *reg, *tmp; 16842 16843 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC) 16844 return NOTIFY_DONE; 16845 16846 rcu_read_lock(); 16847 16848 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 16849 struct cfg80211_sched_scan_request *sched_scan_req; 16850 16851 list_for_each_entry_rcu(sched_scan_req, 16852 &rdev->sched_scan_req_list, 16853 list) { 16854 if (sched_scan_req->owner_nlportid == notify->portid) { 16855 sched_scan_req->nl_owner_dead = true; 16856 schedule_work(&rdev->sched_scan_stop_wk); 16857 } 16858 } 16859 16860 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) { 16861 cfg80211_mlme_unregister_socket(wdev, notify->portid); 16862 16863 if (wdev->owner_nlportid == notify->portid) { 16864 wdev->nl_owner_dead = true; 16865 schedule_work(&rdev->destroy_work); 16866 } else if (wdev->conn_owner_nlportid == notify->portid) { 16867 schedule_work(&wdev->disconnect_wk); 16868 } 16869 16870 cfg80211_release_pmsr(wdev, notify->portid); 16871 } 16872 16873 spin_lock_bh(&rdev->beacon_registrations_lock); 16874 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations, 16875 list) { 16876 if (reg->nlportid == notify->portid) { 16877 list_del(®->list); 16878 kfree(reg); 16879 break; 16880 } 16881 } 16882 spin_unlock_bh(&rdev->beacon_registrations_lock); 16883 } 16884 16885 rcu_read_unlock(); 16886 16887 /* 16888 * It is possible that the user space process that is controlling the 16889 * indoor setting disappeared, so notify the regulatory core. 16890 */ 16891 regulatory_netlink_notify(notify->portid); 16892 return NOTIFY_OK; 16893 } 16894 16895 static struct notifier_block nl80211_netlink_notifier = { 16896 .notifier_call = nl80211_netlink_notify, 16897 }; 16898 16899 void cfg80211_ft_event(struct net_device *netdev, 16900 struct cfg80211_ft_event_params *ft_event) 16901 { 16902 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 16903 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16904 struct sk_buff *msg; 16905 void *hdr; 16906 16907 trace_cfg80211_ft_event(wiphy, netdev, ft_event); 16908 16909 if (!ft_event->target_ap) 16910 return; 16911 16912 msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len, 16913 GFP_KERNEL); 16914 if (!msg) 16915 return; 16916 16917 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT); 16918 if (!hdr) 16919 goto out; 16920 16921 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16922 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 16923 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap)) 16924 goto out; 16925 16926 if (ft_event->ies && 16927 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies)) 16928 goto out; 16929 if (ft_event->ric_ies && 16930 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len, 16931 ft_event->ric_ies)) 16932 goto out; 16933 16934 genlmsg_end(msg, hdr); 16935 16936 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 16937 NL80211_MCGRP_MLME, GFP_KERNEL); 16938 return; 16939 out: 16940 nlmsg_free(msg); 16941 } 16942 EXPORT_SYMBOL(cfg80211_ft_event); 16943 16944 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp) 16945 { 16946 struct cfg80211_registered_device *rdev; 16947 struct sk_buff *msg; 16948 void *hdr; 16949 u32 nlportid; 16950 16951 rdev = wiphy_to_rdev(wdev->wiphy); 16952 if (!rdev->crit_proto_nlportid) 16953 return; 16954 16955 nlportid = rdev->crit_proto_nlportid; 16956 rdev->crit_proto_nlportid = 0; 16957 16958 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16959 if (!msg) 16960 return; 16961 16962 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP); 16963 if (!hdr) 16964 goto nla_put_failure; 16965 16966 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16967 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 16968 NL80211_ATTR_PAD)) 16969 goto nla_put_failure; 16970 16971 genlmsg_end(msg, hdr); 16972 16973 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 16974 return; 16975 16976 nla_put_failure: 16977 nlmsg_free(msg); 16978 } 16979 EXPORT_SYMBOL(cfg80211_crit_proto_stopped); 16980 16981 void nl80211_send_ap_stopped(struct wireless_dev *wdev) 16982 { 16983 struct wiphy *wiphy = wdev->wiphy; 16984 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16985 struct sk_buff *msg; 16986 void *hdr; 16987 16988 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 16989 if (!msg) 16990 return; 16991 16992 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP); 16993 if (!hdr) 16994 goto out; 16995 16996 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16997 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 16998 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 16999 NL80211_ATTR_PAD)) 17000 goto out; 17001 17002 genlmsg_end(msg, hdr); 17003 17004 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 17005 NL80211_MCGRP_MLME, GFP_KERNEL); 17006 return; 17007 out: 17008 nlmsg_free(msg); 17009 } 17010 17011 int cfg80211_external_auth_request(struct net_device *dev, 17012 struct cfg80211_external_auth_params *params, 17013 gfp_t gfp) 17014 { 17015 struct wireless_dev *wdev = dev->ieee80211_ptr; 17016 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 17017 struct sk_buff *msg; 17018 void *hdr; 17019 17020 if (!wdev->conn_owner_nlportid) 17021 return -EINVAL; 17022 17023 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 17024 if (!msg) 17025 return -ENOMEM; 17026 17027 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH); 17028 if (!hdr) 17029 goto nla_put_failure; 17030 17031 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 17032 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 17033 nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) || 17034 nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION, 17035 params->action) || 17036 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) || 17037 nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len, 17038 params->ssid.ssid)) 17039 goto nla_put_failure; 17040 17041 genlmsg_end(msg, hdr); 17042 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 17043 wdev->conn_owner_nlportid); 17044 return 0; 17045 17046 nla_put_failure: 17047 nlmsg_free(msg); 17048 return -ENOBUFS; 17049 } 17050 EXPORT_SYMBOL(cfg80211_external_auth_request); 17051 17052 void cfg80211_update_owe_info_event(struct net_device *netdev, 17053 struct cfg80211_update_owe_info *owe_info, 17054 gfp_t gfp) 17055 { 17056 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 17057 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 17058 struct sk_buff *msg; 17059 void *hdr; 17060 17061 trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info); 17062 17063 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 17064 if (!msg) 17065 return; 17066 17067 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO); 17068 if (!hdr) 17069 goto nla_put_failure; 17070 17071 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 17072 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 17073 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer)) 17074 goto nla_put_failure; 17075 17076 if (!owe_info->ie_len || 17077 nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie)) 17078 goto nla_put_failure; 17079 17080 genlmsg_end(msg, hdr); 17081 17082 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17083 NL80211_MCGRP_MLME, gfp); 17084 return; 17085 17086 nla_put_failure: 17087 genlmsg_cancel(msg, hdr); 17088 nlmsg_free(msg); 17089 } 17090 EXPORT_SYMBOL(cfg80211_update_owe_info_event); 17091 17092 /* initialisation/exit functions */ 17093 17094 int __init nl80211_init(void) 17095 { 17096 int err; 17097 17098 err = genl_register_family(&nl80211_fam); 17099 if (err) 17100 return err; 17101 17102 err = netlink_register_notifier(&nl80211_netlink_notifier); 17103 if (err) 17104 goto err_out; 17105 17106 return 0; 17107 err_out: 17108 genl_unregister_family(&nl80211_fam); 17109 return err; 17110 } 17111 17112 void nl80211_exit(void) 17113 { 17114 netlink_unregister_notifier(&nl80211_netlink_notifier); 17115 genl_unregister_family(&nl80211_fam); 17116 } 17117